0004589c <_API_Mutex_Unlock>: #include void _API_Mutex_Unlock( API_Mutex_Control *the_mutex ) { 4589c: 4e56 0000 linkw %fp,#0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 458a0: 2039 0005 cd08 movel 5cd08 <_Thread_Dispatch_disable_level>,%d0 458a6: 5280 addql #1,%d0 458a8: 206e 0008 moveal %fp@(8),%a0 458ac: 23c0 0005 cd08 movel %d0,5cd08 <_Thread_Dispatch_disable_level> _Thread_Disable_dispatch(); _CORE_mutex_Surrender( 458b2: 42a7 clrl %sp@- 458b4: 2f28 0008 movel %a0@(8),%sp@- 458b8: 4868 0010 pea %a0@(16) 458bc: 4eb9 0004 5ac8 jsr 45ac8 <_CORE_mutex_Surrender> &the_mutex->Mutex, the_mutex->Object.id, NULL ); _Thread_Enable_dispatch(); 458c2: 4fef 000c lea %sp@(12),%sp } 458c6: 4e5e unlk %fp _CORE_mutex_Surrender( &the_mutex->Mutex, the_mutex->Object.id, NULL ); _Thread_Enable_dispatch(); 458c8: 4ef9 0004 6ce2 jmp 46ce2 <_Thread_Enable_dispatch> ... 0004bfe8 <_CORE_barrier_Wait>: Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4bfe8: 203c 0000 0700 movel #1792,%d0 Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4bfee: 4e56 fff4 linkw %fp,#-12 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; 4bff2: 2279 0005 cdc2 moveal 5cdc2 <_Thread_Executing>,%a1 Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4bff8: 48d7 001c moveml %d2-%d4,%sp@ 4bffc: 242e 000c movel %fp@(12),%d2 4c000: 262e 0014 movel %fp@(20),%d3 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL; 4c004: 42a9 0034 clrl %a1@(52) Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4c008: 206e 0008 moveal %fp@(8),%a0 4c00c: 282e 0018 movel %fp@(24),%d4 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4c010: 40c1 movew %sr,%d1 4c012: 8081 orl %d1,%d0 4c014: 46c0 movew %d0,%sr the_barrier->number_of_waiting_threads++; 4c016: 2028 0048 movel %a0@(72),%d0 4c01a: 5280 addql #1,%d0 4c01c: 2140 0048 movel %d0,%a0@(72) if ( _CORE_barrier_Is_automatic( &the_barrier->Attributes ) ) { 4c020: 4aa8 0040 tstl %a0@(64) 4c024: 6626 bnes 4c04c <_CORE_barrier_Wait+0x64> if ( the_barrier->number_of_waiting_threads == the_barrier->Attributes.maximum_count) { 4c026: b0a8 0044 cmpl %a0@(68),%d0 4c02a: 6620 bnes 4c04c <_CORE_barrier_Wait+0x64> executing->Wait.return_code = CORE_BARRIER_STATUS_AUTOMATICALLY_RELEASED; 4c02c: 7001 moveq #1,%d0 4c02e: 2340 0034 movel %d0,%a1@(52) _ISR_Enable( level ); 4c032: 46c1 movew %d1,%sr _CORE_barrier_Release( the_barrier, id, api_barrier_mp_support ); 4c034: 2d44 0010 movel %d4,%fp@(16) 4c038: 2d42 000c movel %d2,%fp@(12) 4c03c: 2d48 0008 movel %a0,%fp@(8) executing->Wait.queue = &the_barrier->Wait_queue; executing->Wait.id = id; _ISR_Enable( level ); _Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout ); } 4c040: 4cd7 001c moveml %sp@,%d2-%d4 4c044: 4e5e unlk %fp if ( _CORE_barrier_Is_automatic( &the_barrier->Attributes ) ) { if ( the_barrier->number_of_waiting_threads == the_barrier->Attributes.maximum_count) { executing->Wait.return_code = CORE_BARRIER_STATUS_AUTOMATICALLY_RELEASED; _ISR_Enable( level ); _CORE_barrier_Release( the_barrier, id, api_barrier_mp_support ); 4c046: 4ef9 0004 bfb4 jmp 4bfb4 <_CORE_barrier_Release> 4c04c: 7001 moveq #1,%d0 } } _Thread_queue_Enter_critical_section( &the_barrier->Wait_queue ); executing->Wait.queue = &the_barrier->Wait_queue; executing->Wait.id = id; 4c04e: 2342 0020 movel %d2,%a1@(32) return; } } _Thread_queue_Enter_critical_section( &the_barrier->Wait_queue ); executing->Wait.queue = &the_barrier->Wait_queue; 4c052: 2348 0044 movel %a0,%a1@(68) 4c056: 2140 0030 movel %d0,%a0@(48) executing->Wait.id = id; _ISR_Enable( level ); 4c05a: 46c1 movew %d1,%sr _Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout ); 4c05c: 2d43 000c movel %d3,%fp@(12) 4c060: 203c 0004 7468 movel #291944,%d0 4c066: 2d48 0008 movel %a0,%fp@(8) 4c06a: 2d40 0010 movel %d0,%fp@(16) } 4c06e: 4cd7 001c moveml %sp@,%d2-%d4 4c072: 4e5e unlk %fp _Thread_queue_Enter_critical_section( &the_barrier->Wait_queue ); executing->Wait.queue = &the_barrier->Wait_queue; executing->Wait.id = id; _ISR_Enable( level ); _Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout ); 4c074: 4ef9 0004 717c jmp 4717c <_Thread_queue_Enqueue_with_handler> ... 00052088 <_CORE_message_queue_Broadcast>: Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 52088: 4e56 ffe0 linkw %fp,#-32 5208c: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 52090: 246e 0008 moveal %fp@(8),%a2 52094: 2a2e 000c movel %fp@(12),%d5 52098: 262e 0010 movel %fp@(16),%d3 5209c: 286e 001c moveal %fp@(28),%a4 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 520a0: b6aa 004c cmpl %a2@(76),%d3 520a4: 6304 blss 520aa <_CORE_message_queue_Broadcast+0x22> 520a6: 7001 moveq #1,%d0 <== NOT EXECUTED 520a8: 6042 bras 520ec <_CORE_message_queue_Broadcast+0x64><== NOT EXECUTED * 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 ) { 520aa: 4aaa 0048 tstl %a2@(72) 520ae: 6610 bnes 520c0 <_CORE_message_queue_Broadcast+0x38> * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 520b0: 4282 clrl %d2 520b2: 283c 0005 439c movel #344988,%d4 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 520b8: 4bf9 0005 a3f4 lea 5a3f4 ,%a5 520be: 601a bras 520da <_CORE_message_queue_Broadcast+0x52> * send and receive and this ensures that we are broadcasting * the message to threads waiting to receive -- not to send. */ if ( the_message_queue->number_of_pending_messages != 0 ) { *count = 0; 520c0: 4294 clrl %a4@ 520c2: 6026 bras 520ea <_CORE_message_queue_Broadcast+0x62> 520c4: 2f03 movel %d3,%sp@- */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 520c6: 5282 addql #1,%d2 520c8: 2f05 movel %d5,%sp@- 520ca: 2f2b 002c movel %a3@(44),%sp@- 520ce: 4e95 jsr %a5@ buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 520d0: 206b 0028 moveal %a3@(40),%a0 520d4: 4fef 000c lea %sp@(12),%sp 520d8: 2083 movel %d3,%a0@ * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 520da: 2f0a movel %a2,%sp@- 520dc: 2044 moveal %d4,%a0 520de: 4e90 jsr %a0@ /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 520e0: 588f addql #4,%sp _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 520e2: 2640 moveal %d0,%a3 /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 520e4: 4a80 tstl %d0 520e6: 66dc bnes 520c4 <_CORE_message_queue_Broadcast+0x3c> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 520e8: 2882 movel %d2,%a4@ 520ea: 4280 clrl %d0 return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } 520ec: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 520f2: 4e5e unlk %fp ... 0004dd08 <_CORE_message_queue_Seize>: CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4dd08: 223c 0000 0700 movel #1792,%d1 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4dd0e: 4e56 ffe0 linkw %fp,#-32 ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 4dd12: 2079 0006 6396 moveal 66396 <_Thread_Executing>,%a0 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4dd18: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 4dd1c: 282e 000c movel %fp@(12),%d4 4dd20: 242e 001c movel %fp@(28),%d2 4dd24: 246e 0008 moveal %fp@(8),%a2 ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 4dd28: 42a8 0034 clrl %a0@(52) void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4dd2c: 262e 0010 movel %fp@(16),%d3 4dd30: 226e 0014 moveal %fp@(20),%a1 4dd34: 1a2e 001b moveb %fp@(27),%d5 CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4dd38: 40c0 movew %sr,%d0 4dd3a: 8280 orl %d0,%d1 4dd3c: 46c1 movew %d1,%sr */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4dd3e: 220a movel %a2,%d1 4dd40: 0681 0000 0054 addil #84,%d1 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 4dd46: 266a 0050 moveal %a2@(80),%a3 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4dd4a: b28b cmpl %a3,%d1 4dd4c: 6700 00a6 beqw 4ddf4 <_CORE_message_queue_Seize+0xec> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 4dd50: 2853 moveal %a3@,%a4 the_chain->first = new_first; new_first->previous = _Chain_Head(the_chain); 4dd52: 4bea 0050 lea %a2@(80),%a5 Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; the_chain->first = new_first; 4dd56: 254c 0050 movel %a4,%a2@(80) new_first->previous = _Chain_Head(the_chain); 4dd5a: 294d 0004 movel %a5,%a4@(4) the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { 4dd5e: 4a8b tstl %a3 4dd60: 6700 0092 beqw 4ddf4 <_CORE_message_queue_Seize+0xec> the_message_queue->number_of_pending_messages -= 1; 4dd64: 53aa 0048 subql #1,%a2@(72) _ISR_Enable( level ); 4dd68: 46c0 movew %d0,%sr *size_p = the_message->Contents.size; _Thread_Executing->Wait.count = 4dd6a: 2079 0006 6396 moveal 66396 <_Thread_Executing>,%a0 the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; _ISR_Enable( level ); *size_p = the_message->Contents.size; 4dd70: 22ab 000c movel %a3@(12),%a1@ _Thread_Executing->Wait.count = _CORE_message_queue_Get_message_priority( the_message ); _CORE_message_queue_Copy_buffer( the_message->Contents.buffer, 4dd74: 240b movel %a3,%d2 4dd76: 0682 0000 0010 addil #16,%d2 if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; _ISR_Enable( level ); *size_p = the_message->Contents.size; _Thread_Executing->Wait.count = 4dd7c: 216b 0008 0024 movel %a3@(8),%a0@(36) const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4dd82: 49f9 0005 55d0 lea 555d0 ,%a4 4dd88: 2f11 movel %a1@,%sp@- 4dd8a: 2f02 movel %d2,%sp@- 4dd8c: 2f03 movel %d3,%sp@- 4dd8e: 4e94 jsr %a4@ * is not, then we can go ahead and free the buffer. * * NOTE: If we note that the queue was not full before this receive, * then we can avoid this dequeue. */ the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 4dd90: 2f0a movel %a2,%sp@- 4dd92: 4eb9 0004 f7b0 jsr 4f7b0 <_Thread_queue_Dequeue> if ( !the_thread ) { 4dd98: 4fef 0010 lea %sp@(16),%sp * is not, then we can go ahead and free the buffer. * * NOTE: If we note that the queue was not full before this receive, * then we can avoid this dequeue. */ the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 4dd9c: 2040 moveal %d0,%a0 if ( !the_thread ) { 4dd9e: 4a80 tstl %d0 4dda0: 661a bnes 4ddbc <_CORE_message_queue_Seize+0xb4> RTEMS_INLINE_ROUTINE void _CORE_message_queue_Free_message_buffer ( CORE_message_queue_Control *the_message_queue, CORE_message_queue_Buffer_control *the_message ) { _Chain_Append( &the_message_queue->Inactive_messages, &the_message->Node ); 4dda2: 45ea 0068 lea %a2@(104),%a2 4dda6: 2d4b 000c movel %a3,%fp@(12) 4ddaa: 2d4a 0008 movel %a2,%fp@(8) executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4ddae: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4ddb4: 4e5e unlk %fp 4ddb6: 4ef9 0004 db88 jmp 4db88 <_Chain_Append> */ _CORE_message_queue_Set_message_priority( the_message, the_thread->Wait.count ); the_message->Contents.size = (size_t) the_thread->Wait.option; 4ddbc: 2028 0030 movel %a0@(48),%d0 CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 4ddc0: 2768 0024 0008 movel %a0@(36),%a3@(8) 4ddc6: 2740 000c movel %d0,%a3@(12) const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4ddca: 2f00 movel %d0,%sp@- 4ddcc: 2f28 002c movel %a0@(44),%sp@- 4ddd0: 2f02 movel %d2,%sp@- 4ddd2: 4e94 jsr %a4@ the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 4ddd4: 2d6b 0008 0010 movel %a3@(8),%fp@(16) 4ddda: 4fef 000c lea %sp@(12),%sp 4ddde: 2d4b 000c movel %a3,%fp@(12) 4dde2: 2d4a 0008 movel %a2,%fp@(8) executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4dde6: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4ddec: 4e5e unlk %fp the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 4ddee: 4ef9 0005 25f8 jmp 525f8 <_CORE_message_queue_Insert_message> return; } #endif } if ( !wait ) { 4ddf4: 4a05 tstb %d5 4ddf6: 6612 bnes 4de0a <_CORE_message_queue_Seize+0x102> _ISR_Enable( level ); 4ddf8: 46c0 movew %d0,%sr executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 4ddfa: 7004 moveq #4,%d0 executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4ddfc: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 #endif } if ( !wait ) { _ISR_Enable( level ); executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 4de02: 2140 0034 movel %d0,%a0@(52) executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4de06: 4e5e unlk %fp 4de08: 4e75 rts 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; 4de0a: 7201 moveq #1,%d1 4de0c: 2541 0030 movel %d1,%a2@(48) _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; 4de10: 2149 0028 movel %a1,%a0@(40) } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; 4de14: 2143 002c movel %d3,%a0@(44) return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; 4de18: 2144 0020 movel %d4,%a0@(32) executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; 4de1c: 214a 0044 movel %a2,%a0@(68) executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 4de20: 46c0 movew %d0,%sr _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 4de22: 4bf9 0004 fbdc lea 4fbdc <_Thread_queue_Timeout>,%a5 4de28: 2d42 000c movel %d2,%fp@(12) 4de2c: 2d4d 0010 movel %a5,%fp@(16) 4de30: 2d4a 0008 movel %a2,%fp@(8) } 4de34: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4de3a: 4e5e unlk %fp executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 4de3c: 4ef9 0004 f8f0 jmp 4f8f0 <_Thread_queue_Enqueue_with_handler> ... 00045c14 <_CORE_semaphore_Surrender>: CORE_semaphore_Status _CORE_semaphore_Surrender( CORE_semaphore_Control *the_semaphore, Objects_Id id, CORE_semaphore_API_mp_support_callout api_semaphore_mp_support ) { 45c14: 4e56 0000 linkw %fp,#0 45c18: 2f0a movel %a2,%sp@- 45c1a: 246e 0008 moveal %fp@(8),%a2 ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 45c1e: 2f0a movel %a2,%sp@- 45c20: 4eb9 0004 703c jsr 4703c <_Thread_queue_Dequeue> 45c26: 588f addql #4,%sp 45c28: 4a80 tstl %d0 45c2a: 6704 beqs 45c30 <_CORE_semaphore_Surrender+0x1c> 45c2c: 4280 clrl %d0 45c2e: 6024 bras 45c54 <_CORE_semaphore_Surrender+0x40> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 45c30: 203c 0000 0700 movel #1792,%d0 45c36: 40c1 movew %sr,%d1 45c38: 8081 orl %d1,%d0 45c3a: 46c0 movew %d0,%sr if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 45c3c: 202a 0048 movel %a2@(72),%d0 45c40: b0aa 0040 cmpl %a2@(64),%d0 45c44: 6504 bcss 45c4a <_CORE_semaphore_Surrender+0x36> 45c46: 7004 moveq #4,%d0 <== NOT EXECUTED 45c48: 6008 bras 45c52 <_CORE_semaphore_Surrender+0x3e> <== NOT EXECUTED the_semaphore->count += 1; 45c4a: 5280 addql #1,%d0 45c4c: 2540 0048 movel %d0,%a2@(72) 45c50: 4280 clrl %d0 else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 45c52: 46c1 movew %d1,%sr } return status; } 45c54: 246e fffc moveal %fp@(-4),%a2 45c58: 4e5e unlk %fp <== NOT EXECUTED 00045fd8 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 45fd8: 4e56 0000 linkw %fp,#0 45fdc: 222e 000c movel %fp@(12),%d1 45fe0: 2f03 movel %d3,%sp@- _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 ); 45fe2: 4283 clrl %d3 45fe4: 1601 moveb %d1,%d3 void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 45fe6: 2f02 movel %d2,%sp@- 45fe8: 242e 0010 movel %fp@(16),%d2 _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 ); 45fec: 2f02 movel %d2,%sp@- void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 45fee: 202e 0008 movel %fp@(8),%d0 _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 ); 45ff2: 2f03 movel %d3,%sp@- _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 45ff4: 263c 0000 0700 movel #1792,%d3 _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 ); 45ffa: 2f00 movel %d0,%sp@- Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; 45ffc: 13c1 0005 cdb2 moveb %d1,5cdb2 <_Internal_errors_What_happened+0x4> bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; 46002: 23c0 0005 cdae movel %d0,5cdae <_Internal_errors_What_happened> _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; 46008: 23c2 0005 cdb4 movel %d2,5cdb4 <_Internal_errors_What_happened+0x6> _User_extensions_Fatal( the_source, is_internal, the_error ); 4600e: 4eb9 0004 7b0a jsr 47b0a <_User_extensions_Fatal> _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 46014: 40c0 movew %sr,%d0 46016: 8083 orl %d3,%d0 46018: 46c0 movew %d0,%sr 4601a: 2002 movel %d2,%d0 <== NOT EXECUTED 4601c: 223c dead beef movel #-559038737,%d1 <== NOT EXECUTED 46022: 4ac8 halt <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 46024: 7005 moveq #5,%d0 46026: 4fef 000c lea %sp@(12),%sp 4602a: 23c0 0005 ce90 movel %d0,5ce90 <_System_state_Current> 46030: 60fe bras 46030 <_Internal_error_Occurred+0x58> ... 0004609c <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 4609c: 4e56 fff0 linkw %fp,#-16 460a0: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 460a4: 246e 0008 moveal %fp@(8),%a2 * If the application is using the optional manager stubs and * still attempts to create the object, the information block * should be all zeroed out because it is in the BSS. So let's * check that code for this manager is even present. */ if ( information->size == 0 ) 460a8: 4aaa 0014 tstl %a2@(20) 460ac: 6604 bnes 460b2 <_Objects_Allocate+0x16> 460ae: 4280 clrl %d0 <== NOT EXECUTED 460b0: 605e bras 46110 <_Objects_Allocate+0x74> <== NOT EXECUTED /* * OK. The manager should be initialized and configured to have objects. * With any luck, it is safe to attempt to allocate an object. */ the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 460b2: 240a movel %a2,%d2 460b4: 0682 0000 001c addil #28,%d2 460ba: 47f9 0004 a070 lea 4a070 <_Chain_Get>,%a3 460c0: 2f02 movel %d2,%sp@- 460c2: 4e93 jsr %a3@ if ( information->auto_extend ) { 460c4: 588f addql #4,%sp 460c6: 4a2a 0010 tstb %a2@(16) 460ca: 6744 beqs 46110 <_Objects_Allocate+0x74> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { 460cc: 4a80 tstl %d0 460ce: 6612 bnes 460e2 <_Objects_Allocate+0x46> _Objects_Extend_information( information ); 460d0: 2f0a movel %a2,%sp@- 460d2: 4eb9 0004 6148 jsr 46148 <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 460d8: 2f02 movel %d2,%sp@- 460da: 4e93 jsr %a3@ } if ( the_object ) { 460dc: 508f addql #8,%sp 460de: 4a80 tstl %d0 460e0: 672e beqs 46110 <_Objects_Allocate+0x74> uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 460e2: 2040 moveal %d0,%a0 460e4: 4281 clrl %d1 460e6: 4283 clrl %d3 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 460e8: 4282 clrl %d2 } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 460ea: 362a 0008 movew %a2@(8),%d3 460ee: 3228 000a movew %a0@(10),%d1 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 460f2: 342a 0012 movew %a2@(18),%d2 information->inactive--; 460f6: 306a 0028 moveaw %a2@(40),%a0 } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 460fa: 9283 subl %d3,%d1 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 460fc: 4c42 1001 remul %d2,%d1,%d1 information->inactive--; 46100: 5388 subql #1,%a0 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 46102: e589 lsll #2,%d1 information->inactive--; 46104: 3548 0028 movew %a0,%a2@(40) block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 46108: 206a 002a moveal %a2@(42),%a0 4610c: d1c1 addal %d1,%a0 4610e: 5390 subql #1,%a0@ information->inactive--; } } return the_object; } 46110: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 46116: 4e5e unlk %fp ... 0004611c <_Objects_Close>: #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4611c: 4280 clrl %d0 void _Objects_Close( Objects_Information *information, Objects_Control *the_object ) { 4611e: 4e56 0000 linkw %fp,#0 46122: 226e 000c moveal %fp@(12),%a1 46126: 206e 0008 moveal %fp@(8),%a0 4612a: 2f0a movel %a2,%sp@- 4612c: 2468 0018 moveal %a0@(24),%a2 46130: 3029 000a movew %a1@(10),%d0 46134: 42b2 0c00 clrl %a2@(00000000,%d0:l:4) _Objects_Invalidate_Id( information, the_object ); _Objects_Namespace_remove( information, the_object ); 46138: 2d49 000c movel %a1,%fp@(12) } 4613c: 245f moveal %sp@+,%a2 4613e: 4e5e unlk %fp Objects_Control *the_object ) { _Objects_Invalidate_Id( information, the_object ); _Objects_Namespace_remove( information, the_object ); 46140: 4ef9 0004 6640 jmp 46640 <_Objects_Namespace_remove> ... 00049e80 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 49e80: 4e56 fffc linkw %fp,#-4 49e84: 222e 0008 movel %fp@(8),%d1 49e88: 2f02 movel %d2,%sp@- /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 49e8a: 4a81 tstl %d1 49e8c: 660a bnes 49e98 <_Objects_Id_to_name+0x18> 49e8e: 2079 0006 863a moveal 6863a <_Thread_Executing>,%a0 49e94: 2228 0008 movel %a0@(8),%d1 */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); 49e98: 7418 moveq #24,%d2 49e9a: 2001 movel %d1,%d0 49e9c: e4a8 lsrl %d2,%d0 49e9e: 143c 0007 moveb #7,%d2 49ea2: c082 andl %d2,%d0 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) 49ea4: 143c 0003 moveb #3,%d2 49ea8: 2040 moveal %d0,%a0 49eaa: 5388 subql #1,%a0 49eac: b488 cmpl %a0,%d2 49eae: 6540 bcss 49ef0 <_Objects_Id_to_name+0x70> 49eb0: 6048 bras 49efa <_Objects_Id_to_name+0x7a> if ( !_Objects_Information_table[ the_api ] ) return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 49eb2: 2001 movel %d1,%d0 49eb4: 741b moveq #27,%d2 49eb6: e4a8 lsrl %d2,%d0 49eb8: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0 if ( !information ) 49ebc: 4a88 tstl %a0 49ebe: 6730 beqs 49ef0 <_Objects_Id_to_name+0x70> return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 49ec0: 4a28 0032 tstb %a0@(50) 49ec4: 662a bnes 49ef0 <_Objects_Id_to_name+0x70> return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 49ec6: 486e fffc pea %fp@(-4) 49eca: 2f01 movel %d1,%sp@- 49ecc: 2f08 movel %a0,%sp@- 49ece: 4eb9 0004 9e20 jsr 49e20 <_Objects_Get> if ( !the_object ) 49ed4: 4fef 000c lea %sp@(12),%sp 49ed8: 4a80 tstl %d0 49eda: 6714 beqs 49ef0 <_Objects_Id_to_name+0x70> return OBJECTS_INVALID_ID; *name = the_object->name; 49edc: 206e 000c moveal %fp@(12),%a0 49ee0: 2240 moveal %d0,%a1 49ee2: 20a9 000c movel %a1@(12),%a0@ _Thread_Enable_dispatch(); 49ee6: 4eb9 0004 a71e jsr 4a71e <_Thread_Enable_dispatch> 49eec: 4280 clrl %d0 return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 49eee: 6002 bras 49ef2 <_Objects_Id_to_name+0x72> 49ef0: 7003 moveq #3,%d0 } 49ef2: 242e fff8 movel %fp@(-8),%d2 49ef6: 4e5e unlk %fp 49ef8: 4e75 rts the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 49efa: 41f9 0006 8538 lea 68538 <_Objects_Information_table>,%a0 49f00: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0 49f04: 4a88 tstl %a0 49f06: 66aa bnes 49eb2 <_Objects_Id_to_name+0x32> 49f08: 60e6 bras 49ef0 <_Objects_Id_to_name+0x70> ... 00046a50 <_Objects_Set_name>: { size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a50: 4280 clrl %d0 bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 46a52: 4e56 ffe0 linkw %fp,#-32 46a56: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 46a5a: 2a6e 0008 moveal %fp@(8),%a5 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a5e: 302d 0034 movew %a5@(52),%d0 bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 46a62: 246e 0010 moveal %fp@(16),%a2 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a66: 2f00 movel %d0,%sp@- bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 46a68: 286e 000c moveal %fp@(12),%a4 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a6c: 2f0a movel %a2,%sp@- 46a6e: 4eb9 0004 e5c0 jsr 4e5c0 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 46a74: 508f addql #8,%sp { size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a76: 2640 moveal %d0,%a3 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 46a78: 4a2d 0032 tstb %a5@(50) 46a7c: 6748 beqs 46ac6 <_Objects_Set_name+0x76> char *d; d = _Workspace_Allocate( length + 1 ); 46a7e: 486b 0001 pea %a3@(1) 46a82: 4eb9 0004 82dc jsr 482dc <_Workspace_Allocate> if ( !d ) 46a88: 588f addql #4,%sp #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { char *d; d = _Workspace_Allocate( length + 1 ); 46a8a: 2a40 moveal %d0,%a5 if ( !d ) 46a8c: 4a80 tstl %d0 46a8e: 6604 bnes 46a94 <_Objects_Set_name+0x44> 46a90: 4200 clrb %d0 <== NOT EXECUTED 46a92: 6076 bras 46b0a <_Objects_Set_name+0xba> <== NOT EXECUTED return false; if ( the_object->name.name_p ) { 46a94: 202c 000c movel %a4@(12),%d0 46a98: 670e beqs 46aa8 <_Objects_Set_name+0x58> _Workspace_Free( (void *)the_object->name.name_p ); 46a9a: 2f00 movel %d0,%sp@- 46a9c: 4eb9 0004 82f8 jsr 482f8 <_Workspace_Free> the_object->name.name_p = NULL; 46aa2: 588f addql #4,%sp 46aa4: 42ac 000c clrl %a4@(12) } strncpy( d, name, length ); 46aa8: 2f0b movel %a3,%sp@- 46aaa: 2f0a movel %a2,%sp@- 46aac: 2f0d movel %a5,%sp@- 46aae: 4eb9 0004 e538 jsr 4e538 d[length] = '\0'; the_object->name.name_p = d; 46ab4: 4fef 000c lea %sp@(12),%sp _Workspace_Free( (void *)the_object->name.name_p ); the_object->name.name_p = NULL; } strncpy( d, name, length ); d[length] = '\0'; 46ab8: 4200 clrb %d0 46aba: 1b80 b800 moveb %d0,%a5@(00000000,%a3:l) the_object->name.name_p = d; 46abe: 7001 moveq #1,%d0 46ac0: 294d 000c movel %a5,%a4@(12) 46ac4: 6044 bras 46b0a <_Objects_Set_name+0xba> } else #endif { the_object->name.name_u32 = _Objects_Build_name( 46ac6: 7201 moveq #1,%d1 46ac8: 1012 moveb %a2@,%d0 46aca: b28b cmpl %a3,%d1 46acc: 6446 bccs 46b14 <_Objects_Set_name+0xc4> 46ace: 7602 moveq #2,%d3 46ad0: 142a 0001 moveb %a2@(1),%d2 46ad4: 49c2 extbl %d2 46ad6: 4842 swap %d2 46ad8: 4242 clrw %d2 46ada: b68b cmpl %a3,%d3 46adc: 643a bccs 46b18 <_Objects_Set_name+0xc8> 46ade: 7a03 moveq #3,%d5 46ae0: 122a 0002 moveb %a2@(2),%d1 46ae4: 49c1 extbl %d1 46ae6: e189 lsll #8,%d1 46ae8: ba8b cmpl %a3,%d5 46aea: 6506 bcss 46af2 <_Objects_Set_name+0xa2> 46aec: 163c 0020 moveb #32,%d3 46af0: 6006 bras 46af8 <_Objects_Set_name+0xa8> 46af2: 162a 0003 moveb %a2@(3),%d3 46af6: 49c3 extbl %d3 46af8: 2800 movel %d0,%d4 46afa: 7a18 moveq #24,%d5 46afc: ebac lsll %d5,%d4 46afe: 7001 moveq #1,%d0 46b00: 8484 orl %d4,%d2 46b02: 8481 orl %d1,%d2 46b04: 8483 orl %d3,%d2 46b06: 2942 000c movel %d2,%a4@(12) ); } return true; } 46b0a: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 46b10: 4e5e unlk %fp 46b12: 4e75 rts d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( 46b14: 7420 moveq #32,%d2 46b16: 4842 swap %d2 46b18: 223c 0000 2000 movel #8192,%d1 46b1e: 7620 moveq #32,%d3 46b20: 60d6 bras 46af8 <_Objects_Set_name+0xa8> ... 0004948c <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4948c: 4e56 ffe4 linkw %fp,#-28 49490: 48d7 043c moveml %d2-%d5/%a2,%sp@ RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd *_POSIX_Message_queue_Get_fd ( mqd_t id, Objects_Locations *location ) { return (POSIX_Message_queue_Control_fd *) _Objects_Get( 49494: 486e fffc pea %fp@(-4) 49498: 242e 0008 movel %fp@(8),%d2 4949c: 2f02 movel %d2,%sp@- 4949e: 4879 0006 5070 pea 65070 <_POSIX_Message_queue_Information_fds> 494a4: 246e 0014 moveal %fp@(20),%a2 494a8: 262e 0018 movel %fp@(24),%d3 494ac: 4eb9 0004 c188 jsr 4c188 <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 494b2: 4fef 000c lea %sp@(12),%sp 494b6: 4aae fffc tstl %fp@(-4) 494ba: 6600 00c4 bnew 49580 <_POSIX_Message_queue_Receive_support+0xf4> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 494be: 2040 moveal %d0,%a0 494c0: 7803 moveq #3,%d4 494c2: 7a01 moveq #1,%d5 494c4: 2228 0014 movel %a0@(20),%d1 494c8: c881 andl %d1,%d4 494ca: ba84 cmpl %d4,%d5 494cc: 660a bnes 494d8 <_POSIX_Message_queue_Receive_support+0x4c> _Thread_Enable_dispatch(); 494ce: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> 494d4: 6000 00aa braw 49580 <_POSIX_Message_queue_Receive_support+0xf4> rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 494d8: 2240 moveal %d0,%a1 494da: 2069 0010 moveal %a1@(16),%a0 if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 494de: 2028 0066 movel %a0@(102),%d0 494e2: b0ae 0010 cmpl %fp@(16),%d0 494e6: 6318 blss 49500 <_POSIX_Message_queue_Receive_support+0x74> _Thread_Enable_dispatch(); 494e8: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); 494ee: 747a moveq #122,%d2 494f0: 4eb9 0005 28c4 jsr 528c4 <__errno> 494f6: 72ff moveq #-1,%d1 494f8: 2040 moveal %d0,%a0 494fa: 2082 movel %d2,%a0@ 494fc: 6000 0090 braw 4958e <_POSIX_Message_queue_Receive_support+0x102> length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 49500: 4a03 tstb %d3 49502: 6604 bnes 49508 <_POSIX_Message_queue_Receive_support+0x7c> 49504: 4200 clrb %d0 <== NOT EXECUTED 49506: 600c bras 49514 <_POSIX_Message_queue_Receive_support+0x88><== NOT EXECUTED do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 49508: 2001 movel %d1,%d0 4950a: 760e moveq #14,%d3 4950c: 7a01 moveq #1,%d5 4950e: e6a8 lsrl %d3,%d0 49510: bb80 eorl %d5,%d0 49512: c085 andl %d5,%d0 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 49514: 2f2e 001c movel %fp@(28),%sp@- 49518: 7201 moveq #1,%d1 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 4951a: 76ff moveq #-1,%d3 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4951c: c280 andl %d0,%d1 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 4951e: 2d43 fff8 movel %d3,%fp@(-8) do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 49522: 2f01 movel %d1,%sp@- 49524: 486e fff8 pea %fp@(-8) 49528: 2f2e 000c movel %fp@(12),%sp@- 4952c: 2f02 movel %d2,%sp@- 4952e: 4868 001a pea %a0@(26) 49532: 4eb9 0004 b2d0 jsr 4b2d0 <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 49538: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4953e: 2079 0006 4cee moveal 64cee <_Thread_Executing>,%a0 do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = 49544: 24a8 0024 movel %a0@(36),%a2@ 49548: 6c06 bges 49550 <_POSIX_Message_queue_Receive_support+0xc4> 4954a: 2a12 movel %a2@,%d5 4954c: 4485 negl %d5 4954e: 2485 movel %d5,%a2@ _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) 49550: 4fef 0018 lea %sp@(24),%sp 49554: 4aa8 0034 tstl %a0@(52) 49558: 6606 bnes 49560 <_POSIX_Message_queue_Receive_support+0xd4> return length_out; 4955a: 222e fff8 movel %fp@(-8),%d1 4955e: 602e bras 4958e <_POSIX_Message_queue_Receive_support+0x102> rtems_set_errno_and_return_minus_one( 49560: 4eb9 0005 28c4 jsr 528c4 <__errno> 49566: 2079 0006 4cee moveal 64cee <_Thread_Executing>,%a0 4956c: 2440 moveal %d0,%a2 4956e: 2f28 0034 movel %a0@(52),%sp@- 49572: 4eb9 0004 97b8 jsr 497b8 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 49578: 588f addql #4,%sp 4957a: 72ff moveq #-1,%d1 4957c: 2480 movel %d0,%a2@ 4957e: 600e bras 4958e <_POSIX_Message_queue_Receive_support+0x102> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 49580: 4eb9 0005 28c4 jsr 528c4 <__errno> 49586: 72ff moveq #-1,%d1 49588: 2040 moveal %d0,%a0 4958a: 7009 moveq #9,%d0 4958c: 2080 movel %d0,%a0@ } 4958e: 2001 movel %d1,%d0 49590: 4cee 043c ffe4 moveml %fp@(-28),%d2-%d5/%a2 49596: 4e5e unlk %fp ... 00044e70 <_POSIX_Timer_TSR>: * This is the operation that is run when a timer expires */ void _POSIX_Timer_TSR( Objects_Id timer __attribute__((unused)), void *data) { 44e70: 4e56 0000 linkw %fp,#0 44e74: 2f0a movel %a2,%sp@- 44e76: 246e 000c moveal %fp@(12),%a2 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 44e7a: 52aa 0066 addql #1,%a2@(102) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 44e7e: 4aaa 0052 tstl %a2@(82) 44e82: 6606 bnes 44e8a <_POSIX_Timer_TSR+0x1a> ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { 44e84: 4aaa 0056 tstl %a2@(86) 44e88: 6732 beqs 44ebc <_POSIX_Timer_TSR+0x4c> activated = _POSIX_Timer_Insert_helper( 44e8a: 2f0a movel %a2,%sp@- 44e8c: 4879 0004 4e70 pea 44e70 <_POSIX_Timer_TSR> 44e92: 2f2a 0008 movel %a2@(8),%sp@- 44e96: 2f2a 0062 movel %a2@(98),%sp@- 44e9a: 486a 0010 pea %a2@(16) 44e9e: 4eb9 0004 a408 jsr 4a408 <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 44ea4: 4fef 0014 lea %sp@(20),%sp 44ea8: 4a00 tstb %d0 44eaa: 672a beqs 44ed6 <_POSIX_Timer_TSR+0x66> return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 44eac: 486a 006a pea %a2@(106) 44eb0: 4eb9 0004 6348 jsr 46348 <_TOD_Get> /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 44eb6: 588f addql #4,%sp /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 44eb8: 7003 moveq #3,%d0 44eba: 6002 bras 44ebe <_POSIX_Timer_TSR+0x4e> } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 44ebc: 7004 moveq #4,%d0 <== NOT EXECUTED 44ebe: 1540 003c moveb %d0,%a2@(60) /* * The sending of the signal to the process running the handling function * specified for that signal is simulated */ if ( pthread_kill ( ptimer->thread_id, ptimer->inf.sigev_signo ) ) { 44ec2: 2f2a 0042 movel %a2@(66),%sp@- 44ec6: 2f2a 0038 movel %a2@(56),%sp@- 44eca: 4eb9 0004 9fe8 jsr 49fe8 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 44ed0: 508f addql #8,%sp 44ed2: 42aa 0066 clrl %a2@(102) } 44ed6: 246e fffc moveal %fp@(-4),%a2 44eda: 4e5e unlk %fp ... 00044e4c <_POSIX_signals_Ualarm_TSR>: void _POSIX_signals_Ualarm_TSR( Objects_Id id __attribute__((unused)), void *argument __attribute__((unused)) ) { 44e4c: 4e56 0000 linkw %fp,#0 /* * Send a SIGALRM but if there is a problem, ignore it. * It's OK, there isn't a way this should fail. */ (void) kill( getpid(), SIGALRM ); 44e50: 4eb9 0004 24e8 jsr 424e8 44e56: 4878 000e pea e 44e5a: 2f00 movel %d0,%sp@- 44e5c: 4eb9 0004 4b6c jsr 44b6c RTEMS_INLINE_ROUTINE void _Watchdog_Reset( Watchdog_Control *the_watchdog ) { (void) _Watchdog_Remove( the_watchdog ); 44e62: 4879 0005 ecde pea 5ecde <_POSIX_signals_Ualarm_timer> 44e68: 4eb9 0004 8338 jsr 48338 <_Watchdog_Remove> _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 44e6e: 4fef 000c lea %sp@(12),%sp 44e72: 203c 0005 ecde movel #388318,%d0 44e78: 2d40 000c movel %d0,%fp@(12) 44e7c: 203c 0005 e590 movel #386448,%d0 44e82: 2d40 0008 movel %d0,%fp@(8) /* * If the reset interval is non-zero, reschedule ourselves. */ _Watchdog_Reset( &_POSIX_signals_Ualarm_timer ); } 44e86: 4e5e unlk %fp 44e88: 4ef9 0004 821c jmp 4821c <_Watchdog_Insert> ... 00057360 <_Region_Process_queue>: */ void _Region_Process_queue( Region_Control *the_region ) { 57360: 4e56 ffe4 linkw %fp,#-28 57364: 2039 0007 545c movel 7545c <_Thread_Dispatch_disable_level>,%d0 5736a: 5280 addql #1,%d0 5736c: 48d7 3c1c moveml %d2-%d4/%a2-%a5,%sp@ 57370: 266e 0008 moveal %fp@(8),%a3 57374: 23c0 0007 545c movel %d0,7545c <_Thread_Dispatch_disable_level> * NOTE: Be sure to disable dispatching before unlocking the mutex * since we do not want to open a window where a context * switch could occur. */ _Thread_Disable_dispatch(); _RTEMS_Unlock_allocator(); 5737a: 2f39 0007 550e movel 7550e <_RTEMS_Allocator_Mutex>,%sp@- /* * NOTE: The following loop is O(n) where n is the number of * threads whose memory request is satisfied. */ for ( ; ; ) { the_thread = _Thread_queue_First( &the_region->Wait_queue ); 57380: 240b movel %a3,%d2 RTEMS_INLINE_ROUTINE void *_Region_Allocate_segment ( Region_Control *the_region, uintptr_t size ) { return _Heap_Allocate( &the_region->Memory, size ); 57382: 280b movel %a3,%d4 57384: 0682 0000 0010 addil #16,%d2 5738a: 0684 0000 0068 addil #104,%d4 57390: 4bf9 0005 2a14 lea 52a14 <_Heap_Allocate_aligned_with_boundary>,%a5 if ( the_segment == NULL ) break; *(void **)the_thread->Wait.return_argument = the_segment; the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); 57396: 49f9 0005 7a6c lea 57a6c <_Thread_queue_Extract>,%a4 * NOTE: Be sure to disable dispatching before unlocking the mutex * since we do not want to open a window where a context * switch could occur. */ _Thread_Disable_dispatch(); _RTEMS_Unlock_allocator(); 5739c: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> 573a2: 588f addql #4,%sp /* * NOTE: The following loop is O(n) where n is the number of * threads whose memory request is satisfied. */ for ( ; ; ) { the_thread = _Thread_queue_First( &the_region->Wait_queue ); 573a4: 263c 0005 7b70 movel #359280,%d3 573aa: 2f02 movel %d2,%sp@- 573ac: 2043 moveal %d3,%a0 573ae: 4e90 jsr %a0@ if ( the_thread == NULL ) 573b0: 588f addql #4,%sp /* * NOTE: The following loop is O(n) where n is the number of * threads whose memory request is satisfied. */ for ( ; ; ) { the_thread = _Thread_queue_First( &the_region->Wait_queue ); 573b2: 2440 moveal %d0,%a2 if ( the_thread == NULL ) 573b4: 4a80 tstl %d0 573b6: 672c beqs 573e4 <_Region_Process_queue+0x84> 573b8: 42a7 clrl %sp@- 573ba: 42a7 clrl %sp@- 573bc: 2f2a 0024 movel %a2@(36),%sp@- 573c0: 2f04 movel %d4,%sp@- 573c2: 4e95 jsr %a5@ the_segment = (void **) _Region_Allocate_segment( the_region, the_thread->Wait.count ); if ( the_segment == NULL ) 573c4: 4fef 0010 lea %sp@(16),%sp 573c8: 4a80 tstl %d0 573ca: 6718 beqs 573e4 <_Region_Process_queue+0x84> break; *(void **)the_thread->Wait.return_argument = the_segment; 573cc: 206a 0028 moveal %a2@(40),%a0 the_region->number_of_used_blocks += 1; 573d0: 52ab 0064 addql #1,%a3@(100) ); if ( the_segment == NULL ) break; *(void **)the_thread->Wait.return_argument = the_segment; 573d4: 2080 movel %d0,%a0@ the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); 573d6: 2f0a movel %a2,%sp@- 573d8: 2f02 movel %d2,%sp@- 573da: 4e94 jsr %a4@ the_thread->Wait.return_code = RTEMS_SUCCESSFUL; } 573dc: 508f addql #8,%sp break; *(void **)the_thread->Wait.return_argument = the_segment; the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); the_thread->Wait.return_code = RTEMS_SUCCESSFUL; 573de: 42aa 0034 clrl %a2@(52) } 573e2: 60c6 bras 573aa <_Region_Process_queue+0x4a> _Thread_Enable_dispatch(); } 573e4: 4cee 3c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a5 573ea: 4e5e unlk %fp *(void **)the_thread->Wait.return_argument = the_segment; the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); the_thread->Wait.return_code = RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 573ec: 4ef9 0005 4012 jmp 54012 <_Thread_Enable_dispatch> ... 00046d94 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 46d94: 4e56 ffe8 linkw %fp,#-24 46d98: 222e 0010 movel %fp@(16),%d1 46d9c: 48d7 047c moveml %d2-%d6/%a2,%sp@ 46da0: 246e 000c moveal %fp@(12),%a2 46da4: 242e 0014 movel %fp@(20),%d2 46da8: 282e 001c movel %fp@(28),%d4 46dac: 2a2e 0024 movel %fp@(36),%d5 /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; 46db0: 42aa 010a clrl %a2@(266) Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 46db4: 162e 001b moveb %fp@(27),%d3 /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; 46db8: 42aa 010e clrl %a2@(270) Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 46dbc: 1c2e 0023 moveb %fp@(35),%d6 /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; 46dc0: 42aa 0112 clrl %a2@(274) extensions_area = NULL; the_thread->libc_reent = NULL; 46dc4: 42aa 0106 clrl %a2@(262) if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { 46dc8: 4a81 tstl %d1 46dca: 6620 bnes 46dec <_Thread_Initialize+0x58> actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 46dcc: 2f02 movel %d2,%sp@- 46dce: 2f0a movel %a2,%sp@- 46dd0: 4eb9 0004 7674 jsr 47674 <_Thread_Stack_Allocate> if ( !actual_stack_size || actual_stack_size < stack_size ) 46dd6: 508f addql #8,%sp 46dd8: 4a80 tstl %d0 46dda: 6700 0176 beqw 46f52 <_Thread_Initialize+0x1be> 46dde: b480 cmpl %d0,%d2 46de0: 6200 0170 bhiw 46f52 <_Thread_Initialize+0x1be> return false; /* stack allocation failed */ stack = the_thread->Start.stack; 46de4: 222a 00ca movel %a2@(202),%d1 the_thread->Start.core_allocated_stack = true; 46de8: 7401 moveq #1,%d2 46dea: 6004 bras 46df0 <_Thread_Initialize+0x5c> } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 46dec: 2002 movel %d2,%d0 46dee: 4202 clrb %d2 Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 46df0: 2541 00c2 movel %d1,%a2@(194) 46df4: 1542 00bc moveb %d2,%a2@(188) the_stack->size = size; 46df8: 2540 00be movel %d0,%a2@(190) /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { 46dfc: 4a03 tstb %d3 46dfe: 6604 bnes 46e04 <_Thread_Initialize+0x70> 46e00: 4283 clrl %d3 46e02: 6016 bras 46e1a <_Thread_Initialize+0x86> fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); 46e04: 4878 001c pea 1c 46e08: 4eb9 0004 7e98 jsr 47e98 <_Workspace_Allocate> if ( !fp_area ) 46e0e: 588f addql #4,%sp /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); 46e10: 2600 movel %d0,%d3 if ( !fp_area ) 46e12: 6606 bnes 46e1a <_Thread_Initialize+0x86> 46e14: 4282 clrl %d2 46e16: 6000 00d4 braw 46eec <_Thread_Initialize+0x158> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 46e1a: 2039 0005 cda6 movel 5cda6 <_Thread_Maximum_extensions>,%d0 fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); if ( !fp_area ) goto failed; fp_area = _Context_Fp_start( fp_area, 0 ); } the_thread->fp_context = fp_area; 46e20: 2543 0102 movel %d3,%a2@(258) the_thread->Start.fp_context = fp_area; 46e24: 2543 00c6 movel %d3,%a2@(198) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 46e28: 42aa 0050 clrl %a2@(80) the_watchdog->routine = routine; 46e2c: 42aa 0064 clrl %a2@(100) the_watchdog->id = id; 46e30: 42aa 0068 clrl %a2@(104) the_watchdog->user_data = user_data; 46e34: 42aa 006c clrl %a2@(108) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 46e38: 4a80 tstl %d0 46e3a: 6604 bnes 46e40 <_Thread_Initialize+0xac> 46e3c: 4282 clrl %d2 46e3e: 6016 bras 46e56 <_Thread_Initialize+0xc2> extensions_area = _Workspace_Allocate( 46e40: e588 lsll #2,%d0 46e42: 2040 moveal %d0,%a0 46e44: 4868 0004 pea %a0@(4) 46e48: 4eb9 0004 7e98 jsr 47e98 <_Workspace_Allocate> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 46e4e: 588f addql #4,%sp /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { extensions_area = _Workspace_Allocate( 46e50: 2400 movel %d0,%d2 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 46e52: 6700 0098 beqw 46eec <_Thread_Initialize+0x158> goto failed; } the_thread->extensions = (void **) extensions_area; 46e56: 2542 0116 movel %d2,%a2@(278) * if they are linked to the thread. An extension user may * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { 46e5a: 6718 beqs 46e74 <_Thread_Initialize+0xe0> for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 46e5c: 2239 0005 cda6 movel 5cda6 <_Thread_Maximum_extensions>,%d1 46e62: 4280 clrl %d0 46e64: 600a bras 46e70 <_Thread_Initialize+0xdc> the_thread->extensions[i] = NULL; 46e66: 206a 0116 moveal %a2@(278),%a0 46e6a: 42b0 0c00 clrl %a0@(00000000,%d0:l:4) * 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++ ) 46e6e: 5280 addql #1,%d0 46e70: b280 cmpl %d0,%d1 46e72: 64f2 bccs 46e66 <_Thread_Initialize+0xd2> /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; 46e74: 2545 00ac movel %d5,%a2@(172) the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 46e78: 7002 moveq #2,%d0 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 46e7a: 256e 0028 00b0 movel %fp@(40),%a2@(176) /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 46e80: 1546 00aa moveb %d6,%a2@(170) the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 46e84: b085 cmpl %d5,%d0 46e86: 660a bnes 46e92 <_Thread_Initialize+0xfe> case THREAD_CPU_BUDGET_ALGORITHM_NONE: case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: break; #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 46e88: 41f9 0005 ccb8 lea 5ccb8 <_Thread_Ticks_per_timeslice>,%a0 46e8e: 2550 0076 movel %a0@,%a2@(118) #if defined(RTEMS_ITRON_API) the_thread->suspend_count = 0; #endif the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority ); 46e92: 2f04 movel %d4,%sp@- case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 46e94: 256e 002c 00b4 movel %fp@(44),%a2@(180) the_thread->current_state = STATES_DORMANT; 46e9a: 7001 moveq #1,%d0 #if defined(RTEMS_ITRON_API) the_thread->suspend_count = 0; #endif the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority ); 46e9c: 2f0a movel %a2,%sp@- #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; 46e9e: 2540 0010 movel %d0,%a2@(16) the_thread->Wait.queue = NULL; 46ea2: 42aa 0044 clrl %a2@(68) the_thread->resource_count = 0; 46ea6: 42aa 001c clrl %a2@(28) #if defined(RTEMS_ITRON_API) the_thread->suspend_count = 0; #endif the_thread->real_priority = priority; 46eaa: 2544 0018 movel %d4,%a2@(24) the_thread->Start.initial_priority = priority; 46eae: 2544 00b8 movel %d4,%a2@(184) _Thread_Set_priority( the_thread, priority ); 46eb2: 4eb9 0004 74a0 jsr 474a0 <_Thread_Set_priority> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 46eb8: 206e 0008 moveal %fp@(8),%a0 46ebc: 4280 clrl %d0 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 46ebe: 256e 0030 000c movel %fp@(48),%a2@(12) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 46ec4: 2068 0018 moveal %a0@(24),%a0 46ec8: 302a 000a movew %a2@(10),%d0 /* * Initialize the CPU usage statistics */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Set_to_zero( &the_thread->cpu_time_used ); 46ecc: 42aa 0082 clrl %a2@(130) 46ed0: 218a 0c00 movel %a2,%a0@(00000000,%d0:l:4) 46ed4: 42aa 0086 clrl %a2@(134) * 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 ); 46ed8: 2f0a movel %a2,%sp@- 46eda: 4eb9 0004 7b54 jsr 47b54 <_User_extensions_Thread_create> if ( extension_status ) 46ee0: 4fef 000c lea %sp@(12),%sp 46ee4: 4a00 tstb %d0 46ee6: 6704 beqs 46eec <_Thread_Initialize+0x158> 46ee8: 7001 moveq #1,%d0 46eea: 6068 bras 46f54 <_Thread_Initialize+0x1c0> return true; failed: if ( the_thread->libc_reent ) 46eec: 202a 0106 movel %a2@(262),%d0 46ef0: 670a beqs 46efc <_Thread_Initialize+0x168> _Workspace_Free( the_thread->libc_reent ); 46ef2: 2f00 movel %d0,%sp@- 46ef4: 4eb9 0004 7eb4 jsr 47eb4 <_Workspace_Free> 46efa: 588f addql #4,%sp for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 46efc: 202a 010a movel %a2@(266),%d0 46f00: 670a beqs 46f0c <_Thread_Initialize+0x178> _Workspace_Free( the_thread->API_Extensions[i] ); 46f02: 2f00 movel %d0,%sp@- 46f04: 4eb9 0004 7eb4 jsr 47eb4 <_Workspace_Free> 46f0a: 588f addql #4,%sp 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] ) 46f0c: 202a 010e movel %a2@(270),%d0 46f10: 670a beqs 46f1c <_Thread_Initialize+0x188> _Workspace_Free( the_thread->API_Extensions[i] ); 46f12: 2f00 movel %d0,%sp@- 46f14: 4eb9 0004 7eb4 jsr 47eb4 <_Workspace_Free> 46f1a: 588f addql #4,%sp 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] ) 46f1c: 202a 0112 movel %a2@(274),%d0 46f20: 670a beqs 46f2c <_Thread_Initialize+0x198> _Workspace_Free( the_thread->API_Extensions[i] ); 46f22: 2f00 movel %d0,%sp@- <== NOT EXECUTED 46f24: 4eb9 0004 7eb4 jsr 47eb4 <_Workspace_Free> <== NOT EXECUTED 46f2a: 588f addql #4,%sp <== NOT EXECUTED if ( extensions_area ) 46f2c: 4a82 tstl %d2 46f2e: 670a beqs 46f3a <_Thread_Initialize+0x1a6> (void) _Workspace_Free( extensions_area ); 46f30: 2f02 movel %d2,%sp@- 46f32: 4eb9 0004 7eb4 jsr 47eb4 <_Workspace_Free> 46f38: 588f addql #4,%sp #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( fp_area ) 46f3a: 4a83 tstl %d3 46f3c: 670a beqs 46f48 <_Thread_Initialize+0x1b4> (void) _Workspace_Free( fp_area ); 46f3e: 2f03 movel %d3,%sp@- 46f40: 4eb9 0004 7eb4 jsr 47eb4 <_Workspace_Free> 46f46: 588f addql #4,%sp #endif _Thread_Stack_Free( the_thread ); 46f48: 2f0a movel %a2,%sp@- 46f4a: 4eb9 0004 76c0 jsr 476c0 <_Thread_Stack_Free> return false; 46f50: 588f addql #4,%sp 46f52: 4200 clrb %d0 } 46f54: 4cee 047c ffe8 moveml %fp@(-24),%d2-%d6/%a2 46f5a: 4e5e unlk %fp ... 00047c14 <_Thread_Restart>: Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { if ( !_States_Is_dormant( the_thread->current_state ) ) { 47c14: 7001 moveq #1,%d0 bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { 47c16: 4e56 0000 linkw %fp,#0 47c1a: 2f0a movel %a2,%sp@- 47c1c: 246e 0008 moveal %fp@(8),%a2 if ( !_States_Is_dormant( the_thread->current_state ) ) { 47c20: c0aa 0010 andl %a2@(16),%d0 47c24: 4a00 tstb %d0 47c26: 6704 beqs 47c2c <_Thread_Restart+0x18> 47c28: 4200 clrb %d0 47c2a: 6064 bras 47c90 <_Thread_Restart+0x7c> _Thread_Set_transient( the_thread ); 47c2c: 2f0a movel %a2,%sp@- 47c2e: 4eb9 0004 7df0 jsr 47df0 <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); 47c34: 2f2e 0010 movel %fp@(16),%sp@- 47c38: 2f2e 000c movel %fp@(12),%sp@- 47c3c: 2f0a movel %a2,%sp@- 47c3e: 4eb9 0004 b1ac jsr 4b1ac <_Thread_Reset> _Thread_Load_environment( the_thread ); 47c44: 2f0a movel %a2,%sp@- 47c46: 4eb9 0004 ae48 jsr 4ae48 <_Thread_Load_environment> _Thread_Ready( the_thread ); 47c4c: 2f0a movel %a2,%sp@- 47c4e: 4eb9 0004 b0ec jsr 4b0ec <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); 47c54: 2f0a movel %a2,%sp@- 47c56: 4eb9 0004 83d0 jsr 483d0 <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) 47c5c: 4fef 001c lea %sp@(28),%sp 47c60: b5f9 0005 d89a cmpal 5d89a <_Thread_Executing>,%a2 47c66: 6626 bnes 47c8e <_Thread_Restart+0x7a> */ RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void ) { #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( _Thread_Executing->fp_context != NULL ) 47c68: 4aaa 0102 tstl %a2@(258) 47c6c: 670c beqs 47c7a <_Thread_Restart+0x66> _Context_Restore_fp( &_Thread_Executing->fp_context ); 47c6e: 486a 0102 pea %a2@(258) 47c72: 4eb9 0004 88c0 jsr 488c0 <_CPU_Context_restore_fp> 47c78: 588f addql #4,%sp #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); 47c7a: 2079 0005 d89a moveal 5d89a <_Thread_Executing>,%a0 47c80: 41e8 00ce lea %a0@(206),%a0 47c84: 2f08 movel %a0,%sp@- 47c86: 4eb9 0004 877e jsr 4877e <_CPU_Context_Restart_self> 47c8c: 588f addql #4,%sp <== NOT EXECUTED 47c8e: 7001 moveq #1,%d0 return true; } return false; } 47c90: 246e fffc moveal %fp@(-4),%a2 47c94: 4e5e unlk %fp <== NOT EXECUTED 00046798 <_Thread_blocking_operation_Cancel>: /* * If the sync state is timed out, this is very likely not needed. * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { 46798: 7202 moveq #2,%d1 Thread_blocking_operation_States sync_state __attribute__((unused)), #endif Thread_Control *the_thread, ISR_Level level ) { 4679a: 4e56 0000 linkw %fp,#0 4679e: 202e 0010 movel %fp@(16),%d0 467a2: 2f0a movel %a2,%sp@- 467a4: 246e 000c moveal %fp@(12),%a2 #endif /* * The thread is not waiting on anything after this completes. */ the_thread->Wait.queue = NULL; 467a8: 42aa 0044 clrl %a2@(68) /* * 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 ) ) { 467ac: b2aa 0050 cmpl %a2@(80),%d1 467b0: 6618 bnes 467ca <_Thread_blocking_operation_Cancel+0x32> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 467b2: 123c 0003 moveb #3,%d1 467b6: 2541 0050 movel %d1,%a2@(80) _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 467ba: 46c0 movew %d0,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 467bc: 486a 0048 pea %a2@(72) 467c0: 4eb9 0004 7d6c jsr 47d6c <_Watchdog_Remove> 467c6: 588f addql #4,%sp 467c8: 6002 bras 467cc <_Thread_blocking_operation_Cancel+0x34> } else _ISR_Enable( level ); 467ca: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 467cc: 2d4a 0008 movel %a2,%fp@(8) #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 467d0: 246e fffc moveal %fp@(-4),%a2 467d4: 203c 1003 fff8 movel #268697592,%d0 467da: 2d40 000c movel %d0,%fp@(12) 467de: 4e5e unlk %fp 467e0: 4ef9 0004 6928 jmp 46928 <_Thread_Clear_state> ... 00047214 <_Thread_queue_Enqueue_priority>: Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 47214: 4e56 ffe4 linkw %fp,#-28 47218: 206e 000c moveal %fp@(12),%a0 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 4721c: 43e8 003c lea %a0@(60),%a1 Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; 47220: 2028 0014 movel %a0@(20),%d0 Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 47224: 48d7 0c7c moveml %d2-%d6/%a2-%a3,%sp@ _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 ]; 47228: 2400 movel %d0,%d2 4722a: ec8a lsrl #6,%d2 4722c: 2202 movel %d2,%d1 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); 4722e: 283c 0000 0700 movel #1792,%d4 _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 ]; 47234: e989 lsll #4,%d1 47236: e58a lsll #2,%d2 Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 47238: 246e 0008 moveal %fp@(8),%a2 _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 ]; 4723c: 9282 subl %d2,%d1 4723e: 47f2 1800 lea %a2@(00000000,%d1:l),%a3 47242: 2149 0038 movel %a1,%a0@(56) the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 47246: 43e8 0038 lea %a0@(56),%a1 block_state = the_thread_queue->state; 4724a: 2a2a 0038 movel %a2@(56),%d5 4724e: 2149 0040 movel %a1,%a0@(64) RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 47252: 42a8 003c clrl %a0@(60) if ( _Thread_queue_Is_reverse_search( priority ) ) 47256: 0800 0005 btst #5,%d0 4725a: 6660 bnes 472bc <_Thread_queue_Enqueue_priority+0xa8> */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4725c: 2c0b movel %a3,%d6 4725e: 5886 addql #4,%d6 goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); 47260: 2404 movel %d4,%d2 47262: 40c1 movew %sr,%d1 47264: 8481 orl %d1,%d2 47266: 46c2 movew %d2,%sr search_thread = (Thread_Control *) header->first; 47268: 2253 moveal %a3@,%a1 4726a: 76ff moveq #-1,%d3 while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 4726c: 601e bras 4728c <_Thread_queue_Enqueue_priority+0x78> search_priority = search_thread->current_priority; 4726e: 2629 0014 movel %a1@(20),%d3 if ( priority <= search_priority ) 47272: b680 cmpl %d0,%d3 47274: 641a bccs 47290 <_Thread_queue_Enqueue_priority+0x7c> break; search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); 47276: 2404 movel %d4,%d2 47278: 46c1 movew %d1,%sr 4727a: 8481 orl %d1,%d2 4727c: 46c2 movew %d2,%sr if ( !_States_Are_set( search_thread->current_state, block_state) ) { 4727e: 2405 movel %d5,%d2 47280: c4a9 0010 andl %a1@(16),%d2 47284: 6604 bnes 4728a <_Thread_queue_Enqueue_priority+0x76> _ISR_Enable( level ); 47286: 46c1 movew %d1,%sr <== NOT EXECUTED goto restart_forward_search; 47288: 60d6 bras 47260 <_Thread_queue_Enqueue_priority+0x4c><== NOT EXECUTED } search_thread = (Thread_Control *)search_thread->Object.Node.next; 4728a: 2251 moveal %a1@,%a1 restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->first; while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 4728c: bc89 cmpl %a1,%d6 4728e: 66de bnes 4726e <_Thread_queue_Enqueue_priority+0x5a> 47290: 2401 movel %d1,%d2 } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 47292: 7801 moveq #1,%d4 47294: b8aa 0030 cmpl %a2@(48),%d4 47298: 6600 00a4 bnew 4733e <_Thread_queue_Enqueue_priority+0x12a> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 4729c: 42aa 0030 clrl %a2@(48) if ( priority == search_priority ) 472a0: b680 cmpl %d0,%d3 472a2: 677e beqs 47322 <_Thread_queue_Enqueue_priority+0x10e> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; 472a4: 2669 0004 moveal %a1@(4),%a3 the_node = (Chain_Node *) the_thread; the_node->next = search_node; 472a8: 2089 movel %a1,%a0@ the_node->previous = previous_node; 472aa: 214b 0004 movel %a3,%a0@(4) previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 472ae: 214a 0044 movel %a2,%a0@(68) previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; the_node->previous = previous_node; previous_node->next = the_node; 472b2: 2688 movel %a0,%a3@ search_node->previous = the_node; 472b4: 2348 0004 movel %a0,%a1@(4) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 472b8: 46c1 movew %d1,%sr 472ba: 6062 bras 4731e <_Thread_queue_Enqueue_priority+0x10a> return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 472bc: 4283 clrl %d3 472be: 1639 0005 b552 moveb 5b552 ,%d3 _ISR_Disable( level ); 472c4: 2404 movel %d4,%d2 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 472c6: 5283 addql #1,%d3 _ISR_Disable( level ); 472c8: 40c1 movew %sr,%d1 472ca: 8481 orl %d1,%d2 472cc: 46c2 movew %d2,%sr search_thread = (Thread_Control *) header->last; 472ce: 226b 0008 moveal %a3@(8),%a1 while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 472d2: 6020 bras 472f4 <_Thread_queue_Enqueue_priority+0xe0> search_priority = search_thread->current_priority; 472d4: 2629 0014 movel %a1@(20),%d3 if ( priority >= search_priority ) 472d8: b680 cmpl %d0,%d3 472da: 631c blss 472f8 <_Thread_queue_Enqueue_priority+0xe4> break; search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); 472dc: 2404 movel %d4,%d2 472de: 46c1 movew %d1,%sr 472e0: 8481 orl %d1,%d2 472e2: 46c2 movew %d2,%sr if ( !_States_Are_set( search_thread->current_state, block_state) ) { 472e4: 2405 movel %d5,%d2 472e6: c4a9 0010 andl %a1@(16),%d2 472ea: 6604 bnes 472f0 <_Thread_queue_Enqueue_priority+0xdc> _ISR_Enable( level ); 472ec: 46c1 movew %d1,%sr goto restart_reverse_search; 472ee: 60cc bras 472bc <_Thread_queue_Enqueue_priority+0xa8> } search_thread = (Thread_Control *) 472f0: 2269 0004 moveal %a1@(4),%a1 restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->last; while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 472f4: b7c9 cmpal %a1,%a3 472f6: 66dc bnes 472d4 <_Thread_queue_Enqueue_priority+0xc0> 472f8: 2401 movel %d1,%d2 } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != 472fa: 7801 moveq #1,%d4 472fc: b8aa 0030 cmpl %a2@(48),%d4 47300: 663c bnes 4733e <_Thread_queue_Enqueue_priority+0x12a> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 47302: 42aa 0030 clrl %a2@(48) if ( priority == search_priority ) 47306: b680 cmpl %d0,%d3 47308: 6718 beqs 47322 <_Thread_queue_Enqueue_priority+0x10e> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; 4730a: 2651 moveal %a1@,%a3 the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; 4730c: 2149 0004 movel %a1,%a0@(4) search_node = (Chain_Node *) search_thread; next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; 47310: 208b movel %a3,%a0@ the_node->previous = search_node; search_node->next = the_node; next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 47312: 214a 0044 movel %a2,%a0@(68) next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; search_node->next = the_node; 47316: 2288 movel %a0,%a1@ next_node->previous = the_node; 47318: 2748 0004 movel %a0,%a3@(4) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 4731c: 46c1 movew %d1,%sr 4731e: 7001 moveq #1,%d0 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 47320: 6026 bras 47348 <_Thread_queue_Enqueue_priority+0x134> 47322: 43e9 003c lea %a1@(60),%a1 equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; 47326: 2669 0004 moveal %a1@(4),%a3 the_node = (Chain_Node *) the_thread; the_node->next = search_node; 4732a: 2089 movel %a1,%a0@ the_node->previous = previous_node; 4732c: 214b 0004 movel %a3,%a0@(4) previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 47330: 214a 0044 movel %a2,%a0@(68) previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; the_node->previous = previous_node; previous_node->next = the_node; 47334: 2688 movel %a0,%a3@ search_node->previous = the_node; 47336: 2348 0004 movel %a0,%a1@(4) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 4733a: 46c2 movew %d2,%sr 4733c: 60e0 bras 4731e <_Thread_queue_Enqueue_priority+0x10a> * 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; 4733e: 206e 0010 moveal %fp@(16),%a0 return the_thread_queue->sync_state; 47342: 202a 0030 movel %a2@(48),%d0 * 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; 47346: 2082 movel %d2,%a0@ return the_thread_queue->sync_state; } 47348: 4cd7 0c7c moveml %sp@,%d2-%d6/%a2-%a3 4734c: 4e5e unlk %fp <== NOT EXECUTED 0004c16c <_Thread_queue_Extract_fifo>: Thread_Control *the_thread ) { ISR_Level level; _ISR_Disable( level ); 4c16c: 223c 0000 0700 movel #1792,%d1 void _Thread_queue_Extract_fifo( Thread_queue_Control *the_thread_queue __attribute__((unused)), Thread_Control *the_thread ) { 4c172: 4e56 0000 linkw %fp,#0 4c176: 2f0a movel %a2,%sp@- 4c178: 246e 000c moveal %fp@(12),%a2 ISR_Level level; _ISR_Disable( level ); 4c17c: 40c0 movew %sr,%d0 4c17e: 8280 orl %d0,%d1 4c180: 46c1 movew %d1,%sr if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 4c182: 222a 0010 movel %a2@(16),%d1 4c186: 0281 0003 bee0 andil #245472,%d1 4c18c: 660a bnes 4c198 <_Thread_queue_Extract_fifo+0x2c> _ISR_Enable( level ); 4c18e: 46c0 movew %d0,%sr #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c190: 246e fffc moveal %fp@(-4),%a2 4c194: 4e5e unlk %fp 4c196: 4e75 rts ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4c198: 2052 moveal %a2@,%a0 _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4c19a: 7202 moveq #2,%d1 previous = the_node->previous; 4c19c: 226a 0004 moveal %a2@(4),%a1 return; } _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; 4c1a0: 42aa 0044 clrl %a2@(68) next->previous = previous; previous->next = next; 4c1a4: 2288 movel %a0,%a1@ Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 4c1a6: 2149 0004 movel %a1,%a0@(4) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4c1aa: b2aa 0050 cmpl %a2@(80),%d1 4c1ae: 6704 beqs 4c1b4 <_Thread_queue_Extract_fifo+0x48> _ISR_Enable( level ); 4c1b0: 46c0 movew %d0,%sr 4c1b2: 6014 bras 4c1c8 <_Thread_queue_Extract_fifo+0x5c> 4c1b4: 7203 moveq #3,%d1 4c1b6: 2541 0050 movel %d1,%a2@(80) } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 4c1ba: 46c0 movew %d0,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 4c1bc: 486a 0048 pea %a2@(72) 4c1c0: 4eb9 0004 7d6c jsr 47d6c <_Watchdog_Remove> 4c1c6: 588f addql #4,%sp RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 4c1c8: 2d4a 0008 movel %a2,%fp@(8) #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c1cc: 246e fffc moveal %fp@(-4),%a2 4c1d0: 203c 1003 fff8 movel #268697592,%d0 4c1d6: 2d40 000c movel %d0,%fp@(12) 4c1da: 4e5e unlk %fp 4c1dc: 4ef9 0004 6928 jmp 46928 <_Thread_Clear_state> ... 00051644 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 51644: 4e56 ffb4 linkw %fp,#-76 51648: 200e movel %fp,%d0 5164a: 0680 ffff fff4 addil #-12,%d0 51650: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 51654: 246e 0008 moveal %fp@(8),%a2 51658: 240e movel %fp,%d2 5165a: 2a0e movel %fp,%d5 5165c: 260e movel %fp,%d3 5165e: 0682 ffff ffe8 addil #-24,%d2 51664: 5185 subql #8,%d5 51666: 0683 ffff ffec addil #-20,%d3 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 5166c: 41ea 0008 lea %a2@(8),%a0 static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 51670: 4bea 0040 lea %a2@(64),%a5 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 51674: 2e0a movel %a2,%d7 /* * 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 ); 51676: 280a movel %a2,%d4 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 51678: 0687 0000 0030 addil #48,%d7 /* * 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 ); 5167e: 0684 0000 0068 addil #104,%d4 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 51684: 49f9 0005 51fc lea 551fc <_Watchdog_Adjust_to_chain>,%a4 ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 5168a: 47f9 0005 528c lea 5528c <_Watchdog_Insert>,%a3 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 51690: 2d48 ffe4 movel %a0,%fp@(-28) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 51694: 2d45 fff4 movel %d5,%fp@(-12) the_chain->permanent_null = NULL; 51698: 42ae fff8 clrl %fp@(-8) the_chain->last = _Chain_Head(the_chain); 5169c: 2d40 fffc movel %d0,%fp@(-4) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 516a0: 2d43 ffe8 movel %d3,%fp@(-24) the_chain->permanent_null = NULL; 516a4: 42ae ffec clrl %fp@(-20) the_chain->last = _Chain_Head(the_chain); 516a8: 2d42 fff0 movel %d2,%fp@(-16) 516ac: 2d4d ffe0 movel %a5,%fp@(-32) { /* * 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; 516b0: 41ee fff4 lea %fp@(-12),%a0 * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 516b4: 3a7c 0700 moveaw #1792,%a5 { /* * 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; 516b8: 2548 0078 movel %a0,%a2@(120) static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 516bc: 2039 0007 55a0 movel 755a0 <_Watchdog_Ticks_since_boot>,%d0 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 516c2: 222a 003c movel %a2@(60),%d1 watchdogs->last_snapshot = snapshot; 516c6: 2540 003c movel %d0,%a2@(60) _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 516ca: 486e ffe8 pea %fp@(-24) 516ce: 9081 subl %d1,%d0 516d0: 2f00 movel %d0,%sp@- 516d2: 2f07 movel %d7,%sp@- 516d4: 4e94 jsr %a4@ static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 516d6: 2039 0007 54ee movel 754ee <_TOD_Now>,%d0 /* * 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 ) { 516dc: 4fef 000c lea %sp@(12),%sp Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 516e0: 222a 0074 movel %a2@(116),%d1 /* * 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 ) { 516e4: b280 cmpl %d0,%d1 516e6: 6414 bccs 516fc <_Timer_server_Body+0xb8> /* * 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 ); 516e8: 486e ffe8 pea %fp@(-24) 516ec: 2c00 movel %d0,%d6 516ee: 9c81 subl %d1,%d6 516f0: 2f06 movel %d6,%sp@- 516f2: 2d40 ffdc movel %d0,%fp@(-36) 516f6: 2f04 movel %d4,%sp@- 516f8: 4e94 jsr %a4@ 516fa: 6018 bras 51714 <_Timer_server_Body+0xd0> } else if ( snapshot < last_snapshot ) { 516fc: b280 cmpl %d0,%d1 516fe: 631c blss 5171c <_Timer_server_Body+0xd8> /* * 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 ); 51700: 9280 subl %d0,%d1 51702: 2f01 movel %d1,%sp@- 51704: 4878 0001 pea 1 51708: 2d40 ffdc movel %d0,%fp@(-36) 5170c: 2f04 movel %d4,%sp@- 5170e: 4eb9 0005 517c jsr 5517c <_Watchdog_Adjust> 51714: 202e ffdc movel %fp@(-36),%d0 51718: 4fef 000c lea %sp@(12),%sp } watchdogs->last_snapshot = snapshot; 5171c: 2540 0074 movel %d0,%a2@(116) } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 51720: 202a 0078 movel %a2@(120),%d0 51724: 2f00 movel %d0,%sp@- 51726: 4eb9 0005 2014 jsr 52014 <_Chain_Get> if ( timer == NULL ) { 5172c: 588f addql #4,%sp } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 5172e: 2040 moveal %d0,%a0 if ( timer == NULL ) { 51730: 4a80 tstl %d0 51732: 6724 beqs 51758 <_Timer_server_Body+0x114> static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 51734: 2028 0038 movel %a0@(56),%d0 51738: 7201 moveq #1,%d1 5173a: b280 cmpl %d0,%d1 5173c: 6608 bnes 51746 <_Timer_server_Body+0x102> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 5173e: 4868 0010 pea %a0@(16) 51742: 2f07 movel %d7,%sp@- 51744: 600c bras 51752 <_Timer_server_Body+0x10e> } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 51746: 7c03 moveq #3,%d6 51748: bc80 cmpl %d0,%d6 5174a: 66d4 bnes 51720 <_Timer_server_Body+0xdc> _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 5174c: 4868 0010 pea %a0@(16) 51750: 2f04 movel %d4,%sp@- 51752: 4e93 jsr %a3@ 51754: 508f addql #8,%sp 51756: 60c8 bras 51720 <_Timer_server_Body+0xdc> * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 51758: 200d movel %a5,%d0 5175a: 40c1 movew %sr,%d1 5175c: 8081 orl %d1,%d0 5175e: 46c0 movew %d0,%sr if ( _Chain_Is_empty( insert_chain ) ) { 51760: baae fff4 cmpl %fp@(-12),%d5 51764: 6612 bnes 51778 <_Timer_server_Body+0x134> ts->insert_chain = NULL; 51766: 42aa 0078 clrl %a2@(120) _ISR_Enable( level ); 5176a: 46c1 movew %d1,%sr /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 5176c: 3a7c 0700 moveaw #1792,%a5 _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 ) ) { 51770: b6ae ffe8 cmpl %fp@(-24),%d3 51774: 6608 bnes 5177e <_Timer_server_Body+0x13a> 51776: 6042 bras 517ba <_Timer_server_Body+0x176> ts->insert_chain = NULL; _ISR_Enable( level ); break; } else { _ISR_Enable( level ); 51778: 46c1 movew %d1,%sr <== NOT EXECUTED 5177a: 6000 ff40 braw 516bc <_Timer_server_Body+0x78> <== NOT EXECUTED /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 5177e: 220d movel %a5,%d1 51780: 40c0 movew %sr,%d0 51782: 8280 orl %d0,%d1 51784: 46c1 movew %d1,%sr */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 51786: 206e ffe8 moveal %fp@(-24),%a0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 5178a: b688 cmpl %a0,%d3 5178c: 6726 beqs 517b4 <_Timer_server_Body+0x170> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 5178e: 2250 moveal %a0@,%a1 the_chain->first = new_first; 51790: 2d49 ffe8 movel %a1,%fp@(-24) new_first->previous = _Chain_Head(the_chain); 51794: 2342 0004 movel %d2,%a1@(4) watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { 51798: 4a88 tstl %a0 5179a: 6718 beqs 517b4 <_Timer_server_Body+0x170> watchdog->state = WATCHDOG_INACTIVE; 5179c: 42a8 0008 clrl %a0@(8) _ISR_Enable( level ); 517a0: 46c0 movew %d0,%sr /* * 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 ); 517a2: 2f28 0024 movel %a0@(36),%sp@- 517a6: 2f28 0020 movel %a0@(32),%sp@- 517aa: 2068 001c moveal %a0@(28),%a0 517ae: 4e90 jsr %a0@ } 517b0: 508f addql #8,%sp 517b2: 60ca bras 5177e <_Timer_server_Body+0x13a> watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 517b4: 46c0 movew %d0,%sr 517b6: 6000 fef8 braw 516b0 <_Timer_server_Body+0x6c> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 517ba: 4200 clrb %d0 517bc: 1540 007c moveb %d0,%a2@(124) 517c0: 2039 0007 545c movel 7545c <_Thread_Dispatch_disable_level>,%d0 517c6: 5280 addql #1,%d0 517c8: 23c0 0007 545c movel %d0,7545c <_Thread_Dispatch_disable_level> /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 517ce: 4878 0008 pea 8 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 517d2: 4bf9 0005 53a8 lea 553a8 <_Watchdog_Remove>,%a5 /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 517d8: 2f12 movel %a2@,%sp@- 517da: 4eb9 0005 499c jsr 5499c <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); 517e0: 2f0a movel %a2,%sp@- 517e2: 4eba fd9c jsr %pc@(51580 <_Timer_server_Reset_interval_system_watchdog>) _Timer_server_Reset_tod_system_watchdog( ts ); 517e6: 2f0a movel %a2,%sp@- 517e8: 4eba fdf6 jsr %pc@(515e0 <_Timer_server_Reset_tod_system_watchdog>) _Thread_Enable_dispatch(); 517ec: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> ts->active = true; 517f2: 7201 moveq #1,%d1 517f4: 1541 007c moveb %d1,%a2@(124) static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 517f8: 2f2e ffe4 movel %fp@(-28),%sp@- 517fc: 4e95 jsr %a5@ static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 517fe: 2f2e ffe0 movel %fp@(-32),%sp@- 51802: 4e95 jsr %a5@ 51804: 4fef 0018 lea %sp@(24),%sp 51808: 6000 fea6 braw 516b0 <_Timer_server_Body+0x6c> 0005180c <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 5180c: 4e56 fff0 linkw %fp,#-16 51810: 206e 000c moveal %fp@(12),%a0 51814: 48d7 041c moveml %d2-%d4/%a2,%sp@ 51818: 246e 0008 moveal %fp@(8),%a2 if ( ts->insert_chain == NULL ) { 5181c: 202a 0078 movel %a2@(120),%d0 51820: 6600 00f8 bnew 5191a <_Timer_server_Schedule_operation_method+0x10e> 51824: 2039 0007 545c movel 7545c <_Thread_Dispatch_disable_level>,%d0 5182a: 5280 addql #1,%d0 5182c: 23c0 0007 545c movel %d0,7545c <_Thread_Dispatch_disable_level> * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 51832: 2028 0038 movel %a0@(56),%d0 51836: 7201 moveq #1,%d1 51838: b280 cmpl %d0,%d1 5183a: 6660 bnes 5189c <_Timer_server_Schedule_operation_method+0x90> /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 5183c: 203c 0000 0700 movel #1792,%d0 51842: 40c3 movew %sr,%d3 51844: 8083 orl %d3,%d0 51846: 46c0 movew %d0,%sr snapshot = _Watchdog_Ticks_since_boot; 51848: 2039 0007 55a0 movel 755a0 <_Watchdog_Ticks_since_boot>,%d0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 5184e: 220a movel %a2,%d1 51850: 0681 0000 0034 addil #52,%d1 last_snapshot = ts->Interval_watchdogs.last_snapshot; 51856: 242a 003c movel %a2@(60),%d2 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 5185a: 226a 0030 moveal %a2@(48),%a1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 5185e: b289 cmpl %a1,%d1 51860: 6716 beqs 51878 <_Timer_server_Schedule_operation_method+0x6c> first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; 51862: 2800 movel %d0,%d4 51864: 9882 subl %d2,%d4 delta_interval = first_watchdog->delta_interval; 51866: 2229 0010 movel %a1@(16),%d1 if (delta_interval > delta) { 5186a: b881 cmpl %d1,%d4 5186c: 6504 bcss 51872 <_Timer_server_Schedule_operation_method+0x66> 5186e: 4281 clrl %d1 51870: 6002 bras 51874 <_Timer_server_Schedule_operation_method+0x68> delta_interval -= delta; 51872: 9284 subl %d4,%d1 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 51874: 2341 0010 movel %d1,%a1@(16) } ts->Interval_watchdogs.last_snapshot = snapshot; 51878: 2540 003c movel %d0,%a2@(60) _ISR_Enable( level ); 5187c: 46c3 movew %d3,%sr _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 5187e: 4868 0010 pea %a0@(16) 51882: 486a 0030 pea %a2@(48) 51886: 4eb9 0005 528c jsr 5528c <_Watchdog_Insert> if ( !ts->active ) { 5188c: 508f addql #8,%sp 5188e: 102a 007c moveb %a2@(124),%d0 51892: 6678 bnes 5190c <_Timer_server_Schedule_operation_method+0x100> _Timer_server_Reset_interval_system_watchdog( ts ); 51894: 2f0a movel %a2,%sp@- 51896: 4eba fce8 jsr %pc@(51580 <_Timer_server_Reset_interval_system_watchdog>) 5189a: 606e bras 5190a <_Timer_server_Schedule_operation_method+0xfe> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 5189c: 7203 moveq #3,%d1 5189e: b280 cmpl %d0,%d1 518a0: 666a bnes 5190c <_Timer_server_Schedule_operation_method+0x100> /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 518a2: 203c 0000 0700 movel #1792,%d0 518a8: 40c3 movew %sr,%d3 518aa: 8083 orl %d3,%d0 518ac: 46c0 movew %d0,%sr 518ae: 200a movel %a2,%d0 518b0: 0680 0000 006c addil #108,%d0 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 518b6: 2239 0007 54ee movel 754ee <_TOD_Now>,%d1 last_snapshot = ts->TOD_watchdogs.last_snapshot; 518bc: 242a 0074 movel %a2@(116),%d2 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 518c0: 226a 0068 moveal %a2@(104),%a1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 518c4: b089 cmpl %a1,%d0 518c6: 6720 beqs 518e8 <_Timer_server_Schedule_operation_method+0xdc> if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 518c8: 2029 0010 movel %a1@(16),%d0 if ( snapshot > last_snapshot ) { 518cc: b481 cmpl %d1,%d2 518ce: 6410 bccs 518e0 <_Timer_server_Schedule_operation_method+0xd4> /* * We advanced in time. */ delta = snapshot - last_snapshot; 518d0: 2801 movel %d1,%d4 518d2: 9882 subl %d2,%d4 if (delta_interval > delta) { 518d4: b880 cmpl %d0,%d4 518d6: 6504 bcss 518dc <_Timer_server_Schedule_operation_method+0xd0> 518d8: 4280 clrl %d0 <== NOT EXECUTED 518da: 6008 bras 518e4 <_Timer_server_Schedule_operation_method+0xd8><== NOT EXECUTED delta_interval -= delta; 518dc: 9084 subl %d4,%d0 518de: 6004 bras 518e4 <_Timer_server_Schedule_operation_method+0xd8> } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 518e0: d082 addl %d2,%d0 delta_interval += delta; 518e2: 9081 subl %d1,%d0 } first_watchdog->delta_interval = delta_interval; 518e4: 2340 0010 movel %d0,%a1@(16) } ts->TOD_watchdogs.last_snapshot = snapshot; 518e8: 2541 0074 movel %d1,%a2@(116) _ISR_Enable( level ); 518ec: 46c3 movew %d3,%sr _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 518ee: 4868 0010 pea %a0@(16) 518f2: 486a 0068 pea %a2@(104) 518f6: 4eb9 0005 528c jsr 5528c <_Watchdog_Insert> if ( !ts->active ) { 518fc: 508f addql #8,%sp 518fe: 102a 007c moveb %a2@(124),%d0 51902: 6608 bnes 5190c <_Timer_server_Schedule_operation_method+0x100> _Timer_server_Reset_tod_system_watchdog( ts ); 51904: 2f0a movel %a2,%sp@- 51906: 4eba fcd8 jsr %pc@(515e0 <_Timer_server_Reset_tod_system_watchdog>) 5190a: 588f addql #4,%sp * 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 ); } } 5190c: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 51912: 4e5e unlk %fp if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 51914: 4ef9 0005 4012 jmp 54012 <_Thread_Enable_dispatch> * 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 ); 5191a: 202a 0078 movel %a2@(120),%d0 5191e: 2d48 000c movel %a0,%fp@(12) } } 51922: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 * 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 ); 51928: 2d40 0008 movel %d0,%fp@(8) } } 5192c: 4e5e unlk %fp * 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 ); 5192e: 4ef9 0005 1fdc jmp 51fdc <_Chain_Append> 0004ba98 : } void pthread_exit( void *value_ptr ) { 4ba98: 4e56 0000 linkw %fp,#0 _POSIX_Thread_Exit( _Thread_Executing, value_ptr ); 4ba9c: 2f2e 0008 movel %fp@(8),%sp@- 4baa0: 2f39 0005 cdc2 movel 5cdc2 <_Thread_Executing>,%sp@- 4baa6: 4eb9 0004 ba28 jsr 4ba28 <_POSIX_Thread_Exit> 4baac: 508f addql #8,%sp <== NOT EXECUTED } 4baae: 4e5e unlk %fp <== NOT EXECUTED ... 00045420 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 45420: 4e56 0000 linkw %fp,#0 * Don't even think about deleting a resource from an ISR. * Besides this request is supposed to be for _Thread_Executing * and the ISR context is not a thread. */ if ( _ISR_Is_in_progress() ) 45424: 2039 0005 dcde movel 5dcde <_ISR_Nest_level>,%d0 * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 4542a: 2f02 movel %d2,%sp@- * Don't even think about deleting a resource from an ISR. * Besides this request is supposed to be for _Thread_Executing * and the ISR context is not a thread. */ if ( _ISR_Is_in_progress() ) 4542c: 4a80 tstl %d0 4542e: 6646 bnes 45476 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 45430: 2079 0005 dcfe moveal 5dcfe <_Thread_Executing>,%a0 45436: 2039 0005 dc44 movel 5dc44 <_Thread_Dispatch_disable_level>,%d0 4543c: 5280 addql #1,%d0 4543e: 2068 010e moveal %a0@(270),%a0 45442: 23c0 0005 dc44 movel %d0,5dc44 <_Thread_Dispatch_disable_level> _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 45448: 4aa8 00d4 tstl %a0@(212) 4544c: 6704 beqs 45452 4544e: 4202 clrb %d2 <== NOT EXECUTED 45450: 6008 bras 4545a <== NOT EXECUTED /* Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ int _EXFUN(pthread_setcancelstate, (int __state, int *__oldstate)); int _EXFUN(pthread_setcanceltype, (int __type, int *__oldtype)); void _EXFUN(pthread_testcancel, (void)); 45452: 4aa8 00dc tstl %a0@(220) 45456: 56c2 sne %d2 45458: 4482 negl %d2 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 4545a: 4eb9 0004 772a jsr 4772a <_Thread_Enable_dispatch> if ( cancel ) 45460: 4a02 tstb %d2 45462: 6712 beqs 45476 _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 45464: 4878 ffff pea ffffffff 45468: 2f39 0005 dcfe movel 5dcfe <_Thread_Executing>,%sp@- 4546e: 4eb9 0004 a5fc jsr 4a5fc <_POSIX_Thread_Exit> 45474: 508f addql #8,%sp <== NOT EXECUTED } 45476: 242e fffc movel %fp@(-4),%d2 4547a: 4e5e unlk %fp ... 000454b2 : #endif Objects_Information *_Internal_Objects[ OBJECTS_INTERNAL_CLASSES_LAST + 1 ]; void rtems_initialize_data_structures(void) { 454b2: 4e56 0000 linkw %fp,#0 454b6: 42b9 0005 ce90 clrl 5ce90 <_System_state_Current> #endif /* * Initialize any target architecture specific support as early as possible */ _CPU_Initialize(); 454bc: 4eb9 0004 7ff4 jsr 47ff4 <_CPU_Initialize> /* * Do this as early as possible to ensure no debugging output * is even attempted to be printed. */ _Debug_Manager_initialization(); 454c2: 4eb9 0004 9fa4 jsr 49fa4 <_Debug_Manager_initialization> _API_extensions_Initialization(); 454c8: 4eb9 0004 5740 jsr 45740 <_API_extensions_Initialization> * This routine initializes the thread dispatching subsystem. */ RTEMS_INLINE_ROUTINE void _Thread_Dispatch_initialization( void ) { _Thread_Dispatch_disable_level = 1; 454ce: 7001 moveq #1,%d0 454d0: 23c0 0005 cd08 movel %d0,5cd08 <_Thread_Dispatch_disable_level> /* * Before this is called, we are not allowed to allocate memory * from the Workspace because it is not initialized. */ _Workspace_Handler_initialization(); 454d6: 4eb9 0004 7ecc jsr 47ecc <_Workspace_Handler_initialization> _User_extensions_Handler_initialization(); 454dc: 4eb9 0004 79e8 jsr 479e8 <_User_extensions_Handler_initialization> _ISR_Handler_initialization(); 454e2: 4eb9 0004 6034 jsr 46034 <_ISR_Handler_initialization> /* * Initialize the internal support API and allocator Mutex */ _Objects_Information_table[OBJECTS_INTERNAL_API] = _Internal_Objects; _API_Mutex_Initialization( 1 ); 454e8: 4878 0001 pea 1 _ISR_Handler_initialization(); /* * Initialize the internal support API and allocator Mutex */ _Objects_Information_table[OBJECTS_INTERNAL_API] = _Internal_Objects; 454ec: 203c 0005 cd1e movel #380190,%d0 454f2: 23c0 0005 ccc4 movel %d0,5ccc4 <_Objects_Information_table+0x4> _API_Mutex_Initialization( 1 ); 454f8: 4eb9 0004 5870 jsr 45870 <_API_Mutex_Initialization> _API_Mutex_Allocate( &_RTEMS_Allocator_Mutex ); 454fe: 4879 0005 cdba pea 5cdba <_RTEMS_Allocator_Mutex> 45504: 4eb9 0004 57d0 jsr 457d0 <_API_Mutex_Allocate> #include #endif Objects_Information *_Internal_Objects[ OBJECTS_INTERNAL_CLASSES_LAST + 1 ]; void rtems_initialize_data_structures(void) 4550a: 508f addql #8,%sp RTEMS_INLINE_ROUTINE void _Priority_Handler_initialization( void ) { int index; _Priority_Major_bit_map = 0; 4550c: 41f9 0005 ce28 lea 5ce28 <_Priority_Bit_map>,%a0 45512: 4240 clrw %d0 45514: 33c0 0005 cdb8 movew %d0,5cdb8 <_Priority_Major_bit_map> for ( index=0 ; index <16 ; index++ ) _Priority_Bit_map[ index ] = 0; 4551a: 4258 clrw %a0@+ RTEMS_INLINE_ROUTINE void _Priority_Handler_initialization( void ) { int index; _Priority_Major_bit_map = 0; for ( index=0 ; index <16 ; index++ ) 4551c: b1fc 0005 ce48 cmpal #380488,%a0 45522: 66f6 bnes 4551a _API_Mutex_Initialization( 1 ); _API_Mutex_Allocate( &_RTEMS_Allocator_Mutex ); _Priority_Handler_initialization(); _Watchdog_Handler_initialization(); 45524: 4eb9 0004 7d20 jsr 47d20 <_Watchdog_Handler_initialization> _TOD_Handler_initialization(); 4552a: 4eb9 0004 5c5c jsr 45c5c <_TOD_Handler_initialization> _Thread_Handler_initialization(); 45530: 4eb9 0004 6f60 jsr 46f60 <_Thread_Handler_initialization> _MPCI_Handler_initialization( RTEMS_TIMEOUT ); #endif /* MANAGERS */ _RTEMS_API_Initialize(); 45536: 4eb9 0004 56ec jsr 456ec <_RTEMS_API_Initialize> _Extension_Manager_initialization(); 4553c: 4eb9 0004 558c jsr 4558c <_Extension_Manager_initialization> _IO_Manager_initialization(); 45542: 4eb9 0004 5604 jsr 45604 <_IO_Manager_initialization> #ifdef RTEMS_POSIX_API _POSIX_API_Initialize(); 45548: 4eb9 0004 5698 jsr 45698 <_POSIX_API_Initialize> _Thread_Create_idle(); /* * Scheduling can properly occur now as long as we avoid dispatching. */ } 4554e: 4e5e unlk %fp 45550: 7001 moveq #1,%d0 45552: 23c0 0005 ce90 movel %d0,5ce90 <_System_state_Current> * _Thread_Executing and _Thread_Heir are not set. * * At this point all API extensions are in place. After the call to * _Thread_Create_idle() _Thread_Executing and _Thread_Heir will be set. */ _Thread_Create_idle(); 45558: 4ef9 0004 6aa4 jmp 46aa4 <_Thread_Create_idle> ... 00046d60 : 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 ) { 46d60: 4e56 0000 linkw %fp,#0 46d64: 206e 000c moveal %fp@(12),%a0 46d68: 2f0a movel %a2,%sp@- 46d6a: 226e 0010 moveal %fp@(16),%a1 46d6e: 2f02 movel %d2,%sp@- 46d70: 242e 0008 movel %fp@(8),%d2 rtems_device_major_number major_limit = _IO_Number_of_drivers; 46d74: 2039 0006 296a movel 6296a <_IO_Number_of_drivers>,%d0 if ( rtems_interrupt_is_in_progress() ) 46d7a: 2239 0006 214a movel 6214a <_ISR_Nest_level>,%d1 46d80: 6706 beqs 46d88 46d82: 7012 moveq #18,%d0 46d84: 6000 00d6 braw 46e5c return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) 46d88: 4a89 tstl %a1 46d8a: 6700 00ce beqw 46e5a return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; 46d8e: 2280 movel %d0,%a1@ if ( driver_table == NULL ) 46d90: 4a88 tstl %a0 46d92: 6700 00c6 beqw 46e5a static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 46d96: 4a90 tstl %a0@ 46d98: 6600 00ce bnew 46e68 46d9c: 4aa8 0004 tstl %a0@(4) 46da0: 6600 00c6 bnew 46e68 46da4: 6000 00b4 braw 46e5a rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 46da8: 2039 0006 20b0 movel 620b0 <_Thread_Dispatch_disable_level>,%d0 46dae: 5280 addql #1,%d0 46db0: 23c0 0006 20b0 movel %d0,620b0 <_Thread_Dispatch_disable_level> if ( major >= major_limit ) return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { 46db6: 4a82 tstl %d2 46db8: 662c bnes 46de6 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; 46dba: 2039 0006 296a movel 6296a <_IO_Number_of_drivers>,%d0 46dc0: 2479 0006 296e moveal 6296e <_IO_Driver_address_table>,%a2 46dc6: 6010 bras 46dd8 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 46dc8: 4a92 tstl %a2@ 46dca: 6600 00a6 bnew 46e72 46dce: 4aaa 0004 tstl %a2@(4) 46dd2: 6600 009e bnew 46e72 46dd6: 6004 bras 46ddc rtems_device_major_number n = _IO_Number_of_drivers; rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { 46dd8: b082 cmpl %d2,%d0 46dda: 62ec bhis 46dc8 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 46ddc: 2282 movel %d2,%a1@ if ( m != n ) 46dde: b082 cmpl %d2,%d0 46de0: 6634 bnes 46e16 46de2: 6000 0098 braw 46e7c _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 46de6: 2202 movel %d2,%d1 46de8: 2002 movel %d2,%d0 46dea: e789 lsll #3,%d1 46dec: eb88 lsll #5,%d0 46dee: 2479 0006 296e moveal 6296e <_IO_Driver_address_table>,%a2 46df4: 9081 subl %d1,%d0 46df6: d5c0 addal %d0,%a2 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 46df8: 4a92 tstl %a2@ 46dfa: 660e bnes 46e0a 46dfc: 4aaa 0004 tstl %a2@(4) 46e00: 57c0 seq %d0 46e02: 49c0 extbl %d0 46e04: 4480 negl %d0 } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { 46e06: 4a00 tstb %d0 46e08: 660a bnes 46e14 _Thread_Enable_dispatch(); 46e0a: 4eb9 0004 8686 jsr 48686 <_Thread_Enable_dispatch> 46e10: 700c moveq #12,%d0 return RTEMS_RESOURCE_IN_USE; 46e12: 6048 bras 46e5c } *registered_major = major; 46e14: 2282 movel %d2,%a1@ } _IO_Driver_address_table [major] = *driver_table; 46e16: 4878 0018 pea 18 46e1a: 2202 movel %d2,%d1 46e1c: 2002 movel %d2,%d0 46e1e: e789 lsll #3,%d1 46e20: eb88 lsll #5,%d0 46e22: 2f08 movel %a0,%sp@- 46e24: 9081 subl %d1,%d0 46e26: d0b9 0006 296e addl 6296e <_IO_Driver_address_table>,%d0 46e2c: 2f00 movel %d0,%sp@- 46e2e: 4eb9 0005 1ccc jsr 51ccc _Thread_Enable_dispatch(); 46e34: 4eb9 0004 8686 jsr 48686 <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); } 46e3a: 246e fffc moveal %fp@(-4),%a2 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 46e3e: 4fef 000c lea %sp@(12),%sp 46e42: 2d42 0008 movel %d2,%fp@(8) } 46e46: 242e fff8 movel %fp@(-8),%d2 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 46e4a: 42ae 0010 clrl %fp@(16) 46e4e: 42ae 000c clrl %fp@(12) } 46e52: 4e5e unlk %fp _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 46e54: 4ef9 0004 e990 jmp 4e990 46e5a: 7009 moveq #9,%d0 } 46e5c: 242e fff8 movel %fp@(-8),%d2 46e60: 246e fffc moveal %fp@(-4),%a2 46e64: 4e5e unlk %fp 46e66: 4e75 rts return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) 46e68: b082 cmpl %d2,%d0 46e6a: 6200 ff3c bhiw 46da8 46e6e: 700a moveq #10,%d0 46e70: 60ea bras 46e5c rtems_device_major_number n = _IO_Number_of_drivers; rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { 46e72: 5282 addql #1,%d2 46e74: 45ea 0018 lea %a2@(24),%a2 46e78: 6000 ff5e braw 46dd8 if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); 46e7c: 4eb9 0004 8686 jsr 48686 <_Thread_Enable_dispatch> 46e82: 7005 moveq #5,%d0 return sc; 46e84: 60d6 bras 46e5c ... 0004f390 : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { 4f390: 4e56 fffc linkw %fp,#-4 4f394: 2f0a movel %a2,%sp@- 4f396: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get ( Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) 4f398: 486e fffc pea %fp@(-4) 4f39c: 2f2e 0008 movel %fp@(8),%sp@- 4f3a0: 4879 0007 52e6 pea 752e6 <_Partition_Information> 4f3a6: 242e 000c movel %fp@(12),%d2 4f3aa: 4eb9 0005 378c jsr 5378c <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { 4f3b0: 4fef 000c lea %sp@(12),%sp 4f3b4: 2440 moveal %d0,%a2 4f3b6: 4aae fffc tstl %fp@(-4) 4f3ba: 6704 beqs 4f3c0 4f3bc: 7004 moveq #4,%d0 4f3be: 603c bras 4f3fc ) { void *starting; void *ending; starting = the_partition->starting_address; 4f3c0: 202a 0010 movel %a2@(16),%d0 ending = _Addresses_Add_offset( starting, the_partition->length ); 4f3c4: 222a 0014 movel %a2@(20),%d1 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); 4f3c8: b082 cmpl %d2,%d0 4f3ca: 623c bhis 4f408 4f3cc: d280 addl %d0,%d1 4f3ce: b282 cmpl %d2,%d1 4f3d0: 6536 bcss 4f408 return ( 4f3d2: 2202 movel %d2,%d1 4f3d4: 9280 subl %d0,%d1 4f3d6: 2001 movel %d1,%d0 4f3d8: 4c6a 0001 0018 remul %a2@(24),%d1,%d0 4f3de: 4a81 tstl %d1 4f3e0: 6626 bnes 4f408 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); 4f3e2: 2f02 movel %d2,%sp@- 4f3e4: 486a 0024 pea %a2@(36) 4f3e8: 4eb9 0005 1fdc jsr 51fdc <_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; 4f3ee: 53aa 0020 subql #1,%a2@(32) _Thread_Enable_dispatch(); 4f3f2: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4f3f8: 508f addql #8,%sp case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); 4f3fa: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4f3fc: 242e fff4 movel %fp@(-12),%d2 4f400: 246e fff8 moveal %fp@(-8),%a2 4f404: 4e5e unlk %fp 4f406: 4e75 rts _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 4f408: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4f40e: 7009 moveq #9,%d0 return RTEMS_INVALID_ADDRESS; 4f410: 60ea bras 4f3fc ... 000717f0 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 717f0: 4e56 ffec linkw %fp,#-20 717f4: 48d7 041c moveml %d2-%d4/%a2,%sp@ 717f8: 486e fffc pea %fp@(-4) 717fc: 262e 0008 movel %fp@(8),%d3 71800: 2f03 movel %d3,%sp@- 71802: 4879 0009 c770 pea 9c770 <_Rate_monotonic_Information> 71808: 242e 000c movel %fp@(12),%d2 7180c: 4eb9 0004 a8e0 jsr 4a8e0 <_Objects_Get> rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 71812: 4fef 000c lea %sp@(12),%sp 71816: 2440 moveal %d0,%a2 71818: 4aae fffc tstl %fp@(-4) 7181c: 6600 0138 bnew 71956 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 71820: 2039 0009 bd86 movel 9bd86 <_Thread_Executing>,%d0 71826: b0aa 0040 cmpl %a2@(64),%d0 7182a: 670c beqs 71838 _Thread_Enable_dispatch(); 7182c: 4eb9 0004 b19a jsr 4b19a <_Thread_Enable_dispatch> 71832: 7817 moveq #23,%d4 return RTEMS_NOT_OWNER_OF_RESOURCE; 71834: 6000 0122 braw 71958 } if ( length == RTEMS_PERIOD_STATUS ) { 71838: 4a82 tstl %d2 7183a: 6622 bnes 7185e switch ( the_period->state ) { 7183c: 202a 0038 movel %a2@(56),%d0 71840: 7204 moveq #4,%d1 71842: b280 cmpl %d0,%d1 71844: 6404 bccs 7184a 71846: 4284 clrl %d4 <== NOT EXECUTED 71848: 600a bras 71854 <== NOT EXECUTED 7184a: 41f9 0009 5cfa lea 95cfa ,%a0 71850: 2830 0c00 movel %a0@(00000000,%d0:l:4),%d4 case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); 71854: 4eb9 0004 b19a jsr 4b19a <_Thread_Enable_dispatch> return( return_value ); 7185a: 6000 00fc braw 71958 } _ISR_Disable( level ); 7185e: 203c 0000 0700 movel #1792,%d0 71864: 40c4 movew %sr,%d4 71866: 8084 orl %d4,%d0 71868: 46c0 movew %d0,%sr switch ( the_period->state ) { 7186a: 202a 0038 movel %a2@(56),%d0 7186e: 7202 moveq #2,%d1 71870: b280 cmpl %d0,%d1 71872: 6740 beqs 718b4 71874: 123c 0004 moveb #4,%d1 71878: b280 cmpl %d0,%d1 7187a: 6700 00a4 beqw 71920 7187e: 4a80 tstl %d0 71880: 6600 00d4 bnew 71956 case RATE_MONOTONIC_INACTIVE: { _ISR_Enable( level ); 71884: 46c4 movew %d4,%sr /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 71886: 2f0a movel %a2,%sp@- ); the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 71888: 4284 clrl %d4 _ISR_Enable( level ); /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 7188a: 4eb9 0007 15dc jsr 715dc <_Rate_monotonic_Initiate_statistics> Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 71890: 203c 0007 1964 movel #465252,%d0 the_period->state = RATE_MONOTONIC_ACTIVE; 71896: 7202 moveq #2,%d1 71898: 2540 002c movel %d0,%a2@(44) the_watchdog->id = id; 7189c: 2543 0030 movel %d3,%a2@(48) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 718a0: 2542 001c movel %d2,%a2@(28) 718a4: 2541 0038 movel %d1,%a2@(56) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 718a8: 42aa 0018 clrl %a2@(24) the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 718ac: 42aa 0034 clrl %a2@(52) 718b0: 6000 0084 braw 71936 case RATE_MONOTONIC_ACTIVE: /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 718b4: 2f0a movel %a2,%sp@- 718b6: 4eb9 0007 16fc jsr 716fc <_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; the_period->next_length = length; 718bc: 2542 003c movel %d2,%a2@(60) /* * 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; 718c0: 7401 moveq #1,%d2 718c2: 2542 0038 movel %d2,%a2@(56) the_period->next_length = length; _ISR_Enable( level ); 718c6: 46c4 movew %d4,%sr _Thread_Executing->Wait.id = the_period->Object.id; 718c8: 2079 0009 bd86 moveal 9bd86 <_Thread_Executing>,%a0 718ce: 216a 0008 0020 movel %a2@(8),%a0@(32) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 718d4: 4878 4000 pea 4000 718d8: 2f08 movel %a0,%sp@- 718da: 4eb9 0004 b9c8 jsr 4b9c8 <_Thread_Set_state> /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 718e0: 203c 0000 0700 movel #1792,%d0 718e6: 40c1 movew %sr,%d1 718e8: 8081 orl %d1,%d0 718ea: 46c0 movew %d0,%sr local_state = the_period->state; the_period->state = RATE_MONOTONIC_ACTIVE; 718ec: 143c 0002 moveb #2,%d2 /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; 718f0: 202a 0038 movel %a2@(56),%d0 the_period->state = RATE_MONOTONIC_ACTIVE; 718f4: 2542 0038 movel %d2,%a2@(56) _ISR_Enable( level ); 718f8: 46c1 movew %d1,%sr /* * 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 ) 718fa: 7203 moveq #3,%d1 718fc: 4fef 000c lea %sp@(12),%sp 71900: b280 cmpl %d0,%d1 71902: 6612 bnes 71916 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 71904: 4878 4000 pea 4000 71908: 2f39 0009 bd86 movel 9bd86 <_Thread_Executing>,%sp@- 7190e: 4eb9 0004 ade0 jsr 4ade0 <_Thread_Clear_state> 71914: 508f addql #8,%sp _Thread_Enable_dispatch(); 71916: 4eb9 0004 b19a jsr 4b19a <_Thread_Enable_dispatch> 7191c: 4284 clrl %d4 return RTEMS_SUCCESSFUL; 7191e: 6038 bras 71958 case RATE_MONOTONIC_EXPIRED: /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 71920: 2f0a movel %a2,%sp@- 71922: 4eb9 0007 16fc jsr 716fc <_Rate_monotonic_Update_statistics> _ISR_Enable( level ); 71928: 46c4 movew %d4,%sr the_period->state = RATE_MONOTONIC_ACTIVE; 7192a: 7002 moveq #2,%d0 the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 7192c: 7806 moveq #6,%d4 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 7192e: 2542 001c movel %d2,%a2@(28) */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; 71932: 2540 0038 movel %d0,%a2@(56) the_period->next_length = length; 71936: 2542 003c movel %d2,%a2@(60) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 7193a: 486a 0010 pea %a2@(16) 7193e: 4879 0009 bda4 pea 9bda4 <_Watchdog_Ticks_chain> 71944: 4eb9 0004 c108 jsr 4c108 <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 7194a: 4eb9 0004 b19a jsr 4b19a <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; 71950: 4fef 000c lea %sp@(12),%sp 71954: 6002 bras 71958 71956: 7804 moveq #4,%d4 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 71958: 2004 movel %d4,%d0 7195a: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 71960: 4e5e unlk %fp <== NOT EXECUTED 0004ff88 : rtems_status_code rtems_region_get_segment_size( rtems_id id, void *segment, uintptr_t *size ) { 4ff88: 4e56 fffc linkw %fp,#-4 4ff8c: 2f03 movel %d3,%sp@- 4ff8e: 262e 0010 movel %fp@(16),%d3 4ff92: 2f02 movel %d2,%sp@- 4ff94: 242e 000c movel %fp@(12),%d2 Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; register Region_Control *the_region; if ( !segment ) 4ff98: 6766 beqs 50000 return RTEMS_INVALID_ADDRESS; if ( !size ) 4ff9a: 4a83 tstl %d3 4ff9c: 6762 beqs 50000 return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); 4ff9e: 2f39 0007 550e movel 7550e <_RTEMS_Allocator_Mutex>,%sp@- 4ffa4: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 4ffaa: 486e fffc pea %fp@(-4) 4ffae: 2f2e 0008 movel %fp@(8),%sp@- 4ffb2: 4879 0007 535a pea 7535a <_Region_Information> 4ffb8: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 4ffbe: 222e fffc movel %fp@(-4),%d1 4ffc2: 4fef 0010 lea %sp@(16),%sp 4ffc6: 670a beqs 4ffd2 4ffc8: 7001 moveq #1,%d0 4ffca: b081 cmpl %d1,%d0 4ffcc: 6620 bnes 4ffee 4ffce: 7404 moveq #4,%d2 4ffd0: 601e bras 4fff0 case OBJECTS_LOCAL: if ( !_Heap_Size_of_alloc_area( &the_region->Memory, segment, size ) ) 4ffd2: 2f03 movel %d3,%sp@- 4ffd4: 2040 moveal %d0,%a0 4ffd6: 2f02 movel %d2,%sp@- 4ffd8: 4868 0068 pea %a0@(104) 4ffdc: 4eb9 0005 31d4 jsr 531d4 <_Heap_Size_of_alloc_area> 4ffe2: 4fef 000c lea %sp@(12),%sp 4ffe6: 4a00 tstb %d0 4ffe8: 6604 bnes 4ffee 4ffea: 7409 moveq #9,%d2 <== NOT EXECUTED 4ffec: 6002 bras 4fff0 <== NOT EXECUTED 4ffee: 4282 clrl %d2 case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 4fff0: 2f39 0007 550e movel 7550e <_RTEMS_Allocator_Mutex>,%sp@- 4fff6: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> return return_status; 4fffc: 588f addql #4,%sp 4fffe: 6002 bras 50002 50000: 7409 moveq #9,%d2 } 50002: 2002 movel %d2,%d0 50004: 242e fff4 movel %fp@(-12),%d2 50008: 262e fff8 movel %fp@(-8),%d3 5000c: 4e5e unlk %fp <== NOT EXECUTED 0005132c : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 5132c: 4e56 ffe8 linkw %fp,#-24 51330: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 51334: 282e 0008 movel %fp@(8),%d4 51338: 262e 000c movel %fp@(12),%d3 5133c: 242e 0010 movel %fp@(16),%d2 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; 51340: 2679 0007 5d2a moveal 75d2a <_Timer_server>,%a3 if ( !timer_server ) 51346: 4a8b tstl %a3 51348: 6606 bnes 51350 5134a: 700e moveq #14,%d0 5134c: 6000 00a4 braw 513f2 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 51350: 4a39 0007 5470 tstb 75470 <_TOD_Is_set> 51356: 6606 bnes 5135e 51358: 700b moveq #11,%d0 <== NOT EXECUTED 5135a: 6000 0096 braw 513f2 <== NOT EXECUTED return RTEMS_NOT_DEFINED; if ( !routine ) 5135e: 4a82 tstl %d2 51360: 6606 bnes 51368 51362: 7009 moveq #9,%d0 51364: 6000 008c braw 513f2 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 51368: 2f03 movel %d3,%sp@- 5136a: 4eb9 0004 e7a8 jsr 4e7a8 <_TOD_Validate> 51370: 588f addql #4,%sp 51372: 4a00 tstb %d0 51374: 677a beqs 513f0 return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 51376: 2f03 movel %d3,%sp@- 51378: 4eb9 0004 e708 jsr 4e708 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) 5137e: 588f addql #4,%sp return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 51380: 2600 movel %d0,%d3 if ( seconds <= _TOD_Seconds_since_epoch() ) 51382: b0b9 0007 54ee cmpl 754ee <_TOD_Now>,%d0 51388: 6366 blss 513f0 5138a: 486e fffc pea %fp@(-4) 5138e: 2f04 movel %d4,%sp@- 51390: 4879 0007 5cf0 pea 75cf0 <_Timer_Information> 51396: 4eb9 0005 378c jsr 5378c <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 5139c: 4fef 000c lea %sp@(12),%sp 513a0: 2440 moveal %d0,%a2 513a2: 4aae fffc tstl %fp@(-4) 513a6: 6704 beqs 513ac 513a8: 7004 moveq #4,%d0 513aa: 6046 bras 513f2 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 513ac: 486a 0010 pea %a2@(16) 513b0: 4eb9 0005 53a8 jsr 553a8 <_Watchdog_Remove> the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 513b6: 256e 0014 0034 movel %fp@(20),%a2@(52) the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 513bc: 7003 moveq #3,%d0 void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; 513be: 2544 0030 movel %d4,%a2@(48) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 513c2: 96b9 0007 54ee subl 754ee <_TOD_Now>,%d3 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; 513c8: 2540 0038 movel %d0,%a2@(56) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 513cc: 2543 001c movel %d3,%a2@(28) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 513d0: 2542 002c movel %d2,%a2@(44) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 513d4: 42aa 0018 clrl %a2@(24) (*timer_server->schedule_operation)( timer_server, the_timer ); 513d8: 2f0a movel %a2,%sp@- 513da: 2f0b movel %a3,%sp@- 513dc: 206b 0004 moveal %a3@(4),%a0 513e0: 4e90 jsr %a0@ _Thread_Enable_dispatch(); 513e2: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 513e8: 4fef 000c lea %sp@(12),%sp _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 ); _Thread_Enable_dispatch(); 513ec: 4280 clrl %d0 return RTEMS_SUCCESSFUL; 513ee: 6002 bras 513f2 513f0: 7014 moveq #20,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 513f2: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 513f8: 4e5e unlk %fp <== NOT EXECUTED 00044d60 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 44d60: 4e56 ffe8 linkw %fp,#-24 44d64: 48d7 041c moveml %d2-%d4/%a2,%sp@ 44d68: 262e 0008 movel %fp@(8),%d3 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 44d6c: 4ab9 0005 ecfa tstl 5ecfa <_POSIX_signals_Ualarm_timer+0x1c> 44d72: 6622 bnes 44d96 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 44d74: 42b9 0005 ece6 clrl 5ece6 <_POSIX_signals_Ualarm_timer+0x8> the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 44d7a: 4282 clrl %d2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 44d7c: 203c 0004 4e4c movel #282188,%d0 the_watchdog->id = id; 44d82: 42b9 0005 ecfe clrl 5ecfe <_POSIX_signals_Ualarm_timer+0x20> Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 44d88: 23c0 0005 ecfa movel %d0,5ecfa <_POSIX_signals_Ualarm_timer+0x1c> the_watchdog->id = id; the_watchdog->user_data = user_data; 44d8e: 42b9 0005 ed02 clrl 5ed02 <_POSIX_signals_Ualarm_timer+0x24> 44d94: 6058 bras 44dee _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 44d96: 4879 0005 ecde pea 5ecde <_POSIX_signals_Ualarm_timer> 44d9c: 4eb9 0004 8338 jsr 48338 <_Watchdog_Remove> if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 44da2: 588f addql #4,%sp 44da4: 7201 moveq #1,%d1 44da6: 5580 subql #2,%d0 44da8: b280 cmpl %d0,%d1 44daa: 6404 bccs 44db0 44dac: 4282 clrl %d2 <== NOT EXECUTED 44dae: 603e bras 44dee <== NOT EXECUTED * boot. Since alarm() is dealing in seconds, we must account for * this. */ ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); 44db0: 2039 0005 ecf2 movel 5ecf2 <_POSIX_signals_Ualarm_timer+0x14>,%d0 44db6: d0b9 0005 ecea addl 5ecea <_POSIX_signals_Ualarm_timer+0xc>,%d0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 44dbc: 486e fff8 pea %fp@(-8) 44dc0: 90b9 0005 ecf6 subl 5ecf6 <_POSIX_signals_Ualarm_timer+0x18>,%d0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 44dc6: 283c 000f 4240 movel #1000000,%d4 ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 44dcc: 2f00 movel %d0,%sp@- 44dce: 4eb9 0004 7e60 jsr 47e60 <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 44dd4: 202e fff8 movel %fp@(-8),%d0 44dd8: 4c04 0800 mulsl %d4,%d0 remaining += tp.tv_nsec / 1000; 44ddc: 283c 0000 03e8 movel #1000,%d4 44de2: 508f addql #8,%sp 44de4: 242e fffc movel %fp@(-4),%d2 44de8: 4c44 2802 remsl %d4,%d2,%d2 44dec: d480 addl %d0,%d2 /* * If useconds is non-zero, then the caller wants to schedule * the alarm repeatedly at that interval. If the interval is * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { 44dee: 4a83 tstl %d3 44df0: 674e beqs 44e40 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); 44df2: 280e movel %fp,%d4 * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 44df4: 223c 000f 4240 movel #1000000,%d1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); 44dfa: 5184 subql #8,%d4 44dfc: 45f9 0004 7ee4 lea 47ee4 <_Timespec_To_ticks>,%a2 * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 44e02: 4c41 3000 remul %d1,%d0,%d3 44e06: 4c41 3003 remul %d1,%d3,%d3 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 44e0a: 223c 0000 03e8 movel #1000,%d1 44e10: 4c00 1800 mulsl %d0,%d1 ticks = _Timespec_To_ticks( &tp ); 44e14: 2f04 movel %d4,%sp@- */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 44e16: 2d41 fffc movel %d1,%fp@(-4) * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 44e1a: 2d43 fff8 movel %d3,%fp@(-8) tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); 44e1e: 4e92 jsr %a2@ if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 44e20: 2f04 movel %d4,%sp@- 44e22: 4e92 jsr %a2@ ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 44e24: 4879 0005 ecde pea 5ecde <_POSIX_signals_Ualarm_timer> 44e2a: 4879 0005 e590 pea 5e590 <_Watchdog_Ticks_chain> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 44e30: 23c0 0005 ecea movel %d0,5ecea <_POSIX_signals_Ualarm_timer+0xc> _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 44e36: 4eb9 0004 821c jsr 4821c <_Watchdog_Insert> 44e3c: 4fef 0010 lea %sp@(16),%sp } return remaining; } 44e40: 2002 movel %d2,%d0 44e42: 4cee 041c ffe8 moveml %fp@(-24),%d2-%d4/%a2 44e48: 4e5e unlk %fp <== NOT EXECUTED