=============================================================================== 00047150 <_API_Mutex_Unlock>: #include void _API_Mutex_Unlock( API_Mutex_Control *the_mutex ) { 47150: 4e56 0000 linkw %fp,#0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 47154: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 4715a: 5280 addql #1,%d0 4715c: 206e 0008 moveal %fp@(8),%a0 47160: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> _Thread_Disable_dispatch(); _CORE_mutex_Surrender( 47166: 42a7 clrl %sp@- 47168: 2f28 0008 movel %a0@(8),%sp@- 4716c: 4868 0010 pea %a0@(16) 47170: 4eb9 0004 7458 jsr 47458 <_CORE_mutex_Surrender> &the_mutex->Mutex, the_mutex->Object.id, NULL ); _Thread_Enable_dispatch(); 47176: 4fef 000c lea %sp@(12),%sp } 4717a: 4e5e unlk %fp _CORE_mutex_Surrender( &the_mutex->Mutex, the_mutex->Object.id, NULL ); _Thread_Enable_dispatch(); 4717c: 4ef9 0004 8cd6 jmp 48cd6 <_Thread_Enable_dispatch> ... =============================================================================== 0004702a <_API_extensions_Run_postdriver>: * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { 4702a: 4e56 0000 linkw %fp,#0 4702e: 2f0a movel %a2,%sp@- the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } 47030: 2479 0005 f5a0 moveal 5f5a0 <_API_extensions_List>,%a2 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 47036: b5fc 0005 f5a4 cmpal #390564,%a2 4703c: 6710 beqs 4704e <_API_extensions_Run_postdriver+0x24><== NEVER TAKEN * Currently all APIs configure this hook so it is always non-NULL. */ #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); 4703e: 206a 0008 moveal %a2@(8),%a0 47042: 4e90 jsr %a0@ Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { 47044: 2452 moveal %a2@,%a2 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 47046: b5fc 0005 f5a4 cmpal #390564,%a2 4704c: 66f0 bnes 4703e <_API_extensions_Run_postdriver+0x14><== NEVER TAKEN #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); } } 4704e: 246e fffc moveal %fp@(-4),%a2 47052: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00047056 <_API_extensions_Run_postswitch>: * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { 47056: 4e56 0000 linkw %fp,#0 4705a: 2f0a movel %a2,%sp@- the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } 4705c: 2479 0005 f5a0 moveal 5f5a0 <_API_extensions_List>,%a2 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 47062: b5fc 0005 f5a4 cmpal #390564,%a2 47068: 6718 beqs 47082 <_API_extensions_Run_postswitch+0x2c><== NEVER TAKEN !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); 4706a: 2f39 0005 f5e4 movel 5f5e4 <_Per_CPU_Information+0xc>,%sp@- 47070: 206a 000c moveal %a2@(12),%a0 47074: 4e90 jsr %a0@ Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { 47076: 2452 moveal %a2@,%a2 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 47078: 588f addql #4,%sp 4707a: b5fc 0005 f5a4 cmpal #390564,%a2 47080: 66e8 bnes 4706a <_API_extensions_Run_postswitch+0x14><== NEVER TAKEN the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } 47082: 246e fffc moveal %fp@(-4),%a2 47086: 4e5e unlk %fp ... =============================================================================== 0004edd8 <_CORE_barrier_Wait>: Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4edd8: 203c 0000 0700 movel #1792,%d0 Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4edde: 4e56 fff4 linkw %fp,#-12 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; 4ede2: 2279 0006 1e98 moveal 61e98 <_Per_CPU_Information+0xc>,%a1 Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4ede8: 48d7 001c moveml %d2-%d4,%sp@ 4edec: 206e 0008 moveal %fp@(8),%a0 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL; 4edf0: 42a9 0034 clrl %a1@(52) Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4edf4: 242e 000c movel %fp@(12),%d2 4edf8: 262e 0014 movel %fp@(20),%d3 4edfc: 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 ); 4ee00: 40c1 movew %sr,%d1 4ee02: 8081 orl %d1,%d0 4ee04: 46c0 movew %d0,%sr the_barrier->number_of_waiting_threads++; 4ee06: 2028 0048 movel %a0@(72),%d0 4ee0a: 5280 addql #1,%d0 4ee0c: 2140 0048 movel %d0,%a0@(72) if ( _CORE_barrier_Is_automatic( &the_barrier->Attributes ) ) { 4ee10: 4aa8 0040 tstl %a0@(64) 4ee14: 6606 bnes 4ee1c <_CORE_barrier_Wait+0x44> if ( the_barrier->number_of_waiting_threads == 4ee16: b0a8 0044 cmpl %a0@(68),%d0 4ee1a: 672e beqs 4ee4a <_CORE_barrier_Wait+0x72> 4ee1c: 7001 moveq #1,%d0 4ee1e: 2140 0030 movel %d0,%a0@(48) return; } } _Thread_queue_Enter_critical_section( &the_barrier->Wait_queue ); executing->Wait.queue = &the_barrier->Wait_queue; 4ee22: 2348 0044 movel %a0,%a1@(68) executing->Wait.id = id; 4ee26: 2342 0020 movel %d2,%a1@(32) _ISR_Enable( level ); 4ee2a: 46c1 movew %d1,%sr _Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout ); 4ee2c: 2d43 000c movel %d3,%fp@(12) 4ee30: 203c 0004 b700 movel #308992,%d0 4ee36: 2d48 0008 movel %a0,%fp@(8) } 4ee3a: 4cd7 001c moveml %sp@,%d2-%d4 _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 ); 4ee3e: 2d40 0010 movel %d0,%fp@(16) } 4ee42: 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 ); 4ee44: 4ef9 0004 b33c jmp 4b33c <_Thread_queue_Enqueue_with_handler> _ISR_Disable( level ); the_barrier->number_of_waiting_threads++; 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; 4ee4a: 7001 moveq #1,%d0 4ee4c: 2340 0034 movel %d0,%a1@(52) _ISR_Enable( level ); 4ee50: 46c1 movew %d1,%sr _CORE_barrier_Release( the_barrier, id, api_barrier_mp_support ); 4ee52: 2d44 0010 movel %d4,%fp@(16) 4ee56: 2d42 000c movel %d2,%fp@(12) executing->Wait.queue = &the_barrier->Wait_queue; executing->Wait.id = id; _ISR_Enable( level ); _Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout ); } 4ee5a: 4cd7 001c moveml %sp@,%d2-%d4 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 ); 4ee5e: 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 ); } 4ee62: 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 ); 4ee64: 4ef9 0004 ed9c jmp 4ed9c <_CORE_barrier_Release> ... =============================================================================== 0004cfbc <_CORE_message_queue_Close>: void _CORE_message_queue_Close( CORE_message_queue_Control *the_message_queue, Thread_queue_Flush_callout remote_extract_callout, uint32_t status ) { 4cfbc: 4e56 0000 linkw %fp,#0 4cfc0: 2f0a movel %a2,%sp@- /* * This will flush blocked threads whether they were blocked on * a send or receive. */ _Thread_queue_Flush( 4cfc2: 2f2e 0010 movel %fp@(16),%sp@- 4cfc6: 2f2e 000c movel %fp@(12),%sp@- void _CORE_message_queue_Close( CORE_message_queue_Control *the_message_queue, Thread_queue_Flush_callout remote_extract_callout, uint32_t status ) { 4cfca: 246e 0008 moveal %fp@(8),%a2 /* * This will flush blocked threads whether they were blocked on * a send or receive. */ _Thread_queue_Flush( 4cfce: 2f0a movel %a2,%sp@- 4cfd0: 4eb9 0004 a06c jsr 4a06c <_Thread_queue_Flush> * This removes all messages from the pending message queue. Since * we just flushed all waiting threads, we don't have to worry about * the flush satisfying any blocked senders as a side-effect. */ if ( the_message_queue->number_of_pending_messages != 0 ) 4cfd6: 4fef 000c lea %sp@(12),%sp 4cfda: 4aaa 0048 tstl %a2@(72) 4cfde: 6612 bnes 4cff2 <_CORE_message_queue_Close+0x36> (void) _CORE_message_queue_Flush_support( the_message_queue ); (void) _Workspace_Free( the_message_queue->message_buffers ); 4cfe0: 2d6a 005c 0008 movel %a2@(92),%fp@(8) } 4cfe6: 246e fffc moveal %fp@(-4),%a2 4cfea: 4e5e unlk %fp */ if ( the_message_queue->number_of_pending_messages != 0 ) (void) _CORE_message_queue_Flush_support( the_message_queue ); (void) _Workspace_Free( the_message_queue->message_buffers ); 4cfec: 4ef9 0004 aa66 jmp 4aa66 <_Workspace_Free> * we just flushed all waiting threads, we don't have to worry about * the flush satisfying any blocked senders as a side-effect. */ if ( the_message_queue->number_of_pending_messages != 0 ) (void) _CORE_message_queue_Flush_support( the_message_queue ); 4cff2: 2f0a movel %a2,%sp@- 4cff4: 4eb9 0004 d010 jsr 4d010 <_CORE_message_queue_Flush_support> (void) _Workspace_Free( the_message_queue->message_buffers ); 4cffa: 2d6a 005c 0008 movel %a2@(92),%fp@(8) * we just flushed all waiting threads, we don't have to worry about * the flush satisfying any blocked senders as a side-effect. */ if ( the_message_queue->number_of_pending_messages != 0 ) (void) _CORE_message_queue_Flush_support( the_message_queue ); 4d000: 588f addql #4,%sp (void) _Workspace_Free( the_message_queue->message_buffers ); } 4d002: 246e fffc moveal %fp@(-4),%a2 4d006: 4e5e unlk %fp */ if ( the_message_queue->number_of_pending_messages != 0 ) (void) _CORE_message_queue_Flush_support( the_message_queue ); (void) _Workspace_Free( the_message_queue->message_buffers ); 4d008: 4ef9 0004 aa66 jmp 4aa66 <_Workspace_Free> ... =============================================================================== 00050408 <_CORE_message_queue_Initialize>: /* * Round size up to multiple of a pointer for chain init and * check for overflow on adding overhead to each message. */ allocated_message_size = maximum_message_size; if (allocated_message_size & (sizeof(uint32_t) - 1)) { 50408: 7203 moveq #3,%d1 CORE_message_queue_Control *the_message_queue, CORE_message_queue_Attributes *the_message_queue_attributes, uint32_t maximum_pending_messages, size_t maximum_message_size ) { 5040a: 4e56 fff4 linkw %fp,#-12 5040e: 202e 0014 movel %fp@(20),%d0 50412: 48d7 040c moveml %d2-%d3/%a2,%sp@ 50416: 246e 0008 moveal %fp@(8),%a2 5041a: 242e 0010 movel %fp@(16),%d2 /* * Round size up to multiple of a pointer for chain init and * check for overflow on adding overhead to each message. */ allocated_message_size = maximum_message_size; if (allocated_message_size & (sizeof(uint32_t) - 1)) { 5041e: c280 andl %d0,%d1 ) { size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; 50420: 2542 0044 movel %d2,%a2@(68) the_message_queue->number_of_pending_messages = 0; 50424: 42aa 0048 clrl %a2@(72) the_message_queue->maximum_message_size = maximum_message_size; 50428: 2540 004c movel %d0,%a2@(76) /* * Round size up to multiple of a pointer for chain init and * check for overflow on adding overhead to each message. */ allocated_message_size = maximum_message_size; if (allocated_message_size & (sizeof(uint32_t) - 1)) { 5042c: 4a81 tstl %d1 5042e: 6718 beqs 50448 <_CORE_message_queue_Initialize+0x40> allocated_message_size += sizeof(uint32_t); 50430: 2200 movel %d0,%d1 50432: 5881 addql #4,%d1 allocated_message_size &= ~(sizeof(uint32_t) - 1); 50434: 76fc moveq #-4,%d3 50436: c283 andl %d3,%d1 } if (allocated_message_size < maximum_message_size) 50438: b280 cmpl %d0,%d1 5043a: 640e bccs 5044a <_CORE_message_queue_Initialize+0x42><== ALWAYS TAKEN STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 5043c: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) return false; 50442: 4200 clrb %d0 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 50444: 4e5e unlk %fp 50446: 4e75 rts /* * Round size up to multiple of a pointer for chain init and * check for overflow on adding overhead to each message. */ allocated_message_size = maximum_message_size; if (allocated_message_size & (sizeof(uint32_t) - 1)) { 50448: 2200 movel %d0,%d1 /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); 5044a: 2601 movel %d1,%d3 5044c: 0683 0000 0010 addil #16,%d3 /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * 50452: 2003 movel %d3,%d0 50454: 4c02 0800 mulsl %d2,%d0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 50458: b280 cmpl %d0,%d1 5045a: 62e0 bhis 5043c <_CORE_message_queue_Initialize+0x34><== NEVER TAKEN /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); 5045c: 2f00 movel %d0,%sp@- 5045e: 4eb9 0005 32d6 jsr 532d6 <_Workspace_Allocate> if (the_message_queue->message_buffers == 0) 50464: 588f addql #4,%sp return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 50466: 2540 005c movel %d0,%a2@(92) _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 5046a: 67d0 beqs 5043c <_CORE_message_queue_Initialize+0x34> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 5046c: 2f03 movel %d3,%sp@- 5046e: 2f02 movel %d2,%sp@- 50470: 2f00 movel %d0,%sp@- 50472: 486a 0060 pea %a2@(96) 50476: 4eb9 0005 5148 jsr 55148 <_Chain_Initialize> RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 5047c: 41ea 0054 lea %a2@(84),%a0 allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 50480: 7001 moveq #1,%d0 50482: 2548 0050 movel %a0,%a2@(80) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 50486: 41ea 0050 lea %a2@(80),%a0 5048a: 2548 0058 movel %a0,%a2@(88) 5048e: 4878 0006 pea 6 50492: 4878 0080 pea 80 50496: 206e 000c moveal %fp@(12),%a0 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 5049a: 42aa 0054 clrl %a2@(84) 5049e: b090 cmpl %a0@,%d0 504a0: 57c0 seq %d0 504a2: 49c0 extbl %d0 504a4: 4480 negl %d0 504a6: 2f00 movel %d0,%sp@- 504a8: 2f0a movel %a2,%sp@- 504aa: 4eb9 0005 2934 jsr 52934 <_Thread_queue_Initialize> THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 504b0: 4fef 0020 lea %sp@(32),%sp } 504b4: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 504ba: 7001 moveq #1,%d0 } 504bc: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 000504c0 <_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 ); 504c0: 203c 0000 0700 movel #1792,%d0 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 504c6: 4e56 ffe4 linkw %fp,#-28 ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 504ca: 2079 0006 941c moveal 6941c <_Per_CPU_Information+0xc>,%a0 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 504d0: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 504d4: 246e 0008 moveal %fp@(8),%a2 504d8: 2a2e 000c movel %fp@(12),%d5 504dc: 242e 0010 movel %fp@(16),%d2 504e0: 226e 0014 moveal %fp@(20),%a1 504e4: 282e 001c movel %fp@(28),%d4 504e8: 162e 001b moveb %fp@(27),%d3 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; 504ec: 42a8 0034 clrl %a0@(52) _ISR_Disable( level ); 504f0: 40c1 movew %sr,%d1 504f2: 8081 orl %d1,%d0 504f4: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 504f6: 200a movel %a2,%d0 504f8: 0680 0000 0054 addil #84,%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 ); } 504fe: 266a 0050 moveal %a2@(80),%a3 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 50502: b08b cmpl %a3,%d0 50504: 674e beqs 50554 <_CORE_message_queue_Seize+0x94> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; 50506: 2053 moveal %a3@,%a0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_first_unprotected( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 50508: 49ea 0050 lea %a2@(80),%a4 5050c: 214c 0004 movel %a4,%a0@(4) executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; _ISR_Disable( level ); the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; 50510: 53aa 0048 subql #1,%a2@(72) Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; 50514: 2548 0050 movel %a0,%a2@(80) _ISR_Enable( level ); 50518: 46c1 movew %d1,%sr *size_p = the_message->Contents.size; 5051a: 22ab 0008 movel %a3@(8),%a1@ 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 ); 5051e: 45ea 0060 lea %a2@(96),%a2 _Thread_Executing->Wait.count = 50522: 2079 0006 941c moveal 6941c <_Per_CPU_Information+0xc>,%a0 50528: 42a8 0024 clrl %a0@(36) const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 5052c: 2f11 movel %a1@,%sp@- 5052e: 486b 000c pea %a3@(12) 50532: 2f02 movel %d2,%sp@- 50534: 4eb9 0005 7868 jsr 57868 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 ); 5053a: 4fef 000c lea %sp@(12),%sp 5053e: 2d4a 0008 movel %a2,%fp@(8) 50542: 2d4b 000c movel %a3,%fp@(12) 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 ); } 50546: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 5054c: 4e5e unlk %fp 5054e: 4ef9 0005 033c jmp 5033c <_Chain_Append> return; } #endif } if ( !wait ) { 50554: 4a03 tstb %d3 50556: 6612 bnes 5056a <_CORE_message_queue_Seize+0xaa> _ISR_Enable( level ); 50558: 46c1 movew %d1,%sr executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 5055a: 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 ); } 5055c: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 #endif } if ( !wait ) { _ISR_Enable( level ); executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 50562: 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 ); } 50566: 4e5e unlk %fp 50568: 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; 5056a: 7001 moveq #1,%d0 5056c: 2540 0030 movel %d0,%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; 50570: 2142 002c movel %d2,%a0@(44) executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; 50574: 214a 0044 movel %a2,%a0@(68) executing->Wait.id = id; 50578: 2145 0020 movel %d5,%a0@(32) executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; 5057c: 2149 0028 movel %a1,%a0@(40) /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 50580: 46c1 movew %d1,%sr _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 50582: 49f9 0005 2a40 lea 52a40 <_Thread_queue_Timeout>,%a4 50588: 2d44 000c movel %d4,%fp@(12) 5058c: 2d4c 0010 movel %a4,%fp@(16) 50590: 2d4a 0008 movel %a2,%fp@(8) } 50594: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 5059a: 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 ); 5059c: 4ef9 0005 267c jmp 5267c <_Thread_queue_Enqueue_with_handler> ... =============================================================================== 000505a4 <_CORE_message_queue_Submit>: #endif CORE_message_queue_Submit_types submit_type, bool wait, Watchdog_Interval timeout ) { 505a4: 4e56 fff4 linkw %fp,#-12 505a8: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 505ac: 246e 0008 moveal %fp@(8),%a2 505b0: 242e 0010 movel %fp@(16),%d2 CORE_message_queue_Buffer_control *the_message; Thread_Control *the_thread; if ( size > the_message_queue->maximum_message_size ) { 505b4: b4aa 004c cmpl %a2@(76),%d2 505b8: 6256 bhis 50610 <_CORE_message_queue_Submit+0x6c> } /* * Is there a thread currently waiting on this message queue? */ if ( the_message_queue->number_of_pending_messages == 0 ) { 505ba: 202a 0048 movel %a2@(72),%d0 505be: 675c beqs 5061c <_CORE_message_queue_Submit+0x78> /* * No one waiting on the message queue at this time, so attempt to * queue the message up for a future receive. */ if ( the_message_queue->number_of_pending_messages < 505c0: b0aa 0044 cmpl %a2@(68),%d0 505c4: 650c bcss 505d2 <_CORE_message_queue_Submit+0x2e> ); return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } #if !defined(RTEMS_SCORE_COREMSG_ENABLE_BLOCKING_SEND) return CORE_MESSAGE_QUEUE_STATUS_TOO_MANY; 505c6: 7002 moveq #2,%d0 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT; #endif } 505c8: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 505ce: 4e5e unlk %fp 505d0: 4e75 rts _CORE_message_queue_Allocate_message_buffer ( CORE_message_queue_Control *the_message_queue ) { return (CORE_message_queue_Buffer_control *) _Chain_Get( &the_message_queue->Inactive_messages ); 505d2: 486a 0060 pea %a2@(96) 505d6: 4eb9 0005 039c jsr 5039c <_Chain_Get> 505dc: 2640 moveal %d0,%a3 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 505de: 2f02 movel %d2,%sp@- 505e0: 2f2e 000c movel %fp@(12),%sp@- 505e4: 486b 000c pea %a3@(12) 505e8: 4eb9 0005 7868 jsr 57868 _CORE_message_queue_Copy_buffer( buffer, the_message->Contents.buffer, size ); the_message->Contents.size = size; 505ee: 2742 0008 movel %d2,%a3@(8) _CORE_message_queue_Set_message_priority( the_message, submit_type ); _CORE_message_queue_Insert_message( 505f2: 2f2e 001c movel %fp@(28),%sp@- 505f6: 2f0b movel %a3,%sp@- 505f8: 2f0a movel %a2,%sp@- 505fa: 4eb9 0005 51bc jsr 551bc <_CORE_message_queue_Insert_message> the_message_queue, the_message, submit_type ); return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 50600: 4fef 001c lea %sp@(28),%sp 50604: 4280 clrl %d0 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT; #endif } 50606: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 5060c: 4e5e unlk %fp 5060e: 4e75 rts { CORE_message_queue_Buffer_control *the_message; Thread_Control *the_thread; if ( size > the_message_queue->maximum_message_size ) { return CORE_MESSAGE_QUEUE_STATUS_INVALID_SIZE; 50610: 7001 moveq #1,%d0 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT; #endif } 50612: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 50618: 4e5e unlk %fp 5061a: 4e75 rts /* * Is there a thread currently waiting on this message queue? */ if ( the_message_queue->number_of_pending_messages == 0 ) { the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 5061c: 2f0a movel %a2,%sp@- 5061e: 4eb9 0005 2504 jsr 52504 <_Thread_queue_Dequeue> if ( the_thread ) { 50624: 588f addql #4,%sp /* * Is there a thread currently waiting on this message queue? */ if ( the_message_queue->number_of_pending_messages == 0 ) { the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 50626: 2640 moveal %d0,%a3 if ( the_thread ) { 50628: 4a80 tstl %d0 5062a: 672e beqs 5065a <_CORE_message_queue_Submit+0xb6> 5062c: 2f02 movel %d2,%sp@- 5062e: 2f2e 000c movel %fp@(12),%sp@- 50632: 2f2b 002c movel %a3@(44),%sp@- 50636: 4eb9 0005 7868 jsr 57868 _CORE_message_queue_Copy_buffer( buffer, the_thread->Wait.return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 5063c: 206b 0028 moveal %a3@(40),%a0 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 50640: 4fef 000c lea %sp@(12),%sp 50644: 4280 clrl %d0 _CORE_message_queue_Copy_buffer( buffer, the_thread->Wait.return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 50646: 2082 movel %d2,%a0@ the_thread->Wait.count = (uint32_t) submit_type; 50648: 222e 001c movel %fp@(28),%d1 5064c: 2741 0024 movel %d1,%a3@(36) _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT; #endif } 50650: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 50656: 4e5e unlk %fp 50658: 4e75 rts /* * Is there a thread currently waiting on this message queue? */ if ( the_message_queue->number_of_pending_messages == 0 ) { the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); if ( the_thread ) { 5065a: 202a 0048 movel %a2@(72),%d0 /* * No one waiting on the message queue at this time, so attempt to * queue the message up for a future receive. */ if ( the_message_queue->number_of_pending_messages < 5065e: b0aa 0044 cmpl %a2@(68),%d0 50662: 6400 ff62 bccw 505c6 <_CORE_message_queue_Submit+0x22> 50666: 6000 ff6a braw 505d2 <_CORE_message_queue_Submit+0x2e> ... =============================================================================== 000473a8 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 473a8: 4e56 0000 linkw %fp,#0 _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 473ac: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 473b2: 2f0a movel %a2,%sp@- 473b4: 246e 0008 moveal %fp@(8),%a2 473b8: 2f02 movel %d2,%sp@- 473ba: 142e 0013 moveb %fp@(19),%d2 _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 473be: 4a80 tstl %d0 473c0: 6704 beqs 473c6 <_CORE_mutex_Seize+0x1e> 473c2: 4a02 tstb %d2 473c4: 6634 bnes 473fa <_CORE_mutex_Seize+0x52> <== ALWAYS TAKEN 473c6: 486e 0018 pea %fp@(24) 473ca: 2f0a movel %a2,%sp@- 473cc: 4eb9 0004 bcd4 jsr 4bcd4 <_CORE_mutex_Seize_interrupt_trylock> 473d2: 508f addql #8,%sp 473d4: 4a80 tstl %d0 473d6: 6716 beqs 473ee <_CORE_mutex_Seize+0x46> 473d8: 4a02 tstb %d2 473da: 6636 bnes 47412 <_CORE_mutex_Seize+0x6a> 473dc: 202e 0018 movel %fp@(24),%d0 473e0: 46c0 movew %d0,%sr 473e2: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 473e8: 7001 moveq #1,%d0 473ea: 2140 0034 movel %d0,%a0@(52) } 473ee: 242e fff8 movel %fp@(-8),%d2 473f2: 246e fffc moveal %fp@(-4),%a2 473f6: 4e5e unlk %fp 473f8: 4e75 rts bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 473fa: 7001 moveq #1,%d0 473fc: b0b9 0005 f590 cmpl 5f590 <_System_state_Current>,%d0 47402: 64c2 bccs 473c6 <_CORE_mutex_Seize+0x1e> 47404: 4878 0012 pea 12 47408: 42a7 clrl %sp@- 4740a: 42a7 clrl %sp@- 4740c: 4eb9 0004 7ac4 jsr 47ac4 <_Internal_error_Occurred> 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; 47412: 7001 moveq #1,%d0 47414: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 4741a: 2540 0030 movel %d0,%a2@(48) 4741e: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 47424: 5280 addql #1,%d0 47426: 216e 000c 0020 movel %fp@(12),%a0@(32) 4742c: 214a 0044 movel %a2,%a0@(68) 47430: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> 47436: 202e 0018 movel %fp@(24),%d0 4743a: 46c0 movew %d0,%sr 4743c: 2f2e 0014 movel %fp@(20),%sp@- 47440: 2f0a movel %a2,%sp@- 47442: 4eb9 0004 731c jsr 4731c <_CORE_mutex_Seize_interrupt_blocking> } 47448: 242e fff8 movel %fp@(-8),%d2 bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 4744c: 508f addql #8,%sp } 4744e: 246e fffc moveal %fp@(-4),%a2 47452: 4e5e unlk %fp ... =============================================================================== 000475ac <_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 ) { 475ac: 4e56 0000 linkw %fp,#0 475b0: 2f0a movel %a2,%sp@- 475b2: 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)) ) { 475b6: 2f0a movel %a2,%sp@- 475b8: 4eb9 0004 9030 jsr 49030 <_Thread_queue_Dequeue> 475be: 588f addql #4,%sp 475c0: 4a80 tstl %d0 475c2: 670a beqs 475ce <_CORE_semaphore_Surrender+0x22> status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } 475c4: 246e fffc moveal %fp@(-4),%a2 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 475c8: 4280 clrl %d0 status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } 475ca: 4e5e unlk %fp 475cc: 4e75 rts if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 475ce: 303c 0700 movew #1792,%d0 475d2: 40c1 movew %sr,%d1 475d4: 8081 orl %d1,%d0 475d6: 46c0 movew %d0,%sr if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 475d8: 202a 0048 movel %a2@(72),%d0 475dc: b0aa 0040 cmpl %a2@(64),%d0 475e0: 6412 bccs 475f4 <_CORE_semaphore_Surrender+0x48> <== NEVER TAKEN the_semaphore->count += 1; 475e2: 5280 addql #1,%d0 475e4: 2540 0048 movel %d0,%a2@(72) { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 475e8: 4280 clrl %d0 _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 475ea: 46c1 movew %d1,%sr } return status; } 475ec: 246e fffc moveal %fp@(-4),%a2 475f0: 4e5e unlk %fp 475f2: 4e75 rts } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; 475f4: 7004 moveq #4,%d0 <== NOT EXECUTED _ISR_Enable( level ); 475f6: 46c1 movew %d1,%sr <== NOT EXECUTED 475f8: 60f2 bras 475ec <_CORE_semaphore_Surrender+0x40> <== NOT EXECUTED ... =============================================================================== 0004bc60 <_Chain_Initialize>: Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { 4bc60: 4e56 ffec linkw %fp,#-20 4bc64: 202e 0010 movel %fp@(16),%d0 4bc68: 48d7 043c moveml %d2-%d5/%a2,%sp@ 4bc6c: 246e 0008 moveal %fp@(8),%a2 size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4bc70: 280a movel %a2,%d4 4bc72: 5884 addql #4,%d4 Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { 4bc74: 262e 000c movel %fp@(12),%d3 4bc78: 242e 0014 movel %fp@(20),%d2 Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; 4bc7c: 42aa 0004 clrl %a2@(4) while ( count-- ) { 4bc80: 4a80 tstl %d0 4bc82: 6740 beqs 4bcc4 <_Chain_Initialize+0x64> <== NEVER TAKEN { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; Chain_Node *next = starting_address; 4bc84: 2043 moveal %d3,%a0 ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; 4bc86: 224a moveal %a2,%a1 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4bc88: 5380 subql #1,%d0 * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( 4bc8a: 2208 movel %a0,%d1 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4bc8c: 2a00 movel %d0,%d5 * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( 4bc8e: d282 addl %d2,%d1 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { current->next = next; 4bc90: 2288 movel %a0,%a1@ next->previous = current; 4bc92: 2149 0004 movel %a1,%a0@(4) Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4bc96: 4a80 tstl %d0 4bc98: 6714 beqs 4bcae <_Chain_Initialize+0x4e> 4bc9a: 2248 moveal %a0,%a1 current->next = next; next->previous = current; current = next; next = (Chain_Node *) 4bc9c: 2041 moveal %d1,%a0 * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( 4bc9e: 2208 movel %a0,%d1 4bca0: 5380 subql #1,%d0 4bca2: d282 addl %d2,%d1 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { current->next = next; 4bca4: 2288 movel %a0,%a1@ next->previous = current; 4bca6: 2149 0004 movel %a1,%a0@(4) Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4bcaa: 4a80 tstl %d0 4bcac: 66ec bnes 4bc9a <_Chain_Initialize+0x3a> * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( 4bcae: 4c05 2800 mulsl %d5,%d2 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4bcb2: 2043 moveal %d3,%a0 4bcb4: d1c2 addal %d2,%a0 next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; tail->previous = current; 4bcb6: 2548 0008 movel %a0,%a2@(8) current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; 4bcba: 2084 movel %d4,%a0@ tail->previous = current; } 4bcbc: 4cd7 043c moveml %sp@,%d2-%d5/%a2 4bcc0: 4e5e unlk %fp 4bcc2: 4e75 rts ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; 4bcc4: 204a moveal %a2,%a0 <== NOT EXECUTED next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; tail->previous = current; 4bcc6: 2548 0008 movel %a0,%a2@(8) <== NOT EXECUTED current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; 4bcca: 2084 movel %d4,%a0@ <== NOT EXECUTED tail->previous = current; } 4bccc: 4cd7 043c moveml %sp@,%d2-%d5/%a2 <== NOT EXECUTED 4bcd0: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 000462b4 <_Event_Surrender>: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; option_set = (rtems_option) the_thread->Wait.option; _ISR_Disable( level ); 462b4: 203c 0000 0700 movel #1792,%d0 */ void _Event_Surrender( Thread_Control *the_thread ) { 462ba: 4e56 ffec linkw %fp,#-20 462be: 48d7 043c moveml %d2-%d5/%a2,%sp@ 462c2: 246e 0008 moveal %fp@(8),%a2 rtems_event_set event_condition; rtems_event_set seized_events; rtems_option option_set; RTEMS_API_Control *api; api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 462c6: 206a 00fc moveal %a2@(252),%a0 option_set = (rtems_option) the_thread->Wait.option; 462ca: 282a 0030 movel %a2@(48),%d4 _ISR_Disable( level ); 462ce: 40c3 movew %sr,%d3 462d0: 8083 orl %d3,%d0 462d2: 46c0 movew %d0,%sr pending_events = api->pending_events; event_condition = (rtems_event_set) the_thread->Wait.count; 462d4: 222a 0024 movel %a2@(36),%d1 RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Get( rtems_event_set the_event_set, rtems_event_set the_event_condition ) { return ( the_event_set & the_event_condition ); 462d8: 2001 movel %d1,%d0 api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; option_set = (rtems_option) the_thread->Wait.option; _ISR_Disable( level ); pending_events = api->pending_events; 462da: 2410 movel %a0@,%d2 462dc: c082 andl %d2,%d0 seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { 462de: 6776 beqs 46356 <_Event_Surrender+0xa2> /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && 462e0: 4ab9 0005 f5e0 tstl 5f5e0 <_Per_CPU_Information+0x8> 462e6: 670a beqs 462f2 <_Event_Surrender+0x3e> 462e8: b5f9 0005 f5e4 cmpal 5f5e4 <_Per_CPU_Information+0xc>,%a2 462ee: 6700 00a0 beqw 46390 <_Event_Surrender+0xdc> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); 462f2: 2a2a 0010 movel %a2@(16),%d5 462f6: 0285 0000 0100 andil #256,%d5 } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 462fc: 674c beqs 4634a <_Event_Surrender+0x96> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 462fe: b081 cmpl %d1,%d0 46300: 6706 beqs 46308 <_Event_Surrender+0x54> 46302: 0804 0001 btst #1,%d4 46306: 6742 beqs 4634a <_Event_Surrender+0x96> <== NEVER TAKEN RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear( rtems_event_set the_event_set, rtems_event_set the_mask ) { return ( the_event_set & ~(the_mask) ); 46308: 2200 movel %d0,%d1 4630a: 4681 notl %d1 4630c: c282 andl %d2,%d1 4630e: 2081 movel %d1,%a0@ api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 46310: 206a 0028 moveal %a2@(40),%a0 * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; 46314: 42aa 0024 clrl %a2@(36) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 46318: 2080 movel %d0,%a0@ _ISR_Flash( level ); 4631a: 203c 0000 0700 movel #1792,%d0 46320: 46c3 movew %d3,%sr 46322: 8083 orl %d3,%d0 46324: 46c0 movew %d0,%sr if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 46326: 7a02 moveq #2,%d5 46328: baaa 0050 cmpl %a2@(80),%d5 4632c: 6734 beqs 46362 <_Event_Surrender+0xae> _ISR_Enable( level ); 4632e: 46c3 movew %d3,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 46330: 2f3c 1003 fff8 movel #268697592,%sp@- 46336: 2f0a movel %a2,%sp@- 46338: 4eb9 0004 8908 jsr 48908 <_Thread_Clear_state> 4633e: 508f addql #8,%sp } return; } } _ISR_Enable( level ); } 46340: 4cee 043c ffec moveml %fp@(-20),%d2-%d5/%a2 46346: 4e5e unlk %fp 46348: 4e75 rts _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 4634a: 46c3 movew %d3,%sr } 4634c: 4cee 043c ffec moveml %fp@(-20),%d2-%d5/%a2 46352: 4e5e unlk %fp 46354: 4e75 rts /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { _ISR_Enable( level ); 46356: 46c3 movew %d3,%sr } return; } } _ISR_Enable( level ); } 46358: 4cee 043c ffec moveml %fp@(-20),%d2-%d5/%a2 4635e: 4e5e unlk %fp 46360: 4e75 rts RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 46362: 7003 moveq #3,%d0 46364: 2540 0050 movel %d0,%a2@(80) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 46368: 46c3 movew %d3,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 4636a: 486a 0048 pea %a2@(72) 4636e: 4eb9 0004 9c80 jsr 49c80 <_Watchdog_Remove> 46374: 2f3c 1003 fff8 movel #268697592,%sp@- 4637a: 2f0a movel %a2,%sp@- 4637c: 4eb9 0004 8908 jsr 48908 <_Thread_Clear_state> 46382: 4fef 000c lea %sp@(12),%sp } return; } } _ISR_Enable( level ); } 46386: 4cee 043c ffec moveml %fp@(-20),%d2-%d5/%a2 4638c: 4e5e unlk %fp 4638e: 4e75 rts * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 46390: 2279 0005 f618 moveal 5f618 <_Event_Sync_state>,%a1 /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && 46396: 7a02 moveq #2,%d5 46398: ba89 cmpl %a1,%d5 4639a: 6710 beqs 463ac <_Event_Surrender+0xf8> <== NEVER TAKEN ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 4639c: 2279 0005 f618 moveal 5f618 <_Event_Sync_state>,%a1 * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 463a2: 1a3c 0001 moveb #1,%d5 463a6: ba89 cmpl %a1,%d5 463a8: 6600 ff48 bnew 462f2 <_Event_Surrender+0x3e> (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { 463ac: b081 cmpl %d1,%d0 463ae: 6706 beqs 463b6 <_Event_Surrender+0x102> 463b0: 0804 0001 btst #1,%d4 463b4: 671a beqs 463d0 <_Event_Surrender+0x11c> <== NEVER TAKEN 463b6: 2200 movel %d0,%d1 463b8: 4681 notl %d1 463ba: c282 andl %d2,%d1 463bc: 2081 movel %d1,%a0@ api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 463be: 206a 0028 moveal %a2@(40),%a0 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; 463c2: 42aa 0024 clrl %a2@(36) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 463c6: 2080 movel %d0,%a0@ _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 463c8: 7003 moveq #3,%d0 463ca: 23c0 0005 f618 movel %d0,5f618 <_Event_Sync_state> } _ISR_Enable( level ); 463d0: 46c3 movew %d3,%sr } return; } } _ISR_Enable( level ); } 463d2: 4cee 043c ffec moveml %fp@(-20),%d2-%d5/%a2 463d8: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 000463dc <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 463dc: 4e56 fffc linkw %fp,#-4 463e0: 2f03 movel %d3,%sp@- 463e2: 2f02 movel %d2,%sp@- Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 463e4: 486e fffc pea %fp@(-4) 463e8: 2f2e 0008 movel %fp@(8),%sp@- 463ec: 4eb9 0004 8cfc jsr 48cfc <_Thread_Get> switch ( location ) { 463f2: 508f addql #8,%sp 463f4: 4aae fffc tstl %fp@(-4) 463f8: 6642 bnes 4643c <_Event_Timeout+0x60> <== NEVER TAKEN * * If it is not satisfied, then it is "nothing happened" and * this is the "timeout" transition. After a request is satisfied, * a timeout is not allowed to occur. */ _ISR_Disable( level ); 463fa: 223c 0000 0700 movel #1792,%d1 46400: 40c2 movew %sr,%d2 46402: 8282 orl %d2,%d1 46404: 46c1 movew %d1,%sr _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; 46406: 2040 moveal %d0,%a0 46408: 42a8 0024 clrl %a0@(36) if ( _Thread_Is_executing( the_thread ) ) { 4640c: b0b9 0005 f5e4 cmpl 5f5e4 <_Per_CPU_Information+0xc>,%d0 46412: 6734 beqs 46448 <_Event_Timeout+0x6c> if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; 46414: 7606 moveq #6,%d3 46416: 2040 moveal %d0,%a0 46418: 2143 0034 movel %d3,%a0@(52) _ISR_Enable( level ); 4641c: 46c2 movew %d2,%sr 4641e: 2f3c 1003 fff8 movel #268697592,%sp@- 46424: 2f00 movel %d0,%sp@- 46426: 4eb9 0004 8908 jsr 48908 <_Thread_Clear_state> _Thread_Unblock( the_thread ); _Thread_Unnest_dispatch(); break; 4642c: 508f addql #8,%sp */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4642e: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 46434: 5380 subql #1,%d0 46436: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } 4643c: 242e fff4 movel %fp@(-12),%d2 46440: 262e fff8 movel %fp@(-8),%d3 46444: 4e5e unlk %fp 46446: 4e75 rts } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 46448: 2239 0005 f618 movel 5f618 <_Event_Sync_state>,%d1 4644e: 7601 moveq #1,%d3 46450: b681 cmpl %d1,%d3 46452: 66c0 bnes 46414 <_Event_Timeout+0x38> _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; 46454: 7606 moveq #6,%d3 46456: 2040 moveal %d0,%a0 #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 46458: 7202 moveq #2,%d1 } the_thread->Wait.return_code = RTEMS_TIMEOUT; 4645a: 2143 0034 movel %d3,%a0@(52) #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 4645e: 23c1 0005 f618 movel %d1,5f618 <_Event_Sync_state> } the_thread->Wait.return_code = RTEMS_TIMEOUT; _ISR_Enable( level ); 46464: 46c2 movew %d2,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 46466: 2f3c 1003 fff8 movel #268697592,%sp@- 4646c: 2f00 movel %d0,%sp@- 4646e: 4eb9 0004 8908 jsr 48908 <_Thread_Clear_state> _Thread_Unblock( the_thread ); _Thread_Unnest_dispatch(); break; 46474: 508f addql #8,%sp */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 46476: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 4647c: 5380 subql #1,%d0 4647e: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> 46484: 60b6 bras 4643c <_Event_Timeout+0x60> ... =============================================================================== 0004be5c <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 4be5c: 4e56 ffcc linkw %fp,#-52 4be60: 226e 000c moveal %fp@(12),%a1 4be64: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 4be68: 246e 0008 moveal %fp@(8),%a2 Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE 4be6c: 2e09 movel %a1,%d7 4be6e: 5887 addql #4,%d7 - HEAP_ALLOC_BONUS; uintptr_t const page_size = heap->page_size; 4be70: 202a 0010 movel %a2@(16),%d0 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 4be74: 222e 0010 movel %fp@(16),%d1 4be78: 282e 0014 movel %fp@(20),%d4 Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE - HEAP_ALLOC_BONUS; uintptr_t const page_size = heap->page_size; 4be7c: 2d40 fffc movel %d0,%fp@(-4) Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { 4be80: be89 cmpl %a1,%d7 4be82: 6500 014e bcsw 4bfd2 <_Heap_Allocate_aligned_with_boundary+0x176> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { 4be86: 4a84 tstl %d4 4be88: 6600 0144 bnew 4bfce <_Heap_Allocate_aligned_with_boundary+0x172> if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4be8c: 206a 0008 moveal %a2@(8),%a0 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4be90: b1ca cmpal %a2,%a0 4be92: 6700 013e beqw 4bfd2 <_Heap_Allocate_aligned_with_boundary+0x176> uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4be96: 242e fffc movel %fp@(-4),%d2 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4be9a: 7c04 moveq #4,%d6 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4be9c: 5e82 addql #7,%d2 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4be9e: 9c89 subl %a1,%d6 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4bea0: 7601 moveq #1,%d3 4bea2: 2647 moveal %d7,%a3 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4bea4: 2d42 fff8 movel %d2,%fp@(-8) + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4bea8: 2d46 fff4 movel %d6,%fp@(-12) /* * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { 4beac: 2028 0004 movel %a0@(4),%d0 4beb0: b08b cmpl %a3,%d0 4beb2: 630e blss 4bec2 <_Heap_Allocate_aligned_with_boundary+0x66> if ( alignment == 0 ) { 4beb4: 4a81 tstl %d1 4beb6: 661c bnes 4bed4 <_Heap_Allocate_aligned_with_boundary+0x78> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 4beb8: 2408 movel %a0,%d2 4beba: 5082 addql #8,%d2 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { 4bebc: 4a82 tstl %d2 4bebe: 6600 00de bnew 4bf9e <_Heap_Allocate_aligned_with_boundary+0x142> break; } block = block->next; 4bec2: 2003 movel %d3,%d0 4bec4: 5280 addql #1,%d0 4bec6: 2068 0008 moveal %a0@(8),%a0 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4beca: b1ca cmpal %a2,%a0 4becc: 6700 0110 beqw 4bfde <_Heap_Allocate_aligned_with_boundary+0x182> 4bed0: 2600 movel %d0,%d3 4bed2: 60d8 bras 4beac <_Heap_Allocate_aligned_with_boundary+0x50> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4bed4: 7efe moveq #-2,%d7 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 4bed6: 4be8 0008 lea %a0@(8),%a5 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4beda: c087 andl %d7,%d0 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4bedc: 286a 0014 moveal %a2@(20),%a4 uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; 4bee0: d088 addl %a0,%d0 uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; 4bee2: 2a2e fff8 movel %fp@(-8),%d5 4bee6: 9a8c subl %a4,%d5 uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; uintptr_t alloc_begin = alloc_end - alloc_size; 4bee8: 242e fff4 movel %fp@(-12),%d2 4beec: d480 addl %d0,%d2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4beee: 2c02 movel %d2,%d6 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4bef0: d085 addl %d5,%d0 4bef2: 4c41 6005 remul %d1,%d5,%d6 4bef6: 9485 subl %d5,%d2 uintptr_t alloc_begin = alloc_end - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { 4bef8: b480 cmpl %d0,%d2 4befa: 630a blss 4bf06 <_Heap_Allocate_aligned_with_boundary+0xaa> 4befc: 2a00 movel %d0,%d5 4befe: 4c41 5002 remul %d1,%d2,%d5 4bf02: 9082 subl %d2,%d0 4bf04: 2400 movel %d0,%d2 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { 4bf06: 4a84 tstl %d4 4bf08: 676a beqs 4bf74 <_Heap_Allocate_aligned_with_boundary+0x118> /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { alloc_begin = _Heap_Align_down( alloc_begin_ceiling, alignment ); } alloc_end = alloc_begin + alloc_size; 4bf0a: 2002 movel %d2,%d0 4bf0c: d089 addl %a1,%d0 4bf0e: 2c00 movel %d0,%d6 4bf10: 4c44 6005 remul %d4,%d5,%d6 4bf14: 2c00 movel %d0,%d6 4bf16: 9c85 subl %d5,%d6 4bf18: 2a06 movel %d6,%d5 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4bf1a: bc82 cmpl %d2,%d6 4bf1c: 6356 blss 4bf74 <_Heap_Allocate_aligned_with_boundary+0x118> 4bf1e: bc80 cmpl %d0,%d6 4bf20: 6452 bccs 4bf74 <_Heap_Allocate_aligned_with_boundary+0x118> alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; 4bf22: 2c0d movel %a5,%d6 4bf24: dc89 addl %a1,%d6 uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { 4bf26: ba86 cmpl %d6,%d5 4bf28: 6598 bcss 4bec2 <_Heap_Allocate_aligned_with_boundary+0x66> return 0; } alloc_begin = boundary_line - alloc_size; 4bf2a: 2405 movel %d5,%d2 4bf2c: 9489 subl %a1,%d2 4bf2e: 2a02 movel %d2,%d5 4bf30: 4c41 5000 remul %d1,%d0,%d5 4bf34: 9480 subl %d0,%d2 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; 4bf36: 2002 movel %d2,%d0 4bf38: d089 addl %a1,%d0 4bf3a: 2e00 movel %d0,%d7 4bf3c: 4c44 7005 remul %d4,%d5,%d7 4bf40: 2e00 movel %d0,%d7 4bf42: 9e85 subl %d5,%d7 4bf44: 2a07 movel %d7,%d5 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4bf46: be82 cmpl %d2,%d7 4bf48: 632a blss 4bf74 <_Heap_Allocate_aligned_with_boundary+0x118> 4bf4a: be80 cmpl %d0,%d7 4bf4c: 6426 bccs 4bf74 <_Heap_Allocate_aligned_with_boundary+0x118> if ( boundary_line < boundary_floor ) { 4bf4e: ba86 cmpl %d6,%d5 4bf50: 6500 ff70 bcsw 4bec2 <_Heap_Allocate_aligned_with_boundary+0x66> return 0; } alloc_begin = boundary_line - alloc_size; 4bf54: 2405 movel %d5,%d2 4bf56: 9489 subl %a1,%d2 4bf58: 2a02 movel %d2,%d5 4bf5a: 4c41 5000 remul %d1,%d0,%d5 4bf5e: 9480 subl %d0,%d2 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; 4bf60: 2002 movel %d2,%d0 4bf62: d089 addl %a1,%d0 4bf64: 2e00 movel %d0,%d7 4bf66: 4c44 7005 remul %d4,%d5,%d7 4bf6a: 2e00 movel %d0,%d7 4bf6c: 9e85 subl %d5,%d7 4bf6e: 2a07 movel %d7,%d5 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4bf70: be82 cmpl %d2,%d7 4bf72: 62d6 bhis 4bf4a <_Heap_Allocate_aligned_with_boundary+0xee><== ALWAYS TAKEN boundary_line = _Heap_Align_down( alloc_end, boundary ); } } /* Ensure that the we have a valid new block at the beginning */ if ( alloc_begin >= alloc_begin_floor ) { 4bf74: b48d cmpl %a5,%d2 4bf76: 6500 ff4a bcsw 4bec2 <_Heap_Allocate_aligned_with_boundary+0x66> 4bf7a: 2e2e fffc movel %fp@(-4),%d7 4bf7e: 2c02 movel %d2,%d6 4bf80: 70f8 moveq #-8,%d0 4bf82: 9088 subl %a0,%d0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4bf84: d082 addl %d2,%d0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4bf86: 4c47 6005 remul %d7,%d5,%d6 uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; 4bf8a: 9085 subl %d5,%d0 if ( free_size >= min_block_size || free_size == 0 ) { 4bf8c: b08c cmpl %a4,%d0 4bf8e: 6400 ff2c bccw 4bebc <_Heap_Allocate_aligned_with_boundary+0x60> 4bf92: 4a80 tstl %d0 4bf94: 6600 ff2c bnew 4bec2 <_Heap_Allocate_aligned_with_boundary+0x66> } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { 4bf98: 4a82 tstl %d2 4bf9a: 6700 ff26 beqw 4bec2 <_Heap_Allocate_aligned_with_boundary+0x66> if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 4bf9e: 2f09 movel %a1,%sp@- search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4bfa0: 52aa 0048 addql #1,%a2@(72) stats->searches += search_count; 4bfa4: d7aa 004c addl %d3,%a2@(76) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 4bfa8: 2f02 movel %d2,%sp@- 4bfaa: 2f08 movel %a0,%sp@- 4bfac: 2f0a movel %a2,%sp@- 4bfae: 4eb9 0004 79ae jsr 479ae <_Heap_Block_allocate> 4bfb4: 4fef 0010 lea %sp@(16),%sp 4bfb8: 2002 movel %d2,%d0 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { 4bfba: b6aa 0044 cmpl %a2@(68),%d3 4bfbe: 6304 blss 4bfc4 <_Heap_Allocate_aligned_with_boundary+0x168> stats->max_search = search_count; 4bfc0: 2543 0044 movel %d3,%a2@(68) } return (void *) alloc_begin; } 4bfc4: 4cee 3cfc ffcc moveml %fp@(-52),%d2-%d7/%a2-%a5 4bfca: 4e5e unlk %fp 4bfcc: 4e75 rts /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { 4bfce: b889 cmpl %a1,%d4 4bfd0: 6410 bccs 4bfe2 <_Heap_Allocate_aligned_with_boundary+0x186> do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4bfd2: 4280 clrl %d0 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4bfd4: 4cee 3cfc ffcc moveml %fp@(-52),%d2-%d7/%a2-%a5 4bfda: 4e5e unlk %fp 4bfdc: 4e75 rts do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4bfde: 4280 clrl %d0 4bfe0: 60d8 bras 4bfba <_Heap_Allocate_aligned_with_boundary+0x15e> if ( boundary != 0 ) { if ( boundary < alloc_size ) { return NULL; } if ( alignment == 0 ) { 4bfe2: 4a81 tstl %d1 4bfe4: 6600 fea6 bnew 4be8c <_Heap_Allocate_aligned_with_boundary+0x30> alignment = page_size; 4bfe8: 2200 movel %d0,%d1 4bfea: 6000 fea0 braw 4be8c <_Heap_Allocate_aligned_with_boundary+0x30> ... =============================================================================== 000479ae <_Heap_Block_allocate>: - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 479ae: 70fe moveq #-2,%d0 Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { 479b0: 4e56 ffe0 linkw %fp,#-32 479b4: 206e 000c moveal %fp@(12),%a0 479b8: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ } _Heap_Protection_block_initialize( heap, block ); return block; } 479bc: 2428 0004 movel %a0@(4),%d2 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 479c0: 7801 moveq #1,%d4 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 479c2: c082 andl %d2,%d0 Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { 479c4: 222e 0010 movel %fp@(16),%d1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 479c8: 49f0 0800 lea %a0@(00000000,%d0:l),%a4 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 479cc: 2641 moveal %d1,%a3 479ce: 518b subql #8,%a3 Heap_Statistics *const stats = &heap->stats; uintptr_t const alloc_area_begin = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_area_offset = alloc_begin - alloc_area_begin; 479d0: 2a0b movel %a3,%d5 479d2: 9a88 subl %a0,%d5 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 479d4: c8ac 0004 andl %a4@(4),%d4 Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { 479d8: 246e 0008 moveal %fp@(8),%a2 479dc: 262e 0014 movel %fp@(20),%d3 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { 479e0: 4a84 tstl %d4 479e2: 6600 0090 bnew 47a74 <_Heap_Block_allocate+0xc6> } _Heap_Protection_block_initialize( heap, block ); return block; } 479e6: 2828 0008 movel %a0@(8),%d4 { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; next->prev = prev; 479ea: 2a44 moveal %d4,%a5 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { free_list_anchor = block->prev; 479ec: 2268 000c moveal %a0@(12),%a1 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 479f0: 2344 0008 movel %d4,%a1@(8) next->prev = prev; 479f4: 2b49 000c movel %a1,%a5@(12) _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; ++stats->used_blocks; stats->free_size -= _Heap_Block_size( block ); 479f8: 91aa 0030 subl %d0,%a2@(48) free_list_anchor = block->prev; _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; 479fc: 53aa 0038 subql #1,%a2@(56) ++stats->used_blocks; 47a00: 52aa 0040 addql #1,%a2@(64) stats->free_size -= _Heap_Block_size( block ); } else { free_list_anchor = _Heap_Free_list_head( heap ); } if ( alloc_area_offset < heap->page_size ) { 47a04: 202a 0010 movel %a2@(16),%d0 47a08: b085 cmpl %d5,%d0 47a0a: 6272 bhis 47a7e <_Heap_Block_allocate+0xd0> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 47a0c: 4c40 1004 remul %d0,%d4,%d1 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 47a10: 97c4 subal %d4,%a3 _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); uintptr_t const new_block_begin = (uintptr_t) new_block; uintptr_t const new_block_size = block_end - new_block_begin; block_end = new_block_begin; block_size = block_end - block_begin; 47a12: 200b movel %a3,%d0 47a14: 9088 subl %a0,%d0 _HAssert( block_size >= heap->min_block_size ); _HAssert( new_block_size >= heap->min_block_size ); /* Statistics */ stats->free_size += block_size; 47a16: d1aa 0030 addl %d0,%a2@(48) uintptr_t block_end = block_begin + block_size; Heap_Block *const new_block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); uintptr_t const new_block_begin = (uintptr_t) new_block; uintptr_t const new_block_size = block_end - new_block_begin; 47a1a: 99cb subal %a3,%a4 _HAssert( new_block_size >= heap->min_block_size ); /* Statistics */ stats->free_size += block_size; if ( _Heap_Is_prev_used( block ) ) { 47a1c: 0802 0000 btst #0,%d2 47a20: 6774 beqs 47a96 <_Heap_Block_allocate+0xe8> RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; 47a22: 2a69 0008 moveal %a1@(8),%a5 block = prev_block; block_size += prev_block_size; } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 47a26: 7401 moveq #1,%d2 _Heap_Free_list_insert_after( free_list_anchor, block ); free_list_anchor = block; /* Statistics */ ++stats->free_blocks; 47a28: 2208 movel %a0,%d1 new_block->next = next; 47a2a: 214d 0008 movel %a5,%a0@(8) block = prev_block; block_size += prev_block_size; } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 47a2e: 8480 orl %d0,%d2 new_block->prev = block_before; 47a30: 2149 000c movel %a1,%a0@(12) block_before->next = new_block; 47a34: 2348 0008 movel %a0,%a1@(8) next->prev = new_block; 47a38: 2b48 000c movel %a0,%a5@(12) _Heap_Free_list_insert_after( free_list_anchor, block ); free_list_anchor = block; /* Statistics */ ++stats->free_blocks; 47a3c: 52aa 0038 addql #1,%a2@(56) block = prev_block; block_size += prev_block_size; } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 47a40: 2142 0004 movel %d2,%a0@(4) new_block->prev_size = block_size; 47a44: 2680 movel %d0,%a3@ new_block->size_and_flag = new_block_size; 47a46: 274c 0004 movel %a4,%a3@(4) _Heap_Block_split( heap, new_block, free_list_anchor, alloc_size ); 47a4a: 2f03 movel %d3,%sp@- 47a4c: 2f01 movel %d1,%sp@- 47a4e: 2f0b movel %a3,%sp@- 47a50: 2f0a movel %a2,%sp@- 47a52: 4eba fcb0 jsr %pc@(47704 <_Heap_Block_split>) 47a56: 4fef 0010 lea %sp@(16),%sp alloc_size ); } /* Statistics */ if ( stats->min_free_size > stats->free_size ) { 47a5a: 202a 0030 movel %a2@(48),%d0 47a5e: b0aa 0034 cmpl %a2@(52),%d0 47a62: 6404 bccs 47a68 <_Heap_Block_allocate+0xba> stats->min_free_size = stats->free_size; 47a64: 2540 0034 movel %d0,%a2@(52) } _Heap_Protection_block_initialize( heap, block ); return block; } 47a68: 200b movel %a3,%d0 47a6a: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 47a70: 4e5e unlk %fp 47a72: 4e75 rts stats->free_size -= _Heap_Block_size( block ); } else { free_list_anchor = _Heap_Free_list_head( heap ); } if ( alloc_area_offset < heap->page_size ) { 47a74: 202a 0010 movel %a2@(16),%d0 /* Statistics */ --stats->free_blocks; ++stats->used_blocks; stats->free_size -= _Heap_Block_size( block ); } else { free_list_anchor = _Heap_Free_list_head( heap ); 47a78: 224a moveal %a2,%a1 } if ( alloc_area_offset < heap->page_size ) { 47a7a: b085 cmpl %d5,%d0 47a7c: 638e blss 47a0c <_Heap_Block_allocate+0x5e> Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { _Heap_Block_split( heap, block, free_list_anchor, alloc_size ); 47a7e: 2645 moveal %d5,%a3 47a80: 4873 3800 pea %a3@(00000000,%d3:l) 47a84: 2648 moveal %a0,%a3 47a86: 2f09 movel %a1,%sp@- 47a88: 2f08 movel %a0,%sp@- 47a8a: 2f0a movel %a2,%sp@- 47a8c: 4eba fc76 jsr %pc@(47704 <_Heap_Block_split>) 47a90: 4fef 0010 lea %sp@(16),%sp 47a94: 60c4 bras 47a5a <_Heap_Block_allocate+0xac> RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Prev_block( const Heap_Block *block ) { return (Heap_Block *) ((uintptr_t) block - block->prev_size); 47a96: 91d0 subal %a0@,%a0 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 47a98: 74fe moveq #-2,%d2 } else { Heap_Block *const prev_block = _Heap_Prev_block( block ); uintptr_t const prev_block_size = _Heap_Block_size( prev_block ); block = prev_block; block_size += prev_block_size; 47a9a: 2209 movel %a1,%d1 47a9c: c4a8 0004 andl %a0@(4),%d2 47aa0: d082 addl %d2,%d0 } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 47aa2: 7401 moveq #1,%d2 47aa4: 8480 orl %d0,%d2 new_block->prev_size = block_size; 47aa6: 2680 movel %d0,%a3@ block = prev_block; block_size += prev_block_size; } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 47aa8: 2142 0004 movel %d2,%a0@(4) new_block->prev_size = block_size; new_block->size_and_flag = new_block_size; 47aac: 274c 0004 movel %a4,%a3@(4) _Heap_Block_split( heap, new_block, free_list_anchor, alloc_size ); 47ab0: 2f03 movel %d3,%sp@- 47ab2: 2f01 movel %d1,%sp@- 47ab4: 2f0b movel %a3,%sp@- 47ab6: 2f0a movel %a2,%sp@- 47ab8: 4eba fc4a jsr %pc@(47704 <_Heap_Block_split>) 47abc: 4fef 0010 lea %sp@(16),%sp 47ac0: 6098 bras 47a5a <_Heap_Block_allocate+0xac> ... =============================================================================== 00047704 <_Heap_Block_split>: Heap_Control *heap, Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { 47704: 4e56 ffe4 linkw %fp,#-28 47708: 226e 0008 moveal %fp@(8),%a1 4770c: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 47710: 246e 000c moveal %fp@(12),%a2 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 47714: 76fe moveq #-2,%d3 } _Heap_Protection_block_initialize( heap, block ); return block; } 47716: 282a 0004 movel %a2@(4),%d4 ) { Heap_Statistics *const stats = &heap->stats; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; 4771a: 2669 0014 moveal %a1@(20),%a3 uintptr_t const min_alloc_size = min_block_size - HEAP_BLOCK_HEADER_SIZE; 4771e: 220b movel %a3,%d1 47720: 5181 subql #8,%d1 Heap_Control *heap, Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { 47722: 286e 0010 moveal %fp@(16),%a4 Heap_Statistics *const stats = &heap->stats; uintptr_t const page_size = heap->page_size; 47726: 2429 0010 movel %a1@(16),%d2 return heap->stats.size; } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Max( uintptr_t a, uintptr_t b ) { return a > b ? a : b; 4772a: 202e 0014 movel %fp@(20),%d0 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4772e: c684 andl %d4,%d3 return heap->stats.size; } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Max( uintptr_t a, uintptr_t b ) { return a > b ? a : b; 47730: b280 cmpl %d0,%d1 47732: 6302 blss 47736 <_Heap_Block_split+0x32> 47734: 2001 movel %d1,%d0 uintptr_t const min_block_size = heap->min_block_size; uintptr_t const min_alloc_size = min_block_size - HEAP_BLOCK_HEADER_SIZE; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const used_size = 47736: 5080 addql #8,%d0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; 47738: 2a00 movel %d0,%d5 4773a: 4c42 5001 remul %d2,%d1,%d5 if ( remainder != 0 ) { 4773e: 4a81 tstl %d1 47740: 6766 beqs 477a8 <_Heap_Block_split+0xa4> return value - remainder + alignment; 47742: d480 addl %d0,%d2 47744: 9481 subl %d1,%d2 _Heap_Max( alloc_size, min_alloc_size ) + HEAP_BLOCK_HEADER_SIZE; uintptr_t const used_block_size = _Heap_Align_up( used_size, page_size ); uintptr_t const free_size = block_size + HEAP_ALLOC_BONUS - used_size; 47746: 2203 movel %d3,%d1 47748: 5881 addql #4,%d1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4774a: 41f2 3800 lea %a2@(00000000,%d3:l),%a0 4774e: 9280 subl %d0,%d1 uintptr_t const free_size_limit = min_block_size + HEAP_ALLOC_BONUS; 47750: 588b addql #4,%a3 Heap_Block *next_block = _Heap_Block_at( block, block_size ); _HAssert( used_size <= block_size + HEAP_ALLOC_BONUS ); _HAssert( used_size + free_size == block_size + HEAP_ALLOC_BONUS ); if ( free_size >= free_size_limit ) { 47752: b7c1 cmpal %d1,%a3 47754: 6264 bhis 477ba <_Heap_Block_split+0xb6> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 47756: 7001 moveq #1,%d0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 47758: 47f2 2800 lea %a2@(00000000,%d2:l),%a3 Heap_Block *const free_block = _Heap_Block_at( block, used_block_size ); uintptr_t free_block_size = block_size - used_block_size; 4775c: 9682 subl %d2,%d3 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 4775e: 7201 moveq #1,%d1 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 47760: c880 andl %d0,%d4 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 47762: 70fe moveq #-2,%d0 uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; block->size_and_flag = size | flag; 47764: 8484 orl %d4,%d2 47766: 2542 0004 movel %d2,%a2@(4) _HAssert( used_block_size + free_block_size == block_size ); _Heap_Block_set_size( block, used_block_size ); /* Statistics */ stats->free_size += free_block_size; 4776a: d7a9 0030 addl %d3,%a1@(48) - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4776e: c0a8 0004 andl %a0@(4),%d0 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 47772: c2b0 0804 andl %a0@(00000004,%d0:l),%d1 if ( _Heap_Is_used( next_block ) ) { 47776: 6750 beqs 477c8 <_Heap_Block_split+0xc4> <== NEVER TAKEN RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; 47778: 246c 0008 moveal %a4@(8),%a2 free_block_size += next_block_size; next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; 4777c: 7001 moveq #1,%d0 new_block->next = next; new_block->prev = block_before; 4777e: 274c 000c movel %a4,%a3@(12) 47782: 8083 orl %d3,%d0 Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 47784: 274a 0008 movel %a2,%a3@(8) new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 47788: 254b 000c movel %a3,%a2@(12) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; 4778c: 294b 0008 movel %a3,%a4@(8) if ( _Heap_Is_used( next_block ) ) { _Heap_Free_list_insert_after( free_list_anchor, free_block ); /* Statistics */ ++stats->free_blocks; 47790: 52a9 0038 addql #1,%a1@(56) free_block_size += next_block_size; next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; 47794: 2740 0004 movel %d0,%a3@(4) next_block->prev_size = free_block_size; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 47798: 70fe moveq #-2,%d0 4779a: c1a8 0004 andl %d0,%a0@(4) next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; next_block->prev_size = free_block_size; 4779e: 2083 movel %d3,%a0@ _Heap_Protection_block_initialize( heap, free_block ); } else { next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; } } 477a0: 4cd7 1c3c moveml %sp@,%d2-%d5/%a2-%a4 477a4: 4e5e unlk %fp 477a6: 4e75 rts uintptr_t const used_size = _Heap_Max( alloc_size, min_alloc_size ) + HEAP_BLOCK_HEADER_SIZE; uintptr_t const used_block_size = _Heap_Align_up( used_size, page_size ); uintptr_t const free_size = block_size + HEAP_ALLOC_BONUS - used_size; 477a8: 2203 movel %d3,%d1 477aa: 5881 addql #4,%d1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 477ac: 41f2 3800 lea %a2@(00000000,%d3:l),%a0 uintptr_t remainder = value % alignment; if ( remainder != 0 ) { return value - remainder + alignment; } else { return value; 477b0: 2400 movel %d0,%d2 477b2: 9280 subl %d0,%d1 uintptr_t const free_size_limit = min_block_size + HEAP_ALLOC_BONUS; 477b4: 588b addql #4,%a3 Heap_Block *next_block = _Heap_Block_at( block, block_size ); _HAssert( used_size <= block_size + HEAP_ALLOC_BONUS ); _HAssert( used_size + free_size == block_size + HEAP_ALLOC_BONUS ); if ( free_size >= free_size_limit ) { 477b6: b7c1 cmpal %d1,%a3 477b8: 639c blss 47756 <_Heap_Block_split+0x52> next_block->prev_size = free_block_size; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; _Heap_Protection_block_initialize( heap, free_block ); } else { next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 477ba: 7001 moveq #1,%d0 } } 477bc: 4cd7 1c3c moveml %sp@,%d2-%d5/%a2-%a4 next_block->prev_size = free_block_size; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; _Heap_Protection_block_initialize( heap, free_block ); } else { next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 477c0: 81a8 0004 orl %d0,%a0@(4) } } 477c4: 4e5e unlk %fp 477c6: 4e75 rts } else { uintptr_t const next_block_size = _Heap_Block_size( next_block ); _Heap_Free_list_replace( next_block, free_block ); free_block_size += next_block_size; 477c8: d680 addl %d0,%d3 next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; 477ca: 7001 moveq #1,%d0 } _Heap_Protection_block_initialize( heap, block ); return block; } 477cc: 2268 0008 moveal %a0@(8),%a1 477d0: 2468 000c moveal %a0@(12),%a2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 477d4: 41f3 3800 lea %a3@(00000000,%d3:l),%a0 free_block_size += next_block_size; next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; 477d8: 8083 orl %d3,%d0 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; 477da: 2749 0008 movel %a1,%a3@(8) new_block->prev = prev; 477de: 274a 000c movel %a2,%a3@(12) 477e2: 2740 0004 movel %d0,%a3@(4) next_block->prev_size = free_block_size; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 477e6: 70fe moveq #-2,%d0 next->prev = new_block; prev->next = new_block; 477e8: 254b 0008 movel %a3,%a2@(8) 477ec: c1a8 0004 andl %d0,%a0@(4) Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; 477f0: 234b 000c movel %a3,%a1@(12) next_block = _Heap_Block_at( free_block, free_block_size ); } free_block->size_and_flag = free_block_size | HEAP_PREV_BLOCK_USED; next_block->prev_size = free_block_size; 477f4: 2083 movel %d3,%a0@ 477f6: 60a8 bras 477a0 <_Heap_Block_split+0x9c> =============================================================================== 0004c318 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4c318: 4e56 ffcc linkw %fp,#-52 4c31c: 202e 0010 movel %fp@(16),%d0 4c320: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 4c324: 246e 0008 moveal %fp@(8),%a2 4c328: 242e 000c movel %fp@(12),%d2 Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; 4c32c: 2602 movel %d2,%d3 4c32e: d680 addl %d0,%d3 uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4c330: 2a2a 0020 movel %a2@(32),%d5 Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; 4c334: 282a 0010 movel %a2@(16),%d4 uintptr_t const min_block_size = heap->min_block_size; 4c338: 222a 0014 movel %a2@(20),%d1 uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; uintptr_t const free_size = stats->free_size; 4c33c: 2c2a 0030 movel %a2@(48),%d6 Heap_Block *start_block = first_block; Heap_Block *merge_below_block = NULL; Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; 4c340: 42ae fffc clrl %fp@(-4) Heap_Block *extend_last_block = NULL; 4c344: 42ae fff8 clrl %fp@(-8) uintptr_t const free_size = stats->free_size; uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { 4c348: b682 cmpl %d2,%d3 4c34a: 640c bccs 4c358 <_Heap_Extend+0x40> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4c34c: 4cee 3cfc ffcc moveml %fp@(-52),%d2-%d7/%a2-%a5 _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; 4c352: 4200 clrb %d0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4c354: 4e5e unlk %fp 4c356: 4e75 rts if ( extend_area_end < extend_area_begin ) { return false; } extend_area_ok = _Heap_Get_first_and_last_block( 4c358: 486e fff8 pea %fp@(-8) 4c35c: 486e fffc pea %fp@(-4) 4c360: 2f01 movel %d1,%sp@- 4c362: 2f04 movel %d4,%sp@- 4c364: 2f00 movel %d0,%sp@- 4c366: 2f02 movel %d2,%sp@- 4c368: 4eb9 0004 7b44 jsr 47b44 <_Heap_Get_first_and_last_block> page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4c36e: 4fef 0018 lea %sp@(24),%sp 4c372: 4a00 tstb %d0 4c374: 67d6 beqs 4c34c <_Heap_Extend+0x34> 4c376: 2045 moveal %d5,%a0 4c378: 9bcd subal %a5,%a5 4c37a: 97cb subal %a3,%a3 4c37c: 99cc subal %a4,%a4 4c37e: 42ae fff4 clrl %fp@(-12) return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 4c382: ba88 cmpl %a0,%d5 4c384: 6700 014a beqw 4c4d0 <_Heap_Extend+0x1b8> 4c388: 2208 movel %a0,%d1 uintptr_t const sub_area_end = start_block->prev_size; 4c38a: 2010 movel %a0@,%d0 Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 4c38c: b082 cmpl %d2,%d0 4c38e: 6304 blss 4c394 <_Heap_Extend+0x7c> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin 4c390: b681 cmpl %d1,%d3 4c392: 62b8 bhis 4c34c <_Heap_Extend+0x34> ) { return false; } if ( extend_area_end == sub_area_begin ) { 4c394: b681 cmpl %d1,%d3 4c396: 6700 0132 beqw 4c4ca <_Heap_Extend+0x1b2> merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4c39a: b083 cmpl %d3,%d0 4c39c: 6304 blss 4c3a2 <_Heap_Extend+0x8a> 4c39e: 2d48 fff4 movel %a0,%fp@(-12) 4c3a2: 2e00 movel %d0,%d7 4c3a4: 2240 moveal %d0,%a1 4c3a6: 5189 subql #8,%a1 4c3a8: 4c44 7001 remul %d4,%d1,%d7 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4c3ac: 93c1 subal %d1,%a1 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4c3ae: b480 cmpl %d0,%d2 4c3b0: 6700 0100 beqw 4c4b2 <_Heap_Extend+0x19a> start_block->prev_size = extend_area_end; merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4c3b4: b082 cmpl %d2,%d0 4c3b6: 6402 bccs 4c3ba <_Heap_Extend+0xa2> RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_of_alloc_area( uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) 4c3b8: 2a49 moveal %a1,%a5 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4c3ba: 70fe moveq #-2,%d0 4c3bc: c0a9 0004 andl %a1@(4),%d0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4c3c0: 41f1 0800 lea %a1@(00000000,%d0:l),%a0 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4c3c4: b1c5 cmpal %d5,%a0 4c3c6: 66ba bnes 4c382 <_Heap_Extend+0x6a> <== NEVER TAKEN if ( extend_area_begin < heap->area_begin ) { 4c3c8: b4aa 0018 cmpl %a2@(24),%d2 4c3cc: 6500 010a bcsw 4c4d8 <_Heap_Extend+0x1c0> heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { 4c3d0: b6aa 001c cmpl %a2@(28),%d3 4c3d4: 6304 blss 4c3da <_Heap_Extend+0xc2> heap->area_end = extend_area_end; 4c3d6: 2543 001c movel %d3,%a2@(28) } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4c3da: 226e fff8 moveal %fp@(-8),%a1 heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 4c3de: 2009 movel %a1,%d0 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4c3e0: 7201 moveq #1,%d1 } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4c3e2: 206e fffc moveal %fp@(-4),%a0 heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 4c3e6: 9088 subl %a0,%d0 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4c3e8: 8280 orl %d0,%d1 } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; 4c3ea: 2083 movel %d3,%a0@ extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4c3ec: 2141 0004 movel %d1,%a0@(4) _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; 4c3f0: 2280 movel %d0,%a1@ extend_last_block->size_and_flag = 0; 4c3f2: 42a9 0004 clrl %a1@(4) _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 4c3f6: b1ea 0020 cmpal %a2@(32),%a0 4c3fa: 6400 0104 bccw 4c500 <_Heap_Extend+0x1e8> heap->first_block = extend_first_block; 4c3fe: 2548 0020 movel %a0,%a2@(32) } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4c402: 4a8c tstl %a4 4c404: 6700 0148 beqw 4c54e <_Heap_Extend+0x236> Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; 4c408: 202a 0010 movel %a2@(16),%d0 uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); 4c40c: 5082 addql #8,%d2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; 4c40e: 2802 movel %d2,%d4 4c410: 4c40 4001 remul %d0,%d1,%d4 if ( remainder != 0 ) { 4c414: 4a81 tstl %d1 4c416: 6704 beqs 4c41c <_Heap_Extend+0x104> return value - remainder + alignment; 4c418: d480 addl %d0,%d2 4c41a: 9481 subl %d1,%d2 uintptr_t const new_first_block_begin = 4c41c: 2042 moveal %d2,%a0 4c41e: 5188 subql #8,%a0 new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE; uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = 4c420: 200c movel %a4,%d0 4c422: 9088 subl %a0,%d0 first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; 4c424: 7201 moveq #1,%d1 4c426: 8280 orl %d0,%d1 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; 4c428: 2094 movel %a4@,%a0@ new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; 4c42a: 2141 0004 movel %d1,%a0@(4) _Heap_Free_block( heap, new_first_block ); 4c42e: 2f08 movel %a0,%sp@- 4c430: 2f0a movel %a2,%sp@- 4c432: 4eba fec8 jsr %pc@(4c2fc <_Heap_Free_block>) 4c436: 508f addql #8,%sp link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4c438: 4a8b tstl %a3 4c43a: 6700 00d4 beqw 4c510 <_Heap_Extend+0x1f8> ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( extend_area_end - last_block_begin - HEAP_BLOCK_HEADER_SIZE, 4c43e: 5183 subql #8,%d3 uintptr_t extend_area_end ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( 4c440: 968b subl %a3,%d3 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4c442: 2203 movel %d3,%d1 4c444: 4c6a 1000 0010 remul %a2@(16),%d0,%d1 Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; 4c44a: 7201 moveq #1,%d1 4c44c: 9680 subl %d0,%d3 ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = (last_block->size_and_flag - last_block_new_size) 4c44e: 202b 0004 movel %a3@(4),%d0 4c452: 9083 subl %d3,%d0 | HEAP_PREV_BLOCK_USED; 4c454: 8280 orl %d0,%d1 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4c456: 7001 moveq #1,%d0 4c458: 2781 3804 movel %d1,%a3@(00000004,%d3:l) 4c45c: c0ab 0004 andl %a3@(4),%d0 block->size_and_flag = size | flag; 4c460: 8680 orl %d0,%d3 4c462: 2743 0004 movel %d3,%a3@(4) _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); 4c466: 2f0b movel %a3,%sp@- 4c468: 2f0a movel %a2,%sp@- 4c46a: 4eba fe90 jsr %pc@(4c2fc <_Heap_Free_block>) 4c46e: 508f addql #8,%sp extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4c470: 4a8c tstl %a4 4c472: 6700 00c4 beqw 4c538 <_Heap_Extend+0x220> _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4c476: 202a 0030 movel %a2@(48),%d0 4c47a: 9086 subl %d6,%d0 4c47c: 2c00 movel %d0,%d6 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4c47e: 7001 moveq #1,%d0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4c480: 206a 0024 moveal %a2@(36),%a0 * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 4c484: 222a 0020 movel %a2@(32),%d1 4c488: 9288 subl %a0,%d1 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4c48a: c0a8 0004 andl %a0@(4),%d0 block->size_and_flag = size | flag; 4c48e: 8280 orl %d0,%d1 4c490: 2141 0004 movel %d1,%a0@(4) _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; 4c494: ddaa 002c addl %d6,%a2@(44) if ( extended_size_ptr != NULL ) 4c498: 4aae 0014 tstl %fp@(20) 4c49c: 6700 00ca beqw 4c568 <_Heap_Extend+0x250> *extended_size_ptr = extended_size; 4c4a0: 206e 0014 moveal %fp@(20),%a0 4c4a4: 2086 movel %d6,%a0@ return true; } 4c4a6: 4cee 3cfc ffcc moveml %fp@(-52),%d2-%d7/%a2-%a5 stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 4c4ac: 7001 moveq #1,%d0 } 4c4ae: 4e5e unlk %fp 4c4b0: 4e75 rts - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4c4b2: 70fe moveq #-2,%d0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_of_alloc_area( uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) 4c4b4: 2649 moveal %a1,%a3 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4c4b6: c0a9 0004 andl %a1@(4),%d0 } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { start_block->prev_size = extend_area_end; 4c4ba: 2083 movel %d3,%a0@ RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4c4bc: 41f1 0800 lea %a1@(00000000,%d0:l),%a0 } else if ( sub_area_end < extend_area_begin ) { link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4c4c0: b1c5 cmpal %d5,%a0 4c4c2: 6600 febe bnew 4c382 <_Heap_Extend+0x6a> 4c4c6: 6000 ff00 braw 4c3c8 <_Heap_Extend+0xb0> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { 4c4ca: 2848 moveal %a0,%a4 4c4cc: 6000 fed4 braw 4c3a2 <_Heap_Extend+0x8a> return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 4c4d0: 222a 0018 movel %a2@(24),%d1 4c4d4: 6000 feb4 braw 4c38a <_Heap_Extend+0x72> } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4c4d8: 226e fff8 moveal %fp@(-8),%a1 heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 4c4dc: 2009 movel %a1,%d0 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4c4de: 7201 moveq #1,%d1 } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4c4e0: 206e fffc moveal %fp@(-4),%a0 heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 4c4e4: 9088 subl %a0,%d0 start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); if ( extend_area_begin < heap->area_begin ) { heap->area_begin = extend_area_begin; 4c4e6: 2542 0018 movel %d2,%a2@(24) extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4c4ea: 8280 orl %d0,%d1 } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; 4c4ec: 2083 movel %d3,%a0@ extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4c4ee: 2141 0004 movel %d1,%a0@(4) _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; 4c4f2: 2280 movel %d0,%a1@ extend_last_block->size_and_flag = 0; 4c4f4: 42a9 0004 clrl %a1@(4) _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 4c4f8: b1ea 0020 cmpal %a2@(32),%a0 4c4fc: 6500 ff00 bcsw 4c3fe <_Heap_Extend+0xe6> heap->first_block = extend_first_block; } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 4c500: b3ea 0024 cmpal %a2@(36),%a1 4c504: 6300 fefc blsw 4c402 <_Heap_Extend+0xea> heap->last_block = extend_last_block; 4c508: 2549 0024 movel %a1,%a2@(36) 4c50c: 6000 fef4 braw 4c402 <_Heap_Extend+0xea> ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { 4c510: 4a8d tstl %a5 4c512: 6700 ff5c beqw 4c470 <_Heap_Extend+0x158> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4c516: 7001 moveq #1,%d0 ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); 4c518: 222e fffc movel %fp@(-4),%d1 4c51c: 928d subl %a5,%d1 4c51e: c0ad 0004 andl %a5@(4),%d0 } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { _Heap_Link_above( 4c522: 206e fff8 moveal %fp@(-8),%a0 block->size_and_flag = size | flag; 4c526: 8280 orl %d0,%d1 uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4c528: 7001 moveq #1,%d0 4c52a: 2b41 0004 movel %d1,%a5@(4) 4c52e: 81a8 0004 orl %d0,%a0@(4) extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4c532: 4a8c tstl %a4 4c534: 6600 ff40 bnew 4c476 <_Heap_Extend+0x15e> 4c538: 4a8b tstl %a3 4c53a: 6600 ff3a bnew 4c476 <_Heap_Extend+0x15e> _Heap_Free_block( heap, extend_first_block ); 4c53e: 2f2e fffc movel %fp@(-4),%sp@- 4c542: 2f0a movel %a2,%sp@- 4c544: 4eba fdb6 jsr %pc@(4c2fc <_Heap_Free_block>) 4c548: 508f addql #8,%sp 4c54a: 6000 ff2a braw 4c476 <_Heap_Extend+0x15e> heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { _Heap_Merge_below( heap, extend_area_begin, merge_below_block ); } else if ( link_below_block != NULL ) { 4c54e: 4aae fff4 tstl %fp@(-12) 4c552: 6700 fee4 beqw 4c438 <_Heap_Extend+0x120> { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = (link_begin - last_block_begin) | HEAP_PREV_BLOCK_USED; 4c556: 202e fff4 movel %fp@(-12),%d0 4c55a: 7201 moveq #1,%d1 4c55c: 9089 subl %a1,%d0 4c55e: 8280 orl %d0,%d1 4c560: 2341 0004 movel %d1,%a1@(4) 4c564: 6000 fed2 braw 4c438 <_Heap_Extend+0x120> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4c568: 4cee 3cfc ffcc moveml %fp@(-52),%d2-%d7/%a2-%a5 <== NOT EXECUTED stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 4c56e: 7001 moveq #1,%d0 <== NOT EXECUTED } 4c570: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 0004bff0 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4bff0: 4e56 ffe8 linkw %fp,#-24 4bff4: 206e 0008 moveal %fp@(8),%a0 4bff8: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 4bffc: 202e 000c movel %fp@(12),%d0 /* * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { 4c000: 6700 00f2 beqw 4c0f4 <_Heap_Free+0x104> 4c004: 2240 moveal %d0,%a1 4c006: 5189 subql #8,%a1 4c008: 4c68 0001 0010 remul %a0@(16),%d1,%d0 RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap( const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block 4c00e: 2028 0020 movel %a0@(32),%d0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4c012: 93c1 subal %d1,%a1 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 4c014: b089 cmpl %a1,%d0 4c016: 6200 0098 bhiw 4c0b0 <_Heap_Free+0xc0> 4c01a: 2228 0024 movel %a0@(36),%d1 4c01e: b289 cmpl %a1,%d1 4c020: 6500 008e bcsw 4c0b0 <_Heap_Free+0xc0> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4c024: 2629 0004 movel %a1@(4),%d3 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4c028: 74fe moveq #-2,%d2 4c02a: c483 andl %d3,%d2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4c02c: 45f1 2800 lea %a1@(00000000,%d2:l),%a2 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 4c030: b5c0 cmpal %d0,%a2 4c032: 657c bcss 4c0b0 <_Heap_Free+0xc0> <== NEVER TAKEN 4c034: b5c1 cmpal %d1,%a2 4c036: 6278 bhis 4c0b0 <_Heap_Free+0xc0> <== NEVER TAKEN 4c038: 282a 0004 movel %a2@(4),%d4 return false; } _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_prev_used( next_block ) ) { 4c03c: 0804 0000 btst #0,%d4 4c040: 676e beqs 4c0b0 <_Heap_Free+0xc0> <== NEVER TAKEN - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4c042: 7afe moveq #-2,%d5 4c044: c885 andl %d5,%d4 return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4c046: b5c1 cmpal %d1,%a2 4c048: 6700 00fa beqw 4c144 <_Heap_Free+0x154> block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 4c04c: 7a01 moveq #1,%d5 4c04e: cab2 4804 andl %a2@(00000004,%d4:l),%d5 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) 4c052: 57c5 seq %d5 4c054: 4485 negl %d5 next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { 4c056: 0803 0000 btst #0,%d3 4c05a: 665e bnes 4c0ba <_Heap_Free+0xca> uintptr_t const prev_size = block->prev_size; 4c05c: 2611 movel %a1@,%d3 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4c05e: 93c3 subal %d3,%a1 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 4c060: b3c0 cmpal %d0,%a1 4c062: 654c bcss 4c0b0 <_Heap_Free+0xc0> <== NEVER TAKEN 4c064: b3c1 cmpal %d1,%a1 4c066: 6248 bhis 4c0b0 <_Heap_Free+0xc0> <== NEVER TAKEN block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 4c068: 7001 moveq #1,%d0 4c06a: c0a9 0004 andl %a1@(4),%d0 return( false ); } /* As we always coalesce free blocks, the block that preceedes prev_block must have been used. */ if ( !_Heap_Is_prev_used ( prev_block) ) { 4c06e: 6740 beqs 4c0b0 <_Heap_Free+0xc0> <== NEVER TAKEN _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4c070: 4a05 tstb %d5 4c072: 6700 00d6 beqw 4c14a <_Heap_Free+0x15a> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4c076: 266a 0008 moveal %a2@(8),%a3 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; 4c07a: d882 addl %d2,%d4 4c07c: d684 addl %d4,%d3 _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c07e: 7001 moveq #1,%d0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4c080: 246a 000c moveal %a2@(12),%a2 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 4c084: 254b 0008 movel %a3,%a2@(8) if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c088: 8083 orl %d3,%d0 next->prev = prev; 4c08a: 274a 000c movel %a2,%a3@(12) } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4c08e: 53a8 0038 subql #1,%a0@(56) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 4c092: 2383 3800 movel %d3,%a1@(00000000,%d3:l) if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c096: 2340 0004 movel %d0,%a1@(4) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4c09a: 53a8 0040 subql #1,%a0@(64) ++stats->frees; 4c09e: 52a8 0050 addql #1,%a0@(80) stats->free_size += block_size; 4c0a2: d5a8 0030 addl %d2,%a0@(48) return( true ); 4c0a6: 7001 moveq #1,%d0 } 4c0a8: 4cd7 0c3c moveml %sp@,%d2-%d5/%a2-%a3 4c0ac: 4e5e unlk %fp 4c0ae: 4e75 rts 4c0b0: 4cd7 0c3c moveml %sp@,%d2-%d5/%a2-%a3 /* As we always coalesce free blocks, the block that preceedes prev_block must have been used. */ if ( !_Heap_Is_prev_used ( prev_block) ) { _HAssert( false ); return( false ); 4c0b4: 4200 clrb %d0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4c0b6: 4e5e unlk %fp 4c0b8: 4e75 rts uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4c0ba: 4a05 tstb %d5 4c0bc: 673a beqs 4c0f8 <_Heap_Free+0x108> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4c0be: 266a 0008 moveal %a2@(8),%a3 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; 4c0c2: d882 addl %d2,%d4 _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c0c4: 7001 moveq #1,%d0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4c0c6: 246a 000c moveal %a2@(12),%a2 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; 4c0ca: 234b 0008 movel %a3,%a1@(8) next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c0ce: 8084 orl %d4,%d0 new_block->prev = prev; 4c0d0: 234a 000c movel %a2,%a1@(12) next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4c0d4: 2384 4800 movel %d4,%a1@(00000000,%d4:l) next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c0d8: 2340 0004 movel %d0,%a1@(4) /* Statistics */ --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); 4c0dc: 7001 moveq #1,%d0 next->prev = new_block; prev->next = new_block; 4c0de: 2549 0008 movel %a1,%a2@(8) Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; 4c0e2: 2749 000c movel %a1,%a3@(12) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4c0e6: 53a8 0040 subql #1,%a0@(64) ++stats->frees; 4c0ea: 52a8 0050 addql #1,%a0@(80) stats->free_size += block_size; 4c0ee: d5a8 0030 addl %d2,%a0@(48) 4c0f2: 60b4 bras 4c0a8 <_Heap_Free+0xb8> * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { return true; 4c0f4: 7001 moveq #1,%d0 4c0f6: 60b0 bras 4c0a8 <_Heap_Free+0xb8> block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4c0f8: 2028 0038 movel %a0@(56),%d0 next_block->prev_size = size; } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 4c0fc: 7201 moveq #1,%d1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4c0fe: 7afe moveq #-2,%d5 next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4c100: 5280 addql #1,%d0 RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; 4c102: 2668 0008 moveal %a0@(8),%a3 new_block->next = next; new_block->prev = block_before; 4c106: 2348 000c movel %a0,%a1@(12) next_block->prev_size = size; } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 4c10a: 8282 orl %d2,%d1 Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4c10c: 234b 0008 movel %a3,%a1@(8) 4c110: 2341 0004 movel %d1,%a1@(4) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4c114: cbaa 0004 andl %d5,%a2@(4) new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4c118: 2749 000c movel %a1,%a3@(12) next_block->prev_size = block_size; 4c11c: 2482 movel %d2,%a2@ { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; 4c11e: 2149 0008 movel %a1,%a0@(8) /* Statistics */ ++stats->free_blocks; 4c122: 2140 0038 movel %d0,%a0@(56) if ( stats->max_free_blocks < stats->free_blocks ) { 4c126: b0a8 003c cmpl %a0@(60),%d0 4c12a: 6300 ff6e blsw 4c09a <_Heap_Free+0xaa> stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4c12e: 53a8 0040 subql #1,%a0@(64) ++stats->frees; 4c132: 52a8 0050 addql #1,%a0@(80) stats->free_size += block_size; 4c136: d5a8 0030 addl %d2,%a0@(48) next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { stats->max_free_blocks = stats->free_blocks; 4c13a: 2140 003c movel %d0,%a0@(60) /* Statistics */ --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); 4c13e: 7001 moveq #1,%d0 4c140: 6000 ff66 braw 4c0a8 <_Heap_Free+0xb8> return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4c144: 4205 clrb %d5 4c146: 6000 ff0e braw 4c056 <_Heap_Free+0x66> prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; 4c14a: d682 addl %d2,%d3 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c14c: 7201 moveq #1,%d1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4c14e: 7afe moveq #-2,%d5 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c150: 8283 orl %d3,%d1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; 4c152: 2483 movel %d3,%a2@ /* Statistics */ --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); 4c154: 7001 moveq #1,%d0 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4c156: 2341 0004 movel %d1,%a1@(4) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4c15a: cbaa 0004 andl %d5,%a2@(4) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4c15e: 53a8 0040 subql #1,%a0@(64) ++stats->frees; 4c162: 52a8 0050 addql #1,%a0@(80) stats->free_size += block_size; 4c166: d5a8 0030 addl %d2,%a0@(48) 4c16a: 6000 ff3c braw 4c0a8 <_Heap_Free+0xb8> ... =============================================================================== 0004cc68 <_Heap_Get_information>: void _Heap_Get_information( Heap_Control *the_heap, Heap_Information_block *the_info ) { 4cc68: 4e56 fff0 linkw %fp,#-16 4cc6c: 48d7 041c moveml %d2-%d4/%a2,%sp@ 4cc70: 246e 0008 moveal %fp@(8),%a2 4cc74: 282e 000c movel %fp@(12),%d4 Heap_Block *the_block = the_heap->first_block; Heap_Block *const end = the_heap->last_block; memset(the_info, 0, sizeof(*the_info)); 4cc78: 2044 moveal %d4,%a0 void _Heap_Get_information( Heap_Control *the_heap, Heap_Information_block *the_info ) { Heap_Block *the_block = the_heap->first_block; 4cc7a: 226a 0020 moveal %a2@(32),%a1 Heap_Block *const end = the_heap->last_block; 4cc7e: 242a 0024 movel %a2@(36),%d2 memset(the_info, 0, sizeof(*the_info)); 4cc82: 4298 clrl %a0@+ 4cc84: 4298 clrl %a0@+ 4cc86: 4298 clrl %a0@+ 4cc88: 4298 clrl %a0@+ 4cc8a: 4298 clrl %a0@+ 4cc8c: 4290 clrl %a0@ while ( the_block != end ) { 4cc8e: b489 cmpl %a1,%d2 4cc90: 6734 beqs 4ccc6 <_Heap_Get_information+0x5e> <== NEVER TAKEN uintptr_t const the_size = _Heap_Block_size(the_block); Heap_Block *const next_block = _Heap_Block_at(the_block, the_size); Heap_Information *info; if ( _Heap_Is_prev_used(next_block) ) info = &the_info->Used; 4cc92: 2604 movel %d4,%d3 4cc94: 0683 0000 000c addil #12,%d3 Heap_Block *the_block = the_heap->first_block; Heap_Block *const end = the_heap->last_block; memset(the_info, 0, sizeof(*the_info)); while ( the_block != end ) { 4cc9a: 2229 0004 movel %a1@(4),%d1 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4cc9e: 70fe moveq #-2,%d0 uintptr_t const the_size = _Heap_Block_size(the_block); Heap_Block *const next_block = _Heap_Block_at(the_block, the_size); Heap_Information *info; if ( _Heap_Is_prev_used(next_block) ) info = &the_info->Used; 4cca0: 2043 moveal %d3,%a0 4cca2: c081 andl %d1,%d0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4cca4: d3c0 addal %d0,%a1 if ( info->largest < the_size ) info->largest = the_size; the_block = next_block; } } 4cca6: 2229 0004 movel %a1@(4),%d1 while ( the_block != end ) { uintptr_t const the_size = _Heap_Block_size(the_block); Heap_Block *const next_block = _Heap_Block_at(the_block, the_size); Heap_Information *info; if ( _Heap_Is_prev_used(next_block) ) 4ccaa: 0801 0000 btst #0,%d1 4ccae: 6602 bnes 4ccb2 <_Heap_Get_information+0x4a> info = &the_info->Used; else info = &the_info->Free; 4ccb0: 2044 moveal %d4,%a0 info->number++; 4ccb2: 5290 addql #1,%a0@ info->total += the_size; 4ccb4: d1a8 0008 addl %d0,%a0@(8) if ( info->largest < the_size ) 4ccb8: b0a8 0004 cmpl %a0@(4),%d0 4ccbc: 6304 blss 4ccc2 <_Heap_Get_information+0x5a> info->largest = the_size; 4ccbe: 2140 0004 movel %d0,%a0@(4) Heap_Block *the_block = the_heap->first_block; Heap_Block *const end = the_heap->last_block; memset(the_info, 0, sizeof(*the_info)); while ( the_block != end ) { 4ccc2: b3c2 cmpal %d2,%a1 4ccc4: 66d8 bnes 4cc9e <_Heap_Get_information+0x36> if ( info->largest < the_size ) info->largest = the_size; the_block = next_block; } } 4ccc6: 4cd7 041c moveml %sp@,%d2-%d4/%a2 4ccca: 4e5e unlk %fp ... =============================================================================== 0005bd7c <_Heap_Resize_block>: void *alloc_begin_ptr, uintptr_t new_alloc_size, uintptr_t *old_size, uintptr_t *new_size ) { 5bd7c: 4e56 ffe4 linkw %fp,#-28 5bd80: 226e 0014 moveal %fp@(20),%a1 5bd84: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 5bd88: 242e 000c movel %fp@(12),%d2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 5bd8c: 2202 movel %d2,%d1 5bd8e: 2042 moveal %d2,%a0 5bd90: 5188 subql #8,%a0 5bd92: 246e 0008 moveal %fp@(8),%a2 5bd96: 4c6a 1000 0010 remul %a2@(16),%d0,%d1 5bd9c: 266e 0018 moveal %fp@(24),%a3 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 5bda0: 91c0 subal %d0,%a0 uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr; Heap_Block *const block = _Heap_Block_of_alloc_area( alloc_begin, page_size ); *old_size = 0; 5bda2: 4291 clrl %a1@ void *alloc_begin_ptr, uintptr_t new_alloc_size, uintptr_t *old_size, uintptr_t *new_size ) { 5bda4: 202e 0010 movel %fp@(16),%d0 uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr; Heap_Block *const block = _Heap_Block_of_alloc_area( alloc_begin, page_size ); *old_size = 0; *new_size = 0; 5bda8: 4293 clrl %a3@ const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 5bdaa: b1ea 0020 cmpal %a2@(32),%a0 5bdae: 6500 0098 bcsw 5be48 <_Heap_Resize_block+0xcc> 5bdb2: b1ea 0024 cmpal %a2@(36),%a0 5bdb6: 6200 0090 bhiw 5be48 <_Heap_Resize_block+0xcc> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 5bdba: 76fe moveq #-2,%d3 5bdbc: 78fe moveq #-2,%d4 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 5bdbe: 7a01 moveq #1,%d5 uintptr_t const block_begin = (uintptr_t) block; uintptr_t block_size = _Heap_Block_size( block ); uintptr_t block_end = block_begin + block_size; uintptr_t alloc_size = block_end - alloc_begin + HEAP_ALLOC_BONUS; 5bdc0: 7204 moveq #4,%d1 5bdc2: 9282 subl %d2,%d1 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 5bdc4: c6a8 0004 andl %a0@(4),%d3 { Heap_Statistics *const stats = &heap->stats; uintptr_t const block_begin = (uintptr_t) block; uintptr_t block_size = _Heap_Block_size( block ); uintptr_t block_end = block_begin + block_size; 5bdc8: 49f0 3800 lea %a0@(00000000,%d3:l),%a4 uintptr_t alloc_size = block_end - alloc_begin + HEAP_ALLOC_BONUS; 5bdcc: d28c addl %a4,%d1 5bdce: c8ac 0004 andl %a4@(4),%d4 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 5bdd2: cab4 4804 andl %a4@(00000004,%d4:l),%d5 bool next_block_is_free = _Heap_Is_free( next_block );; _HAssert( _Heap_Is_block_in_heap( heap, next_block ) ); _HAssert( _Heap_Is_prev_used( next_block ) ); *old_size = alloc_size; 5bdd6: 2281 movel %d1,%a1@ RTEMS_INLINE_ROUTINE bool _Heap_Is_free( const Heap_Block *block ) { return !_Heap_Is_used( block ); 5bdd8: 4a85 tstl %d5 5bdda: 57c5 seq %d5 5bddc: 4485 negl %d5 if ( next_block_is_free ) { 5bdde: 4a05 tstb %d5 5bde0: 6672 bnes 5be54 <_Heap_Resize_block+0xd8> <== NEVER TAKEN block_size += next_block_size; alloc_size += next_block_size; } if ( new_alloc_size > alloc_size ) { 5bde2: b280 cmpl %d0,%d1 5bde4: 6576 bcss 5be5c <_Heap_Resize_block+0xe0> return HEAP_RESIZE_UNSATISFIED; } if ( next_block_is_free ) { 5bde6: 4a05 tstb %d5 5bde8: 672a beqs 5be14 <_Heap_Resize_block+0x98> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 5bdea: 7201 moveq #1,%d1 5bdec: c2a8 0004 andl %a0@(4),%d1 old_size, new_size ); } return HEAP_RESIZE_FATAL_ERROR; } 5bdf0: 226c 0008 moveal %a4@(8),%a1 block->size_and_flag = size | flag; 5bdf4: 8283 orl %d3,%d1 5bdf6: 286c 000c moveal %a4@(12),%a4 5bdfa: 2141 0004 movel %d1,%a0@(4) _Heap_Block_set_size( block, block_size ); _Heap_Free_list_remove( next_block ); next_block = _Heap_Block_at( block, block_size ); next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 5bdfe: 7201 moveq #1,%d1 5be00: 83b0 3804 orl %d1,%a0@(00000004,%d3:l) RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 5be04: 2949 0008 movel %a1,%a4@(8) next->prev = prev; 5be08: 234c 000c movel %a4,%a1@(12) /* Statistics */ --stats->free_blocks; 5be0c: 53aa 0038 subql #1,%a2@(56) stats->free_size -= next_block_size; 5be10: 99aa 0030 subl %d4,%a2@(48) } block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size ); 5be14: 2f00 movel %d0,%sp@- 5be16: 2f02 movel %d2,%sp@- 5be18: 2f08 movel %a0,%sp@- 5be1a: 2f0a movel %a2,%sp@- 5be1c: 4eb9 0004 79ae jsr 479ae <_Heap_Block_allocate> block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); *new_size = (uintptr_t) next_block - alloc_begin + HEAP_ALLOC_BONUS; /* Statistics */ ++stats->resizes; 5be22: 4fef 0010 lea %sp@(16),%sp - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 5be26: 72fe moveq #-2,%d1 /* Statistics */ --stats->free_blocks; stats->free_size -= next_block_size; } block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size ); 5be28: 2040 moveal %d0,%a0 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); *new_size = (uintptr_t) next_block - alloc_begin + HEAP_ALLOC_BONUS; 5be2a: 2240 moveal %d0,%a1 5be2c: 93c2 subal %d2,%a1 /* Statistics */ ++stats->resizes; return HEAP_RESIZE_SUCCESSFUL; 5be2e: 4280 clrl %d0 5be30: c2a8 0004 andl %a0@(4),%d1 block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size ); block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); *new_size = (uintptr_t) next_block - alloc_begin + HEAP_ALLOC_BONUS; 5be34: 43f1 1804 lea %a1@(00000004,%d1:l),%a1 5be38: 2689 movel %a1,%a3@ /* Statistics */ ++stats->resizes; 5be3a: 52aa 0054 addql #1,%a2@(84) old_size, new_size ); } return HEAP_RESIZE_FATAL_ERROR; } 5be3e: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 5be44: 4e5e unlk %fp 5be46: 4e75 rts new_alloc_size, old_size, new_size ); } return HEAP_RESIZE_FATAL_ERROR; 5be48: 7002 moveq #2,%d0 } 5be4a: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 5be50: 4e5e unlk %fp 5be52: 4e75 rts _HAssert( _Heap_Is_prev_used( next_block ) ); *old_size = alloc_size; if ( next_block_is_free ) { block_size += next_block_size; 5be54: d684 addl %d4,%d3 alloc_size += next_block_size; 5be56: d284 addl %d4,%d1 } if ( new_alloc_size > alloc_size ) { 5be58: b280 cmpl %d0,%d1 5be5a: 648a bccs 5bde6 <_Heap_Resize_block+0x6a> <== NEVER TAKEN return HEAP_RESIZE_UNSATISFIED; 5be5c: 7001 moveq #1,%d0 old_size, new_size ); } return HEAP_RESIZE_FATAL_ERROR; } 5be5e: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 5be64: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 0005be68 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 5be68: 4e56 0000 linkw %fp,#0 5be6c: 202e 000c movel %fp@(12),%d0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 5be70: 2040 moveal %d0,%a0 5be72: 5188 subql #8,%a0 5be74: 226e 0008 moveal %fp@(8),%a1 5be78: 2f02 movel %d2,%sp@- 5be7a: 2400 movel %d0,%d2 5be7c: 4c69 2001 0010 remul %a1@(16),%d1,%d2 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 5be82: 91c1 subal %d1,%a0 RTEMS_INLINE_ROUTINE bool _Heap_Is_block_in_heap( const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block 5be84: 2229 0020 movel %a1@(32),%d1 && (uintptr_t) block <= (uintptr_t) heap->last_block; 5be88: b288 cmpl %a0,%d1 5be8a: 6236 bhis 5bec2 <_Heap_Size_of_alloc_area+0x5a> 5be8c: 2269 0024 moveal %a1@(36),%a1 5be90: b3c8 cmpal %a0,%a1 5be92: 652e bcss 5bec2 <_Heap_Size_of_alloc_area+0x5a> <== NEVER TAKEN - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 5be94: 74fe moveq #-2,%d2 5be96: c4a8 0004 andl %a0@(4),%d2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 5be9a: d1c2 addal %d2,%a0 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 5be9c: b1c1 cmpal %d1,%a0 5be9e: 6522 bcss 5bec2 <_Heap_Size_of_alloc_area+0x5a> <== NEVER TAKEN 5bea0: b1c9 cmpal %a1,%a0 5bea2: 621e bhis 5bec2 <_Heap_Size_of_alloc_area+0x5a> <== NEVER TAKEN block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 5bea4: 7201 moveq #1,%d1 5bea6: c2a8 0004 andl %a0@(4),%d1 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 5beaa: 6716 beqs 5bec2 <_Heap_Size_of_alloc_area+0x5a> <== NEVER TAKEN ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; 5beac: 7204 moveq #4,%d1 5beae: 9280 subl %d0,%d1 5beb0: 2001 movel %d1,%d0 5beb2: d088 addl %a0,%d0 5beb4: 226e 0010 moveal %fp@(16),%a1 return true; } 5beb8: 241f movel %sp@+,%d2 5beba: 4e5e unlk %fp || !_Heap_Is_prev_used( next_block ) ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; 5bebc: 2280 movel %d0,%a1@ return true; 5bebe: 7001 moveq #1,%d0 } 5bec0: 4e75 rts 5bec2: 241f movel %sp@+,%d2 5bec4: 4e5e unlk %fp if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) ) { return false; 5bec6: 4200 clrb %d0 } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; } ... =============================================================================== 00048516 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 48516: 4e56 ffc4 linkw %fp,#-60 4851a: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 4851e: 246e 0008 moveal %fp@(8),%a2 uintptr_t const min_block_size = heap->min_block_size; Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 48522: 4bfa ff94 lea %pc@(484b8 <_Heap_Walk_print_nothing>),%a5 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 48526: 2a2e 000c movel %fp@(12),%d5 uintptr_t const page_size = heap->page_size; 4852a: 262a 0010 movel %a2@(16),%d3 uintptr_t const min_block_size = heap->min_block_size; 4852e: 2c2a 0014 movel %a2@(20),%d6 Heap_Block *const first_block = heap->first_block; 48532: 282a 0020 movel %a2@(32),%d4 Heap_Block *const last_block = heap->last_block; 48536: 2e2a 0024 movel %a2@(36),%d7 Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 4853a: 4a2e 0013 tstb %fp@(19) 4853e: 6704 beqs 48544 <_Heap_Walk+0x2e> 48540: 4bfa ff7e lea %pc@(484c0 <_Heap_Walk_print>),%a5 if ( !_System_state_Is_up( _System_state_Get() ) ) { 48544: 7003 moveq #3,%d0 48546: b0b9 0006 1ab8 cmpl 61ab8 <_System_state_Current>,%d0 4854c: 670c beqs 4855a <_Heap_Walk+0x44> block = next_block; } while ( block != first_block ); return true; } 4854e: 4cee 3cfc ffc4 moveml %fp@(-60),%d2-%d7/%a2-%a5 } block = next_block; } while ( block != first_block ); return true; 48554: 7001 moveq #1,%d0 } 48556: 4e5e unlk %fp 48558: 4e75 rts Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; (*printer)( 4855a: 2f2a 000c movel %a2@(12),%sp@- 4855e: 2f2a 0008 movel %a2@(8),%sp@- 48562: 2f07 movel %d7,%sp@- 48564: 2f04 movel %d4,%sp@- 48566: 2f2a 001c movel %a2@(28),%sp@- 4856a: 2f2a 0018 movel %a2@(24),%sp@- 4856e: 2f06 movel %d6,%sp@- 48570: 2f03 movel %d3,%sp@- 48572: 4879 0005 df85 pea 5df85 <_Status_Object_name_errors_to_status+0x5d> 48578: 42a7 clrl %sp@- 4857a: 2f05 movel %d5,%sp@- 4857c: 4e95 jsr %a5@ heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 4857e: 4fef 002c lea %sp@(44),%sp 48582: 4a83 tstl %d3 48584: 6700 0082 beqw 48608 <_Heap_Walk+0xf2> ) { #if (CPU_ALIGNMENT == 0) return true; #else return (((uintptr_t)address % CPU_ALIGNMENT) == 0); 48588: 7003 moveq #3,%d0 4858a: c083 andl %d3,%d0 (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 4858c: 6600 0090 bnew 4861e <_Heap_Walk+0x108> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 48590: 2206 movel %d6,%d1 48592: 4c43 1000 remul %d3,%d0,%d1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 48596: 4a80 tstl %d0 48598: 6600 00a4 bnew 4863e <_Heap_Walk+0x128> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 4859c: 2004 movel %d4,%d0 4859e: 5080 addql #8,%d0 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 485a0: 4c43 0001 remul %d3,%d1,%d0 ); return false; } if ( 485a4: 4a81 tstl %d1 485a6: 6600 00ae bnew 48656 <_Heap_Walk+0x140> block = next_block; } while ( block != first_block ); return true; } 485aa: 2044 moveal %d4,%a0 485ac: 2228 0004 movel %a0@(4),%d1 485b0: 2d41 ffec movel %d1,%fp@(-20) ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 485b4: 0801 0000 btst #0,%d1 485b8: 6700 0188 beqw 48742 <_Heap_Walk+0x22c> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 485bc: 2047 moveal %d7,%a0 485be: 72fe moveq #-2,%d1 485c0: c2a8 0004 andl %a0@(4),%d1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 485c4: d1c1 addal %d1,%a0 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 485c6: 7201 moveq #1,%d1 485c8: c2a8 0004 andl %a0@(4),%d1 ); return false; } if ( _Heap_Is_free( last_block ) ) { 485cc: 6724 beqs 485f2 <_Heap_Walk+0xdc> ); return false; } if ( 485ce: b1c4 cmpal %d4,%a0 485d0: 6700 009c beqw 4866e <_Heap_Walk+0x158> _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 485d4: 4879 0005 e0df pea 5e0df <_Status_Object_name_errors_to_status+0x1b7> 485da: 4878 0001 pea 1 485de: 2f05 movel %d5,%sp@- 485e0: 4e95 jsr %a5@ 485e2: 4fef 000c lea %sp@(12),%sp if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 485e6: 4200 clrb %d0 block = next_block; } while ( block != first_block ); return true; } 485e8: 4cee 3cfc ffc4 moveml %fp@(-60),%d2-%d7/%a2-%a5 485ee: 4e5e unlk %fp 485f0: 4e75 rts return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( 485f2: 4879 0005 e0ca pea 5e0ca <_Status_Object_name_errors_to_status+0x1a2> } if ( _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 485f8: 4878 0001 pea 1 485fc: 2f05 movel %d5,%sp@- 485fe: 4e95 jsr %a5@ 48600: 4fef 000c lea %sp@(12),%sp if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 48604: 4200 clrb %d0 48606: 60e0 bras 485e8 <_Heap_Walk+0xd2> first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); 48608: 4879 0005 e016 pea 5e016 <_Status_Object_name_errors_to_status+0xee> } if ( _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 4860e: 4878 0001 pea 1 48612: 2f05 movel %d5,%sp@- 48614: 4e95 jsr %a5@ 48616: 4fef 000c lea %sp@(12),%sp if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 4861a: 4200 clrb %d0 4861c: 60ca bras 485e8 <_Heap_Walk+0xd2> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( 4861e: 2f03 movel %d3,%sp@- 48620: 4879 0005 e029 pea 5e029 <_Status_Object_name_errors_to_status+0x101> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 48626: 4878 0001 pea 1 4862a: 2f05 movel %d5,%sp@- 4862c: 4e95 jsr %a5@ 4862e: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 48632: 4200 clrb %d0 block = next_block; } while ( block != first_block ); return true; } 48634: 4cee 3cfc ffc4 moveml %fp@(-60),%d2-%d7/%a2-%a5 4863a: 4e5e unlk %fp 4863c: 4e75 rts return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( 4863e: 2f06 movel %d6,%sp@- 48640: 4879 0005 e047 pea 5e047 <_Status_Object_name_errors_to_status+0x11f> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 48646: 4878 0001 pea 1 4864a: 2f05 movel %d5,%sp@- 4864c: 4e95 jsr %a5@ 4864e: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 48652: 4200 clrb %d0 48654: 60de bras 48634 <_Heap_Walk+0x11e> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 48656: 2f04 movel %d4,%sp@- 48658: 4879 0005 e06b pea 5e06b <_Status_Object_name_errors_to_status+0x143> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 4865e: 4878 0001 pea 1 48662: 2f05 movel %d5,%sp@- 48664: 4e95 jsr %a5@ 48666: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 4866a: 4200 clrb %d0 4866c: 60c6 bras 48634 <_Heap_Walk+0x11e> int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 4866e: 202a 0010 movel %a2@(16),%d0 block = next_block; } while ( block != first_block ); return true; } 48672: 226a 0008 moveal %a2@(8),%a1 int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 48676: 2d40 fffc movel %d0,%fp@(-4) const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 4867a: b3ca cmpal %a2,%a1 4867c: 6700 034e beqw 489cc <_Heap_Walk+0x4b6> block = next_block; } while ( block != first_block ); return true; } 48680: 242a 0020 movel %a2@(32),%d2 48684: 2d42 fff4 movel %d2,%fp@(-12) const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 48688: b3c2 cmpal %d2,%a1 4868a: 6500 009a bcsw 48726 <_Heap_Walk+0x210> 4868e: 286a 0024 moveal %a2@(36),%a4 48692: b3cc cmpal %a4,%a1 48694: 6200 0090 bhiw 48726 <_Heap_Walk+0x210> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 48698: 47e9 0008 lea %a1@(8),%a3 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 4869c: 200b movel %a3,%d0 4869e: 222e fffc movel %fp@(-4),%d1 486a2: 4c41 0002 remul %d1,%d2,%d0 ); return false; } if ( 486a6: 4a82 tstl %d2 486a8: 6600 00b0 bnew 4875a <_Heap_Walk+0x244> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 486ac: 74fe moveq #-2,%d2 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 486ae: 7001 moveq #1,%d0 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 486b0: c4a9 0004 andl %a1@(4),%d2 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 486b4: c0b1 2804 andl %a1@(00000004,%d2:l),%d0 ); return false; } if ( _Heap_Is_used( free_block ) ) { 486b8: 6600 0304 bnew 489be <_Heap_Walk+0x4a8> 486bc: 222e fff4 movel %fp@(-12),%d1 486c0: 240a movel %a2,%d2 486c2: 266e ffec moveal %fp@(-20),%a3 486c6: 2d43 fff8 movel %d3,%fp@(-8) 486ca: 2d44 fff0 movel %d4,%fp@(-16) ); return false; } if ( free_block->prev != prev_block ) { 486ce: 2069 000c moveal %a1@(12),%a0 486d2: b488 cmpl %a0,%d2 486d4: 6600 02cc bnew 489a2 <_Heap_Walk+0x48c> return false; } prev_block = free_block; free_block = free_block->next; 486d8: 2069 0008 moveal %a1@(8),%a0 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 486dc: b1ca cmpal %a2,%a0 486de: 6700 0096 beqw 48776 <_Heap_Walk+0x260> const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 486e2: b1c1 cmpal %d1,%a0 486e4: 6542 bcss 48728 <_Heap_Walk+0x212> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 486e6: 2608 movel %a0,%d3 486e8: 5083 addql #8,%d3 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 486ea: b9c8 cmpal %a0,%a4 486ec: 653a bcss 48728 <_Heap_Walk+0x212> <== NEVER TAKEN RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 486ee: 282e fffc movel %fp@(-4),%d4 ); return false; } if ( _Heap_Is_used( free_block ) ) { 486f2: 2409 movel %a1,%d2 486f4: 2248 moveal %a0,%a1 486f6: 4c44 3000 remul %d4,%d0,%d3 ); return false; } if ( 486fa: 4a80 tstl %d0 486fc: 665e bnes 4875c <_Heap_Walk+0x246> - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 486fe: 70fe moveq #-2,%d0 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 48700: 7601 moveq #1,%d3 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 48702: c0a8 0004 andl %a0@(4),%d0 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 48706: c6b0 0804 andl %a0@(00000004,%d0:l),%d3 ); return false; } if ( _Heap_Is_used( free_block ) ) { 4870a: 67c2 beqs 486ce <_Heap_Walk+0x1b8> (*printer)( 4870c: 2f08 movel %a0,%sp@- 4870e: 4879 0005 e15e pea 5e15e <_Status_Object_name_errors_to_status+0x236> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 48714: 4878 0001 pea 1 48718: 2f05 movel %d5,%sp@- 4871a: 4e95 jsr %a5@ 4871c: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 48720: 4200 clrb %d0 48722: 6000 ff10 braw 48634 <_Heap_Walk+0x11e> const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 48726: 2049 moveal %a1,%a0 <== NOT EXECUTED const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( 48728: 2f08 movel %a0,%sp@- 4872a: 4879 0005 e10e pea 5e10e <_Status_Object_name_errors_to_status+0x1e6> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 48730: 4878 0001 pea 1 48734: 2f05 movel %d5,%sp@- 48736: 4e95 jsr %a5@ 48738: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 4873c: 4200 clrb %d0 4873e: 6000 fef4 braw 48634 <_Heap_Walk+0x11e> return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( 48742: 4879 0005 e09c pea 5e09c <_Status_Object_name_errors_to_status+0x174> } if ( _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 48748: 4878 0001 pea 1 4874c: 2f05 movel %d5,%sp@- 4874e: 4e95 jsr %a5@ 48750: 4fef 000c lea %sp@(12),%sp if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 48754: 4200 clrb %d0 48756: 6000 fe90 braw 485e8 <_Heap_Walk+0xd2> ); return false; } if ( 4875a: 2049 moveal %a1,%a0 <== NOT EXECUTED !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 4875c: 2f08 movel %a0,%sp@- 4875e: 4879 0005 e12e pea 5e12e <_Status_Object_name_errors_to_status+0x206> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 48764: 4878 0001 pea 1 48768: 2f05 movel %d5,%sp@- 4876a: 4e95 jsr %a5@ 4876c: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 48770: 4200 clrb %d0 48772: 6000 fec0 braw 48634 <_Heap_Walk+0x11e> 48776: 262e fff8 movel %fp@(-8),%d3 4877a: 282e fff0 movel %fp@(-16),%d4 ); return false; } if ( _Heap_Is_used( free_block ) ) { 4877e: 2844 moveal %d4,%a4 48780: 2d41 fff4 movel %d1,%fp@(-12) 48784: 222e fff4 movel %fp@(-12),%d1 48788: 2d4b ffec movel %a3,%fp@(-20) 4878c: 2d43 fffc movel %d3,%fp@(-4) 48790: 262e ffec movel %fp@(-20),%d3 48794: 2d47 fff0 movel %d7,%fp@(-16) - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 48798: 74fe moveq #-2,%d2 4879a: c483 andl %d3,%d2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4879c: 47f4 2800 lea %a4@(00000000,%d2:l),%a3 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 487a0: b7c1 cmpal %d1,%a3 487a2: 657e bcss 48822 <_Heap_Walk+0x30c> <== NEVER TAKEN 487a4: b7ea 0024 cmpal %a2@(36),%a3 487a8: 6278 bhis 48822 <_Heap_Walk+0x30c> <== NEVER TAKEN uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; 487aa: b9ee fff0 cmpal %fp@(-16),%a4 487ae: 56c7 sne %d7 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 487b0: 222e fffc movel %fp@(-4),%d1 487b4: 2002 movel %d2,%d0 487b6: 3247 moveaw %d7,%a1 487b8: 4c41 0007 remul %d1,%d7,%d0 487bc: 2009 movel %a1,%d0 487be: 4480 negl %d0 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 487c0: 4a87 tstl %d7 487c2: 6704 beqs 487c8 <_Heap_Walk+0x2b2> 487c4: 4a00 tstb %d0 487c6: 667c bnes 48844 <_Heap_Walk+0x32e> <== NEVER TAKEN ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 487c8: b486 cmpl %d6,%d2 487ca: 6406 bccs 487d2 <_Heap_Walk+0x2bc> 487cc: 4a00 tstb %d0 487ce: 6600 008e bnew 4885e <_Heap_Walk+0x348> ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 487d2: b7cc cmpal %a4,%a3 487d4: 6206 bhis 487dc <_Heap_Walk+0x2c6> 487d6: 4a00 tstb %d0 487d8: 6600 00a8 bnew 48882 <_Heap_Walk+0x36c> block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 487dc: 7001 moveq #1,%d0 487de: 7201 moveq #1,%d1 487e0: c0ab 0004 andl %a3@(4),%d0 487e4: c681 andl %d1,%d3 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 487e6: 4a80 tstl %d0 487e8: 6700 00cc beqw 488b6 <_Heap_Walk+0x3a0> if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 487ec: 4a83 tstl %d3 487ee: 6700 00ac beqw 4889c <_Heap_Walk+0x386> (*printer)( 487f2: 2f02 movel %d2,%sp@- 487f4: 2f0c movel %a4,%sp@- 487f6: 4879 0005 e303 pea 5e303 <_Status_Object_name_errors_to_status+0x3db> 487fc: 42a7 clrl %sp@- 487fe: 2f05 movel %d5,%sp@- 48800: 4e95 jsr %a5@ 48802: 4fef 0014 lea %sp@(20),%sp block->prev_size ); } block = next_block; } while ( block != first_block ); 48806: b7c4 cmpal %d4,%a3 48808: 6700 fd44 beqw 4854e <_Heap_Walk+0x38> 4880c: 262b 0004 movel %a3@(4),%d3 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 48810: 74fe moveq #-2,%d2 48812: 284b moveal %a3,%a4 48814: c483 andl %d3,%d2 48816: 222a 0020 movel %a2@(32),%d1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4881a: 47f4 2800 lea %a4@(00000000,%d2:l),%a3 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 4881e: b7c1 cmpal %d1,%a3 48820: 6482 bccs 487a4 <_Heap_Walk+0x28e> <== ALWAYS TAKEN Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { (*printer)( 48822: 2f0b movel %a3,%sp@- 48824: 2f0c movel %a4,%sp@- 48826: 4879 0005 e1ac pea 5e1ac <_Status_Object_name_errors_to_status+0x284> return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( 4882c: 4878 0001 pea 1 48830: 2f05 movel %d5,%sp@- 48832: 4e95 jsr %a5@ "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 48834: 4fef 0014 lea %sp@(20),%sp 48838: 4200 clrb %d0 block = next_block; } while ( block != first_block ); return true; } 4883a: 4cee 3cfc ffc4 moveml %fp@(-60),%d2-%d7/%a2-%a5 48840: 4e5e unlk %fp 48842: 4e75 rts return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( 48844: 2f02 movel %d2,%sp@- 48846: 2f0c movel %a4,%sp@- 48848: 4879 0005 e1d9 pea 5e1d9 <_Status_Object_name_errors_to_status+0x2b1> return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( 4884e: 4878 0001 pea 1 48852: 2f05 movel %d5,%sp@- 48854: 4e95 jsr %a5@ "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 48856: 4fef 0014 lea %sp@(20),%sp 4885a: 4200 clrb %d0 4885c: 60dc bras 4883a <_Heap_Walk+0x324> return false; } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( 4885e: 2f06 movel %d6,%sp@- 48860: 2f02 movel %d2,%sp@- 48862: 2f0c movel %a4,%sp@- 48864: 4879 0005 e207 pea 5e207 <_Status_Object_name_errors_to_status+0x2df> 4886a: 4878 0001 pea 1 4886e: 2f05 movel %d5,%sp@- 48870: 4e95 jsr %a5@ block, block_size, min_block_size ); return false; 48872: 4fef 0018 lea %sp@(24),%sp block = next_block; } while ( block != first_block ); return true; } 48876: 4cee 3cfc ffc4 moveml %fp@(-60),%d2-%d7/%a2-%a5 block, block_size, min_block_size ); return false; 4887c: 4200 clrb %d0 block = next_block; } while ( block != first_block ); return true; } 4887e: 4e5e unlk %fp 48880: 4e75 rts return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( 48882: 2f0b movel %a3,%sp@- 48884: 2f0c movel %a4,%sp@- 48886: 4879 0005 e232 pea 5e232 <_Status_Object_name_errors_to_status+0x30a> 4888c: 4878 0001 pea 1 48890: 2f05 movel %d5,%sp@- 48892: 4e95 jsr %a5@ "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 48894: 4fef 0014 lea %sp@(20),%sp 48898: 4200 clrb %d0 4889a: 609e bras 4883a <_Heap_Walk+0x324> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 4889c: 2f14 movel %a4@,%sp@- 4889e: 2f02 movel %d2,%sp@- 488a0: 2f0c movel %a4,%sp@- 488a2: 4879 0005 e31a pea 5e31a <_Status_Object_name_errors_to_status+0x3f2> 488a8: 42a7 clrl %sp@- 488aa: 2f05 movel %d5,%sp@- 488ac: 4e95 jsr %a5@ 488ae: 4fef 0018 lea %sp@(24),%sp 488b2: 6000 ff52 braw 48806 <_Heap_Walk+0x2f0> block = next_block; } while ( block != first_block ); return true; } 488b6: 2e2a 0008 movel %a2@(8),%d7 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 488ba: 43f9 0005 df52 lea 5df52 <_Status_Object_name_errors_to_status+0x2a>,%a1 block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? 488c0: 222c 0008 movel %a4@(8),%d1 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 488c4: b2aa 000c cmpl %a2@(12),%d1 488c8: 670a beqs 488d4 <_Heap_Walk+0x3be> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 488ca: 43f9 0005 de9e lea 5de9e ,%a1 488d0: b28a cmpl %a2,%d1 488d2: 6764 beqs 48938 <_Heap_Walk+0x422> false, "block 0x%08x: size %u, prev 0x%08x%s, next 0x%08x%s\n", block, block_size, block->prev, block->prev == first_free_block ? 488d4: 202c 000c movel %a4@(12),%d0 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 488d8: 41f9 0005 df6b lea 5df6b <_Status_Object_name_errors_to_status+0x43>,%a0 488de: b087 cmpl %d7,%d0 488e0: 670a beqs 488ec <_Heap_Walk+0x3d6> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 488e2: 41f9 0005 de9e lea 5de9e ,%a0 488e8: b08a cmpl %a2,%d0 488ea: 6754 beqs 48940 <_Heap_Walk+0x42a> Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 488ec: 2f09 movel %a1,%sp@- 488ee: 2f01 movel %d1,%sp@- 488f0: 2f08 movel %a0,%sp@- 488f2: 2f00 movel %d0,%sp@- 488f4: 2f02 movel %d2,%sp@- 488f6: 2f0c movel %a4,%sp@- 488f8: 4879 0005 e266 pea 5e266 <_Status_Object_name_errors_to_status+0x33e> 488fe: 42a7 clrl %sp@- 48900: 2f05 movel %d5,%sp@- 48902: 4e95 jsr %a5@ block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 48904: 2213 movel %a3@,%d1 48906: 4fef 0024 lea %sp@(36),%sp 4890a: b282 cmpl %d2,%d1 4890c: 663a bnes 48948 <_Heap_Walk+0x432> ); return false; } if ( !prev_used ) { 4890e: 4a83 tstl %d3 48910: 6776 beqs 48988 <_Heap_Walk+0x472> block = next_block; } while ( block != first_block ); return true; } 48912: 206a 0008 moveal %a2@(8),%a0 ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 48916: b1ca cmpal %a2,%a0 48918: 6754 beqs 4896e <_Heap_Walk+0x458> <== NEVER TAKEN if ( free_block == block ) { 4891a: b1cc cmpal %a4,%a0 4891c: 6700 fee8 beqw 48806 <_Heap_Walk+0x2f0> 48920: 2e2e fff0 movel %fp@(-16),%d7 return true; } free_block = free_block->next; 48924: 2068 0008 moveal %a0@(8),%a0 ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 48928: b1ca cmpal %a2,%a0 4892a: 6742 beqs 4896e <_Heap_Walk+0x458> if ( free_block == block ) { 4892c: b1cc cmpal %a4,%a0 4892e: 66f4 bnes 48924 <_Heap_Walk+0x40e> 48930: 2d47 fff0 movel %d7,%fp@(-16) 48934: 6000 fed0 braw 48806 <_Heap_Walk+0x2f0> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 48938: 43f9 0005 df61 lea 5df61 <_Status_Object_name_errors_to_status+0x39>,%a1 4893e: 6094 bras 488d4 <_Heap_Walk+0x3be> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 48940: 41f9 0005 df7b lea 5df7b <_Status_Object_name_errors_to_status+0x53>,%a0 48946: 60a4 bras 488ec <_Heap_Walk+0x3d6> " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( 48948: 2f0b movel %a3,%sp@- 4894a: 2f01 movel %d1,%sp@- 4894c: 2f02 movel %d2,%sp@- 4894e: 2f0c movel %a4,%sp@- 48950: 4879 0005 e29b pea 5e29b <_Status_Object_name_errors_to_status+0x373> 48956: 4878 0001 pea 1 4895a: 2f05 movel %d5,%sp@- 4895c: 4e95 jsr %a5@ 4895e: 4fef 001c lea %sp@(28),%sp block = next_block; } while ( block != first_block ); return true; } 48962: 4cee 3cfc ffc4 moveml %fp@(-60),%d2-%d7/%a2-%a5 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 48968: 4200 clrb %d0 block = next_block; } while ( block != first_block ); return true; } 4896a: 4e5e unlk %fp 4896c: 4e75 rts return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 4896e: 2f0c movel %a4,%sp@- 48970: 4879 0005 e33f pea 5e33f <_Status_Object_name_errors_to_status+0x417> 48976: 4878 0001 pea 1 4897a: 2f05 movel %d5,%sp@- 4897c: 4e95 jsr %a5@ 4897e: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 48982: 4200 clrb %d0 48984: 6000 fcae braw 48634 <_Heap_Walk+0x11e> return false; } if ( !prev_used ) { (*printer)( 48988: 2f0c movel %a4,%sp@- 4898a: 4879 0005 e2d4 pea 5e2d4 <_Status_Object_name_errors_to_status+0x3ac> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 48990: 4878 0001 pea 1 48994: 2f05 movel %d5,%sp@- 48996: 4e95 jsr %a5@ 48998: 4fef 0010 lea %sp@(16),%sp return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 4899c: 4200 clrb %d0 4899e: 6000 fc94 braw 48634 <_Heap_Walk+0x11e> return false; } if ( free_block->prev != prev_block ) { (*printer)( 489a2: 2f08 movel %a0,%sp@- 489a4: 2f09 movel %a1,%sp@- 489a6: 4879 0005 e17a pea 5e17a <_Status_Object_name_errors_to_status+0x252> return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( 489ac: 4878 0001 pea 1 489b0: 2f05 movel %d5,%sp@- 489b2: 4e95 jsr %a5@ "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 489b4: 4fef 0014 lea %sp@(20),%sp 489b8: 4200 clrb %d0 489ba: 6000 fe7e braw 4883a <_Heap_Walk+0x324> ); return false; } if ( _Heap_Is_used( free_block ) ) { 489be: 2049 moveal %a1,%a0 <== NOT EXECUTED (*printer)( 489c0: 2f08 movel %a0,%sp@- <== NOT EXECUTED 489c2: 4879 0005 e15e pea 5e15e <_Status_Object_name_errors_to_status+0x236><== NOT EXECUTED 489c8: 6000 fd4a braw 48714 <_Heap_Walk+0x1fe> <== NOT EXECUTED const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 489cc: 222a 0020 movel %a2@(32),%d1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 489d0: 2844 moveal %d4,%a4 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 489d2: 2d41 fff4 movel %d1,%fp@(-12) ); return false; } if ( _Heap_Is_used( free_block ) ) { 489d6: 222e fff4 movel %fp@(-12),%d1 489da: 2d43 fffc movel %d3,%fp@(-4) 489de: 262e ffec movel %fp@(-20),%d3 489e2: 2d47 fff0 movel %d7,%fp@(-16) 489e6: 6000 fdb0 braw 48798 <_Heap_Walk+0x282> ... =============================================================================== 00046f62 <_IO_Initialize_all_drivers>: * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { 46f62: 4e56 0000 linkw %fp,#0 46f66: 2f0a movel %a2,%sp@- 46f68: 2f02 movel %d2,%sp@- rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 46f6a: 4ab9 0005 f654 tstl 5f654 <_IO_Number_of_drivers> 46f70: 671e beqs 46f90 <_IO_Initialize_all_drivers+0x2e><== NEVER TAKEN 46f72: 4282 clrl %d2 46f74: 45f9 0004 bc18 lea 4bc18 ,%a2 (void) rtems_io_initialize( major, 0, NULL ); 46f7a: 42a7 clrl %sp@- 46f7c: 42a7 clrl %sp@- 46f7e: 2f02 movel %d2,%sp@- void _IO_Initialize_all_drivers( void ) { rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 46f80: 5282 addql #1,%d2 (void) rtems_io_initialize( major, 0, NULL ); 46f82: 4e92 jsr %a2@ void _IO_Initialize_all_drivers( void ) { rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 46f84: 4fef 000c lea %sp@(12),%sp 46f88: b4b9 0005 f654 cmpl 5f654 <_IO_Number_of_drivers>,%d2 46f8e: 65ea bcss 46f7a <_IO_Initialize_all_drivers+0x18> (void) rtems_io_initialize( major, 0, NULL ); } 46f90: 242e fff8 movel %fp@(-8),%d2 46f94: 246e fffc moveal %fp@(-4),%a2 46f98: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00046ec8 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { 46ec8: 4e56 fff0 linkw %fp,#-16 46ecc: 48d7 003c moveml %d2-%d5,%sp@ uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; 46ed0: 2639 0005 dc16 movel 5dc16 ,%d3 drivers_in_table = Configuration.number_of_device_drivers; 46ed6: 2439 0005 dc12 movel 5dc12 ,%d2 number_of_drivers = Configuration.maximum_drivers; 46edc: 2839 0005 dc0e movel 5dc0e ,%d4 /* * If the user claims there are less drivers than are actually in * the table, then let's just go with the table's count. */ if ( number_of_drivers <= drivers_in_table ) 46ee2: b882 cmpl %d2,%d4 46ee4: 6366 blss 46f4c <_IO_Manager_initialization+0x84> * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( 46ee6: 2004 movel %d4,%d0 46ee8: 2a04 movel %d4,%d5 46eea: e788 lsll #3,%d0 46eec: eb8d lsll #5,%d5 46eee: 9a80 subl %d0,%d5 46ef0: 2f05 movel %d5,%sp@- 46ef2: 4eb9 0004 9e38 jsr 49e38 <_Workspace_Allocate_or_fatal_error> sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 46ef8: 2f05 movel %d5,%sp@- 46efa: 42a7 clrl %sp@- /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 46efc: 23c0 0005 f658 movel %d0,5f658 <_IO_Driver_address_table> _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 46f02: 2f00 movel %d0,%sp@- _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 46f04: 23c4 0005 f654 movel %d4,5f654 <_IO_Number_of_drivers> memset( 46f0a: 4eb9 0004 e3f4 jsr 4e3f4 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 46f10: 4fef 0010 lea %sp@(16),%sp 46f14: 4a82 tstl %d2 46f16: 672a beqs 46f42 <_IO_Manager_initialization+0x7a><== NEVER TAKEN 46f18: 2839 0005 f658 movel 5f658 <_IO_Driver_address_table>,%d4 46f1e: 4280 clrl %d0 46f20: 4281 clrl %d1 _IO_Driver_address_table[index] = driver_table[index]; 46f22: 2243 moveal %d3,%a1 46f24: 2044 moveal %d4,%a0 46f26: d3c0 addal %d0,%a1 46f28: d1c0 addal %d0,%a0 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 46f2a: 5281 addql #1,%d1 46f2c: 0680 0000 0018 addil #24,%d0 _IO_Driver_address_table[index] = driver_table[index]; 46f32: 20d9 movel %a1@+,%a0@+ 46f34: 20d9 movel %a1@+,%a0@+ 46f36: 20d9 movel %a1@+,%a0@+ 46f38: 20d9 movel %a1@+,%a0@+ 46f3a: 20d9 movel %a1@+,%a0@+ 46f3c: 2091 movel %a1@,%a0@ memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 46f3e: b282 cmpl %d2,%d1 46f40: 65e0 bcss 46f22 <_IO_Manager_initialization+0x5a> _IO_Driver_address_table[index] = driver_table[index]; } 46f42: 4cee 003c fff0 moveml %fp@(-16),%d2-%d5 46f48: 4e5e unlk %fp 46f4a: 4e75 rts * If the maximum number of driver is the same as the number in the * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { _IO_Driver_address_table = driver_table; 46f4c: 23c3 0005 f658 movel %d3,5f658 <_IO_Driver_address_table> _IO_Number_of_drivers = number_of_drivers; 46f52: 23c2 0005 f654 movel %d2,5f654 <_IO_Number_of_drivers> sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) _IO_Driver_address_table[index] = driver_table[index]; } 46f58: 4cee 003c fff0 moveml %fp@(-16),%d2-%d5 46f5e: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00047ac4 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 47ac4: 4e56 fffc linkw %fp,#-4 47ac8: 206e 0010 moveal %fp@(16),%a0 47acc: 2f02 movel %d2,%sp@- 47ace: 222e 000c movel %fp@(12),%d1 _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 ); 47ad2: 4282 clrl %d2 47ad4: 1401 moveb %d1,%d2 47ad6: 2242 moveal %d2,%a1 47ad8: 2f08 movel %a0,%sp@- void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 47ada: 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 ); 47ade: 2f09 movel %a1,%sp@- Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; 47ae0: 13c1 0005 f4e2 moveb %d1,5f4e2 <_Internal_errors_What_happened+0x4> _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 47ae6: 2d48 fffc movel %a0,%fp@(-4) bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; 47aea: 23c0 0005 f4de movel %d0,5f4de <_Internal_errors_What_happened> _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; 47af0: 23c8 0005 f4e4 movel %a0,5f4e4 <_Internal_errors_What_happened+0x6> _User_extensions_Fatal( the_source, is_internal, the_error ); 47af6: 2f00 movel %d0,%sp@- 47af8: 4eb9 0004 99b6 jsr 499b6 <_User_extensions_Fatal> _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 47afe: 206e fffc moveal %fp@(-4),%a0 <== NOT EXECUTED 47b02: 327c 0700 moveaw #1792,%a1 <== NOT EXECUTED 47b06: 2409 movel %a1,%d2 <== NOT EXECUTED 47b08: 40c0 movew %sr,%d0 <== NOT EXECUTED 47b0a: 8082 orl %d2,%d0 <== NOT EXECUTED 47b0c: 46c0 movew %d0,%sr <== NOT EXECUTED 47b0e: 2008 movel %a0,%d0 <== NOT EXECUTED 47b10: 223c dead beef movel #-559038737,%d1 <== NOT EXECUTED 47b16: 4ac8 halt <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 47b18: 7005 moveq #5,%d0 <== NOT EXECUTED 47b1a: 4fef 000c lea %sp@(12),%sp <== NOT EXECUTED 47b1e: 23c0 0005 f590 movel %d0,5f590 <_System_state_Current> <== NOT EXECUTED 47b24: 60fe bras 47b24 <_Internal_error_Occurred+0x60> <== NOT EXECUTED ... =============================================================================== 00047b88 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 47b88: 4e56 fff0 linkw %fp,#-16 47b8c: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 47b90: 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 ) 47b94: 4aaa 0014 tstl %a2@(20) 47b98: 660c bnes 47ba6 <_Objects_Allocate+0x1e> <== ALWAYS TAKEN return NULL; 47b9a: 4280 clrl %d0 <== NOT EXECUTED ); } #endif return the_object; } 47b9c: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 47ba2: 4e5e unlk %fp 47ba4: 4e75 rts /* * 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 ); 47ba6: 240a movel %a2,%d2 47ba8: 0682 0000 001c addil #28,%d2 47bae: 47f9 0004 71e4 lea 471e4 <_Chain_Get>,%a3 47bb4: 2f02 movel %d2,%sp@- 47bb6: 4e93 jsr %a3@ if ( information->auto_extend ) { 47bb8: 588f addql #4,%sp 47bba: 4a2a 0010 tstb %a2@(16) 47bbe: 67dc beqs 47b9c <_Objects_Allocate+0x14> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { 47bc0: 4a80 tstl %d0 47bc2: 6738 beqs 47bfc <_Objects_Allocate+0x74> } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 47bc4: 2040 moveal %d0,%a0 47bc6: 4281 clrl %d1 47bc8: 4283 clrl %d3 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 47bca: 4282 clrl %d2 } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 47bcc: 362a 0008 movew %a2@(8),%d3 47bd0: 3228 000a movew %a0@(10),%d1 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 47bd4: 342a 0012 movew %a2@(18),%d2 information->inactive_per_block[ block ]--; 47bd8: 206a 002a moveal %a2@(42),%a0 } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 47bdc: 9283 subl %d3,%d1 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 47bde: 4c42 1001 remul %d2,%d1,%d1 information->inactive_per_block[ block ]--; information->inactive--; 47be2: 326a 0028 moveaw %a2@(40),%a1 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 47be6: e589 lsll #2,%d1 information->inactive--; 47be8: 5389 subql #1,%a1 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 47bea: d1c1 addal %d1,%a0 47bec: 5390 subql #1,%a0@ information->inactive--; 47bee: 3549 0028 movew %a1,%a2@(40) ); } #endif return the_object; } 47bf2: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 47bf8: 4e5e unlk %fp 47bfa: 4e75 rts * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { _Objects_Extend_information( information ); 47bfc: 2f0a movel %a2,%sp@- 47bfe: 4eb9 0004 7c44 jsr 47c44 <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 47c04: 2f02 movel %d2,%sp@- 47c06: 4e93 jsr %a3@ } if ( the_object ) { 47c08: 508f addql #8,%sp 47c0a: 4a80 tstl %d0 47c0c: 66b6 bnes 47bc4 <_Objects_Allocate+0x3c> ); } #endif return the_object; } 47c0e: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 47c14: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00047c18 <_Objects_Close>: RTEMS_INLINE_ROUTINE void _Objects_Invalidate_Id( Objects_Information *information, Objects_Control *the_object ) { _Objects_Set_local_object( 47c18: 4280 clrl %d0 void _Objects_Close( Objects_Information *information, Objects_Control *the_object ) { 47c1a: 4e56 0000 linkw %fp,#0 47c1e: 226e 000c moveal %fp@(12),%a1 47c22: 206e 0008 moveal %fp@(8),%a0 47c26: 2f0a movel %a2,%sp@- #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 47c28: 2468 0018 moveal %a0@(24),%a2 RTEMS_INLINE_ROUTINE void _Objects_Invalidate_Id( Objects_Information *information, Objects_Control *the_object ) { _Objects_Set_local_object( 47c2c: 3029 000a movew %a1@(10),%d0 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 47c30: 42b2 0c00 clrl %a2@(00000000,%d0:l:4) _Objects_Invalidate_Id( information, the_object ); _Objects_Namespace_remove( information, the_object ); } 47c34: 245f moveal %sp@+,%a2 Objects_Control *the_object ) { _Objects_Invalidate_Id( information, the_object ); _Objects_Namespace_remove( information, the_object ); 47c36: 2d49 000c movel %a1,%fp@(12) } 47c3a: 4e5e unlk %fp Objects_Control *the_object ) { _Objects_Invalidate_Id( information, the_object ); _Objects_Namespace_remove( information, the_object ); 47c3c: 4ef9 0004 818c jmp 4818c <_Objects_Namespace_remove> ... =============================================================================== 00047c44 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { 47c44: 4e56 ffcc linkw %fp,#-52 47c48: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 47c4c: 246e 0008 moveal %fp@(8),%a2 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 47c50: 4285 clrl %d5 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 47c52: 206a 002e moveal %a2@(46),%a0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 47c56: 3a2a 0008 movew %a2@(8),%d5 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 47c5a: 4a88 tstl %a0 47c5c: 6700 022c beqw 47e8a <_Objects_Extend_information+0x246> block_count = 0; else { block_count = information->maximum / information->allocation_size; 47c60: 322a 000e movew %a2@(14),%d1 47c64: 302a 0012 movew %a2@(18),%d0 47c68: 3801 movew %d1,%d4 47c6a: 0284 0000 ffff andil #65535,%d4 47c70: 88c0 divuw %d0,%d4 47c72: 0284 0000 ffff andil #65535,%d4 for ( ; block < block_count; block++ ) { 47c78: 6700 0226 beqw 47ea0 <_Objects_Extend_information+0x25c> if ( information->object_blocks[ block ] == NULL ) { 47c7c: 4a90 tstl %a0@ 47c7e: 6700 0230 beqw 47eb0 <_Objects_Extend_information+0x26c> * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 47c82: 5888 addql #4,%a0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 47c84: 2605 movel %d5,%d3 index_base = minimum_index; block = 0; 47c86: 4282 clrl %d2 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { 47c88: 0280 0000 ffff andil #65535,%d0 do_extend = false; break; } else index_base += information->allocation_size; 47c8e: d680 addl %d0,%d3 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 47c90: 5282 addql #1,%d2 47c92: b484 cmpl %d4,%d2 47c94: 6400 01a0 bccw 47e36 <_Objects_Extend_information+0x1f2> if ( information->object_blocks[ block ] == NULL ) { 47c98: 4a98 tstl %a0@+ 47c9a: 66f2 bnes 47c8e <_Objects_Extend_information+0x4a> do_extend = false; 47c9c: 4207 clrb %d7 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 47c9e: 0281 0000 ffff andil #65535,%d1 47ca4: 2641 moveal %d1,%a3 47ca6: d7c0 addal %d0,%a3 /* * We need to limit the number of objects to the maximum number * representable in the index portion of the object Id. In the * case of 16-bit Ids, this is only 256 object instances. */ if ( maximum > OBJECTS_ID_FINAL_INDEX ) { 47ca8: b7fc 0000 ffff cmpal #65535,%a3 47cae: 6200 017c bhiw 47e2c <_Objects_Extend_information+0x1e8> /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; 47cb2: 41ea 0014 lea %a2@(20),%a0 47cb6: 4c10 0800 mulsl %a0@,%d0 if ( information->auto_extend ) { 47cba: 4a2a 0010 tstb %a2@(16) 47cbe: 6700 017c beqw 47e3c <_Objects_Extend_information+0x1f8> new_object_block = _Workspace_Allocate( block_size ); 47cc2: 2f00 movel %d0,%sp@- 47cc4: 4eb9 0004 9e02 jsr 49e02 <_Workspace_Allocate> if ( !new_object_block ) 47cca: 588f addql #4,%sp * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; if ( information->auto_extend ) { new_object_block = _Workspace_Allocate( block_size ); 47ccc: 2c00 movel %d0,%d6 if ( !new_object_block ) 47cce: 6700 015c beqw 47e2c <_Objects_Extend_information+0x1e8> } /* * Do we need to grow the tables? */ if ( do_extend ) { 47cd2: 4a07 tstb %d7 47cd4: 6700 00be beqw 47d94 <_Objects_Extend_information+0x150> */ /* * Up the block count and maximum */ block_count++; 47cd8: 2a44 moveal %d4,%a5 47cda: 528d addql #1,%a5 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); 47cdc: 200b movel %a3,%d0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 47cde: 41f5 da00 lea %a5@(00000000,%a5:l:2),%a0 ((maximum + minimum_index) * sizeof(Objects_Control *)); 47ce2: d088 addl %a0,%d0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 47ce4: d085 addl %d5,%d0 block_count++; /* * Allocate the tables and break it up. */ block_size = block_count * 47ce6: e588 lsll #2,%d0 (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); 47ce8: 2f00 movel %d0,%sp@- 47cea: 4eb9 0004 9e02 jsr 49e02 <_Workspace_Allocate> if ( !object_blocks ) { 47cf0: 588f addql #4,%sp * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); 47cf2: 2840 moveal %d0,%a4 if ( !object_blocks ) { 47cf4: 4a80 tstl %d0 47cf6: 6700 01c8 beqw 47ec0 <_Objects_Extend_information+0x27c> } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( 47cfa: 2e0d movel %a5,%d7 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 47cfc: 4280 clrl %d0 } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( 47cfe: e58f lsll #2,%d7 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 47d00: 302a 000e movew %a2@(14),%d0 47d04: 4bf4 7800 lea %a4@(00000000,%d7:l),%a5 47d08: de8d addl %a5,%d7 47d0a: b085 cmpl %d5,%d0 47d0c: 6200 013e bhiw 47e4c <_Objects_Extend_information+0x208> } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 47d10: 4a85 tstl %d5 47d12: 670c beqs 47d20 <_Objects_Extend_information+0xdc><== NEVER TAKEN 47d14: 2047 moveal %d7,%a0 47d16: 4280 clrl %d0 local_table[ index ] = NULL; 47d18: 4298 clrl %a0@+ } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 47d1a: 5280 addql #1,%d0 47d1c: b085 cmpl %d5,%d0 47d1e: 65f8 bcss 47d18 <_Objects_Extend_information+0xd4><== NEVER TAKEN 47d20: e58c lsll #2,%d4 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 47d22: 4281 clrl %d1 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 47d24: 42b4 4800 clrl %a4@(00000000,%d4:l) inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 47d28: 322a 0012 movew %a2@(18),%d1 /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; 47d2c: 42b5 4800 clrl %a5@(00000000,%d4:l) for ( index=index_base ; index < ( information->allocation_size + index_base ); 47d30: d283 addl %d3,%d1 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 47d32: b283 cmpl %d3,%d1 47d34: 6310 blss 47d46 <_Objects_Extend_information+0x102><== NEVER TAKEN 47d36: 2247 moveal %d7,%a1 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 47d38: 2003 movel %d3,%d0 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 47d3a: 41f1 3c00 lea %a1@(00000000,%d3:l:4),%a0 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; 47d3e: 4298 clrl %a0@+ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { 47d40: 5280 addql #1,%d0 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 47d42: b280 cmpl %d0,%d1 47d44: 62f8 bhis 47d3e <_Objects_Extend_information+0xfa> index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; } _ISR_Disable( level ); 47d46: 203c 0000 0700 movel #1792,%d0 47d4c: 40c4 movew %sr,%d4 47d4e: 8084 orl %d4,%d0 47d50: 46c0 movew %d0,%sr uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 47d52: 2012 movel %a2@,%d0 47d54: 7a18 moveq #24,%d5 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 47d56: 4281 clrl %d1 47d58: eba8 lsll %d5,%d0 47d5a: 322a 0004 movew %a2@(4),%d1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 47d5e: 1a3c 001b moveb #27,%d5 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 47d62: 08c0 0010 bset #16,%d0 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 47d66: eba9 lsll %d5,%d1 47d68: 4285 clrl %d5 47d6a: 8081 orl %d1,%d0 47d6c: 3a0b movew %a3,%d5 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; 47d6e: 206a 002e moveal %a2@(46),%a0 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 47d72: 8085 orl %d5,%d0 information->object_blocks = object_blocks; 47d74: 254c 002e movel %a4,%a2@(46) information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; 47d78: 354b 000e movew %a3,%a2@(14) _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; 47d7c: 254d 002a movel %a5,%a2@(42) information->local_table = local_table; 47d80: 2547 0018 movel %d7,%a2@(24) 47d84: 2540 000a movel %d0,%a2@(10) information->the_class, _Objects_Local_node, information->maximum ); _ISR_Enable( level ); 47d88: 46c4 movew %d4,%sr _Workspace_Free( old_tables ); 47d8a: 2f08 movel %a0,%sp@- 47d8c: 4eb9 0004 9e1e jsr 49e1e <_Workspace_Free> 47d92: 588f addql #4,%sp } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 47d94: 206a 002e moveal %a2@(46),%a0 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 47d98: 4280 clrl %d0 47d9a: 280e movel %fp,%d4 47d9c: 0684 ffff fff4 addil #-12,%d4 47da2: 47f9 0004 71e4 lea 471e4 <_Chain_Get>,%a3 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 47da8: 2a0a movel %a2,%d5 47daa: 0685 0000 001c addil #28,%d5 47db0: 49f9 0004 7184 lea 47184 <_Chain_Append>,%a4 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 47db6: e58a lsll #2,%d2 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 47db8: 302a 0012 movew %a2@(18),%d0 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 47dbc: 2186 2800 movel %d6,%a0@(00000000,%d2:l) /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 47dc0: 2f2a 0014 movel %a2@(20),%sp@- 47dc4: 2f00 movel %d0,%sp@- 47dc6: 2f06 movel %d6,%sp@- 47dc8: 2f04 movel %d4,%sp@- 47dca: 4eb9 0004 bc60 jsr 4bc60 <_Chain_Initialize> /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 47dd0: 4fef 0010 lea %sp@(16),%sp 47dd4: 2f04 movel %d4,%sp@- 47dd6: 4e93 jsr %a3@ 47dd8: 588f addql #4,%sp 47dda: 4a80 tstl %d0 47ddc: 6734 beqs 47e12 <_Objects_Extend_information+0x1ce><== NEVER TAKEN 47dde: 2212 movel %a2@,%d1 47de0: 7e18 moveq #24,%d7 the_object->id = _Objects_Build_id( 47de2: 4286 clrl %d6 47de4: 2040 moveal %d0,%a0 47de6: 3c2a 0004 movew %a2@(4),%d6 47dea: efa9 lsll %d7,%d1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 47dec: 1e3c 001b moveb #27,%d7 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 47df0: 08c1 0010 bset #16,%d1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 47df4: efae lsll %d7,%d6 47df6: 8286 orl %d6,%d1 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 47df8: 8283 orl %d3,%d1 index ); _Chain_Append( &information->Inactive, &the_object->Node ); index++; 47dfa: 5283 addql #1,%d3 47dfc: 2141 0008 movel %d1,%a0@(8) information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 47e00: 2f00 movel %d0,%sp@- 47e02: 2f05 movel %d5,%sp@- 47e04: 4e94 jsr %a4@ index++; 47e06: 508f addql #8,%sp /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 47e08: 2f04 movel %d4,%sp@- 47e0a: 4e93 jsr %a3@ 47e0c: 588f addql #4,%sp 47e0e: 4a80 tstl %d0 47e10: 66cc bnes 47dde <_Objects_Extend_information+0x19a> _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 47e12: 4281 clrl %d1 47e14: 302a 0012 movew %a2@(18),%d0 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 47e18: 326a 0028 moveaw %a2@(40),%a1 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 47e1c: 206a 002a moveal %a2@(42),%a0 47e20: 3200 movew %d0,%d1 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 47e22: d089 addl %a1,%d0 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 47e24: 2181 2800 movel %d1,%a0@(00000000,%d2:l) information->inactive = 47e28: 3540 0028 movew %d0,%a2@(40) (Objects_Maximum)(information->inactive + information->allocation_size); } 47e2c: 4cee 3cfc ffcc moveml %fp@(-52),%d2-%d7/%a2-%a5 47e32: 4e5e unlk %fp 47e34: 4e75 rts /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 47e36: 7e01 moveq #1,%d7 47e38: 6000 fe64 braw 47c9e <_Objects_Extend_information+0x5a> if ( information->auto_extend ) { new_object_block = _Workspace_Allocate( block_size ); if ( !new_object_block ) return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); 47e3c: 2f00 movel %d0,%sp@- 47e3e: 4eb9 0004 9e38 jsr 49e38 <_Workspace_Allocate_or_fatal_error> 47e44: 588f addql #4,%sp 47e46: 2c00 movel %d0,%d6 47e48: 6000 fe88 braw 47cd2 <_Objects_Extend_information+0x8e> /* * Copy each section of the table over. This has to be performed as * separate parts as size of each block has changed. */ memcpy( object_blocks, 47e4c: e58c lsll #2,%d4 47e4e: 2f04 movel %d4,%sp@- 47e50: 2f2a 002e movel %a2@(46),%sp@- 47e54: 2f0c movel %a4,%sp@- 47e56: 4eb9 0004 e384 jsr 4e384 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, 47e5c: 2f04 movel %d4,%sp@- 47e5e: 2f2a 002a movel %a2@(42),%sp@- 47e62: 2f0d movel %a5,%sp@- 47e64: 4eb9 0004 e384 jsr 4e384 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 47e6a: 4280 clrl %d0 47e6c: 302a 000e movew %a2@(14),%d0 47e70: da80 addl %d0,%d5 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 47e72: e58d lsll #2,%d5 47e74: 2f05 movel %d5,%sp@- 47e76: 2f2a 0018 movel %a2@(24),%sp@- 47e7a: 2f07 movel %d7,%sp@- 47e7c: 4eb9 0004 e384 jsr 4e384 47e82: 4fef 0024 lea %sp@(36),%sp 47e86: 6000 fe9a braw 47d22 <_Objects_Extend_information+0xde> minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 47e8a: 4280 clrl %d0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 47e8c: 2605 movel %d5,%d3 index_base = minimum_index; block = 0; 47e8e: 4282 clrl %d2 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; 47e90: 4284 clrl %d4 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 47e92: 322a 000e movew %a2@(14),%d1 47e96: 302a 0012 movew %a2@(18),%d0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 47e9a: 7e01 moveq #1,%d7 47e9c: 6000 fe00 braw 47c9e <_Objects_Extend_information+0x5a> minimum_index = _Objects_Get_index( information->minimum_id ); 47ea0: 2605 movel %d5,%d3 <== NOT EXECUTED index_base = minimum_index; block = 0; 47ea2: 4282 clrl %d2 <== NOT EXECUTED if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 47ea4: 0280 0000 ffff andil #65535,%d0 <== NOT EXECUTED /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 47eaa: 7e01 moveq #1,%d7 <== NOT EXECUTED 47eac: 6000 fdf0 braw 47c9e <_Objects_Extend_information+0x5a><== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); 47eb0: 2605 movel %d5,%d3 <== NOT EXECUTED index_base = minimum_index; block = 0; 47eb2: 4282 clrl %d2 <== NOT EXECUTED block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { 47eb4: 0280 0000 ffff andil #65535,%d0 <== NOT EXECUTED do_extend = false; 47eba: 4207 clrb %d7 <== NOT EXECUTED 47ebc: 6000 fde0 braw 47c9e <_Objects_Extend_information+0x5a><== NOT EXECUTED (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); if ( !object_blocks ) { _Workspace_Free( new_object_block ); 47ec0: 2f06 movel %d6,%sp@- 47ec2: 4eb9 0004 9e1e jsr 49e1e <_Workspace_Free> return; 47ec8: 588f addql #4,%sp } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); } 47eca: 4cee 3cfc ffcc moveml %fp@(-52),%d2-%d7/%a2-%a5 47ed0: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00047f84 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 47f84: 4e56 0000 linkw %fp,#0 47f88: 2f02 movel %d2,%sp@- 47f8a: 342e 000e movew %fp@(14),%d2 Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 47f8e: 660a bnes 47f9a <_Objects_Get_information+0x16> if ( the_class > (uint32_t) the_class_api_maximum ) return NULL; if ( !_Objects_Information_table[ the_api ] ) return NULL; 47f90: 4280 clrl %d0 if ( info->maximum == 0 ) return NULL; #endif return info; } 47f92: 242e fffc movel %fp@(-4),%d2 47f96: 4e5e unlk %fp 47f98: 4e75 rts /* * This call implicitly validates the_api so we do not call * _Objects_Is_api_valid above here. */ the_class_api_maximum = _Objects_API_maximum_class( the_api ); 47f9a: 2f2e 0008 movel %fp@(8),%sp@- 47f9e: 4eb9 0004 c170 jsr 4c170 <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) 47fa4: 588f addql #4,%sp 47fa6: 4a80 tstl %d0 47fa8: 67e6 beqs 47f90 <_Objects_Get_information+0xc> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 47faa: 0282 0000 ffff andil #65535,%d2 47fb0: b480 cmpl %d0,%d2 47fb2: 62dc bhis 47f90 <_Objects_Get_information+0xc> return NULL; if ( !_Objects_Information_table[ the_api ] ) 47fb4: 202e 0008 movel %fp@(8),%d0 47fb8: 41f9 0005 f404 lea 5f404 <_Objects_Information_table>,%a0 47fbe: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0 47fc2: 4a88 tstl %a0 47fc4: 67ca beqs 47f90 <_Objects_Get_information+0xc> <== NEVER TAKEN return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 47fc6: 2030 2c00 movel %a0@(00000000,%d2:l:4),%d0 if ( !info ) 47fca: 67c6 beqs 47f92 <_Objects_Get_information+0xe> <== NEVER TAKEN * Thus we may have 0 local instances and still have a valid object * pointer. */ #if !defined(RTEMS_MULTIPROCESSING) if ( info->maximum == 0 ) return NULL; 47fcc: 2040 moveal %d0,%a0 47fce: 4a68 000e tstw %a0@(14) 47fd2: 56c1 sne %d1 #endif return info; } 47fd4: 242e fffc movel %fp@(-4),%d2 * Thus we may have 0 local instances and still have a valid object * pointer. */ #if !defined(RTEMS_MULTIPROCESSING) if ( info->maximum == 0 ) return NULL; 47fd8: 49c1 extbl %d1 #endif return info; } 47fda: 4e5e unlk %fp * Thus we may have 0 local instances and still have a valid object * pointer. */ #if !defined(RTEMS_MULTIPROCESSING) if ( info->maximum == 0 ) return NULL; 47fdc: c081 andl %d1,%d0 <== NOT EXECUTED #endif return info; } =============================================================================== 00049a7c <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { 49a7c: 4e56 ffe0 linkw %fp,#-32 49a80: 48d7 043c moveml %d2-%d5/%a2,%sp@ 49a84: 262e 000c movel %fp@(12),%d3 49a88: 242e 0010 movel %fp@(16),%d2 char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) 49a8c: 4a83 tstl %d3 49a8e: 660e bnes 49a9e <_Objects_Get_name_as_string+0x22> #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; 49a90: 4282 clrl %d2 _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } 49a92: 2002 movel %d2,%d0 49a94: 4cee 043c ffe0 moveml %fp@(-32),%d2-%d5/%a2 49a9a: 4e5e unlk %fp 49a9c: 4e75 rts Objects_Id tmpId; if ( length == 0 ) return NULL; if ( name == NULL ) 49a9e: 4a82 tstl %d2 49aa0: 67f0 beqs 49a92 <_Objects_Get_name_as_string+0x16> return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 49aa2: 4aae 0008 tstl %fp@(8) 49aa6: 6600 00b0 bnew 49b58 <_Objects_Get_name_as_string+0xdc> 49aaa: 2079 0006 214c moveal 6214c <_Per_CPU_Information+0xc>,%a0 49ab0: 2828 0008 movel %a0@(8),%d4 information = _Objects_Get_information_id( tmpId ); 49ab4: 2f04 movel %d4,%sp@- 49ab6: 4eb9 0004 9994 jsr 49994 <_Objects_Get_information_id> if ( !information ) 49abc: 588f addql #4,%sp 49abe: 4a80 tstl %d0 49ac0: 67ce beqs 49a90 <_Objects_Get_name_as_string+0x14> return NULL; the_object = _Objects_Get( information, tmpId, &location ); 49ac2: 486e fffc pea %fp@(-4) 49ac6: 2f04 movel %d4,%sp@- 49ac8: 2f00 movel %d0,%sp@- 49aca: 4eb9 0004 9b6c jsr 49b6c <_Objects_Get> switch ( location ) { 49ad0: 4fef 000c lea %sp@(12),%sp 49ad4: 4aae fffc tstl %fp@(-4) 49ad8: 66b6 bnes 49a90 <_Objects_Get_name_as_string+0x14> if ( information->is_string ) { s = the_object->name.name_p; } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; 49ada: 2040 moveal %d0,%a0 lname[ 0 ] = (u32_name >> 24) & 0xff; 49adc: 7818 moveq #24,%d4 s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 49ade: 2a03 movel %d3,%d5 49ae0: 5385 subql #1,%d5 if ( information->is_string ) { s = the_object->name.name_p; } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; 49ae2: 2228 000c movel %a0@(12),%d1 lname[ 0 ] = (u32_name >> 24) & 0xff; 49ae6: 2001 movel %d1,%d0 49ae8: e8a8 lsrl %d4,%d0 lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; 49aea: 2801 movel %d1,%d4 #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; 49aec: 2601 movel %d1,%d3 lname[ 2 ] = (u32_name >> 8) & 0xff; 49aee: e08c lsrl #8,%d4 lname[ 3 ] = (u32_name >> 0) & 0xff; 49af0: 1d41 fffa moveb %d1,%fp@(-6) #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; 49af4: 4243 clrw %d3 49af6: 4843 swap %d3 lname[ 2 ] = (u32_name >> 8) & 0xff; lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; 49af8: 4201 clrb %d1 } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; 49afa: 1d40 fff7 moveb %d0,%fp@(-9) lname[ 1 ] = (u32_name >> 16) & 0xff; 49afe: 1d43 fff8 moveb %d3,%fp@(-8) lname[ 2 ] = (u32_name >> 8) & 0xff; 49b02: 1d44 fff9 moveb %d4,%fp@(-7) lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; 49b06: 1d41 fffb moveb %d1,%fp@(-5) s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 49b0a: 4a85 tstl %d5 49b0c: 6752 beqs 49b60 <_Objects_Get_name_as_string+0xe4><== NEVER TAKEN 49b0e: 4a00 tstb %d0 49b10: 674e beqs 49b60 <_Objects_Get_name_as_string+0xe4> 49b12: 45ee fff8 lea %fp@(-8),%a2 49b16: 2042 moveal %d2,%a0 49b18: 4281 clrl %d1 *d = (isprint((unsigned char)*s)) ? *s : '*'; 49b1a: 4283 clrl %d3 49b1c: 1600 moveb %d0,%d3 49b1e: 2279 0006 0534 moveal 60534 <__ctype_ptr__>,%a1 49b24: 1800 moveb %d0,%d4 49b26: 1031 3801 moveb %a1@(00000001,%d3:l),%d0 49b2a: 49c0 extbl %d0 49b2c: 0280 0000 0097 andil #151,%d0 49b32: 6602 bnes 49b36 <_Objects_Get_name_as_string+0xba> 49b34: 782a moveq #42,%d4 s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 49b36: 5281 addql #1,%d1 *d = (isprint((unsigned char)*s)) ? *s : '*'; 49b38: 10c4 moveb %d4,%a0@+ s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 49b3a: 2248 moveal %a0,%a1 49b3c: ba81 cmpl %d1,%d5 49b3e: 6304 blss 49b44 <_Objects_Get_name_as_string+0xc8> 49b40: 101a moveb %a2@+,%d0 49b42: 66d6 bnes 49b1a <_Objects_Get_name_as_string+0x9e> *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; 49b44: 4211 clrb %a1@ _Thread_Enable_dispatch(); 49b46: 4eb9 0004 a782 jsr 4a782 <_Thread_Enable_dispatch> return name; } return NULL; /* unreachable path */ } 49b4c: 2002 movel %d2,%d0 49b4e: 4cee 043c ffe0 moveml %fp@(-32),%d2-%d5/%a2 49b54: 4e5e unlk %fp 49b56: 4e75 rts return NULL; if ( name == NULL ) return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 49b58: 282e 0008 movel %fp@(8),%d4 49b5c: 6000 ff56 braw 49ab4 <_Objects_Get_name_as_string+0x38> s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 49b60: 2242 moveal %d2,%a1 *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; 49b62: 4211 clrb %a1@ _Thread_Enable_dispatch(); 49b64: 4eb9 0004 a782 jsr 4a782 <_Thread_Enable_dispatch> 49b6a: 60e0 bras 49b4c <_Objects_Get_name_as_string+0xd0> =============================================================================== 0005bb74 <_Objects_Get_no_protection>: /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; 5bb74: 7001 moveq #1,%d0 if ( information->maximum >= index ) { 5bb76: 4281 clrl %d1 Objects_Control *_Objects_Get_no_protection( Objects_Information *information, Objects_Id id, Objects_Locations *location ) { 5bb78: 4e56 0000 linkw %fp,#0 5bb7c: 206e 0008 moveal %fp@(8),%a0 /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; 5bb80: 90a8 0006 subl %a0@(6),%d0 5bb84: d0ae 000c addl %fp@(12),%d0 if ( information->maximum >= index ) { 5bb88: 3228 000e movew %a0@(14),%d1 Objects_Control *_Objects_Get_no_protection( Objects_Information *information, Objects_Id id, Objects_Locations *location ) { 5bb8c: 226e 0010 moveal %fp@(16),%a1 * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; if ( information->maximum >= index ) { 5bb90: b280 cmpl %d0,%d1 5bb92: 6510 bcss 5bba4 <_Objects_Get_no_protection+0x30> if ( (the_object = information->local_table[ index ]) != NULL ) { 5bb94: 2068 0018 moveal %a0@(24),%a0 5bb98: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 5bb9c: 6706 beqs 5bba4 <_Objects_Get_no_protection+0x30><== NEVER TAKEN *location = OBJECTS_LOCAL; 5bb9e: 4291 clrl %a1@ * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; return NULL; } 5bba0: 4e5e unlk %fp 5bba2: 4e75 rts /* * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; 5bba4: 7001 moveq #1,%d0 return NULL; } 5bba6: 4e5e unlk %fp /* * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; 5bba8: 2280 movel %d0,%a1@ return NULL; 5bbaa: 4280 clrl %d0 } ... =============================================================================== 0004979c <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 4979c: 4e56 fffc linkw %fp,#-4 497a0: 222e 0008 movel %fp@(8),%d1 497a4: 2f02 movel %d2,%sp@- /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 497a6: 4a81 tstl %d1 497a8: 660a bnes 497b4 <_Objects_Id_to_name+0x18> 497aa: 2079 0006 12bc moveal 612bc <_Per_CPU_Information+0xc>,%a0 497b0: 2228 0008 movel %a0@(8),%d1 497b4: 7418 moveq #24,%d2 497b6: 2001 movel %d1,%d0 497b8: e4a8 lsrl %d2,%d0 497ba: 143c 0007 moveb #7,%d2 497be: c082 andl %d2,%d0 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) 497c0: 143c 0002 moveb #2,%d2 497c4: 2040 moveal %d0,%a0 497c6: 5388 subql #1,%a0 497c8: b488 cmpl %a0,%d2 497ca: 654a bcss 49816 <_Objects_Id_to_name+0x7a> the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 497cc: 41f9 0006 10dc lea 610dc <_Objects_Information_table>,%a0 497d2: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0 497d6: 4a88 tstl %a0 497d8: 673c beqs 49816 <_Objects_Id_to_name+0x7a> */ RTEMS_INLINE_ROUTINE uint32_t _Objects_Get_class( Objects_Id id ) { return (uint32_t) 497da: 2001 movel %d1,%d0 497dc: 741b moveq #27,%d2 497de: e4a8 lsrl %d2,%d0 return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 497e0: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 if ( !information ) 497e4: 6730 beqs 49816 <_Objects_Id_to_name+0x7a> <== NEVER TAKEN #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 497e6: 486e fffc pea %fp@(-4) 497ea: 2f01 movel %d1,%sp@- 497ec: 2f00 movel %d0,%sp@- 497ee: 4eb9 0004 9730 jsr 49730 <_Objects_Get> if ( !the_object ) 497f4: 4fef 000c lea %sp@(12),%sp 497f8: 4a80 tstl %d0 497fa: 671a beqs 49816 <_Objects_Id_to_name+0x7a> return OBJECTS_INVALID_ID; *name = the_object->name; 497fc: 206e 000c moveal %fp@(12),%a0 49800: 2240 moveal %d0,%a1 49802: 20a9 000c movel %a1@(12),%a0@ _Thread_Enable_dispatch(); 49806: 4eb9 0004 a44a jsr 4a44a <_Thread_Enable_dispatch> return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 4980c: 242e fff8 movel %fp@(-8),%d2 if ( !the_object ) return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 49810: 4280 clrl %d0 } 49812: 4e5e unlk %fp 49814: 4e75 rts 49816: 242e fff8 movel %fp@(-8),%d2 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) return OBJECTS_INVALID_ID; 4981a: 7003 moveq #3,%d0 return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 4981c: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 0004821c <_Objects_Shrink_information>: /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / 4821c: 4281 clrl %d1 */ void _Objects_Shrink_information( Objects_Information *information ) { 4821e: 4e56 ffec linkw %fp,#-20 48222: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 48226: 246e 0008 moveal %fp@(8),%a2 /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); 4822a: 4282 clrl %d2 block_count = (information->maximum - index_base) / 4822c: 4283 clrl %d3 /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); 4822e: 342a 0008 movew %a2@(8),%d2 block_count = (information->maximum - index_base) / 48232: 362a 000e movew %a2@(14),%d3 48236: 322a 0012 movew %a2@(18),%d1 4823a: 9682 subl %d2,%d3 4823c: 4c41 3003 remul %d1,%d3,%d3 information->allocation_size; for ( block = 0; block < block_count; block++ ) { 48240: 6774 beqs 482b6 <_Objects_Shrink_information+0x9a><== NEVER TAKEN if ( information->inactive_per_block[ block ] == 48242: 206a 002a moveal %a2@(42),%a0 48246: b290 cmpl %a0@,%d1 48248: 677e beqs 482c8 <_Objects_Shrink_information+0xac><== NEVER TAKEN * the_block - the block to remove * * Output parameters: NONE */ void _Objects_Shrink_information( 4824a: 5888 addql #4,%a0 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 4824c: 4280 clrl %d0 4824e: 5280 addql #1,%d0 information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; 48250: d481 addl %d1,%d2 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 48252: b083 cmpl %d3,%d0 48254: 6460 bccs 482b6 <_Objects_Shrink_information+0x9a> information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; 48256: 2800 movel %d0,%d4 48258: e58c lsll #2,%d4 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { if ( information->inactive_per_block[ block ] == 4825a: b298 cmpl %a0@+,%d1 4825c: 66f0 bnes 4824e <_Objects_Shrink_information+0x32> information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); 4825e: 206a 001c moveal %a2@(28),%a0 */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); 48262: 47f9 0004 71bc lea 471bc <_Chain_Extract>,%a3 * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); do { index = _Objects_Get_index( the_object->id ); 48268: 4280 clrl %d0 4826a: 3028 000a movew %a0@(10),%d0 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; 4826e: 2610 movel %a0@,%d3 if ((index >= index_base) && 48270: b480 cmpl %d0,%d2 48272: 620c bhis 48280 <_Objects_Shrink_information+0x64> (index < (index_base + information->allocation_size))) { 48274: 4281 clrl %d1 48276: 322a 0012 movew %a2@(18),%d1 4827a: d282 addl %d2,%d1 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && 4827c: b280 cmpl %d0,%d1 4827e: 6240 bhis 482c0 <_Objects_Shrink_information+0xa4> (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); 48280: 4a83 tstl %d3 48282: 6704 beqs 48288 <_Objects_Shrink_information+0x6c> index = _Objects_Get_index( the_object->id ); /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; 48284: 2043 moveal %d3,%a0 48286: 60e0 bras 48268 <_Objects_Shrink_information+0x4c> while ( the_object ); /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); 48288: 206a 002e moveal %a2@(46),%a0 4828c: 2f30 4800 movel %a0@(00000000,%d4:l),%sp@- 48290: 4eb9 0004 9e1e jsr 49e1e <_Workspace_Free> information->object_blocks[ block ] = NULL; 48296: 206a 002e moveal %a2@(46),%a0 information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; return; 4829a: 588f addql #4,%sp /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; 4829c: 42b0 4800 clrl %a0@(00000000,%d4:l) information->inactive_per_block[ block ] = 0; 482a0: 206a 002a moveal %a2@(42),%a0 information->inactive -= information->allocation_size; 482a4: 302a 0028 movew %a2@(40),%d0 482a8: 322a 0012 movew %a2@(18),%d1 * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; 482ac: 42b0 4800 clrl %a0@(00000000,%d4:l) information->inactive -= information->allocation_size; 482b0: 9081 subl %d1,%d0 482b2: 3540 0028 movew %d0,%a2@(40) return; } index_base += information->allocation_size; } } 482b6: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 482bc: 4e5e unlk %fp 482be: 4e75 rts */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); 482c0: 2f08 movel %a0,%sp@- 482c2: 4e93 jsr %a3@ 482c4: 588f addql #4,%sp 482c6: 60b8 bras 48280 <_Objects_Shrink_information+0x64> information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); 482c8: 206a 001c moveal %a2@(28),%a0 <== NOT EXECUTED index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { if ( information->inactive_per_block[ block ] == 482cc: 4284 clrl %d4 <== NOT EXECUTED */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); 482ce: 47f9 0004 71bc lea 471bc <_Chain_Extract>,%a3 <== NOT EXECUTED 482d4: 6092 bras 48268 <_Objects_Shrink_information+0x4c><== NOT EXECUTED ... =============================================================================== 0004bab6 <_RTEMS_tasks_Create_extension>: bool _RTEMS_tasks_Create_extension( Thread_Control *executing, Thread_Control *created ) { 4bab6: 4e56 0000 linkw %fp,#0 4baba: 2f0a movel %a2,%sp@- 4babc: 246e 000c moveal %fp@(12),%a2 /* * Notepads must be the last entry in the structure and they * can be left off if disabled in the configuration. */ to_allocate = sizeof( RTEMS_API_Control ); if ( !rtems_configuration_get_notepads_enabled() ) 4bac0: 4a39 0005 dbb4 tstb 5dbb4 4bac6: 6758 beqs 4bb20 <_RTEMS_tasks_Create_extension+0x6a> /* * Notepads must be the last entry in the structure and they * can be left off if disabled in the configuration. */ to_allocate = sizeof( RTEMS_API_Control ); 4bac8: 705e moveq #94,%d0 if ( !rtems_configuration_get_notepads_enabled() ) to_allocate -= (RTEMS_NUMBER_NOTEPADS * sizeof(uint32_t)); api = _Workspace_Allocate( to_allocate ); 4baca: 2f00 movel %d0,%sp@- 4bacc: 4eb9 0004 9e02 jsr 49e02 <_Workspace_Allocate> if ( !api ) 4bad2: 588f addql #4,%sp */ to_allocate = sizeof( RTEMS_API_Control ); if ( !rtems_configuration_get_notepads_enabled() ) to_allocate -= (RTEMS_NUMBER_NOTEPADS * sizeof(uint32_t)); api = _Workspace_Allocate( to_allocate ); 4bad4: 2040 moveal %d0,%a0 if ( !api ) 4bad6: 4a80 tstl %d0 4bad8: 6758 beqs 4bb32 <_RTEMS_tasks_Create_extension+0x7c> return false; created->API_Extensions[ THREAD_API_RTEMS ] = api; 4bada: 2540 00fc movel %d0,%a2@(252) */ RTEMS_INLINE_ROUTINE void _ASR_Initialize ( ASR_Information *information ) { information->is_enabled = false; 4bade: 4200 clrb %d0 api->pending_events = EVENT_SETS_NONE_PENDING; 4bae0: 4290 clrl %a0@ 4bae2: 1140 0008 moveb %d0,%a0@(8) api->event_condition = 0; 4bae6: 42a8 0004 clrl %a0@(4) information->handler = NULL; 4baea: 42a8 000a clrl %a0@(10) information->mode_set = RTEMS_DEFAULT_MODES; 4baee: 42a8 000e clrl %a0@(14) information->signals_posted = 0; 4baf2: 42a8 0012 clrl %a0@(18) information->signals_pending = 0; 4baf6: 42a8 0016 clrl %a0@(22) information->nest_level = 0; 4bafa: 42a8 001a clrl %a0@(26) _ASR_Initialize( &api->Signal ); created->task_variables = NULL; 4bafe: 42aa 0108 clrl %a2@(264) if ( rtems_configuration_get_notepads_enabled() ) { 4bb02: 4a39 0005 dbb4 tstb 5dbb4 4bb08: 670c beqs 4bb16 <_RTEMS_tasks_Create_extension+0x60> * task is created via another API, then this routine is invoked * and this API given the opportunity to initialize its extension * area. */ bool _RTEMS_tasks_Create_extension( 4bb0a: 41e8 001e lea %a0@(30),%a0 4bb0e: 7010 moveq #16,%d0 _ASR_Initialize( &api->Signal ); created->task_variables = NULL; if ( rtems_configuration_get_notepads_enabled() ) { for (i=0; i < RTEMS_NUMBER_NOTEPADS; i++) api->Notepads[i] = 0; 4bb10: 4298 clrl %a0@+ 4bb12: 5380 subql #1,%d0 api->event_condition = 0; _ASR_Initialize( &api->Signal ); created->task_variables = NULL; if ( rtems_configuration_get_notepads_enabled() ) { for (i=0; i < RTEMS_NUMBER_NOTEPADS; i++) 4bb14: 66fa bnes 4bb10 <_RTEMS_tasks_Create_extension+0x5a> api->Notepads[i] = 0; } return true; } 4bb16: 246e fffc moveal %fp@(-4),%a2 4bb1a: 4e5e unlk %fp if ( rtems_configuration_get_notepads_enabled() ) { for (i=0; i < RTEMS_NUMBER_NOTEPADS; i++) api->Notepads[i] = 0; } return true; 4bb1c: 7001 moveq #1,%d0 } 4bb1e: 4e75 rts * Notepads must be the last entry in the structure and they * can be left off if disabled in the configuration. */ to_allocate = sizeof( RTEMS_API_Control ); if ( !rtems_configuration_get_notepads_enabled() ) to_allocate -= (RTEMS_NUMBER_NOTEPADS * sizeof(uint32_t)); 4bb20: 701e moveq #30,%d0 api = _Workspace_Allocate( to_allocate ); 4bb22: 2f00 movel %d0,%sp@- 4bb24: 4eb9 0004 9e02 jsr 49e02 <_Workspace_Allocate> if ( !api ) 4bb2a: 588f addql #4,%sp */ to_allocate = sizeof( RTEMS_API_Control ); if ( !rtems_configuration_get_notepads_enabled() ) to_allocate -= (RTEMS_NUMBER_NOTEPADS * sizeof(uint32_t)); api = _Workspace_Allocate( to_allocate ); 4bb2c: 2040 moveal %d0,%a0 if ( !api ) 4bb2e: 4a80 tstl %d0 4bb30: 66a8 bnes 4bada <_RTEMS_tasks_Create_extension+0x24><== ALWAYS TAKEN for (i=0; i < RTEMS_NUMBER_NOTEPADS; i++) api->Notepads[i] = 0; } return true; } 4bb32: 246e fffc moveal %fp@(-4),%a2 4bb36: 4e5e unlk %fp to_allocate -= (RTEMS_NUMBER_NOTEPADS * sizeof(uint32_t)); api = _Workspace_Allocate( to_allocate ); if ( !api ) return false; 4bb38: 4200 clrb %d0 <== NOT EXECUTED for (i=0; i < RTEMS_NUMBER_NOTEPADS; i++) api->Notepads[i] = 0; } return true; } =============================================================================== 0004ba60 <_RTEMS_tasks_Delete_extension>: void _RTEMS_tasks_Delete_extension( Thread_Control *executing, Thread_Control *deleted ) { 4ba60: 4e56 fff4 linkw %fp,#-12 4ba64: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 4ba68: 246e 000c moveal %fp@(12),%a2 4ba6c: 47f9 0004 bb88 lea 4bb88 <_RTEMS_Tasks_Invoke_task_variable_dtor>,%a3 /* * Free per task variable memory */ tvp = deleted->task_variables; 4ba72: 206a 0108 moveal %a2@(264),%a0 deleted->task_variables = NULL; 4ba76: 42aa 0108 clrl %a2@(264) while (tvp) { 4ba7a: 4a88 tstl %a0 4ba7c: 671e beqs 4ba9c <_RTEMS_tasks_Delete_extension+0x3c> next = (rtems_task_variable_t *)tvp->next; 4ba7e: 2410 movel %a0@,%d2 _RTEMS_Tasks_Invoke_task_variable_dtor( deleted, tvp ); 4ba80: 2f08 movel %a0,%sp@- 4ba82: 2f0a movel %a2,%sp@- 4ba84: 4e93 jsr %a3@ * Free per task variable memory */ tvp = deleted->task_variables; deleted->task_variables = NULL; while (tvp) { 4ba86: 508f addql #8,%sp 4ba88: 4a82 tstl %d2 4ba8a: 6710 beqs 4ba9c <_RTEMS_tasks_Delete_extension+0x3c><== NEVER TAKEN next = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( deleted, tvp ); tvp = next; 4ba8c: 2042 moveal %d2,%a0 */ tvp = deleted->task_variables; deleted->task_variables = NULL; while (tvp) { next = (rtems_task_variable_t *)tvp->next; 4ba8e: 2410 movel %a0@,%d2 _RTEMS_Tasks_Invoke_task_variable_dtor( deleted, tvp ); 4ba90: 2f08 movel %a0,%sp@- 4ba92: 2f0a movel %a2,%sp@- 4ba94: 4e93 jsr %a3@ * Free per task variable memory */ tvp = deleted->task_variables; deleted->task_variables = NULL; while (tvp) { 4ba96: 508f addql #8,%sp 4ba98: 4a82 tstl %d2 4ba9a: 66f0 bnes 4ba8c <_RTEMS_tasks_Delete_extension+0x2c> /* * Free API specific memory */ (void) _Workspace_Free( deleted->API_Extensions[ THREAD_API_RTEMS ] ); 4ba9c: 2f2a 00fc movel %a2@(252),%sp@- 4baa0: 4eb9 0004 9e1e jsr 49e1e <_Workspace_Free> deleted->API_Extensions[ THREAD_API_RTEMS ] = NULL; 4baa6: 588f addql #4,%sp 4baa8: 42aa 00fc clrl %a2@(252) } 4baac: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 4bab2: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00046b8c <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { 46b8c: 4e56 ffe4 linkw %fp,#-28 46b90: 48d7 1c1c moveml %d2-%d4/%a2-%a4,%sp@ rtems_initialization_tasks_table *user_tasks; /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; 46b94: 2479 0005 dbda moveal 5dbda ,%a2 maximum = Configuration_RTEMS_API.number_of_initialization_tasks; 46b9a: 2639 0005 dbd6 movel 5dbd6 ,%d3 /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) 46ba0: 4a8a tstl %a2 46ba2: 6754 beqs 46bf8 <_RTEMS_tasks_Initialize_user_tasks_body+0x6c> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 46ba4: 4a83 tstl %d3 46ba6: 6750 beqs 46bf8 <_RTEMS_tasks_Initialize_user_tasks_body+0x6c><== NEVER TAKEN 46ba8: 280e movel %fp,%d4 46baa: 4282 clrl %d2 46bac: 5984 subql #4,%d4 46bae: 47f9 0004 6964 lea 46964 ,%a3 &id ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( 46bb4: 49f9 0004 6c14 lea 46c14 ,%a4 /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { return_value = rtems_task_create( 46bba: 2f04 movel %d4,%sp@- 46bbc: 2f2a 000c movel %a2@(12),%sp@- 46bc0: 2f2a 0014 movel %a2@(20),%sp@- 46bc4: 2f2a 0004 movel %a2@(4),%sp@- 46bc8: 2f2a 0008 movel %a2@(8),%sp@- 46bcc: 2f12 movel %a2@,%sp@- 46bce: 4e93 jsr %a3@ user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) 46bd0: 4fef 0018 lea %sp@(24),%sp 46bd4: 4a80 tstl %d0 46bd6: 662a bnes 46c02 <_RTEMS_tasks_Initialize_user_tasks_body+0x76> _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( 46bd8: 2f2a 0018 movel %a2@(24),%sp@- 46bdc: 2f2a 0010 movel %a2@(16),%sp@- 46be0: 2f2e fffc movel %fp@(-4),%sp@- 46be4: 4e94 jsr %a4@ id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) 46be6: 4fef 000c lea %sp@(12),%sp 46bea: 4a80 tstl %d0 46bec: 6614 bnes 46c02 <_RTEMS_tasks_Initialize_user_tasks_body+0x76> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 46bee: 5282 addql #1,%d2 46bf0: 45ea 001c lea %a2@(28),%a2 46bf4: b483 cmpl %d3,%d2 46bf6: 65c2 bcss 46bba <_RTEMS_tasks_Initialize_user_tasks_body+0x2e><== NEVER TAKEN user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); } } 46bf8: 4cee 1c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a4 46bfe: 4e5e unlk %fp 46c00: 4e75 rts id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); 46c02: 2f00 movel %d0,%sp@- 46c04: 4878 0001 pea 1 46c08: 4878 0001 pea 1 46c0c: 4eb9 0004 7ac4 jsr 47ac4 <_Internal_error_Occurred> ... =============================================================================== 0004b9e4 <_RTEMS_tasks_Post_switch_extension>: */ void _RTEMS_tasks_Post_switch_extension( Thread_Control *executing ) { 4b9e4: 4e56 ffec linkw %fp,#-20 4b9e8: 206e 0008 moveal %fp@(8),%a0 4b9ec: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ RTEMS_API_Control *api; ASR_Information *asr; rtems_signal_set signal_set; Modes_Control prev_mode; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 4b9f0: 2468 00fc moveal %a0@(252),%a2 if ( !api ) 4b9f4: 4a8a tstl %a2 4b9f6: 671a beqs 4ba12 <_RTEMS_tasks_Post_switch_extension+0x2e><== NEVER TAKEN * Signal Processing */ asr = &api->Signal; _ISR_Disable( level ); 4b9f8: 203c 0000 0700 movel #1792,%d0 4b9fe: 40c1 movew %sr,%d1 4ba00: 8081 orl %d1,%d0 4ba02: 46c0 movew %d0,%sr signal_set = asr->signals_posted; 4ba04: 242a 0012 movel %a2@(18),%d2 asr->signals_posted = 0; 4ba08: 42aa 0012 clrl %a2@(18) _ISR_Enable( level ); 4ba0c: 46c1 movew %d1,%sr if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ 4ba0e: 4a82 tstl %d2 4ba10: 660a bnes 4ba1c <_RTEMS_tasks_Post_switch_extension+0x38> (*asr->handler)( signal_set ); asr->nest_level -= 1; rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); } 4ba12: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 4ba18: 4e5e unlk %fp 4ba1a: 4e75 rts if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ return; asr->nest_level += 1; 4ba1c: 52aa 001a addql #1,%a2@(26) rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 4ba20: 260e movel %fp,%d3 4ba22: 5983 subql #4,%d3 4ba24: 47f9 0004 d628 lea 4d628 ,%a3 4ba2a: 2f03 movel %d3,%sp@- 4ba2c: 2f3c 0000 ffff movel #65535,%sp@- 4ba32: 2f2a 000e movel %a2@(14),%sp@- 4ba36: 4e93 jsr %a3@ (*asr->handler)( signal_set ); 4ba38: 2f02 movel %d2,%sp@- 4ba3a: 206a 000a moveal %a2@(10),%a0 4ba3e: 4e90 jsr %a0@ asr->nest_level -= 1; 4ba40: 53aa 001a subql #1,%a2@(26) rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 4ba44: 2f03 movel %d3,%sp@- 4ba46: 2f3c 0000 ffff movel #65535,%sp@- 4ba4c: 2f2e fffc movel %fp@(-4),%sp@- 4ba50: 4e93 jsr %a3@ 4ba52: 4fef 001c lea %sp@(28),%sp } 4ba56: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 4ba5c: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 0004b98a <_RTEMS_tasks_Switch_extension>: void _RTEMS_tasks_Switch_extension( Thread_Control *executing, Thread_Control *heir ) { 4b98a: 4e56 0000 linkw %fp,#0 4b98e: 206e 0008 moveal %fp@(8),%a0 /* * Per Task Variables */ tvp = executing->task_variables; 4b992: 2068 0108 moveal %a0@(264),%a0 while (tvp) { 4b996: 4a88 tstl %a0 4b998: 6712 beqs 4b9ac <_RTEMS_tasks_Switch_extension+0x22> tvp->tval = *tvp->ptr; 4b99a: 2268 0004 moveal %a0@(4),%a1 4b99e: 2151 000c movel %a1@,%a0@(12) *tvp->ptr = tvp->gval; 4b9a2: 22a8 0008 movel %a0@(8),%a1@ tvp = (rtems_task_variable_t *)tvp->next; 4b9a6: 2050 moveal %a0@,%a0 /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { 4b9a8: 4a88 tstl %a0 4b9aa: 66ee bnes 4b99a <_RTEMS_tasks_Switch_extension+0x10><== NEVER TAKEN tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; 4b9ac: 206e 000c moveal %fp@(12),%a0 4b9b0: 2068 0108 moveal %a0@(264),%a0 while (tvp) { 4b9b4: 4a88 tstl %a0 4b9b6: 6712 beqs 4b9ca <_RTEMS_tasks_Switch_extension+0x40> tvp->gval = *tvp->ptr; 4b9b8: 2268 0004 moveal %a0@(4),%a1 4b9bc: 2151 0008 movel %a1@,%a0@(8) *tvp->ptr = tvp->tval; 4b9c0: 22a8 000c movel %a0@(12),%a1@ tvp = (rtems_task_variable_t *)tvp->next; 4b9c4: 2050 moveal %a0@,%a0 *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { 4b9c6: 4a88 tstl %a0 4b9c8: 66ee bnes 4b9b8 <_RTEMS_tasks_Switch_extension+0x2e><== NEVER TAKEN tvp->gval = *tvp->ptr; *tvp->ptr = tvp->tval; tvp = (rtems_task_variable_t *)tvp->next; } } 4b9ca: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00047c84 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 47c84: 4e56 fffc linkw %fp,#-4 47c88: 2f0a movel %a2,%sp@- 47c8a: 486e fffc pea %fp@(-4) 47c8e: 2f2e 0008 movel %fp@(8),%sp@- 47c92: 4879 0006 1440 pea 61440 <_Rate_monotonic_Information> 47c98: 4eb9 0004 9b68 jsr 49b68 <_Objects_Get> /* * When we get here, the Timer is already off the chain so we do not * have to worry about that -- hence no _Watchdog_Remove(). */ the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 47c9e: 4fef 000c lea %sp@(12),%sp 47ca2: 2440 moveal %d0,%a2 47ca4: 4aae fffc tstl %fp@(-4) 47ca8: 6636 bnes 47ce0 <_Rate_monotonic_Timeout+0x5c> <== NEVER TAKEN case OBJECTS_LOCAL: the_thread = the_period->owner; 47caa: 206a 0040 moveal %a2@(64),%a0 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_period ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_PERIOD); 47cae: 2028 0010 movel %a0@(16),%d0 47cb2: 0280 0000 4000 andil #16384,%d0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 47cb8: 670a beqs 47cc4 <_Rate_monotonic_Timeout+0x40> 47cba: 202a 0008 movel %a2@(8),%d0 47cbe: b0a8 0020 cmpl %a0@(32),%d0 47cc2: 675e beqs 47d22 <_Rate_monotonic_Timeout+0x9e> _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { 47cc4: 7001 moveq #1,%d0 47cc6: b0aa 0038 cmpl %a2@(56),%d0 47cca: 671c beqs 47ce8 <_Rate_monotonic_Timeout+0x64> _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 47ccc: 7004 moveq #4,%d0 47cce: 2540 0038 movel %d0,%a2@(56) */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 47cd2: 2039 0006 1530 movel 61530 <_Thread_Dispatch_disable_level>,%d0 47cd8: 5380 subql #1,%d0 47cda: 23c0 0006 1530 movel %d0,61530 <_Thread_Dispatch_disable_level> case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } 47ce0: 246e fff8 moveal %fp@(-8),%a2 47ce4: 4e5e unlk %fp 47ce6: 4e75 rts _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 47ce8: 103c 0003 moveb #3,%d0 47cec: 2540 0038 movel %d0,%a2@(56) _Rate_monotonic_Initiate_statistics( the_period ); 47cf0: 2f0a movel %a2,%sp@- 47cf2: 4eb9 0004 7668 jsr 47668 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 47cf8: 256a 003c 001c movel %a2@(60),%a2@(28) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 47cfe: 486a 0010 pea %a2@(16) 47d02: 4879 0006 15f0 pea 615f0 <_Watchdog_Ticks_chain> 47d08: 4eb9 0004 b74c jsr 4b74c <_Watchdog_Insert> 47d0e: 4fef 000c lea %sp@(12),%sp 47d12: 2039 0006 1530 movel 61530 <_Thread_Dispatch_disable_level>,%d0 47d18: 5380 subql #1,%d0 47d1a: 23c0 0006 1530 movel %d0,61530 <_Thread_Dispatch_disable_level> 47d20: 60be bras 47ce0 <_Rate_monotonic_Timeout+0x5c> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 47d22: 2f3c 1003 fff8 movel #268697592,%sp@- 47d28: 2f08 movel %a0,%sp@- 47d2a: 4eb9 0004 a430 jsr 4a430 <_Thread_Clear_state> the_thread = the_period->owner; if ( _States_Is_waiting_for_period( the_thread->current_state ) && the_thread->Wait.id == the_period->Object.id ) { _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); 47d30: 2f0a movel %a2,%sp@- 47d32: 4eb9 0004 7668 jsr 47668 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 47d38: 256a 003c 001c movel %a2@(60),%a2@(28) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 47d3e: 486a 0010 pea %a2@(16) 47d42: 4879 0006 15f0 pea 615f0 <_Watchdog_Ticks_chain> 47d48: 4eb9 0004 b74c jsr 4b74c <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); 47d4e: 4fef 0014 lea %sp@(20),%sp */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 47d52: 2039 0006 1530 movel 61530 <_Thread_Dispatch_disable_level>,%d0 47d58: 5380 subql #1,%d0 47d5a: 23c0 0006 1530 movel %d0,61530 <_Thread_Dispatch_disable_level> 47d60: 6000 ff7e braw 47ce0 <_Rate_monotonic_Timeout+0x5c> =============================================================================== 00048360 <_Scheduler_Handler_initialization>: #include #include #include void _Scheduler_Handler_initialization(void) { 48360: 4e56 0000 linkw %fp,#0 (*_Scheduler.Operations.initialize)(); } 48364: 4e5e unlk %fp #include #include void _Scheduler_Handler_initialization(void) { (*_Scheduler.Operations.initialize)(); 48366: 2279 0005 db14 moveal 5db14 <_Scheduler+0x4>,%a1 4836c: 4ed1 jmp %a1@ ... =============================================================================== 0004838c <_Scheduler_priority_Block>: #include void _Scheduler_priority_Block( Thread_Control *the_thread ) { 4838c: 4e56 0000 linkw %fp,#0 48390: 206e 0008 moveal %fp@(8),%a0 48394: 2f0b movel %a3,%sp@- 48396: 2f0a movel %a2,%sp@- ) { Scheduler_priority_Per_thread *sched_info; Chain_Control *ready; sched_info = (Scheduler_priority_Per_thread *) the_thread->scheduler_info; 48398: 2468 008a moveal %a0@(138),%a2 ready = sched_info->ready_chain; 4839c: 2252 moveal %a2@,%a1 if ( _Chain_Has_only_one_node( ready ) ) { 4839e: 2029 0008 movel %a1@(8),%d0 483a2: b091 cmpl %a1@,%d0 483a4: 6700 0084 beqw 4842a <_Scheduler_priority_Block+0x9e> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 483a8: 2450 moveal %a0@,%a2 previous = the_node->previous; 483aa: 2268 0004 moveal %a0@(4),%a1 next->previous = previous; 483ae: 2549 0004 movel %a1,%a2@(4) previous->next = next; 483b2: 228a movel %a2,%a1@ _Scheduler_priority_Ready_queue_extract( the_thread ); /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) 483b4: b1f9 0005 f5e8 cmpal 5f5e8 <_Per_CPU_Information+0x10>,%a0 483ba: 6720 beqs 483dc <_Scheduler_priority_Block+0x50> _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) 483bc: b1f9 0005 f5e4 cmpal 5f5e4 <_Per_CPU_Information+0xc>,%a0 483c2: 6708 beqs 483cc <_Scheduler_priority_Block+0x40> _Thread_Dispatch_necessary = true; } 483c4: 245f moveal %sp@+,%a2 483c6: 265f moveal %sp@+,%a3 483c8: 4e5e unlk %fp 483ca: 4e75 rts 483cc: 245f moveal %sp@+,%a2 if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; 483ce: 7001 moveq #1,%d0 } 483d0: 265f moveal %sp@+,%a3 483d2: 4e5e unlk %fp if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; 483d4: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> } 483da: 4e75 rts RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 483dc: 3039 0005 f5f4 movew 5f5f4 <_Priority_Major_bit_map>,%d0 483e2: 4840 swap %d0 483e4: 04c0 ff1 %d0 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 483e6: 43f9 0005 f5f8 lea 5f5f8 <_Priority_Bit_map>,%a1 483ec: 0280 0000 ffff andil #65535,%d0 483f2: 3231 0a00 movew %a1@(00000000,%d0:l:2),%d1 483f6: 4841 swap %d1 483f8: 04c1 ff1 %d1 483fa: 2279 0005 db10 moveal 5db10 <_Scheduler>,%a1 return (_Priority_Bits_index( major ) << 4) + 48400: 0281 0000 ffff andil #65535,%d1 48406: e988 lsll #4,%d0 48408: d081 addl %d1,%d0 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 4840a: 2200 movel %d0,%d1 4840c: e988 lsll #4,%d0 4840e: e589 lsll #2,%d1 48410: 9081 subl %d1,%d0 48412: d3c0 addal %d0,%a1 48414: 2019 movel %a1@+,%d0 48416: b3c0 cmpal %d0,%a1 48418: 6750 beqs 4846a <_Scheduler_priority_Block+0xde> <== NEVER TAKEN * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 4841a: 23c0 0005 f5e8 movel %d0,5f5e8 <_Per_CPU_Information+0x10> /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) 48420: b1f9 0005 f5e4 cmpal 5f5e4 <_Per_CPU_Information+0xc>,%a0 48426: 669c bnes 483c4 <_Scheduler_priority_Block+0x38> 48428: 60a2 bras 483cc <_Scheduler_priority_Block+0x40> RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4842a: 2009 movel %a1,%d0 4842c: 5880 addql #4,%d0 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; 4842e: 266a 0004 moveal %a2@(4),%a3 48432: 2280 movel %d0,%a1@ 48434: 302a 000e movew %a2@(14),%d0 head->next = tail; head->previous = NULL; 48438: 42a9 0004 clrl %a1@(4) tail->previous = head; 4843c: 2349 0008 movel %a1,%a1@(8) 48440: 3213 movew %a3@,%d1 48442: c081 andl %d1,%d0 48444: 3680 movew %d0,%a3@ if ( *the_priority_map->minor == 0 ) 48446: 6600 ff6c bnew 483b4 <_Scheduler_priority_Block+0x28> _Priority_Major_bit_map &= the_priority_map->block_major; 4844a: 3239 0005 f5f4 movew 5f5f4 <_Priority_Major_bit_map>,%d1 48450: 302a 000c movew %a2@(12),%d0 48454: c081 andl %d1,%d0 48456: 33c0 0005 f5f4 movew %d0,5f5f4 <_Priority_Major_bit_map> { _Scheduler_priority_Ready_queue_extract( the_thread ); /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) 4845c: b1f9 0005 f5e8 cmpal 5f5e8 <_Per_CPU_Information+0x10>,%a0 48462: 6600 ff58 bnew 483bc <_Scheduler_priority_Block+0x30> 48466: 6000 ff74 braw 483dc <_Scheduler_priority_Block+0x50> Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; 4846a: 4280 clrl %d0 <== NOT EXECUTED * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 4846c: 23c0 0005 f5e8 movel %d0,5f5e8 <_Per_CPU_Information+0x10> <== NOT EXECUTED 48472: 60ac bras 48420 <_Scheduler_priority_Block+0x94> <== NOT EXECUTED =============================================================================== 00048568 <_Scheduler_priority_Free>: #include void _Scheduler_priority_Free ( Thread_Control *the_thread ) { 48568: 4e56 0000 linkw %fp,#0 4856c: 206e 0008 moveal %fp@(8),%a0 _Workspace_Free( the_thread->scheduler_info ); 48570: 2d68 008a 0008 movel %a0@(138),%fp@(8) } 48576: 4e5e unlk %fp void _Scheduler_priority_Free ( Thread_Control *the_thread ) { _Workspace_Free( the_thread->scheduler_info ); 48578: 4ef9 0004 9e1e jmp 49e1e <_Workspace_Free> ... =============================================================================== 000485e8 <_Scheduler_priority_Schedule>: #include #include #include void _Scheduler_priority_Schedule(void) { 485e8: 4e56 0000 linkw %fp,#0 RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 485ec: 3039 0005 f5f4 movew 5f5f4 <_Priority_Major_bit_map>,%d0 485f2: 4840 swap %d0 485f4: 04c0 ff1 %d0 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 485f6: 41f9 0005 f5f8 lea 5f5f8 <_Priority_Bit_map>,%a0 485fc: 0280 0000 ffff andil #65535,%d0 48602: 3230 0a00 movew %a0@(00000000,%d0:l:2),%d1 48606: 4841 swap %d1 48608: 04c1 ff1 %d1 _Scheduler_priority_Schedule_body(); } 4860a: 2079 0005 db10 moveal 5db10 <_Scheduler>,%a0 return (_Priority_Bits_index( major ) << 4) + 48610: 0281 0000 ffff andil #65535,%d1 48616: e988 lsll #4,%d0 48618: d081 addl %d1,%d0 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 4861a: 2200 movel %d0,%d1 4861c: e988 lsll #4,%d0 4861e: e589 lsll #2,%d1 48620: 9081 subl %d1,%d0 48622: d1c0 addal %d0,%a0 48624: 2018 movel %a0@+,%d0 48626: b1c0 cmpal %d0,%a0 48628: 670a beqs 48634 <_Scheduler_priority_Schedule+0x4c><== NEVER TAKEN * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 4862a: 23c0 0005 f5e8 movel %d0,5f5e8 <_Per_CPU_Information+0x10> 48630: 4e5e unlk %fp 48632: 4e75 rts Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; 48634: 4280 clrl %d0 <== NOT EXECUTED 48636: 4e5e unlk %fp <== NOT EXECUTED * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 48638: 23c0 0005 f5e8 movel %d0,5f5e8 <_Per_CPU_Information+0x10> <== NOT EXECUTED =============================================================================== 00048730 <_Scheduler_priority_Yield>: * ready chain * select heir */ void _Scheduler_priority_Yield(void) { 48730: 4e56 fff0 linkw %fp,#-16 Scheduler_priority_Per_thread *sched_info; ISR_Level level; Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; 48734: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 * ready chain * select heir */ void _Scheduler_priority_Yield(void) { 4873a: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; sched_info = (Scheduler_priority_Per_thread *) executing->scheduler_info; ready = sched_info->ready_chain; 4873e: 2268 008a moveal %a0@(138),%a1 _ISR_Disable( level ); 48742: 243c 0000 0700 movel #1792,%d2 48748: 2002 movel %d2,%d0 Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; sched_info = (Scheduler_priority_Per_thread *) executing->scheduler_info; ready = sched_info->ready_chain; 4874a: 2251 moveal %a1@,%a1 _ISR_Disable( level ); 4874c: 40c1 movew %sr,%d1 4874e: 8081 orl %d1,%d0 48750: 46c0 movew %d0,%sr if ( !_Chain_Has_only_one_node( ready ) ) { 48752: 2029 0008 movel %a1@(8),%d0 48756: b091 cmpl %a1@,%d0 48758: 6750 beqs 487aa <_Scheduler_priority_Yield+0x7a> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4875a: 2850 moveal %a0@,%a4 RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 4875c: 2009 movel %a1,%d0 4875e: 5880 addql #4,%d0 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 48760: 2668 0004 moveal %a0@(4),%a3 next->previous = previous; 48764: 294b 0004 movel %a3,%a4@(4) Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 48768: 2469 0008 moveal %a1@(8),%a2 Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; previous->next = next; 4876c: 268c movel %a4,%a3@ { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; 4876e: 2348 0008 movel %a0,%a1@(8) RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 48772: 2080 movel %d0,%a0@ Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; old_last->next = the_node; the_node->previous = old_last; 48774: 214a 0004 movel %a2,%a0@(4) Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; old_last->next = the_node; 48778: 2488 movel %a0,%a2@ _Chain_Extract_unprotected( &executing->Object.Node ); _Chain_Append_unprotected( ready, &executing->Object.Node ); _ISR_Flash( level ); 4877a: 46c1 movew %d1,%sr 4877c: 8481 orl %d1,%d2 4877e: 46c2 movew %d2,%sr if ( _Thread_Is_heir( executing ) ) 48780: b1f9 0005 f5e8 cmpal 5f5e8 <_Per_CPU_Information+0x10>,%a0 48786: 6712 beqs 4879a <_Scheduler_priority_Yield+0x6a> <== ALWAYS TAKEN _Thread_Heir = (Thread_Control *) _Chain_First( ready ); _Thread_Dispatch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) _Thread_Dispatch_necessary = true; 48788: 7001 moveq #1,%d0 <== NOT EXECUTED 4878a: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> <== NOT EXECUTED _ISR_Enable( level ); 48790: 46c1 movew %d1,%sr } 48792: 4cd7 1c04 moveml %sp@,%d2/%a2-%a4 48796: 4e5e unlk %fp 48798: 4e75 rts _Chain_Append_unprotected( ready, &executing->Object.Node ); _ISR_Flash( level ); if ( _Thread_Is_heir( executing ) ) _Thread_Heir = (Thread_Control *) _Chain_First( ready ); 4879a: 23d1 0005 f5e8 movel %a1@,5f5e8 <_Per_CPU_Information+0x10> _Thread_Dispatch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) _Thread_Dispatch_necessary = true; 487a0: 7001 moveq #1,%d0 487a2: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> 487a8: 60e6 bras 48790 <_Scheduler_priority_Yield+0x60> if ( _Thread_Is_heir( executing ) ) _Thread_Heir = (Thread_Control *) _Chain_First( ready ); _Thread_Dispatch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) 487aa: b1f9 0005 f5e8 cmpal 5f5e8 <_Per_CPU_Information+0x10>,%a0 487b0: 67de beqs 48790 <_Scheduler_priority_Yield+0x60> <== ALWAYS TAKEN _Thread_Dispatch_necessary = true; 487b2: 7001 moveq #1,%d0 <== NOT EXECUTED 487b4: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> <== NOT EXECUTED 487ba: 60d4 bras 48790 <_Scheduler_priority_Yield+0x60> <== NOT EXECUTED =============================================================================== 00048974 <_Scheduler_simple_Block>: #include void _Scheduler_simple_Block( Thread_Control *the_thread ) { 48974: 4e56 0000 linkw %fp,#0 48978: 2f02 movel %d2,%sp@- 4897a: 242e 0008 movel %fp@(8),%d2 _Scheduler_simple_Extract(the_thread); 4897e: 2f02 movel %d2,%sp@- 48980: 4eb9 0004 89d8 jsr 489d8 <_Scheduler_simple_Extract> if ( _Thread_Is_heir( the_thread ) ) 48986: 588f addql #4,%sp 48988: b4b9 0006 0140 cmpl 60140 <_Per_CPU_Information+0x10>,%d2 4898e: 6720 beqs 489b0 <_Scheduler_simple_Block+0x3c> _Scheduler_simple_Schedule(); if ( _Thread_Is_executing( the_thread ) ) 48990: b4b9 0006 013c cmpl 6013c <_Per_CPU_Information+0xc>,%d2 48996: 6708 beqs 489a0 <_Scheduler_simple_Block+0x2c> <== NEVER TAKEN _Thread_Dispatch_necessary = true; } 48998: 242e fffc movel %fp@(-4),%d2 4899c: 4e5e unlk %fp 4899e: 4e75 rts 489a0: 242e fffc movel %fp@(-4),%d2 489a4: 4e5e unlk %fp if ( _Thread_Is_heir( the_thread ) ) _Scheduler_simple_Schedule(); if ( _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; 489a6: 7001 moveq #1,%d0 489a8: 13c0 0006 0148 moveb %d0,60148 <_Per_CPU_Information+0x18> } 489ae: 4e75 rts ) { _Scheduler_simple_Extract(the_thread); if ( _Thread_Is_heir( the_thread ) ) _Scheduler_simple_Schedule(); 489b0: 4eb9 0004 8ac0 jsr 48ac0 <_Scheduler_simple_Schedule> if ( _Thread_Is_executing( the_thread ) ) 489b6: b4b9 0006 013c cmpl 6013c <_Per_CPU_Information+0xc>,%d2 489bc: 66da bnes 48998 <_Scheduler_simple_Block+0x24> <== NEVER TAKEN 489be: 60e0 bras 489a0 <_Scheduler_simple_Block+0x2c> =============================================================================== 00048a34 <_Scheduler_simple_Ready_queue_Enqueue_first>: #include void _Scheduler_simple_Ready_queue_Enqueue_first( Thread_Control *the_thread ) { 48a34: 4e56 0000 linkw %fp,#0 48a38: 226e 0008 moveal %fp@(8),%a1 } } /* enqueue */ _Chain_Insert_unprotected( (Chain_Node *)current, &the_thread->Object.Node ); } 48a3c: 2079 0005 e5f0 moveal 5e5f0 <_Scheduler>,%a0 #include void _Scheduler_simple_Ready_queue_Enqueue_first( Thread_Control *the_thread ) { 48a42: 2f0a movel %a2,%sp@- */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { 48a44: 2029 0014 movel %a1@(20),%d0 } } /* enqueue */ _Chain_Insert_unprotected( (Chain_Node *)current, &the_thread->Object.Node ); } 48a48: 2050 moveal %a0@,%a0 */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { 48a4a: b0a8 0014 cmpl %a0@(20),%d0 48a4e: 6308 blss 48a58 <_Scheduler_simple_Ready_queue_Enqueue_first+0x24> * Do NOT need to check for end of chain because there is always * at least one task on the ready chain -- the IDLE task. It can * never block, should never attempt to obtain a semaphore or mutex, * and thus will always be there. */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { 48a50: 2050 moveal %a0@,%a0 current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { 48a52: b0a8 0014 cmpl %a0@(20),%d0 48a56: 62f8 bhis 48a50 <_Scheduler_simple_Ready_queue_Enqueue_first+0x1c><== NEVER TAKEN current = (Thread_Control *)current->Object.Node.previous; 48a58: 2068 0004 moveal %a0@(4),%a0 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 48a5c: 2450 moveal %a0@,%a2 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 48a5e: 2348 0004 movel %a0,%a1@(4) before_node = after_node->next; after_node->next = the_node; 48a62: 2089 movel %a1,%a0@ the_node->next = before_node; before_node->previous = the_node; 48a64: 2549 0004 movel %a1,%a2@(4) Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; 48a68: 228a movel %a2,%a1@ } } /* enqueue */ _Chain_Insert_unprotected( (Chain_Node *)current, &the_thread->Object.Node ); } 48a6a: 245f moveal %sp@+,%a2 48a6c: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00048fd8 <_TOD_Set>: */ void _TOD_Set( const struct timespec *time ) { 48fd8: 4e56 0000 linkw %fp,#0 48fdc: 2039 0006 1f78 movel 61f78 <_Thread_Dispatch_disable_level>,%d0 48fe2: 5280 addql #1,%d0 48fe4: 2f0a movel %a2,%sp@- 48fe6: 246e 0008 moveal %fp@(8),%a2 48fea: 23c0 0006 1f78 movel %d0,61f78 <_Thread_Dispatch_disable_level> long seconds; _Thread_Disable_dispatch(); _TOD_Deactivate(); seconds = _TOD_Seconds_since_epoch(); 48ff0: 2039 0006 2002 movel 62002 <_TOD_Now>,%d0 if ( time->tv_sec < seconds ) 48ff6: 2212 movel %a2@,%d1 48ff8: b280 cmpl %d0,%d1 48ffa: 6d38 blts 49034 <_TOD_Set+0x5c> Watchdog_Adjust_directions direction, Watchdog_Interval units ) { _Watchdog_Adjust( &_Watchdog_Seconds_chain, direction, units ); 48ffc: 9280 subl %d0,%d1 48ffe: 2f01 movel %d1,%sp@- 49000: 42a7 clrl %sp@- 49002: 4879 0006 202c pea 6202c <_Watchdog_Seconds_chain> 49008: 4eb9 0004 b700 jsr 4b700 <_Watchdog_Adjust> _Watchdog_Adjust_seconds( WATCHDOG_BACKWARD, seconds - time->tv_sec ); else _Watchdog_Adjust_seconds( WATCHDOG_FORWARD, time->tv_sec - seconds ); /* POSIX format TOD (timespec) */ _Timestamp_Set( &_TOD_Now, time->tv_sec, time->tv_nsec ); 4900e: 23d2 0006 2002 movel %a2@,62002 <_TOD_Now> 49014: 588a addql #4,%a2 49016: 4fef 000c lea %sp@(12),%sp 4901a: 23d2 0006 2006 movel %a2@,62006 <_TOD_Now+0x4> _TOD_Is_set = true; _TOD_Activate(); _Thread_Enable_dispatch(); } 49020: 246e fffc moveal %fp@(-4),%a2 49024: 4e5e unlk %fp else _Watchdog_Adjust_seconds( WATCHDOG_FORWARD, time->tv_sec - seconds ); /* POSIX format TOD (timespec) */ _Timestamp_Set( &_TOD_Now, time->tv_sec, time->tv_nsec ); _TOD_Is_set = true; 49026: 7001 moveq #1,%d0 49028: 13c0 0006 1f88 moveb %d0,61f88 <_TOD_Is_set> _TOD_Activate(); _Thread_Enable_dispatch(); 4902e: 4ef9 0004 a782 jmp 4a782 <_Thread_Enable_dispatch> 49034: 9081 subl %d1,%d0 49036: 2f00 movel %d0,%sp@- 49038: 4878 0001 pea 1 4903c: 4879 0006 202c pea 6202c <_Watchdog_Seconds_chain> 49042: 4eb9 0004 b700 jsr 4b700 <_Watchdog_Adjust> _Watchdog_Adjust_seconds( WATCHDOG_BACKWARD, seconds - time->tv_sec ); else _Watchdog_Adjust_seconds( WATCHDOG_FORWARD, time->tv_sec - seconds ); /* POSIX format TOD (timespec) */ _Timestamp_Set( &_TOD_Now, time->tv_sec, time->tv_nsec ); 49048: 23d2 0006 2002 movel %a2@,62002 <_TOD_Now> 4904e: 588a addql #4,%a2 49050: 4fef 000c lea %sp@(12),%sp 49054: 23d2 0006 2006 movel %a2@,62006 <_TOD_Now+0x4> _TOD_Is_set = true; _TOD_Activate(); _Thread_Enable_dispatch(); } 4905a: 246e fffc moveal %fp@(-4),%a2 4905e: 4e5e unlk %fp else _Watchdog_Adjust_seconds( WATCHDOG_FORWARD, time->tv_sec - seconds ); /* POSIX format TOD (timespec) */ _Timestamp_Set( &_TOD_Now, time->tv_sec, time->tv_nsec ); _TOD_Is_set = true; 49060: 7001 moveq #1,%d0 49062: 13c0 0006 1f88 moveb %d0,61f88 <_TOD_Is_set> _TOD_Activate(); _Thread_Enable_dispatch(); 49068: 4ef9 0004 a782 jmp 4a782 <_Thread_Enable_dispatch> ... =============================================================================== 00047690 <_TOD_Tickle_ticks>: * * Output parameters: NONE */ void _TOD_Tickle_ticks( void ) { 47690: 4e56 ffec linkw %fp,#-20 Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); 47694: 2239 0005 dbf0 movel 5dbf0 ,%d1 * * Output parameters: NONE */ void _TOD_Tickle_ticks( void ) { 4769a: 48d7 040c moveml %d2-%d3/%a2,%sp@ /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); 4769e: 240e movel %fp,%d2 476a0: 5182 subql #8,%d2 { Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); 476a2: 263c 0000 03e8 movel #1000,%d3 476a8: 4c03 1800 mulsl %d3,%d1 /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); 476ac: 45f9 0004 97dc lea 497dc <_Timespec_Add_to>,%a2 /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; 476b2: 2039 0005 f550 movel 5f550 <_Watchdog_Ticks_since_boot>,%d0 476b8: 5280 addql #1,%d0 /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); 476ba: 2f02 movel %d2,%sp@- 476bc: 4879 0005 f4c2 pea 5f4c2 <_TOD_Uptime> { Timestamp_Control tick; uint32_t seconds; /* Convert the tick quantum to a timestamp */ _Timestamp_Set( &tick, 0, rtems_configuration_get_nanoseconds_per_tick() ); 476c2: 2d41 fffc movel %d1,%fp@(-4) 476c6: 42ae fff8 clrl %fp@(-8) /* Update the counter of ticks since boot */ _Watchdog_Ticks_since_boot += 1; 476ca: 23c0 0005 f550 movel %d0,5f550 <_Watchdog_Ticks_since_boot> /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); 476d0: 4e92 jsr %a2@ /* we do not care how much the uptime changed */ /* Update the timespec format TOD */ seconds = _Timestamp_Add_to_at_tick( &_TOD_Now, &tick ); 476d2: 2f02 movel %d2,%sp@- 476d4: 4879 0005 f4d2 pea 5f4d2 <_TOD_Now> 476da: 4e92 jsr %a2@ while ( seconds ) { 476dc: 4fef 0010 lea %sp@(16),%sp /* Update the timespec format uptime */ _Timestamp_Add_to( &_TOD_Uptime, &tick ); /* we do not care how much the uptime changed */ /* Update the timespec format TOD */ seconds = _Timestamp_Add_to_at_tick( &_TOD_Now, &tick ); 476e0: 2400 movel %d0,%d2 while ( seconds ) { 476e2: 6716 beqs 476fa <_TOD_Tickle_ticks+0x6a> 476e4: 45f9 0004 9d20 lea 49d20 <_Watchdog_Tickle>,%a2 */ RTEMS_INLINE_ROUTINE void _Watchdog_Tickle_seconds( void ) { _Watchdog_Tickle( &_Watchdog_Seconds_chain ); 476ea: 4879 0005 f4fc pea 5f4fc <_Watchdog_Seconds_chain> _Watchdog_Tickle_seconds(); seconds--; 476f0: 5382 subql #1,%d2 476f2: 4e92 jsr %a2@ _Timestamp_Add_to( &_TOD_Uptime, &tick ); /* we do not care how much the uptime changed */ /* Update the timespec format TOD */ seconds = _Timestamp_Add_to_at_tick( &_TOD_Now, &tick ); while ( seconds ) { 476f4: 588f addql #4,%sp 476f6: 4a82 tstl %d2 476f8: 66f0 bnes 476ea <_TOD_Tickle_ticks+0x5a> <== NEVER TAKEN _Watchdog_Tickle_seconds(); seconds--; } } 476fa: 4cee 040c ffec moveml %fp@(-20),%d2-%d3/%a2 47700: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 000476b8 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 476b8: 4e56 0000 linkw %fp,#0 476bc: 206e 0008 moveal %fp@(8),%a0 uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 476c0: 2039 0006 0330 movel 60330 ,%d0 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 476c6: 2f02 movel %d2,%sp@- uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 476c8: 4a88 tstl %a0 476ca: 6762 beqs 4772e <_TOD_Validate+0x76> <== NEVER TAKEN ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 476cc: 243c 000f 4240 movel #1000000,%d2 476d2: 4c40 2002 remul %d0,%d2,%d2 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 476d6: b4a8 0018 cmpl %a0@(24),%d2 476da: 6352 blss 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->ticks >= ticks_per_second) || 476dc: 703b moveq #59,%d0 476de: b0a8 0014 cmpl %a0@(20),%d0 476e2: 654a bcss 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 476e4: b0a8 0010 cmpl %a0@(16),%d0 476e8: 6544 bcss 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 476ea: 7217 moveq #23,%d1 476ec: b2a8 000c cmpl %a0@(12),%d1 476f0: 653c bcss 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 476f2: 2028 0004 movel %a0@(4),%d0 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || 476f6: 6736 beqs 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->month == 0) || 476f8: 740c moveq #12,%d2 476fa: b480 cmpl %d0,%d2 476fc: 6530 bcss 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 476fe: 2210 movel %a0@,%d1 (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || 47700: 0c81 0000 07c3 cmpil #1987,%d1 47706: 6326 blss 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 47708: 2068 0008 moveal %a0@(8),%a0 (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 4770c: 4a88 tstl %a0 4770e: 671e beqs 4772e <_TOD_Validate+0x76> <== NEVER TAKEN (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 47710: 143c 0003 moveb #3,%d2 47714: c282 andl %d2,%d1 47716: 661e bnes 47736 <_TOD_Validate+0x7e> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 47718: 43f9 0005 f4b6 lea 5f4b6 <_TOD_Days_per_month>,%a1 4771e: 2031 0c34 movel %a1@(00000034,%d0:l:4),%d0 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 47722: b1c0 cmpal %d0,%a0 47724: 53c0 sls %d0 47726: 4480 negl %d0 if ( the_tod->day > days_in_month ) return false; return true; } 47728: 241f movel %sp@+,%d2 4772a: 4e5e unlk %fp 4772c: 4e75 rts 4772e: 241f movel %sp@+,%d2 47730: 4e5e unlk %fp (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) return false; 47732: 4200 clrb %d0 if ( the_tod->day > days_in_month ) return false; return true; } 47734: 4e75 rts return false; if ( (the_tod->year % 4) == 0 ) days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 47736: 43f9 0005 f4b6 lea 5f4b6 <_TOD_Days_per_month>,%a1 4773c: 2031 0c00 movel %a1@(00000000,%d0:l:4),%d0 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 47740: b1c0 cmpal %d0,%a0 47742: 53c0 sls %d0 47744: 4480 negl %d0 47746: 60e0 bras 47728 <_TOD_Validate+0x70> =============================================================================== 00048824 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 48824: 4e56 fff0 linkw %fp,#-16 48828: 48d7 041c moveml %d2-%d4/%a2,%sp@ 4882c: 246e 0008 moveal %fp@(8),%a2 States_Control state, original_state; /* * Save original state */ original_state = the_thread->current_state; 48830: 262a 0010 movel %a2@(16),%d3 void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 48834: 242e 000c movel %fp@(12),%d2 /* * Set a transient state for the thread so it is pulled off the Ready chains. * This will prevent it from being scheduled no matter what happens in an * ISR. */ _Thread_Set_transient( the_thread ); 48838: 2f0a movel %a2,%sp@- void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 4883a: 182e 0013 moveb %fp@(19),%d4 /* * Set a transient state for the thread so it is pulled off the Ready chains. * This will prevent it from being scheduled no matter what happens in an * ISR. */ _Thread_Set_transient( the_thread ); 4883e: 4eb9 0004 9608 jsr 49608 <_Thread_Set_transient> /* * Do not bother recomputing all the priority related information if * we are not REALLY changing priority. */ if ( the_thread->current_priority != new_priority ) 48844: 588f addql #4,%sp 48846: b4aa 0014 cmpl %a2@(20),%d2 4884a: 670c beqs 48858 <_Thread_Change_priority+0x34> _Thread_Set_priority( the_thread, new_priority ); 4884c: 2f02 movel %d2,%sp@- 4884e: 2f0a movel %a2,%sp@- 48850: 4eb9 0004 95a4 jsr 495a4 <_Thread_Set_priority> 48856: 508f addql #8,%sp _ISR_Disable( level ); 48858: 203c 0000 0700 movel #1792,%d0 4885e: 40c2 movew %sr,%d2 48860: 8082 orl %d2,%d0 48862: 46c0 movew %d0,%sr /* * If the thread has more than STATES_TRANSIENT set, then it is blocked, * If it is blocked on a thread queue, then we need to requeue it. */ state = the_thread->current_state; 48864: 202a 0010 movel %a2@(16),%d0 if ( state != STATES_TRANSIENT ) { 48868: 7204 moveq #4,%d1 4886a: b280 cmpl %d0,%d1 4886c: 6738 beqs 488a6 <_Thread_Change_priority+0x82> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 4886e: 44c3 movew %d3,%ccr 48870: 6708 beqs 4887a <_Thread_Change_priority+0x56> <== NEVER TAKEN RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); 48872: 72fb moveq #-5,%d1 48874: c280 andl %d0,%d1 48876: 2541 0010 movel %d1,%a2@(16) the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); _ISR_Enable( level ); 4887a: 46c2 movew %d2,%sr */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 4887c: 0280 0003 bee0 andil #245472,%d0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 48882: 660a bnes 4888e <_Thread_Change_priority+0x6a> if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } 48884: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 4888a: 4e5e unlk %fp 4888c: 4e75 rts /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); _ISR_Enable( level ); if ( _States_Is_waiting_on_thread_queue( state ) ) { _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 4888e: 2d4a 000c movel %a2,%fp@(12) 48892: 2d6a 0044 0008 movel %a2@(68),%fp@(8) if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } 48898: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 4889e: 4e5e unlk %fp /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); _ISR_Enable( level ); if ( _States_Is_waiting_on_thread_queue( state ) ) { _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 488a0: 4ef9 0004 94f8 jmp 494f8 <_Thread_queue_Requeue> } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { 488a6: 44c3 movew %d3,%ccr 488a8: 6714 beqs 488be <_Thread_Change_priority+0x9a> <== NEVER TAKEN * Interrupts are STILL disabled. * We now know the thread will be in the READY state when we remove * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 488aa: 42aa 0010 clrl %a2@(16) if ( prepend_it ) 488ae: 4a04 tstb %d4 488b0: 6748 beqs 488fa <_Thread_Change_priority+0xd6> */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue_first( the_thread ); 488b2: 2f0a movel %a2,%sp@- 488b4: 2079 0005 db38 moveal 5db38 <_Scheduler+0x28>,%a0 488ba: 4e90 jsr %a0@ 488bc: 588f addql #4,%sp _Scheduler_Enqueue_first( the_thread ); else _Scheduler_Enqueue( the_thread ); } _ISR_Flash( level ); 488be: 203c 0000 0700 movel #1792,%d0 488c4: 46c2 movew %d2,%sr 488c6: 8082 orl %d2,%d0 488c8: 46c0 movew %d0,%sr * This kernel routine implements the scheduling decision logic for * the scheduler. It does NOT dispatch. */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( void ) { _Scheduler.Operations.schedule(); 488ca: 2079 0005 db18 moveal 5db18 <_Scheduler+0x8>,%a0 488d0: 4e90 jsr %a0@ * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 488d2: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Scheduler_Schedule(); if ( !_Thread_Is_executing_also_the_heir() && 488d8: b1f9 0005 f5e8 cmpal 5f5e8 <_Per_CPU_Information+0x10>,%a0 488de: 670e beqs 488ee <_Thread_Change_priority+0xca> 488e0: 4a28 0074 tstb %a0@(116) 488e4: 6708 beqs 488ee <_Thread_Change_priority+0xca> _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 488e6: 7001 moveq #1,%d0 488e8: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> _ISR_Enable( level ); 488ee: 46c2 movew %d2,%sr } 488f0: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 488f6: 4e5e unlk %fp 488f8: 4e75 rts */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue( the_thread ); 488fa: 2f0a movel %a2,%sp@- 488fc: 2079 0005 db34 moveal 5db34 <_Scheduler+0x24>,%a0 48902: 4e90 jsr %a0@ 48904: 588f addql #4,%sp 48906: 60b6 bras 488be <_Thread_Change_priority+0x9a> =============================================================================== 00048964 <_Thread_Close>: RTEMS_INLINE_ROUTINE void _Objects_Invalidate_Id( Objects_Information *information, Objects_Control *the_object ) { _Objects_Set_local_object( 48964: 4280 clrl %d0 void _Thread_Close( Objects_Information *information, Thread_Control *the_thread ) { 48966: 4e56 0000 linkw %fp,#0 4896a: 2f0b movel %a3,%sp@- 4896c: 266e 0008 moveal %fp@(8),%a3 48970: 2f0a movel %a2,%sp@- 48972: 246e 000c moveal %fp@(12),%a2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 48976: 206b 0018 moveal %a3@(24),%a0 RTEMS_INLINE_ROUTINE void _Objects_Invalidate_Id( Objects_Information *information, Objects_Control *the_object ) { _Objects_Set_local_object( 4897a: 302a 000a movew %a2@(10),%d0 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4897e: 42b0 0c00 clrl %a0@(00000000,%d0:l:4) */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 48982: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 48988: 5380 subql #1,%d0 * disappear and set a transient state on it. So we temporarily * unnest dispatching. */ _Thread_Unnest_dispatch(); _User_extensions_Thread_delete( the_thread ); 4898a: 2f0a movel %a2,%sp@- 4898c: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> 48992: 4eb9 0004 9a60 jsr 49a60 <_User_extensions_Thread_delete> rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 48998: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 4899e: 5280 addql #1,%d0 489a0: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> /* * Now we are in a dispatching critical section again and we * can take the thread OUT of the published set. It is invalid * to use this thread's Id OR name after this call. */ _Objects_Close( information, &the_thread->Object ); 489a6: 2f0a movel %a2,%sp@- 489a8: 2f0b movel %a3,%sp@- 489aa: 4eb9 0004 7c18 jsr 47c18 <_Objects_Close> /* * By setting the dormant state, the thread will not be considered * for scheduling when we remove any blocking states. */ _Thread_Set_state( the_thread, STATES_DORMANT ); 489b0: 4878 0001 pea 1 489b4: 2f0a movel %a2,%sp@- 489b6: 4eb9 0004 95bc jsr 495bc <_Thread_Set_state> if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { 489bc: 2f0a movel %a2,%sp@- 489be: 4eb9 0004 93f4 jsr 493f4 <_Thread_queue_Extract_with_proxy> 489c4: 4fef 0018 lea %sp@(24),%sp 489c8: 4a00 tstb %d0 489ca: 660a bnes 489d6 <_Thread_Close+0x72> if ( _Watchdog_Is_active( &the_thread->Timer ) ) 489cc: 7002 moveq #2,%d0 489ce: b0aa 0050 cmpl %a2@(80),%d0 489d2: 6700 0088 beqw 48a5c <_Thread_Close+0xf8> */ RTEMS_INLINE_ROUTINE void _Scheduler_Free( Thread_Control *the_thread ) { return _Scheduler.Operations.free( the_thread ); 489d6: 2f0a movel %a2,%sp@- 489d8: 2079 0005 db2c moveal 5db2c <_Scheduler+0x1c>,%a0 489de: 4e90 jsr %a0@ /* * The thread might have been FP. So deal with that. */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( _Thread_Is_allocated_fp( the_thread ) ) 489e0: 588f addql #4,%sp 489e2: b5f9 0005 f4ca cmpal 5f4ca <_Thread_Allocated_fp>,%a2 489e8: 6736 beqs 48a20 <_Thread_Close+0xbc> _Thread_Deallocate_fp(); #endif the_thread->fp_context = NULL; _Workspace_Free( the_thread->Start.fp_context ); 489ea: 2f2a 00b8 movel %a2@(184),%sp@- 489ee: 47f9 0004 9e1e lea 49e1e <_Workspace_Free>,%a3 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( _Thread_Is_allocated_fp( the_thread ) ) _Thread_Deallocate_fp(); #endif the_thread->fp_context = NULL; 489f4: 42aa 00f4 clrl %a2@(244) _Workspace_Free( the_thread->Start.fp_context ); 489f8: 4e93 jsr %a3@ /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); 489fa: 2f0a movel %a2,%sp@- 489fc: 4eb9 0004 96b4 jsr 496b4 <_Thread_Stack_Free> the_thread->Start.stack = NULL; _Workspace_Free( the_thread->extensions ); 48a02: 2f2a 0104 movel %a2@(260),%sp@- /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; 48a06: 42aa 00bc clrl %a2@(188) _Workspace_Free( the_thread->extensions ); 48a0a: 4e93 jsr %a3@ the_thread->extensions = NULL; } 48a0c: 266e fffc moveal %fp@(-4),%a3 */ _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; _Workspace_Free( the_thread->extensions ); the_thread->extensions = NULL; 48a10: 4fef 000c lea %sp@(12),%sp 48a14: 42aa 0104 clrl %a2@(260) } 48a18: 246e fff8 moveal %fp@(-8),%a2 48a1c: 4e5e unlk %fp 48a1e: 4e75 rts if ( _Thread_Is_allocated_fp( the_thread ) ) _Thread_Deallocate_fp(); #endif the_thread->fp_context = NULL; _Workspace_Free( the_thread->Start.fp_context ); 48a20: 2f2a 00b8 movel %a2@(184),%sp@- 48a24: 47f9 0004 9e1e lea 49e1e <_Workspace_Free>,%a3 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( _Thread_Is_allocated_fp( the_thread ) ) _Thread_Deallocate_fp(); #endif the_thread->fp_context = NULL; 48a2a: 42aa 00f4 clrl %a2@(244) */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) RTEMS_INLINE_ROUTINE void _Thread_Deallocate_fp( void ) { _Thread_Allocated_fp = NULL; 48a2e: 42b9 0005 f4ca clrl 5f4ca <_Thread_Allocated_fp> _Workspace_Free( the_thread->Start.fp_context ); 48a34: 4e93 jsr %a3@ /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); 48a36: 2f0a movel %a2,%sp@- 48a38: 4eb9 0004 96b4 jsr 496b4 <_Thread_Stack_Free> the_thread->Start.stack = NULL; _Workspace_Free( the_thread->extensions ); 48a3e: 2f2a 0104 movel %a2@(260),%sp@- /* * Free the rest of the memory associated with this task * and set the associated pointers to NULL for safety. */ _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; 48a42: 42aa 00bc clrl %a2@(188) _Workspace_Free( the_thread->extensions ); 48a46: 4e93 jsr %a3@ the_thread->extensions = NULL; } 48a48: 266e fffc moveal %fp@(-4),%a3 */ _Thread_Stack_Free( the_thread ); the_thread->Start.stack = NULL; _Workspace_Free( the_thread->extensions ); the_thread->extensions = NULL; 48a4c: 4fef 000c lea %sp@(12),%sp 48a50: 42aa 0104 clrl %a2@(260) } 48a54: 246e fff8 moveal %fp@(-8),%a2 48a58: 4e5e unlk %fp 48a5a: 4e75 rts */ _Thread_Set_state( the_thread, STATES_DORMANT ); if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { if ( _Watchdog_Is_active( &the_thread->Timer ) ) (void) _Watchdog_Remove( &the_thread->Timer ); 48a5c: 486a 0048 pea %a2@(72) 48a60: 4eb9 0004 9c80 jsr 49c80 <_Watchdog_Remove> 48a66: 588f addql #4,%sp 48a68: 2079 0005 db2c moveal 5db2c <_Scheduler+0x1c>,%a0 48a6e: 2f0a movel %a2,%sp@- 48a70: 4e90 jsr %a0@ /* * The thread might have been FP. So deal with that. */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( _Thread_Is_allocated_fp( the_thread ) ) 48a72: 588f addql #4,%sp 48a74: b5f9 0005 f4ca cmpal 5f4ca <_Thread_Allocated_fp>,%a2 48a7a: 6600 ff6e bnew 489ea <_Thread_Close+0x86> 48a7e: 60a0 bras 48a20 <_Thread_Close+0xbc> <== NOT EXECUTED =============================================================================== 00048b30 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 48b30: 4e56 fffc linkw %fp,#-4 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 48b34: 486e fffc pea %fp@(-4) 48b38: 2f2e 0008 movel %fp@(8),%sp@- 48b3c: 4eb9 0004 8cfc jsr 48cfc <_Thread_Get> switch ( location ) { 48b42: 508f addql #8,%sp 48b44: 4aae fffc tstl %fp@(-4) 48b48: 661e bnes 48b68 <_Thread_Delay_ended+0x38> <== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 48b4a: 2f3c 1000 0018 movel #268435480,%sp@- 48b50: 2f00 movel %d0,%sp@- 48b52: 4eb9 0004 8908 jsr 48908 <_Thread_Clear_state> 48b58: 508f addql #8,%sp 48b5a: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 48b60: 5380 subql #1,%d0 48b62: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Thread_Unnest_dispatch(); break; } } 48b68: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00048b6c <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 48b6c: 4e56 ffc8 linkw %fp,#-56 48b70: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); 48b74: 283c 0000 0700 movel #1792,%d4 48b7a: 2004 movel %d4,%d0 { Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 48b7c: 2479 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a2 _ISR_Disable( level ); 48b82: 40c1 movew %sr,%d1 48b84: 8081 orl %d1,%d0 48b86: 46c0 movew %d0,%sr while ( _Thread_Dispatch_necessary == true ) { 48b88: 1039 0005 f5f0 moveb 5f5f0 <_Per_CPU_Information+0x18>,%d0 48b8e: 6700 0120 beqw 48cb0 <_Thread_Dispatch+0x144> heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 48b92: 7001 moveq #1,%d0 48b94: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; 48b9a: 2679 0005 f5e8 moveal 5f5e8 <_Per_CPU_Information+0x10>,%a3 _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; 48ba0: 4200 clrb %d0 _Thread_Executing = heir; 48ba2: 23cb 0005 f5e4 movel %a3,5f5e4 <_Per_CPU_Information+0xc> executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; 48ba8: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) 48bae: b7ca cmpal %a2,%a3 48bb0: 6700 00fe beqw 48cb0 <_Thread_Dispatch+0x144> 48bb4: 260e movel %fp,%d3 48bb6: 240e movel %fp,%d2 48bb8: 5183 subql #8,%d3 48bba: 2e3c 0004 bdf8 movel #310776,%d7 48bc0: 0682 ffff fff0 addil #-16,%d2 48bc6: 2c3c 0004 9824 movel #301092,%d6 48bcc: 2a3c 0004 97dc movel #301020,%d5 48bd2: 4bf9 0004 9aec lea 49aec <_User_extensions_Thread_switch>,%a5 48bd8: 49f9 0004 9e6c lea 49e6c <_CPU_Context_switch>,%a4 */ #if __RTEMS_ADA__ executing->rtems_ada_self = rtems_ada_self; rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) 48bde: 7001 moveq #1,%d0 48be0: b0ab 007a cmpl %a3@(122),%d0 48be4: 6700 00e2 beqw 48cc8 <_Thread_Dispatch+0x15c> heir->cpu_time_budget = _Thread_Ticks_per_timeslice; _ISR_Enable( level ); 48be8: 46c1 movew %d1,%sr #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 48bea: 2f03 movel %d3,%sp@- 48bec: 2047 moveal %d7,%a0 48bee: 4e90 jsr %a0@ _Timestamp_Subtract( 48bf0: 2046 moveal %d6,%a0 48bf2: 2f02 movel %d2,%sp@- 48bf4: 2f03 movel %d3,%sp@- 48bf6: 4879 0005 f4f4 pea 5f4f4 <_Thread_Time_of_last_context_switch> 48bfc: 4e90 jsr %a0@ &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 48bfe: 2045 moveal %d5,%a0 48c00: 2f02 movel %d2,%sp@- 48c02: 486a 0082 pea %a2@(130) 48c06: 4e90 jsr %a0@ #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 48c08: 2079 0005 f4ce moveal 5f4ce <_Thread_libc_reent>,%a0 48c0e: 4fef 0018 lea %sp@(24),%sp &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 48c12: 202e fff8 movel %fp@(-8),%d0 48c16: 222e fffc movel %fp@(-4),%d1 48c1a: 23c0 0005 f4f4 movel %d0,5f4f4 <_Thread_Time_of_last_context_switch> 48c20: 23c1 0005 f4f8 movel %d1,5f4f8 <_Thread_Time_of_last_context_switch+0x4> #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 48c26: 4a88 tstl %a0 48c28: 6708 beqs 48c32 <_Thread_Dispatch+0xc6> <== NEVER TAKEN executing->libc_reent = *_Thread_libc_reent; 48c2a: 2550 00f8 movel %a0@,%a2@(248) *_Thread_libc_reent = heir->libc_reent; 48c2e: 20ab 00f8 movel %a3@(248),%a0@ } _User_extensions_Thread_switch( executing, heir ); 48c32: 2f0b movel %a3,%sp@- 48c34: 2f0a movel %a2,%sp@- 48c36: 4e95 jsr %a5@ if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 48c38: 486b 00c0 pea %a3@(192) 48c3c: 486a 00c0 pea %a2@(192) 48c40: 4e94 jsr %a4@ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( (executing->fp_context != NULL) && 48c42: 4fef 0010 lea %sp@(16),%sp 48c46: 4aaa 00f4 tstl %a2@(244) 48c4a: 672c beqs 48c78 <_Thread_Dispatch+0x10c> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) RTEMS_INLINE_ROUTINE bool _Thread_Is_allocated_fp ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Allocated_fp ); 48c4c: 2079 0005 f4ca moveal 5f4ca <_Thread_Allocated_fp>,%a0 48c52: b1ca cmpal %a2,%a0 48c54: 6722 beqs 48c78 <_Thread_Dispatch+0x10c> !_Thread_Is_allocated_fp( executing ) ) { if ( _Thread_Allocated_fp != NULL ) 48c56: 4a88 tstl %a0 48c58: 670c beqs 48c66 <_Thread_Dispatch+0xfa> _Context_Save_fp( &_Thread_Allocated_fp->fp_context ); 48c5a: 4868 00f4 pea %a0@(244) 48c5e: 4eb9 0004 9f92 jsr 49f92 <_CPU_Context_save_fp> 48c64: 588f addql #4,%sp _Context_Restore_fp( &executing->fp_context ); 48c66: 486a 00f4 pea %a2@(244) 48c6a: 4eb9 0004 9fca jsr 49fca <_CPU_Context_restore_fp> _Thread_Allocated_fp = executing; 48c70: 588f addql #4,%sp 48c72: 23ca 0005 f4ca movel %a2,5f4ca <_Thread_Allocated_fp> if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; 48c78: 2479 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a2 _ISR_Disable( level ); 48c7e: 2004 movel %d4,%d0 48c80: 40c1 movew %sr,%d1 48c82: 8081 orl %d1,%d0 48c84: 46c0 movew %d0,%sr Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 48c86: 1039 0005 f5f0 moveb 5f5f0 <_Per_CPU_Information+0x18>,%d0 48c8c: 6722 beqs 48cb0 <_Thread_Dispatch+0x144> heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 48c8e: 7001 moveq #1,%d0 48c90: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; 48c96: 2679 0005 f5e8 moveal 5f5e8 <_Per_CPU_Information+0x10>,%a3 _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; 48c9c: 4200 clrb %d0 _Thread_Executing = heir; 48c9e: 23cb 0005 f5e4 movel %a3,5f5e4 <_Per_CPU_Information+0xc> executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Thread_Dispatch_necessary = false; 48ca4: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) 48caa: b5cb cmpal %a3,%a2 48cac: 6600 ff30 bnew 48bde <_Thread_Dispatch+0x72> _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 48cb0: 42b9 0005 f448 clrl 5f448 <_Thread_Dispatch_disable_level> _ISR_Enable( level ); 48cb6: 46c1 movew %d1,%sr _API_extensions_Run_postswitch(); 48cb8: 4eb9 0004 7056 jsr 47056 <_API_extensions_Run_postswitch> } 48cbe: 4cee 3cfc ffc8 moveml %fp@(-56),%d2-%d7/%a2-%a5 48cc4: 4e5e unlk %fp 48cc6: 4e75 rts #if __RTEMS_ADA__ executing->rtems_ada_self = rtems_ada_self; rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 48cc8: 41f9 0005 f400 lea 5f400 <_Thread_Ticks_per_timeslice>,%a0 48cce: 2750 0076 movel %a0@,%a3@(118) 48cd2: 6000 ff14 braw 48be8 <_Thread_Dispatch+0x7c> =============================================================================== 0004d910 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 4d910: 4e56 0000 linkw %fp,#0 4d914: 2f0a movel %a2,%sp@- #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 4d916: 2479 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a2 * * Output parameters: NONE */ void _Thread_Handler( void ) { 4d91c: 2f02 movel %d2,%sp@- /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4d91e: 222a 00a8 movel %a2@(168),%d1 _ISR_Set_level(level); 4d922: 40c0 movew %sr,%d0 4d924: e189 lsll #8,%d1 4d926: 0280 0000 f8ff andil #63743,%d0 4d92c: 8081 orl %d1,%d0 4d92e: 46c0 movew %d0,%sr #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; doneConstructors = 1; 4d930: 7001 moveq #1,%d0 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4d932: 1439 0005 ec0c moveb 5ec0c ,%d2 doneConstructors = 1; 4d938: 13c0 0005 ec0c moveb %d0,5ec0c #endif #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( (executing->fp_context != NULL) && 4d93e: 4aaa 00f4 tstl %a2@(244) 4d942: 6720 beqs 4d964 <_Thread_Handler+0x54> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) RTEMS_INLINE_ROUTINE bool _Thread_Is_allocated_fp ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Allocated_fp ); 4d944: 2079 0005 f4ca moveal 5f4ca <_Thread_Allocated_fp>,%a0 4d94a: b1ca cmpal %a2,%a0 4d94c: 6716 beqs 4d964 <_Thread_Handler+0x54> !_Thread_Is_allocated_fp( executing ) ) { if ( _Thread_Allocated_fp != NULL ) 4d94e: 4a88 tstl %a0 4d950: 670c beqs 4d95e <_Thread_Handler+0x4e> _Context_Save_fp( &_Thread_Allocated_fp->fp_context ); 4d952: 4868 00f4 pea %a0@(244) 4d956: 4eb9 0004 9f92 jsr 49f92 <_CPU_Context_save_fp> 4d95c: 588f addql #4,%sp _Thread_Allocated_fp = executing; 4d95e: 23ca 0005 f4ca movel %a2,5f4ca <_Thread_Allocated_fp> /* * Take care that 'begin' extensions get to complete before * 'switch' extensions can run. This means must keep dispatch * disabled until all 'begin' extensions complete. */ _User_extensions_Thread_begin( executing ); 4d964: 2f0a movel %a2,%sp@- 4d966: 4eb9 0004 9938 jsr 49938 <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4d96c: 4eb9 0004 8cd6 jsr 48cd6 <_Thread_Enable_dispatch> /* * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { 4d972: 588f addql #4,%sp 4d974: 4a02 tstb %d2 4d976: 6746 beqs 4d9be <_Thread_Handler+0xae> INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4d978: 4aaa 0092 tstl %a2@(146) 4d97c: 6718 beqs 4d996 <_Thread_Handler+0x86> <== ALWAYS TAKEN * was placed in return_argument. This assumed that if it returned * anything (which is not supporting in all APIs), then it would be * able to fit in a (void *). */ _User_extensions_Thread_exitted( executing ); 4d97e: 2f0a movel %a2,%sp@- <== NOT EXECUTED 4d980: 4eb9 0004 9976 jsr 49976 <_User_extensions_Thread_exitted> <== NOT EXECUTED _Internal_error_Occurred( 4d986: 4878 0005 pea 5 <== NOT EXECUTED 4d98a: 4878 0001 pea 1 <== NOT EXECUTED 4d98e: 42a7 clrl %sp@- <== NOT EXECUTED 4d990: 4eb9 0004 7ac4 jsr 47ac4 <_Internal_error_Occurred> <== NOT EXECUTED } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4d996: 2f2a 009a movel %a2@(154),%sp@- 4d99a: 206a 008e moveal %a2@(142),%a0 4d99e: 4e90 jsr %a0@ INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = 4d9a0: 588f addql #4,%sp 4d9a2: 2540 0028 movel %d0,%a2@(40) * was placed in return_argument. This assumed that if it returned * anything (which is not supporting in all APIs), then it would be * able to fit in a (void *). */ _User_extensions_Thread_exitted( executing ); 4d9a6: 2f0a movel %a2,%sp@- 4d9a8: 4eb9 0004 9976 jsr 49976 <_User_extensions_Thread_exitted> _Internal_error_Occurred( 4d9ae: 4878 0005 pea 5 4d9b2: 4878 0001 pea 1 4d9b6: 42a7 clrl %sp@- 4d9b8: 4eb9 0004 7ac4 jsr 47ac4 <_Internal_error_Occurred> * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { INIT_NAME (); 4d9be: 4eb9 0005 bf60 jsr 5bf60 <_init> } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4d9c4: 4aaa 0092 tstl %a2@(146) 4d9c8: 66b4 bnes 4d97e <_Thread_Handler+0x6e> <== NEVER TAKEN 4d9ca: 60ca bras 4d996 <_Thread_Handler+0x86> =============================================================================== 00048fa4 <_Thread_Handler_initialization>: * * Output parameters: NONE */ void _Thread_Handler_initialization(void) { 48fa4: 4e56 0000 linkw %fp,#0 /* * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) == (!Configuration.stack_free_hook) ) ) 48fa8: 4ab9 0005 dc08 tstl 5dc08 48fae: 57c1 seq %d1 #endif /* * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) 48fb0: 4ab9 0005 dc04 tstl 5dc04 48fb6: 57c0 seq %d0 == (!Configuration.stack_free_hook) ) ) 48fb8: 4481 negl %d1 #endif /* * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) 48fba: 4480 negl %d0 48fbc: b380 eorl %d1,%d0 uint32_t maximum_internal_threads; #if defined(RTEMS_MULTIPROCESSING) uint32_t maximum_proxies; #endif ticks_per_timeslice = Configuration.ticks_per_timeslice; 48fbe: 2239 0005 dbf4 movel 5dbf4 ,%d1 maximum_extensions = Configuration.maximum_extensions; 48fc4: 2079 0005 dbec moveal 5dbec ,%a0 #endif /* * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) 48fca: 4a00 tstb %d0 48fcc: 6650 bnes 4901e <_Thread_Handler_initialization+0x7a> #if defined(RTEMS_MULTIPROCESSING) if ( _System_state_Is_multiprocessing ) maximum_internal_threads += 1; #endif _Objects_Initialize_information( 48fce: 4878 0008 pea 8 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_BAD_STACK_HOOK ); _Thread_Dispatch_necessary = false; 48fd2: 4200 clrb %d0 #if defined(RTEMS_MULTIPROCESSING) if ( _System_state_Is_multiprocessing ) maximum_internal_threads += 1; #endif _Objects_Initialize_information( 48fd4: 42a7 clrl %sp@- 48fd6: 4878 010c pea 10c 48fda: 4878 0001 pea 1 48fde: 4878 0001 pea 1 48fe2: 4878 0001 pea 1 48fe6: 4879 0005 f558 pea 5f558 <_Thread_Internal_information> INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_BAD_STACK_HOOK ); _Thread_Dispatch_necessary = false; 48fec: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> _Thread_Executing = NULL; 48ff2: 42b9 0005 f5e4 clrl 5f5e4 <_Per_CPU_Information+0xc> _Thread_Heir = NULL; 48ff8: 42b9 0005 f5e8 clrl 5f5e8 <_Per_CPU_Information+0x10> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Thread_Allocated_fp = NULL; 48ffe: 42b9 0005 f4ca clrl 5f4ca <_Thread_Allocated_fp> #endif _Thread_Maximum_extensions = maximum_extensions; 49004: 23c8 0005 f4da movel %a0,5f4da <_Thread_Maximum_extensions> _Thread_Ticks_per_timeslice = ticks_per_timeslice; 4900a: 23c1 0005 f400 movel %d1,5f400 <_Thread_Ticks_per_timeslice> #if defined(RTEMS_MULTIPROCESSING) if ( _System_state_Is_multiprocessing ) maximum_internal_threads += 1; #endif _Objects_Initialize_information( 49010: 4eb9 0004 80ac jsr 480ac <_Objects_Initialize_information> 49016: 4fef 001c lea %sp@(28),%sp false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 4901a: 4e5e unlk %fp 4901c: 4e75 rts * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) == (!Configuration.stack_free_hook) ) ) _Internal_error_Occurred( 4901e: 4878 000e pea e 49022: 4878 0001 pea 1 49026: 42a7 clrl %sp@- 49028: 4eb9 0004 7ac4 jsr 47ac4 <_Internal_error_Occurred> ... =============================================================================== 0004d190 <_Thread_Reset>: void _Thread_Reset( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { 4d190: 4e56 0000 linkw %fp,#0 4d194: 2f0a movel %a2,%sp@- 4d196: 246e 0008 moveal %fp@(8),%a2 the_thread->resource_count = 0; the_thread->is_preemptible = the_thread->Start.is_preemptible; the_thread->budget_algorithm = the_thread->Start.budget_algorithm; 4d19a: 256a 00a0 007a movel %a2@(160),%a2@(122) the_thread->budget_callout = the_thread->Start.budget_callout; 4d1a0: 256a 00a4 007e movel %a2@(164),%a2@(126) the_thread->Start.pointer_argument = pointer_argument; 4d1a6: 256e 000c 0096 movel %fp@(12),%a2@(150) the_thread->Start.numeric_argument = numeric_argument; 4d1ac: 256e 0010 009a movel %fp@(16),%a2@(154) void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { the_thread->resource_count = 0; the_thread->is_preemptible = the_thread->Start.is_preemptible; 4d1b2: 156a 009e 0074 moveb %a2@(158),%a2@(116) Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { the_thread->resource_count = 0; 4d1b8: 42aa 001c clrl %a2@(28) the_thread->budget_callout = the_thread->Start.budget_callout; the_thread->Start.pointer_argument = pointer_argument; the_thread->Start.numeric_argument = numeric_argument; if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { 4d1bc: 2f0a movel %a2,%sp@- 4d1be: 4eb9 0004 a008 jsr 4a008 <_Thread_queue_Extract_with_proxy> 4d1c4: 588f addql #4,%sp 4d1c6: 4a00 tstb %d0 4d1c8: 6608 bnes 4d1d2 <_Thread_Reset+0x42> if ( _Watchdog_Is_active( &the_thread->Timer ) ) 4d1ca: 7002 moveq #2,%d0 4d1cc: b0aa 0050 cmpl %a2@(80),%d0 4d1d0: 672a beqs 4d1fc <_Thread_Reset+0x6c> (void) _Watchdog_Remove( &the_thread->Timer ); } if ( the_thread->current_priority != the_thread->Start.initial_priority ) { 4d1d2: 202a 00ac movel %a2@(172),%d0 4d1d6: b0aa 0014 cmpl %a2@(20),%d0 4d1da: 6718 beqs 4d1f4 <_Thread_Reset+0x64> the_thread->real_priority = the_thread->Start.initial_priority; 4d1dc: 2540 0018 movel %d0,%a2@(24) _Thread_Set_priority( the_thread, the_thread->Start.initial_priority ); 4d1e0: 2d4a 0008 movel %a2,%fp@(8) } } 4d1e4: 246e fffc moveal %fp@(-4),%a2 (void) _Watchdog_Remove( &the_thread->Timer ); } if ( the_thread->current_priority != the_thread->Start.initial_priority ) { the_thread->real_priority = the_thread->Start.initial_priority; _Thread_Set_priority( the_thread, the_thread->Start.initial_priority ); 4d1e8: 2d40 000c movel %d0,%fp@(12) } } 4d1ec: 4e5e unlk %fp (void) _Watchdog_Remove( &the_thread->Timer ); } if ( the_thread->current_priority != the_thread->Start.initial_priority ) { the_thread->real_priority = the_thread->Start.initial_priority; _Thread_Set_priority( the_thread, the_thread->Start.initial_priority ); 4d1ee: 4ef9 0004 a248 jmp 4a248 <_Thread_Set_priority> } } 4d1f4: 246e fffc moveal %fp@(-4),%a2 4d1f8: 4e5e unlk %fp 4d1fa: 4e75 rts the_thread->Start.numeric_argument = numeric_argument; if ( !_Thread_queue_Extract_with_proxy( the_thread ) ) { if ( _Watchdog_Is_active( &the_thread->Timer ) ) (void) _Watchdog_Remove( &the_thread->Timer ); 4d1fc: 486a 0048 pea %a2@(72) 4d200: 4eb9 0004 a968 jsr 4a968 <_Watchdog_Remove> 4d206: 588f addql #4,%sp 4d208: 60c8 bras 4d1d2 <_Thread_Reset+0x42> ... =============================================================================== 0004a1b8 <_Thread_Restart>: */ RTEMS_INLINE_ROUTINE bool _States_Is_dormant ( States_Control the_states ) { return (the_states & STATES_DORMANT); 4a1b8: 7001 moveq #1,%d0 bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { 4a1ba: 4e56 0000 linkw %fp,#0 4a1be: 2f0a movel %a2,%sp@- 4a1c0: 246e 0008 moveal %fp@(8),%a2 4a1c4: c0aa 0010 andl %a2@(16),%d0 if ( !_States_Is_dormant( the_thread->current_state ) ) { 4a1c8: 670a beqs 4a1d4 <_Thread_Restart+0x1c> return true; } return false; } 4a1ca: 246e fffc moveal %fp@(-4),%a2 4a1ce: 4e5e unlk %fp _Thread_Restart_self(); return true; } return false; 4a1d0: 4200 clrb %d0 } 4a1d2: 4e75 rts Thread_Entry_numeric_type numeric_argument ) { if ( !_States_Is_dormant( the_thread->current_state ) ) { _Thread_Set_transient( the_thread ); 4a1d4: 2f0a movel %a2,%sp@- 4a1d6: 4eb9 0004 a2ac jsr 4a2ac <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); 4a1dc: 2f2e 0010 movel %fp@(16),%sp@- 4a1e0: 2f2e 000c movel %fp@(12),%sp@- 4a1e4: 2f0a movel %a2,%sp@- 4a1e6: 4eb9 0004 d190 jsr 4d190 <_Thread_Reset> _Thread_Load_environment( the_thread ); 4a1ec: 2f0a movel %a2,%sp@- 4a1ee: 4eb9 0004 ce7c jsr 4ce7c <_Thread_Load_environment> _Thread_Ready( the_thread ); 4a1f4: 2f0a movel %a2,%sp@- 4a1f6: 4eb9 0004 d160 jsr 4d160 <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); 4a1fc: 2f0a movel %a2,%sp@- 4a1fe: 4eb9 0004 a74c jsr 4a74c <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) 4a204: 4fef 001c lea %sp@(28),%sp 4a208: b5f9 0006 057c cmpal 6057c <_Per_CPU_Information+0xc>,%a2 4a20e: 670a beqs 4a21a <_Thread_Restart+0x62> return true; } return false; } 4a210: 246e fffc moveal %fp@(-4),%a2 4a214: 4e5e unlk %fp _User_extensions_Thread_restart( the_thread ); if ( _Thread_Is_executing ( the_thread ) ) _Thread_Restart_self(); return true; 4a216: 7001 moveq #1,%d0 } return false; } 4a218: 4e75 rts */ RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void ) { #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( _Thread_Executing->fp_context != NULL ) 4a21a: 4aaa 00f4 tstl %a2@(244) 4a21e: 6712 beqs 4a232 <_Thread_Restart+0x7a> _Context_Restore_fp( &_Thread_Executing->fp_context ); 4a220: 486a 00f4 pea %a2@(244) 4a224: 4eb9 0004 acb2 jsr 4acb2 <_CPU_Context_restore_fp> 4a22a: 2479 0006 057c moveal 6057c <_Per_CPU_Information+0xc>,%a2 4a230: 588f addql #4,%sp #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); 4a232: 486a 00c0 pea %a2@(192) 4a236: 4eb9 0004 ab6a jsr 4ab6a <_CPU_Context_Restart_self> 4a23c: 246e fffc moveal %fp@(-4),%a2 <== NOT EXECUTED 4a240: 588f addql #4,%sp <== NOT EXECUTED 4a242: 4e5e unlk %fp <== NOT EXECUTED _User_extensions_Thread_restart( the_thread ); if ( _Thread_Is_executing ( the_thread ) ) _Thread_Restart_self(); return true; 4a244: 7001 moveq #1,%d0 <== NOT EXECUTED } return false; } =============================================================================== 000496b4 <_Thread_Stack_Free>: */ void _Thread_Stack_Free( Thread_Control *the_thread ) { 496b4: 4e56 0000 linkw %fp,#0 496b8: 206e 0008 moveal %fp@(8),%a0 * Call ONLY the CPU table stack free hook, or the * the RTEMS workspace free. This is so the free * routine properly matches the allocation of the stack. */ if ( Configuration.stack_free_hook ) 496bc: 2279 0005 dc08 moveal 5dc08 ,%a1 496c2: 4a89 tstl %a1 496c4: 670a beqs 496d0 <_Thread_Stack_Free+0x1c> (*Configuration.stack_free_hook)( the_thread->Start.Initial_stack.area ); 496c6: 2d68 00b4 0008 movel %a0@(180),%fp@(8) else _Workspace_Free( the_thread->Start.Initial_stack.area ); } 496cc: 4e5e unlk %fp * the RTEMS workspace free. This is so the free * routine properly matches the allocation of the stack. */ if ( Configuration.stack_free_hook ) (*Configuration.stack_free_hook)( the_thread->Start.Initial_stack.area ); 496ce: 4ed1 jmp %a1@ else _Workspace_Free( the_thread->Start.Initial_stack.area ); 496d0: 2d68 00b4 0008 movel %a0@(180),%fp@(8) } 496d6: 4e5e unlk %fp */ if ( Configuration.stack_free_hook ) (*Configuration.stack_free_hook)( the_thread->Start.Initial_stack.area ); else _Workspace_Free( the_thread->Start.Initial_stack.area ); 496d8: 4ef9 0004 9e1e jmp 49e1e <_Workspace_Free> ... =============================================================================== 000487bc <_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 ) ) { 487bc: 7202 moveq #2,%d1 Thread_blocking_operation_States sync_state __attribute__((unused)), #endif Thread_Control *the_thread, ISR_Level level ) { 487be: 4e56 0000 linkw %fp,#0 487c2: 202e 0010 movel %fp@(16),%d0 487c6: 2f0a movel %a2,%sp@- 487c8: 246e 000c moveal %fp@(12),%a2 #endif /* * The thread is not waiting on anything after this completes. */ the_thread->Wait.queue = NULL; 487cc: 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 ) ) { 487d0: b2aa 0050 cmpl %a2@(80),%d1 487d4: 671c beqs 487f2 <_Thread_blocking_operation_Cancel+0x36> _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); } else _ISR_Enable( level ); 487d6: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 487d8: 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 } 487dc: 246e fffc moveal %fp@(-4),%a2 487e0: 203c 1003 fff8 movel #268697592,%d0 487e6: 2d40 000c movel %d0,%fp@(12) 487ea: 4e5e unlk %fp 487ec: 4ef9 0004 8908 jmp 48908 <_Thread_Clear_state> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 487f2: 123c 0003 moveb #3,%d1 487f6: 2541 0050 movel %d1,%a2@(80) * 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 ) ) { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 487fa: 46c0 movew %d0,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 487fc: 486a 0048 pea %a2@(72) 48800: 4eb9 0004 9c80 jsr 49c80 <_Watchdog_Remove> 48806: 588f addql #4,%sp 48808: 203c 1003 fff8 movel #268697592,%d0 4880e: 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 } 48812: 246e fffc moveal %fp@(-4),%a2 48816: 2d40 000c movel %d0,%fp@(12) 4881a: 4e5e unlk %fp 4881c: 4ef9 0004 8908 jmp 48908 <_Thread_Clear_state> ... =============================================================================== 000490ac <_Thread_queue_Dequeue_priority>: Chain_Node *new_second_node; Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); 490ac: 203c 0000 0700 movel #1792,%d0 */ Thread_Control *_Thread_queue_Dequeue_priority( Thread_queue_Control *the_thread_queue ) { 490b2: 4e56 ffe8 linkw %fp,#-24 490b6: 48d7 3c0c moveml %d2-%d3/%a2-%a5,%sp@ 490ba: 266e 0008 moveal %fp@(8),%a3 Chain_Node *new_second_node; Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); 490be: 40c3 movew %sr,%d3 490c0: 8083 orl %d3,%d0 490c2: 46c0 movew %d0,%sr for( index=0 ; 490c4: 4280 clrl %d0 Chain_Node *new_second_node; Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); 490c6: 204b moveal %a3,%a0 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 490c8: 2400 movel %d0,%d2 490ca: 2200 movel %d0,%d1 for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { 490cc: 5280 addql #1,%d0 490ce: e58a lsll #2,%d2 490d0: e989 lsll #4,%d1 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } 490d2: 2450 moveal %a0@,%a2 490d4: 9282 subl %d2,%d1 Chain_Node *previous_node; _ISR_Disable( level ); for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { 490d6: 41e8 000c lea %a0@(12),%a0 490da: 43f3 1804 lea %a3@(00000004,%d1:l),%a1 if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) { 490de: b3ca cmpal %a2,%a1 490e0: 6616 bnes 490f8 <_Thread_queue_Dequeue_priority+0x4c> Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); for( index=0 ; 490e2: 7204 moveq #4,%d1 490e4: b280 cmpl %d0,%d1 490e6: 66e0 bnes 490c8 <_Thread_queue_Dequeue_priority+0x1c> } /* * We did not find a thread to unblock. */ _ISR_Enable( level ); 490e8: 46c3 movew %d3,%sr return NULL; 490ea: 4282 clrl %d2 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } 490ec: 2002 movel %d2,%d0 490ee: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 490f4: 4e5e unlk %fp 490f6: 4e75 rts 490f8: 200a movel %a2,%d0 _ISR_Disable( level ); for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { if ( !_Chain_Is_empty( &the_thread_queue->Queues.Priority[ index ] ) ) { the_thread = (Thread_Control *) _Chain_First( 490fa: 240a movel %a2,%d2 490fc: 0680 0000 003c addil #60,%d0 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } 49102: 206a 0038 moveal %a2@(56),%a0 dequeue: the_thread->Wait.queue = NULL; new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; next_node = the_thread->Object.Node.next; 49106: 2252 moveal %a2@,%a1 previous_node = the_thread->Object.Node.previous; 49108: 266a 0004 moveal %a2@(4),%a3 */ _ISR_Enable( level ); return NULL; dequeue: the_thread->Wait.queue = NULL; 4910c: 42aa 0044 clrl %a2@(68) new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; next_node = the_thread->Object.Node.next; previous_node = the_thread->Object.Node.previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { 49110: b088 cmpl %a0,%d0 49112: 6700 008a beqw 4919e <_Thread_queue_Dequeue_priority+0xf2> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } 49116: 286a 0040 moveal %a2@(64),%a4 next_node = the_thread->Object.Node.next; previous_node = the_thread->Object.Node.previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; 4911a: 2a50 moveal %a0@,%a5 previous_node->next = new_first_node; next_node->previous = new_first_node; 4911c: 2348 0004 movel %a0,%a1@(4) if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; previous_node->next = new_first_node; 49120: 2688 movel %a0,%a3@ next_node->previous = new_first_node; new_first_node->next = next_node; new_first_node->previous = previous_node; 49122: 214b 0004 movel %a3,%a0@(4) last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; previous_node->next = new_first_node; next_node->previous = new_first_node; new_first_node->next = next_node; 49126: 2089 movel %a1,%a0@ new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { 49128: 226a 0040 moveal %a2@(64),%a1 4912c: b3ea 0038 cmpal %a2@(56),%a1 49130: 6716 beqs 49148 <_Thread_queue_Dequeue_priority+0x9c> /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); new_second_node->previous = head; head->next = new_second_node; 49132: 214d 0038 movel %a5,%a0@(56) new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); 49136: 43e8 003c lea %a0@(60),%a1 4913a: 2889 movel %a1,%a4@ new_first_node->next = next_node; new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); 4913c: 43e8 0038 lea %a0@(56),%a1 49140: 2b49 0004 movel %a1,%a5@(4) tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); new_second_node->previous = head; head->next = new_second_node; tail->previous = last_node; 49144: 214c 0040 movel %a4,%a0@(64) } else { previous_node->next = next_node; next_node->previous = previous_node; } if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 49148: 7002 moveq #2,%d0 4914a: b0aa 0050 cmpl %a2@(80),%d0 4914e: 671e beqs 4916e <_Thread_queue_Dequeue_priority+0xc2> _ISR_Enable( level ); 49150: 46c3 movew %d3,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 49152: 2f3c 1003 fff8 movel #268697592,%sp@- 49158: 2f0a movel %a2,%sp@- 4915a: 4eb9 0004 8908 jsr 48908 <_Thread_Clear_state> 49160: 508f addql #8,%sp #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } 49162: 2002 movel %d2,%d0 49164: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 4916a: 4e5e unlk %fp 4916c: 4e75 rts RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 4916e: 7203 moveq #3,%d1 49170: 2541 0050 movel %d1,%a2@(80) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 49174: 46c3 movew %d3,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 49176: 486a 0048 pea %a2@(72) 4917a: 4eb9 0004 9c80 jsr 49c80 <_Watchdog_Remove> 49180: 2f3c 1003 fff8 movel #268697592,%sp@- 49186: 2f0a movel %a2,%sp@- 49188: 4eb9 0004 8908 jsr 48908 <_Thread_Clear_state> 4918e: 4fef 000c lea %sp@(12),%sp #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif return( the_thread ); } 49192: 2002 movel %d2,%d0 49194: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 4919a: 4e5e unlk %fp 4919c: 4e75 rts head->next = new_second_node; tail->previous = last_node; last_node->next = tail; } } else { previous_node->next = next_node; 4919e: 2689 movel %a1,%a3@ next_node->previous = previous_node; 491a0: 234b 0004 movel %a3,%a1@(4) 491a4: 60a2 bras 49148 <_Thread_queue_Dequeue_priority+0x9c> ... =============================================================================== 00049250 <_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 ) { 49250: 4e56 ffe0 linkw %fp,#-32 49254: 48d7 1c7c moveml %d2-%d6/%a2-%a4,%sp@ 49258: 246e 000c moveal %fp@(12),%a2 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4925c: 41ea 003c lea %a2@(60),%a0 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 49260: 49ea 0038 lea %a2@(56),%a4 49264: 266e 0008 moveal %fp@(8),%a3 Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; 49268: 222a 0014 movel %a2@(20),%d1 RTEMS_INLINE_ROUTINE uint32_t _Thread_queue_Header_number ( Priority_Control the_priority ) { return (the_priority / TASK_QUEUE_DATA_PRIORITIES_PER_HEADER); 4926c: 2a01 movel %d1,%d5 4926e: ec8d lsrl #6,%d5 header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; block_state = the_thread_queue->state; 49270: 242b 0038 movel %a3@(56),%d2 Chain_Node *tail = _Chain_Tail( the_chain ); 49274: 2548 0038 movel %a0,%a2@(56) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 49278: 254c 0040 movel %a4,%a2@(64) Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 4927c: 42aa 003c clrl %a2@(60) if ( _Thread_queue_Is_reverse_search( priority ) ) 49280: 0801 0005 btst #5,%d1 49284: 665e bnes 492e4 <_Thread_queue_Enqueue_priority+0x94> 49286: 700c moveq #12,%d0 49288: 4c00 5800 mulsl %d0,%d5 goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); 4928c: 2c3c 0000 0700 movel #1792,%d6 49292: 2006 movel %d6,%d0 RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Tail(the_chain)); 49294: 49f3 5804 lea %a3@(00000004,%d5:l),%a4 49298: 40c3 movew %sr,%d3 4929a: 8083 orl %d3,%d0 4929c: 46c0 movew %d0,%sr 4929e: 2803 movel %d3,%d4 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 492a0: 2073 5800 moveal %a3@(00000000,%d5:l),%a0 restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 492a4: b9c8 cmpal %a0,%a4 492a6: 6700 013a beqw 493e2 <_Thread_queue_Enqueue_priority+0x192> search_priority = search_thread->current_priority; 492aa: 2268 0014 moveal %a0@(20),%a1 if ( priority <= search_priority ) 492ae: b3c1 cmpal %d1,%a1 492b0: 6418 bccs 492ca <_Thread_queue_Enqueue_priority+0x7a> break; search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); 492b2: 2006 movel %d6,%d0 492b4: 46c3 movew %d3,%sr 492b6: 8083 orl %d3,%d0 492b8: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE bool _States_Are_set ( States_Control the_states, States_Control mask ) { return ( (the_states & mask) != STATES_READY); 492ba: 2002 movel %d2,%d0 492bc: c0a8 0010 andl %a0@(16),%d0 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 492c0: 6700 00be beqw 49380 <_Thread_queue_Enqueue_priority+0x130> _ISR_Enable( level ); goto restart_forward_search; } search_thread = (Thread_Control *)search_thread->Object.Node.next; 492c4: 2050 moveal %a0@,%a0 restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 492c6: b9c8 cmpal %a0,%a4 492c8: 66e0 bnes 492aa <_Thread_queue_Enqueue_priority+0x5a> } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 492ca: 202b 0030 movel %a3@(48),%d0 492ce: 7401 moveq #1,%d2 492d0: b480 cmpl %d0,%d2 492d2: 6700 00c4 beqw 49398 <_Thread_queue_Enqueue_priority+0x148> * 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; 492d6: 206e 0010 moveal %fp@(16),%a0 492da: 2084 movel %d4,%a0@ return the_thread_queue->sync_state; } 492dc: 4cd7 1c7c moveml %sp@,%d2-%d6/%a2-%a4 492e0: 4e5e unlk %fp 492e2: 4e75 rts 492e4: 700c moveq #12,%d0 492e6: 4c00 5800 mulsl %d0,%d5 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 492ea: 4283 clrl %d3 492ec: 1639 0005 dbe2 moveb 5dbe2 ,%d3 _ISR_Disable( level ); 492f2: 2c3c 0000 0700 movel #1792,%d6 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 492f8: da8b addl %a3,%d5 492fa: 2845 moveal %d5,%a4 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 492fc: 2243 moveal %d3,%a1 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 492fe: 508c addql #8,%a4 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); 49300: 2006 movel %d6,%d0 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 49302: 5289 addql #1,%a1 _ISR_Disable( level ); 49304: 40c3 movew %sr,%d3 49306: 8083 orl %d3,%d0 49308: 46c0 movew %d0,%sr 4930a: 2803 movel %d3,%d4 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 4930c: 2054 moveal %a4@,%a0 restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 4930e: ba88 cmpl %a0,%d5 49310: 6720 beqs 49332 <_Thread_queue_Enqueue_priority+0xe2> search_priority = search_thread->current_priority; 49312: 2268 0014 moveal %a0@(20),%a1 if ( priority >= search_priority ) 49316: b3c1 cmpal %d1,%a1 49318: 6318 blss 49332 <_Thread_queue_Enqueue_priority+0xe2> break; search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); 4931a: 2006 movel %d6,%d0 4931c: 46c3 movew %d3,%sr 4931e: 8083 orl %d3,%d0 49320: 46c0 movew %d0,%sr 49322: 2002 movel %d2,%d0 49324: c0a8 0010 andl %a0@(16),%d0 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 49328: 6736 beqs 49360 <_Thread_queue_Enqueue_priority+0x110> _ISR_Enable( level ); goto restart_reverse_search; } search_thread = (Thread_Control *) search_thread->Object.Node.previous; 4932a: 2068 0004 moveal %a0@(4),%a0 restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 4932e: ba88 cmpl %a0,%d5 49330: 66e0 bnes 49312 <_Thread_queue_Enqueue_priority+0xc2> } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != 49332: 202b 0030 movel %a3@(48),%d0 49336: 7401 moveq #1,%d2 49338: b480 cmpl %d0,%d2 4933a: 669a bnes 492d6 <_Thread_queue_Enqueue_priority+0x86> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 4933c: 42ab 0030 clrl %a3@(48) if ( priority == search_priority ) 49340: b3c1 cmpal %d1,%a1 49342: 677a beqs 493be <_Thread_queue_Enqueue_priority+0x16e> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; 49344: 2250 moveal %a0@,%a1 the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; 49346: 2548 0004 movel %a0,%a2@(4) search_node = (Chain_Node *) search_thread; next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; 4934a: 2489 movel %a1,%a2@ the_node->previous = search_node; search_node->next = the_node; next_node->previous = the_node; 4934c: 234a 0004 movel %a2,%a1@(4) next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; search_node->next = the_node; 49350: 208a movel %a2,%a0@ next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 49352: 254b 0044 movel %a3,%a2@(68) _ISR_Enable( level ); 49356: 46c3 movew %d3,%sr * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 49358: 4cd7 1c7c moveml %sp@,%d2-%d6/%a2-%a4 4935c: 4e5e unlk %fp 4935e: 4e75 rts if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); if ( !_States_Are_set( search_thread->current_state, block_state) ) { _ISR_Enable( level ); 49360: 46c3 movew %d3,%sr the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 49362: 4283 clrl %d3 49364: 1639 0005 dbe2 moveb 5dbe2 ,%d3 _ISR_Disable( level ); 4936a: 2006 movel %d6,%d0 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 4936c: 2243 moveal %d3,%a1 4936e: 5289 addql #1,%a1 _ISR_Disable( level ); 49370: 40c3 movew %sr,%d3 49372: 8083 orl %d3,%d0 49374: 46c0 movew %d0,%sr 49376: 2803 movel %d3,%d4 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 49378: 2054 moveal %a4@,%a0 restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 4937a: ba88 cmpl %a0,%d5 4937c: 6694 bnes 49312 <_Thread_queue_Enqueue_priority+0xc2><== NEVER TAKEN 4937e: 60b2 bras 49332 <_Thread_queue_Enqueue_priority+0xe2> if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); if ( !_States_Are_set( search_thread->current_state, block_state) ) { _ISR_Enable( level ); 49380: 46c3 movew %d3,%sr if ( _Thread_queue_Is_reverse_search( priority ) ) goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); 49382: 2006 movel %d6,%d0 49384: 40c3 movew %sr,%d3 49386: 8083 orl %d3,%d0 49388: 46c0 movew %d0,%sr 4938a: 2803 movel %d3,%d4 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 4938c: 2073 5800 moveal %a3@(00000000,%d5:l),%a0 restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 49390: b9c8 cmpal %a0,%a4 49392: 6600 ff16 bnew 492aa <_Thread_queue_Enqueue_priority+0x5a> 49396: 604a bras 493e2 <_Thread_queue_Enqueue_priority+0x192> if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 49398: 42ab 0030 clrl %a3@(48) if ( priority == search_priority ) 4939c: b3c1 cmpal %d1,%a1 4939e: 671e beqs 493be <_Thread_queue_Enqueue_priority+0x16e> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; 493a0: 2268 0004 moveal %a0@(4),%a1 the_node = (Chain_Node *) the_thread; the_node->next = search_node; 493a4: 2488 movel %a0,%a2@ the_node->previous = previous_node; 493a6: 2549 0004 movel %a1,%a2@(4) previous_node->next = the_node; 493aa: 228a movel %a2,%a1@ search_node->previous = the_node; 493ac: 214a 0004 movel %a2,%a0@(4) the_thread->Wait.queue = the_thread_queue; 493b0: 254b 0044 movel %a3,%a2@(68) _ISR_Enable( level ); 493b4: 46c3 movew %d3,%sr * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 493b6: 4cd7 1c7c moveml %sp@,%d2-%d6/%a2-%a4 493ba: 4e5e unlk %fp 493bc: 4e75 rts the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); 493be: 49e8 003c lea %a0@(60),%a4 previous_node = search_node->previous; 493c2: 2268 0040 moveal %a0@(64),%a1 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); 493c6: 248c movel %a4,%a2@ previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; the_node->previous = previous_node; 493c8: 2549 0004 movel %a1,%a2@(4) previous_node->next = the_node; 493cc: 228a movel %a2,%a1@ search_node->previous = the_node; 493ce: 214a 0040 movel %a2,%a0@(64) the_thread->Wait.queue = the_thread_queue; 493d2: 254b 0044 movel %a3,%a2@(68) _ISR_Enable( level ); 493d6: 46c4 movew %d4,%sr return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 493d8: 7001 moveq #1,%d0 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 493da: 4cd7 1c7c moveml %sp@,%d2-%d6/%a2-%a4 493de: 4e5e unlk %fp 493e0: 4e75 rts } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 493e2: 202b 0030 movel %a3@(48),%d0 if ( _Thread_queue_Is_reverse_search( priority ) ) goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; 493e6: 327c ffff moveaw #-1,%a1 } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 493ea: 7401 moveq #1,%d2 493ec: b480 cmpl %d0,%d2 493ee: 6600 fee6 bnew 492d6 <_Thread_queue_Enqueue_priority+0x86> 493f2: 60a4 bras 49398 <_Thread_queue_Enqueue_priority+0x148> =============================================================================== 0004d9cc <_Thread_queue_Extract_fifo>: Thread_Control *the_thread ) { ISR_Level level; _ISR_Disable( level ); 4d9cc: 203c 0000 0700 movel #1792,%d0 void _Thread_queue_Extract_fifo( Thread_queue_Control *the_thread_queue __attribute__((unused)), Thread_Control *the_thread ) { 4d9d2: 4e56 0000 linkw %fp,#0 4d9d6: 2f0a movel %a2,%sp@- 4d9d8: 246e 000c moveal %fp@(12),%a2 ISR_Level level; _ISR_Disable( level ); 4d9dc: 40c1 movew %sr,%d1 4d9de: 8081 orl %d1,%d0 4d9e0: 46c0 movew %d0,%sr 4d9e2: 202a 0010 movel %a2@(16),%d0 4d9e6: 0280 0003 bee0 andil #245472,%d0 if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 4d9ec: 6734 beqs 4da22 <_Thread_queue_Extract_fifo+0x56> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4d9ee: 2252 moveal %a2@,%a1 _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4d9f0: 7002 moveq #2,%d0 previous = the_node->previous; 4d9f2: 206a 0004 moveal %a2@(4),%a0 next->previous = previous; 4d9f6: 2348 0004 movel %a0,%a1@(4) previous->next = next; 4d9fa: 2089 movel %a1,%a0@ return; } _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; 4d9fc: 42aa 0044 clrl %a2@(68) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4da00: b0aa 0050 cmpl %a2@(80),%d0 4da04: 6726 beqs 4da2c <_Thread_queue_Extract_fifo+0x60> _ISR_Enable( level ); 4da06: 46c1 movew %d1,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 4da08: 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 } 4da0c: 246e fffc moveal %fp@(-4),%a2 4da10: 203c 1003 fff8 movel #268697592,%d0 4da16: 2d40 000c movel %d0,%fp@(12) 4da1a: 4e5e unlk %fp 4da1c: 4ef9 0004 8908 jmp 48908 <_Thread_Clear_state> ISR_Level level; _ISR_Disable( level ); if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { _ISR_Enable( level ); 4da22: 46c1 movew %d1,%sr #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4da24: 246e fffc moveal %fp@(-4),%a2 4da28: 4e5e unlk %fp 4da2a: 4e75 rts 4da2c: 7003 moveq #3,%d0 4da2e: 2540 0050 movel %d0,%a2@(80) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { _ISR_Enable( level ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 4da32: 46c1 movew %d1,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 4da34: 486a 0048 pea %a2@(72) 4da38: 4eb9 0004 9c80 jsr 49c80 <_Watchdog_Remove> 4da3e: 588f addql #4,%sp 4da40: 203c 1003 fff8 movel #268697592,%d0 4da46: 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 } 4da4a: 246e fffc moveal %fp@(-4),%a2 4da4e: 2d40 000c movel %d0,%fp@(12) 4da52: 4e5e unlk %fp 4da54: 4ef9 0004 8908 jmp 48908 <_Thread_Clear_state> ... =============================================================================== 0004c340 <_Thread_queue_Extract_priority_helper>: Chain_Node *new_first_node; Chain_Node *new_second_node; Chain_Node *last_node; the_node = (Chain_Node *) the_thread; _ISR_Disable( level ); 4c340: 203c 0000 0700 movel #1792,%d0 void _Thread_queue_Extract_priority_helper( Thread_queue_Control *the_thread_queue __attribute__((unused)), Thread_Control *the_thread, bool requeuing ) { 4c346: 4e56 ffec linkw %fp,#-20 4c34a: 48d7 3c04 moveml %d2/%a2-%a5,%sp@ 4c34e: 246e 000c moveal %fp@(12),%a2 4c352: 142e 0013 moveb %fp@(19),%d2 Chain_Node *new_first_node; Chain_Node *new_second_node; Chain_Node *last_node; the_node = (Chain_Node *) the_thread; _ISR_Disable( level ); 4c356: 40c1 movew %sr,%d1 4c358: 8081 orl %d1,%d0 4c35a: 46c0 movew %d0,%sr */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 4c35c: 202a 0010 movel %a2@(16),%d0 4c360: 0280 0003 bee0 andil #245472,%d0 if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 4c366: 677e beqs 4c3e6 <_Thread_queue_Extract_priority_helper+0xa6><== NEVER TAKEN RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4c368: 200a movel %a2,%d0 4c36a: 0680 0000 003c addil #60,%d0 /* * The thread was actually waiting on a thread queue so let's remove it. */ next_node = the_node->next; 4c370: 2252 moveal %a2@,%a1 previous_node = the_node->previous; 4c372: 266a 0004 moveal %a2@(4),%a3 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c376: 206a 0038 moveal %a2@(56),%a0 */ next_node = the_node->next; previous_node = the_node->previous; if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { 4c37a: b088 cmpl %a0,%d0 4c37c: 6774 beqs 4c3f2 <_Thread_queue_Extract_priority_helper+0xb2> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c37e: 286a 0040 moveal %a2@(64),%a4 if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; 4c382: 2a50 moveal %a0@,%a5 previous_node->next = new_first_node; next_node->previous = new_first_node; 4c384: 2348 0004 movel %a0,%a1@(4) new_first_node = _Chain_First( &the_thread->Wait.Block2n ); new_first_thread = (Thread_Control *) new_first_node; last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; previous_node->next = new_first_node; 4c388: 2688 movel %a0,%a3@ next_node->previous = new_first_node; new_first_node->next = next_node; new_first_node->previous = previous_node; 4c38a: 214b 0004 movel %a3,%a0@(4) last_node = _Chain_Last( &the_thread->Wait.Block2n ); new_second_node = new_first_node->next; previous_node->next = new_first_node; next_node->previous = new_first_node; new_first_node->next = next_node; 4c38e: 2089 movel %a1,%a0@ new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { 4c390: 202a 0040 movel %a2@(64),%d0 4c394: b0aa 0038 cmpl %a2@(56),%d0 4c398: 6716 beqs 4c3b0 <_Thread_queue_Extract_priority_helper+0x70> /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); new_second_node->previous = head; head->next = new_second_node; 4c39a: 214d 0038 movel %a5,%a0@(56) new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); 4c39e: 43e8 003c lea %a0@(60),%a1 4c3a2: 2889 movel %a1,%a4@ new_first_node->next = next_node; new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { /* > two threads on 2-n */ head = _Chain_Head( &new_first_thread->Wait.Block2n ); 4c3a4: 43e8 0038 lea %a0@(56),%a1 4c3a8: 2b49 0004 movel %a1,%a5@(4) tail = _Chain_Tail( &new_first_thread->Wait.Block2n ); new_second_node->previous = head; head->next = new_second_node; tail->previous = last_node; 4c3ac: 214c 0040 movel %a4,%a0@(64) /* * If we are not supposed to touch timers or the thread's state, return. */ if ( requeuing ) { 4c3b0: 4a02 tstb %d2 4c3b2: 6626 bnes 4c3da <_Thread_queue_Extract_priority_helper+0x9a> _ISR_Enable( level ); return; } if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4c3b4: 7002 moveq #2,%d0 4c3b6: b0aa 0050 cmpl %a2@(80),%d0 4c3ba: 6742 beqs 4c3fe <_Thread_queue_Extract_priority_helper+0xbe> _ISR_Enable( level ); 4c3bc: 46c1 movew %d1,%sr 4c3be: 2d4a 0008 movel %a2,%fp@(8) 4c3c2: 227c 1003 fff8 moveal #268697592,%a1 #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c3c8: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4c3ce: 2d49 000c movel %a1,%fp@(12) 4c3d2: 4e5e unlk %fp 4c3d4: 4ef9 0004 8908 jmp 48908 <_Thread_Clear_state> /* * If we are not supposed to touch timers or the thread's state, return. */ if ( requeuing ) { _ISR_Enable( level ); 4c3da: 46c1 movew %d1,%sr #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c3dc: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4c3e2: 4e5e unlk %fp 4c3e4: 4e75 rts Chain_Node *last_node; the_node = (Chain_Node *) the_thread; _ISR_Disable( level ); if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { _ISR_Enable( level ); 4c3e6: 46c1 movew %d1,%sr #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c3e8: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4c3ee: 4e5e unlk %fp 4c3f0: 4e75 rts head->next = new_second_node; tail->previous = last_node; last_node->next = tail; } } else { previous_node->next = next_node; 4c3f2: 2689 movel %a1,%a3@ next_node->previous = previous_node; 4c3f4: 234b 0004 movel %a3,%a1@(4) /* * If we are not supposed to touch timers or the thread's state, return. */ if ( requeuing ) { 4c3f8: 4a02 tstb %d2 4c3fa: 67b8 beqs 4c3b4 <_Thread_queue_Extract_priority_helper+0x74> 4c3fc: 60dc bras 4c3da <_Thread_queue_Extract_priority_helper+0x9a> 4c3fe: 7003 moveq #3,%d0 4c400: 2540 0050 movel %d0,%a2@(80) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { _ISR_Enable( level ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 4c404: 46c1 movew %d1,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 4c406: 486a 0048 pea %a2@(72) 4c40a: 4eb9 0004 9c80 jsr 49c80 <_Watchdog_Remove> 4c410: 588f addql #4,%sp 4c412: 227c 1003 fff8 moveal #268697592,%a1 4c418: 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 } 4c41c: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4c422: 2d49 000c movel %a1,%fp@(12) 4c426: 4e5e unlk %fp 4c428: 4ef9 0004 8908 jmp 48908 <_Thread_Clear_state> ... =============================================================================== 00049460 <_Thread_queue_Initialize>: the_thread_queue->state = state; the_thread_queue->discipline = the_discipline; the_thread_queue->timeout_status = timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( the_discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { 49460: 7201 moveq #1,%d1 Thread_queue_Control *the_thread_queue, Thread_queue_Disciplines the_discipline, States_Control state, uint32_t timeout_status ) { 49462: 4e56 0000 linkw %fp,#0 49466: 206e 0008 moveal %fp@(8),%a0 4946a: 2f0a movel %a2,%sp@- 4946c: 202e 000c movel %fp@(12),%d0 49470: 2f02 movel %d2,%sp@- the_thread_queue->state = state; 49472: 216e 0010 0038 movel %fp@(16),%a0@(56) the_thread_queue->discipline = the_discipline; the_thread_queue->timeout_status = timeout_status; 49478: 216e 0014 003c movel %fp@(20),%a0@(60) States_Control state, uint32_t timeout_status ) { the_thread_queue->state = state; the_thread_queue->discipline = the_discipline; 4947e: 2140 0034 movel %d0,%a0@(52) the_thread_queue->timeout_status = timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 49482: 42a8 0030 clrl %a0@(48) if ( the_discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { 49486: b280 cmpl %d0,%d1 49488: 6716 beqs 494a0 <_Thread_queue_Initialize+0x40> RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4948a: 2448 moveal %a0,%a2 4948c: 588a addql #4,%a2 head->next = tail; head->previous = NULL; 4948e: 42a8 0004 clrl %a0@(4) RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 49492: 208a movel %a2,%a0@ head->next = tail; head->previous = NULL; tail->previous = head; 49494: 2148 0008 movel %a0,%a0@(8) _Chain_Initialize_empty( &the_thread_queue->Queues.Priority[index] ); } else { /* must be THREAD_QUEUE_DISCIPLINE_FIFO */ _Chain_Initialize_empty( &the_thread_queue->Queues.Fifo ); } } 49498: 241f movel %sp@+,%d2 4949a: 245f moveal %sp@+,%a2 4949c: 4e5e unlk %fp 4949e: 4e75 rts the_thread_queue->state = state; the_thread_queue->discipline = the_discipline; the_thread_queue->timeout_status = timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( the_discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { 494a0: 2248 moveal %a0,%a1 494a2: 4280 clrl %d0 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 494a4: 2400 movel %d0,%d2 494a6: 2200 movel %d0,%d1 uint32_t index; for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++) 494a8: 5280 addql #1,%d0 494aa: e58a lsll #2,%d2 494ac: e989 lsll #4,%d1 head->next = tail; head->previous = NULL; 494ae: 42a9 0004 clrl %a1@(4) RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 494b2: 9282 subl %d2,%d1 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 494b4: 45f0 1800 lea %a0@(00000000,%d1:l),%a2 494b8: 234a 0008 movel %a2,%a1@(8) Chain_Node *tail = _Chain_Tail( the_chain ); 494bc: 45f0 1804 lea %a0@(00000004,%d1:l),%a2 the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( the_discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { uint32_t index; for( index=0 ; 494c0: 7204 moveq #4,%d1 494c2: 228a movel %a2,%a1@ index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++) 494c4: 43e9 000c lea %a1@(12),%a1 the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( the_discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { uint32_t index; for( index=0 ; 494c8: b280 cmpl %d0,%d1 494ca: 67cc beqs 49498 <_Thread_queue_Initialize+0x38> <== NEVER TAKEN 494cc: 2400 movel %d0,%d2 494ce: 2200 movel %d0,%d1 index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++) 494d0: 5280 addql #1,%d0 494d2: e58a lsll #2,%d2 494d4: e989 lsll #4,%d1 head->next = tail; head->previous = NULL; 494d6: 42a9 0004 clrl %a1@(4) RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 494da: 9282 subl %d2,%d1 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 494dc: 45f0 1800 lea %a0@(00000000,%d1:l),%a2 494e0: 234a 0008 movel %a2,%a1@(8) Chain_Node *tail = _Chain_Tail( the_chain ); 494e4: 45f0 1804 lea %a0@(00000004,%d1:l),%a2 the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( the_discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { uint32_t index; for( index=0 ; 494e8: 7204 moveq #4,%d1 494ea: 228a movel %a2,%a1@ index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++) 494ec: 43e9 000c lea %a1@(12),%a1 the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( the_discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { uint32_t index; for( index=0 ; 494f0: b280 cmpl %d0,%d1 494f2: 66b0 bnes 494a4 <_Thread_queue_Initialize+0x44> 494f4: 60a2 bras 49498 <_Thread_queue_Initialize+0x38> ... =============================================================================== 0004c430 <_Thread_queue_Process_timeout>: #include void _Thread_queue_Process_timeout( Thread_Control *the_thread ) { 4c430: 4e56 0000 linkw %fp,#0 4c434: 206e 0008 moveal %fp@(8),%a0 Thread_queue_Control *the_thread_queue = the_thread->Wait.queue; 4c438: 2268 0044 moveal %a0@(68),%a1 * If it is not satisfied, then it is "nothing happened" and * this is the "timeout" transition. After a request is satisfied, * a timeout is not allowed to occur. */ if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED && 4c43c: 2029 0030 movel %a1@(48),%d0 4c440: 6708 beqs 4c44a <_Thread_queue_Process_timeout+0x1a> 4c442: b1f9 0005 f5e4 cmpal 5f5e4 <_Per_CPU_Information+0xc>,%a0 4c448: 6716 beqs 4c460 <_Thread_queue_Process_timeout+0x30><== ALWAYS TAKEN if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; 4c44a: 2169 003c 0034 movel %a1@(60),%a0@(52) _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); 4c450: 2f08 movel %a0,%sp@- 4c452: 2f09 movel %a1,%sp@- 4c454: 4eb9 0004 c308 jsr 4c308 <_Thread_queue_Extract> 4c45a: 508f addql #8,%sp } } 4c45c: 4e5e unlk %fp 4c45e: 4e75 rts * a timeout is not allowed to occur. */ if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED && _Thread_Is_executing( the_thread ) ) { if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { 4c460: 7203 moveq #3,%d1 4c462: b280 cmpl %d0,%d1 4c464: 67f6 beqs 4c45c <_Thread_queue_Process_timeout+0x2c> the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 4c466: 7002 moveq #2,%d0 } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); } } 4c468: 4e5e unlk %fp */ if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED && _Thread_Is_executing( the_thread ) ) { if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; 4c46a: 2169 003c 0034 movel %a1@(60),%a0@(52) the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 4c470: 2340 0030 movel %d0,%a1@(48) } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); } } ... =============================================================================== 000494f8 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 494f8: 4e56 fff0 linkw %fp,#-16 494fc: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 49500: 246e 0008 moveal %fp@(8),%a2 49504: 266e 000c moveal %fp@(12),%a3 /* * Just in case the thread really wasn't blocked on a thread queue * when we get here. */ if ( !the_thread_queue ) 49508: 4a8a tstl %a2 4950a: 6708 beqs 49514 <_Thread_queue_Requeue+0x1c> <== NEVER TAKEN /* * If queueing by FIFO, there is nothing to do. This only applies to * priority blocking discipline. */ if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { 4950c: 7001 moveq #1,%d0 4950e: b0aa 0034 cmpl %a2@(52),%d0 49512: 670a beqs 4951e <_Thread_queue_Requeue+0x26> <== ALWAYS TAKEN _Thread_queue_Extract_priority_helper( tq, the_thread, true ); (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); } _ISR_Enable( level ); } } 49514: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 <== NOT EXECUTED 4951a: 4e5e unlk %fp <== NOT EXECUTED 4951c: 4e75 rts <== NOT EXECUTED if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 4951e: 303c 0700 movew #1792,%d0 49522: 40c2 movew %sr,%d2 49524: 8082 orl %d2,%d0 49526: 46c0 movew %d0,%sr 49528: 202b 0010 movel %a3@(16),%d0 4952c: 0280 0003 bee0 andil #245472,%d0 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 49532: 660c bnes 49540 <_Thread_queue_Requeue+0x48> <== ALWAYS TAKEN _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); } _ISR_Enable( level ); 49534: 46c2 movew %d2,%sr <== NOT EXECUTED } } 49536: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 4953c: 4e5e unlk %fp 4953e: 4e75 rts ISR_Level level_ignored; _ISR_Disable( level ); if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 49540: 4878 0001 pea 1 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; 49544: 7001 moveq #1,%d0 49546: 2f0b movel %a3,%sp@- 49548: 2540 0030 movel %d0,%a2@(48) 4954c: 2f0a movel %a2,%sp@- 4954e: 4eb9 0004 c340 jsr 4c340 <_Thread_queue_Extract_priority_helper> (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 49554: 486e fffc pea %fp@(-4) 49558: 2f0b movel %a3,%sp@- 4955a: 2f0a movel %a2,%sp@- 4955c: 4eb9 0004 9250 jsr 49250 <_Thread_queue_Enqueue_priority> 49562: 4fef 0018 lea %sp@(24),%sp } _ISR_Enable( level ); 49566: 46c2 movew %d2,%sr 49568: 60cc bras 49536 <_Thread_queue_Requeue+0x3e> ... =============================================================================== 0004956c <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 4956c: 4e56 fffc linkw %fp,#-4 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 49570: 486e fffc pea %fp@(-4) 49574: 2f2e 0008 movel %fp@(8),%sp@- 49578: 4eb9 0004 8cfc jsr 48cfc <_Thread_Get> switch ( location ) { 4957e: 508f addql #8,%sp 49580: 4aae fffc tstl %fp@(-4) 49584: 6618 bnes 4959e <_Thread_queue_Timeout+0x32> <== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 49586: 2f00 movel %d0,%sp@- 49588: 4eb9 0004 c430 jsr 4c430 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4958e: 588f addql #4,%sp 49590: 2039 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d0 49596: 5380 subql #1,%d0 49598: 23c0 0005 f448 movel %d0,5f448 <_Thread_Dispatch_disable_level> _Thread_Unnest_dispatch(); break; } } 4959e: 4e5e unlk %fp ... =============================================================================== 00059448 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 59448: 4e56 ffb0 linkw %fp,#-80 Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; tail->previous = head; 5944c: 41ee fff4 lea %fp@(-12),%a0 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 59450: 200e movel %fp,%d0 59452: 5180 subql #8,%d0 head->previous = NULL; tail->previous = head; 59454: 2d48 fffc movel %a0,%fp@(-4) 59458: 41ee ffec lea %fp@(-20),%a0 5945c: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 59460: 246e 0008 moveal %fp@(8),%a2 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 59464: 260e movel %fp,%d3 59466: 0683 ffff ffe8 addil #-24,%d3 5946c: 240a movel %a2,%d2 5946e: 2a0a movel %a2,%d5 59470: 4bf9 0005 d86c lea 5d86c <_Watchdog_Adjust_to_chain>,%a5 59476: 0682 0000 0030 addil #48,%d2 5947c: 0685 0000 0068 addil #104,%d5 59482: 47f9 0005 a020 lea 5a020 <_Chain_Get>,%a3 59488: 49f9 0005 d8f4 lea 5d8f4 <_Watchdog_Insert>,%a4 5948e: 2c00 movel %d0,%d6 * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 59490: 283c 0000 0700 movel #1792,%d4 59496: 2d48 ffd8 movel %a0,%fp@(-40) 5949a: 41ea 0008 lea %a2@(8),%a0 5949e: 2d48 ffe4 movel %a0,%fp@(-28) 594a2: 41ea 0040 lea %a2@(64),%a0 594a6: 2d48 ffe0 movel %a0,%fp@(-32) 594aa: 41ee ffec lea %fp@(-20),%a0 594ae: 2d40 fff4 movel %d0,%fp@(-12) head->previous = NULL; 594b2: 42ae fff8 clrl %fp@(-8) 594b6: 42ae ffec clrl %fp@(-20) tail->previous = head; 594ba: 2d43 fff0 movel %d3,%fp@(-16) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 594be: 2d48 ffe8 movel %a0,%fp@(-24) { /* * 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; 594c2: 41ee fff4 lea %fp@(-12),%a0 594c6: 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; 594ca: 2039 0007 e34c movel 7e34c <_Watchdog_Ticks_since_boot>,%d0 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 594d0: 222a 003c movel %a2@(60),%d1 watchdogs->last_snapshot = snapshot; 594d4: 2540 003c movel %d0,%a2@(60) _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 594d8: 9081 subl %d1,%d0 594da: 2f03 movel %d3,%sp@- 594dc: 2f00 movel %d0,%sp@- 594de: 2f02 movel %d2,%sp@- 594e0: 4e95 jsr %a5@ static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 594e2: 2039 0007 e2ce movel 7e2ce <_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 ) { 594e8: 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; 594ec: 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 ) { 594f0: b280 cmpl %d0,%d1 594f2: 6500 0086 bcsw 5957a <_Timer_server_Body+0x132> * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { 594f6: b280 cmpl %d0,%d1 594f8: 6200 00a4 bhiw 5959e <_Timer_server_Body+0x156> */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; 594fc: 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 ); 59500: 202a 0078 movel %a2@(120),%d0 59504: 2f00 movel %d0,%sp@- 59506: 4e93 jsr %a3@ if ( timer == NULL ) { 59508: 588f addql #4,%sp 5950a: 4a80 tstl %d0 5950c: 672e beqs 5953c <_Timer_server_Body+0xf4> <== ALWAYS TAKEN static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 5950e: 2040 moveal %d0,%a0 <== NOT EXECUTED 59510: 7e01 moveq #1,%d7 <== NOT EXECUTED 59512: 2228 0038 movel %a0@(56),%d1 <== NOT EXECUTED 59516: be81 cmpl %d1,%d7 <== NOT EXECUTED 59518: 6700 00a8 beqw 595c2 <_Timer_server_Body+0x17a> <== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 5951c: 7e03 moveq #3,%d7 <== NOT EXECUTED 5951e: be81 cmpl %d1,%d7 <== NOT EXECUTED 59520: 66de bnes 59500 <_Timer_server_Body+0xb8> <== NOT EXECUTED _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 59522: 2040 moveal %d0,%a0 <== NOT EXECUTED 59524: 4868 0010 pea %a0@(16) <== NOT EXECUTED 59528: 2f05 movel %d5,%sp@- <== NOT EXECUTED 5952a: 4e94 jsr %a4@ <== NOT EXECUTED } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 5952c: 202a 0078 movel %a2@(120),%d0 <== NOT EXECUTED ) { 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 ); 59530: 508f addql #8,%sp <== NOT EXECUTED } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 59532: 2f00 movel %d0,%sp@- <== NOT EXECUTED 59534: 4e93 jsr %a3@ <== NOT EXECUTED if ( timer == NULL ) { 59536: 588f addql #4,%sp <== NOT EXECUTED 59538: 4a80 tstl %d0 <== NOT EXECUTED 5953a: 66d2 bnes 5950e <_Timer_server_Body+0xc6> <== NOT EXECUTED * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 5953c: 2004 movel %d4,%d0 5953e: 40c1 movew %sr,%d1 59540: 8081 orl %d1,%d0 59542: 46c0 movew %d0,%sr if ( _Chain_Is_empty( insert_chain ) ) { 59544: bcae fff4 cmpl %fp@(-12),%d6 59548: 6700 0086 beqw 595d0 <_Timer_server_Body+0x188> ts->insert_chain = NULL; _ISR_Enable( level ); break; } else { _ISR_Enable( level ); 5954c: 46c1 movew %d1,%sr <== NOT EXECUTED static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 5954e: 2039 0007 e34c movel 7e34c <_Watchdog_Ticks_since_boot>,%d0<== NOT EXECUTED /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 59554: 222a 003c movel %a2@(60),%d1 <== NOT EXECUTED watchdogs->last_snapshot = snapshot; 59558: 2540 003c movel %d0,%a2@(60) <== NOT EXECUTED _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 5955c: 9081 subl %d1,%d0 <== NOT EXECUTED 5955e: 2f03 movel %d3,%sp@- <== NOT EXECUTED 59560: 2f00 movel %d0,%sp@- <== NOT EXECUTED 59562: 2f02 movel %d2,%sp@- <== NOT EXECUTED 59564: 4e95 jsr %a5@ <== NOT EXECUTED static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 59566: 2039 0007 e2ce movel 7e2ce <_TOD_Now>,%d0 <== NOT EXECUTED /* * 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 ) { 5956c: 4fef 000c lea %sp@(12),%sp <== NOT EXECUTED Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 59570: 222a 0074 movel %a2@(116),%d1 <== NOT EXECUTED /* * 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 ) { 59574: b280 cmpl %d0,%d1 <== NOT EXECUTED 59576: 6400 ff7e bccw 594f6 <_Timer_server_Body+0xae> <== NOT EXECUTED /* * This path is for normal forward movement and cases where the * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 5957a: 2f03 movel %d3,%sp@- 5957c: 2e00 movel %d0,%d7 5957e: 9e81 subl %d1,%d7 59580: 2f07 movel %d7,%sp@- 59582: 2d40 ffdc movel %d0,%fp@(-36) 59586: 2f05 movel %d5,%sp@- 59588: 4eb9 0005 d86c jsr 5d86c <_Watchdog_Adjust_to_chain> 5958e: 202e ffdc movel %fp@(-36),%d0 59592: 4fef 000c lea %sp@(12),%sp */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; 59596: 2540 0074 movel %d0,%a2@(116) 5959a: 6000 ff64 braw 59500 <_Timer_server_Body+0xb8> /* * 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 ); 5959e: 9280 subl %d0,%d1 595a0: 2f01 movel %d1,%sp@- 595a2: 4878 0001 pea 1 595a6: 2d40 ffdc movel %d0,%fp@(-36) 595aa: 2f05 movel %d5,%sp@- 595ac: 4eb9 0005 d7d8 jsr 5d7d8 <_Watchdog_Adjust> 595b2: 202e ffdc movel %fp@(-36),%d0 595b6: 4fef 000c lea %sp@(12),%sp } watchdogs->last_snapshot = snapshot; 595ba: 2540 0074 movel %d0,%a2@(116) 595be: 6000 ff40 braw 59500 <_Timer_server_Body+0xb8> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 595c2: 4868 0010 pea %a0@(16) <== NOT EXECUTED 595c6: 2f02 movel %d2,%sp@- <== NOT EXECUTED 595c8: 4e94 jsr %a4@ <== NOT EXECUTED 595ca: 508f addql #8,%sp <== NOT EXECUTED 595cc: 6000 ff32 braw 59500 <_Timer_server_Body+0xb8> <== NOT EXECUTED */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; 595d0: 42aa 0078 clrl %a2@(120) _ISR_Enable( level ); 595d4: 46c1 movew %d1,%sr _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 ) ) { 595d6: 202e ffd8 movel %fp@(-40),%d0 595da: b0ae ffe8 cmpl %fp@(-24),%d0 595de: 6752 beqs 59632 <_Timer_server_Body+0x1ea> /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 595e0: 2204 movel %d4,%d1 595e2: 40c0 movew %sr,%d0 595e4: 8280 orl %d0,%d1 595e6: 46c1 movew %d1,%sr initialized = false; } #endif return status; } 595e8: 206e ffe8 moveal %fp@(-24),%a0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 595ec: b1ee ffd8 cmpal %fp@(-40),%a0 595f0: 6732 beqs 59624 <_Timer_server_Body+0x1dc> <== NEVER TAKEN Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; 595f2: 2250 moveal %a0@,%a1 head->next = new_first; new_first->previous = head; 595f4: 2343 0004 movel %d3,%a1@(4) * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; 595f8: 42a8 0008 clrl %a0@(8) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; 595fc: 2d49 ffe8 movel %a1,%fp@(-24) _ISR_Enable( level ); 59600: 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 ); 59602: 2f28 0024 movel %a0@(36),%sp@- 59606: 2f28 0020 movel %a0@(32),%sp@- 5960a: 2068 001c moveal %a0@(28),%a0 5960e: 4e90 jsr %a0@ } 59610: 508f addql #8,%sp /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 59612: 2204 movel %d4,%d1 59614: 40c0 movew %sr,%d0 59616: 8280 orl %d0,%d1 59618: 46c1 movew %d1,%sr initialized = false; } #endif return status; } 5961a: 206e ffe8 moveal %fp@(-24),%a0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 5961e: b1ee ffd8 cmpal %fp@(-40),%a0 59622: 66ce bnes 595f2 <_Timer_server_Body+0x1aa> watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 59624: 46c0 movew %d0,%sr { /* * 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; 59626: 41ee fff4 lea %fp@(-12),%a0 5962a: 2548 0078 movel %a0,%a2@(120) 5962e: 6000 fe9a braw 594ca <_Timer_server_Body+0x82> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 59632: 4207 clrb %d7 59634: 1547 007c moveb %d7,%a2@(124) 59638: 2039 0007 e244 movel 7e244 <_Thread_Dispatch_disable_level>,%d0 5963e: 5280 addql #1,%d0 59640: 23c0 0007 e244 movel %d0,7e244 <_Thread_Dispatch_disable_level> /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 59646: 4878 0008 pea 8 5964a: 2f12 movel %a2@,%sp@- 5964c: 4eb9 0005 d1bc jsr 5d1bc <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); 59652: 2f0a movel %a2,%sp@- 59654: 4eba fd1a jsr %pc@(59370 <_Timer_server_Reset_interval_system_watchdog>) _Timer_server_Reset_tod_system_watchdog( ts ); 59658: 2f0a movel %a2,%sp@- 5965a: 4eba fd7e jsr %pc@(593da <_Timer_server_Reset_tod_system_watchdog>) _Thread_Enable_dispatch(); 5965e: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> ts->active = true; 59664: 7001 moveq #1,%d0 59666: 1540 007c moveb %d0,%a2@(124) static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 5966a: 2f2e ffe4 movel %fp@(-28),%sp@- 5966e: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 59674: 2f2e ffe0 movel %fp@(-32),%sp@- 59678: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> 5967e: 4fef 0018 lea %sp@(24),%sp 59682: 6000 fe3e braw 594c2 <_Timer_server_Body+0x7a> =============================================================================== 00059686 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 59686: 4e56 fff0 linkw %fp,#-16 5968a: 206e 000c moveal %fp@(12),%a0 5968e: 48d7 041c moveml %d2-%d4/%a2,%sp@ 59692: 246e 0008 moveal %fp@(8),%a2 if ( ts->insert_chain == NULL ) { 59696: 202a 0078 movel %a2@(120),%d0 5969a: 671a beqs 596b6 <_Timer_server_Schedule_operation_method+0x30><== ALWAYS TAKEN * 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 ); 5969c: 202a 0078 movel %a2@(120),%d0 <== NOT EXECUTED 596a0: 2d48 000c movel %a0,%fp@(12) <== NOT EXECUTED } } 596a4: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 <== NOT EXECUTED * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); 596aa: 2d40 0008 movel %d0,%fp@(8) <== NOT EXECUTED } } 596ae: 4e5e unlk %fp <== NOT EXECUTED * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); 596b0: 4ef9 0005 9fc0 jmp 59fc0 <_Chain_Append> <== NOT EXECUTED 596b6: 2039 0007 e244 movel 7e244 <_Thread_Dispatch_disable_level>,%d0 596bc: 5280 addql #1,%d0 596be: 23c0 0007 e244 movel %d0,7e244 <_Thread_Dispatch_disable_level> * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 596c4: 2028 0038 movel %a0@(56),%d0 596c8: 7201 moveq #1,%d1 596ca: b280 cmpl %d0,%d1 596cc: 6700 008a beqw 59758 <_Timer_server_Schedule_operation_method+0xd2> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); if ( !ts->active ) { _Timer_server_Reset_interval_system_watchdog( ts ); } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 596d0: 7803 moveq #3,%d4 596d2: b880 cmpl %d0,%d4 596d4: 670e beqs 596e4 <_Timer_server_Schedule_operation_method+0x5e> * 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 ); } } 596d6: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 596dc: 4e5e unlk %fp if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 596de: 4ef9 0005 c846 jmp 5c846 <_Thread_Enable_dispatch> } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 596e4: 203c 0000 0700 movel #1792,%d0 596ea: 40c2 movew %sr,%d2 596ec: 8082 orl %d2,%d0 596ee: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 596f0: 260a movel %a2,%d3 596f2: 0683 0000 006c addil #108,%d3 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 596f8: 2039 0007 e2ce movel 7e2ce <_TOD_Now>,%d0 last_snapshot = ts->TOD_watchdogs.last_snapshot; 596fe: 222a 0074 movel %a2@(116),%d1 initialized = false; } #endif return status; } 59702: 226a 0068 moveal %a2@(104),%a1 * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 59706: b689 cmpl %a1,%d3 59708: 671c beqs 59726 <_Timer_server_Schedule_operation_method+0xa0> first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 5970a: 2629 0010 movel %a1@(16),%d3 if ( snapshot > last_snapshot ) { 5970e: b280 cmpl %d0,%d1 59710: 6400 00ba bccw 597cc <_Timer_server_Schedule_operation_method+0x146> /* * We advanced in time. */ delta = snapshot - last_snapshot; 59714: 2800 movel %d0,%d4 59716: 9881 subl %d1,%d4 if (delta_interval > delta) { 59718: b883 cmpl %d3,%d4 5971a: 6400 00bc bccw 597d8 <_Timer_server_Schedule_operation_method+0x152> delta_interval -= delta; 5971e: 9684 subl %d4,%d3 59720: 2203 movel %d3,%d1 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 59722: 2341 0010 movel %d1,%a1@(16) } ts->TOD_watchdogs.last_snapshot = snapshot; 59726: 2540 0074 movel %d0,%a2@(116) _ISR_Enable( level ); 5972a: 46c2 movew %d2,%sr _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 5972c: 4868 0010 pea %a0@(16) 59730: 486a 0068 pea %a2@(104) 59734: 4eb9 0005 d8f4 jsr 5d8f4 <_Watchdog_Insert> if ( !ts->active ) { 5973a: 508f addql #8,%sp 5973c: 102a 007c moveb %a2@(124),%d0 59740: 6694 bnes 596d6 <_Timer_server_Schedule_operation_method+0x50> _Timer_server_Reset_tod_system_watchdog( ts ); 59742: 2f0a movel %a2,%sp@- 59744: 4eba fc94 jsr %pc@(593da <_Timer_server_Reset_tod_system_watchdog>) 59748: 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 ); } } 5974a: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 59750: 4e5e unlk %fp if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 59752: 4ef9 0005 c846 jmp 5c846 <_Thread_Enable_dispatch> if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 59758: 203c 0000 0700 movel #1792,%d0 5975e: 40c3 movew %sr,%d3 59760: 8083 orl %d3,%d0 59762: 46c0 movew %d0,%sr snapshot = _Watchdog_Ticks_since_boot; 59764: 2039 0007 e34c movel 7e34c <_Watchdog_Ticks_since_boot>,%d0 5976a: 220a movel %a2,%d1 5976c: 0681 0000 0034 addil #52,%d1 last_snapshot = ts->Interval_watchdogs.last_snapshot; 59772: 282a 003c movel %a2@(60),%d4 initialized = false; } #endif return status; } 59776: 226a 0030 moveal %a2@(48),%a1 * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = _Watchdog_Ticks_since_boot; last_snapshot = ts->Interval_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 5977a: b289 cmpl %a1,%d1 5977c: 6712 beqs 59790 <_Timer_server_Schedule_operation_method+0x10a> first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; 5977e: 2200 movel %d0,%d1 59780: 9284 subl %d4,%d1 delta_interval = first_watchdog->delta_interval; 59782: 2429 0010 movel %a1@(16),%d2 if (delta_interval > delta) { 59786: b481 cmpl %d1,%d2 59788: 633a blss 597c4 <_Timer_server_Schedule_operation_method+0x13e><== NEVER TAKEN delta_interval -= delta; 5978a: 9481 subl %d1,%d2 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 5978c: 2342 0010 movel %d2,%a1@(16) } ts->Interval_watchdogs.last_snapshot = snapshot; 59790: 2540 003c movel %d0,%a2@(60) _ISR_Enable( level ); 59794: 46c3 movew %d3,%sr _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 59796: 4868 0010 pea %a0@(16) 5979a: 486a 0030 pea %a2@(48) 5979e: 4eb9 0005 d8f4 jsr 5d8f4 <_Watchdog_Insert> if ( !ts->active ) { 597a4: 508f addql #8,%sp 597a6: 102a 007c moveb %a2@(124),%d0 597aa: 6600 ff2a bnew 596d6 <_Timer_server_Schedule_operation_method+0x50> _Timer_server_Reset_interval_system_watchdog( ts ); 597ae: 2f0a movel %a2,%sp@- 597b0: 4eba fbbe jsr %pc@(59370 <_Timer_server_Reset_interval_system_watchdog>) 597b4: 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 ); } } 597b6: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 597bc: 4e5e unlk %fp if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 597be: 4ef9 0005 c846 jmp 5c846 <_Thread_Enable_dispatch> delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { delta_interval -= delta; } else { delta_interval = 0; 597c4: 4282 clrl %d2 } first_watchdog->delta_interval = delta_interval; 597c6: 2342 0010 movel %d2,%a1@(16) 597ca: 60c4 bras 59790 <_Timer_server_Schedule_operation_method+0x10a> } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 597cc: d283 addl %d3,%d1 delta_interval += delta; 597ce: 9280 subl %d0,%d1 } first_watchdog->delta_interval = delta_interval; 597d0: 2341 0010 movel %d1,%a1@(16) 597d4: 6000 ff50 braw 59726 <_Timer_server_Schedule_operation_method+0xa0> */ delta = snapshot - last_snapshot; if (delta_interval > delta) { delta_interval -= delta; } else { delta_interval = 0; 597d8: 4281 clrl %d1 <== NOT EXECUTED * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 597da: 2341 0010 movel %d1,%a1@(16) <== NOT EXECUTED 597de: 6000 ff46 braw 59726 <_Timer_server_Schedule_operation_method+0xa0><== NOT EXECUTED =============================================================================== 000497dc <_Timespec_Add_to>: uint32_t _Timespec_Add_to( struct timespec *time, const struct timespec *add ) { 497dc: 4e56 0000 linkw %fp,#0 497e0: 226e 0008 moveal %fp@(8),%a1 497e4: 2f0a movel %a2,%sp@- 497e6: 246e 000c moveal %fp@(12),%a2 uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; 497ea: 206a 0004 moveal %a2@(4),%a0 497ee: d1e9 0004 addal %a1@(4),%a0 /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 497f2: 2208 movel %a0,%d1 uint32_t _Timespec_Add_to( struct timespec *time, const struct timespec *add ) { uint32_t seconds = add->tv_sec; 497f4: 2012 movel %a2@,%d0 /* Add the basics */ time->tv_sec += add->tv_sec; 497f6: d191 addl %d0,%a1@ time->tv_nsec += add->tv_nsec; 497f8: 2348 0004 movel %a0,%a1@(4) /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 497fc: b1fc 3b9a c9ff cmpal #999999999,%a0 49802: 631a blss 4981e <_Timespec_Add_to+0x42> 49804: 2051 moveal %a1@,%a0 * * This routines adds two timespecs. The second argument is added * to the first. */ uint32_t _Timespec_Add_to( 49806: 5288 addql #1,%a0 time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { time->tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 49808: 0681 c465 3600 addil #-1000000000,%d1 time->tv_sec++; seconds++; 4980e: 5280 addql #1,%d0 /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 49810: 0c81 3b9a c9ff cmpil #999999999,%d1 49816: 62ee bhis 49806 <_Timespec_Add_to+0x2a> <== NEVER TAKEN 49818: 2341 0004 movel %d1,%a1@(4) 4981c: 2288 movel %a0,%a1@ time->tv_sec++; seconds++; } return seconds; } 4981e: 245f moveal %sp@+,%a2 49820: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 000499b6 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 499b6: 4e56 fff0 linkw %fp,#-16 499ba: 48d7 041c moveml %d2-%d4/%a2,%sp@ 499be: 242e 0008 movel %fp@(8),%d2 499c2: 262e 0010 movel %fp@(16),%d3 the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 499c6: 2479 0005 f59c moveal 5f59c <_User_extensions_List+0x8>,%a2 void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 499cc: 182e 000f moveb %fp@(15),%d4 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 499d0: b5fc 0005 f594 cmpal #390548,%a2 499d6: 6726 beqs 499fe <_User_extensions_Fatal+0x48> <== NEVER TAKEN the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 499d8: 0284 0000 00ff andil #255,%d4 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) 499de: 206a 0030 moveal %a2@(48),%a0 499e2: 4a88 tstl %a0 499e4: 670c beqs 499f2 <_User_extensions_Fatal+0x3c> (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 499e6: 2f03 movel %d3,%sp@- 499e8: 2f04 movel %d4,%sp@- 499ea: 2f02 movel %d2,%sp@- 499ec: 4e90 jsr %a0@ 499ee: 4fef 000c lea %sp@(12),%sp <== NOT EXECUTED Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 499f2: 246a 0004 moveal %a2@(4),%a2 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 499f6: b5fc 0005 f594 cmpal #390548,%a2 499fc: 66e0 bnes 499de <_User_extensions_Fatal+0x28> <== ALWAYS TAKEN the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 499fe: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 <== NOT EXECUTED 49a04: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00049874 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 49874: 4e56 ffec linkw %fp,#-20 head->next = tail; 49878: 203c 0005 f598 movel #390552,%d0 4987e: 23c0 0005 f594 movel %d0,5f594 <_User_extensions_List> head->previous = NULL; tail->previous = head; 49884: 203c 0005 f594 movel #390548,%d0 4988a: 23c0 0005 f59c movel %d0,5f59c <_User_extensions_List+0x8> ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 49890: 203c 0005 f450 movel #390224,%d0 49896: 23c0 0005 f44c movel %d0,5f44c <_User_extensions_Switches_list> head->previous = NULL; tail->previous = head; 4989c: 203c 0005 f44c movel #390220,%d0 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 498a2: 42b9 0005 f598 clrl 5f598 <_User_extensions_List+0x4> 498a8: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ User_extensions_Control *extension; uint32_t i; uint32_t number_of_extensions; User_extensions_Table *initial_extensions; number_of_extensions = Configuration.number_of_initial_extensions; 498ac: 2439 0005 dc1a movel 5dc1a ,%d2 initial_extensions = Configuration.User_extension_table; 498b2: 2639 0005 dc1e movel 5dc1e ,%d3 498b8: 42b9 0005 f450 clrl 5f450 <_User_extensions_Switches_list+0x4> tail->previous = head; 498be: 23c0 0005 f454 movel %d0,5f454 <_User_extensions_Switches_list+0x8> _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 498c4: 4a83 tstl %d3 498c6: 6764 beqs 4992c <_User_extensions_Handler_initialization+0xb8><== NEVER TAKEN extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( 498c8: 7834 moveq #52,%d4 498ca: 4c02 4800 mulsl %d2,%d4 498ce: 2f04 movel %d4,%sp@- 498d0: 4eb9 0004 9e38 jsr 49e38 <_Workspace_Allocate_or_fatal_error> 498d6: 2440 moveal %d0,%a2 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 498d8: 2f04 movel %d4,%sp@- 498da: 42a7 clrl %sp@- 498dc: 2f00 movel %d0,%sp@- 498de: 4eb9 0004 e3f4 jsr 4e3f4 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 498e4: 4fef 0010 lea %sp@(16),%sp 498e8: 4a82 tstl %d2 498ea: 6740 beqs 4992c <_User_extensions_Handler_initialization+0xb8><== NEVER TAKEN 498ec: 4284 clrl %d4 498ee: 47f9 0004 c4a8 lea 4c4a8 <_User_extensions_Add_set>,%a3 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; 498f4: 2043 moveal %d3,%a0 498f6: 5284 addql #1,%d4 498f8: 0683 0000 0020 addil #32,%d3 498fe: 2558 0014 movel %a0@+,%a2@(20) 49902: 2558 0018 movel %a0@+,%a2@(24) 49906: 2558 001c movel %a0@+,%a2@(28) 4990a: 2558 0020 movel %a0@+,%a2@(32) 4990e: 2558 0024 movel %a0@+,%a2@(36) 49912: 2558 0028 movel %a0@+,%a2@(40) 49916: 2558 002c movel %a0@+,%a2@(44) 4991a: 2550 0030 movel %a0@,%a2@(48) _User_extensions_Add_set( extension ); 4991e: 2f0a movel %a2,%sp@- _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; 49920: 45ea 0034 lea %a2@(52),%a2 49924: 4e93 jsr %a3@ extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 49926: 588f addql #4,%sp 49928: b882 cmpl %d2,%d4 4992a: 65c8 bcss 498f4 <_User_extensions_Handler_initialization+0x80> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; } } } 4992c: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 49932: 4e5e unlk %fp ... =============================================================================== 00049938 <_User_extensions_Thread_begin>: #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { 49938: 4e56 0000 linkw %fp,#0 4993c: 2f0a movel %a2,%sp@- the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 4993e: 2479 0005 f594 moveal 5f594 <_User_extensions_List>,%a2 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { 49944: 2f02 movel %d2,%sp@- 49946: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4994a: b5fc 0005 f598 cmpal #390552,%a2 49950: 6718 beqs 4996a <_User_extensions_Thread_begin+0x32><== NEVER TAKEN !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_begin != NULL ) 49952: 206a 0028 moveal %a2@(40),%a0 49956: 4a88 tstl %a0 49958: 6706 beqs 49960 <_User_extensions_Thread_begin+0x28> (*the_extension->Callouts.thread_begin)( executing ); 4995a: 2f02 movel %d2,%sp@- 4995c: 4e90 jsr %a0@ 4995e: 588f addql #4,%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 49960: 2452 moveal %a2@,%a2 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 49962: b5fc 0005 f598 cmpal #390552,%a2 49968: 66e8 bnes 49952 <_User_extensions_Thread_begin+0x1a> the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_begin != NULL ) (*the_extension->Callouts.thread_begin)( executing ); } } 4996a: 242e fff8 movel %fp@(-8),%d2 4996e: 246e fffc moveal %fp@(-4),%a2 49972: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00049a08 <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 49a08: 4e56 0000 linkw %fp,#0 49a0c: 2f0a movel %a2,%sp@- return false; } } return true; } 49a0e: 2479 0005 f594 moveal 5f594 <_User_extensions_List>,%a2 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 49a14: 2f02 movel %d2,%sp@- 49a16: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); 49a1a: b5fc 0005 f598 cmpal #390552,%a2 49a20: 6722 beqs 49a44 <_User_extensions_Thread_create+0x3c><== NEVER TAKEN !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { 49a22: 206a 0014 moveal %a2@(20),%a0 49a26: 4a88 tstl %a0 49a28: 6710 beqs 49a3a <_User_extensions_Thread_create+0x32> status = (*the_extension->Callouts.thread_create)( 49a2a: 2f02 movel %d2,%sp@- 49a2c: 2f39 0005 f5e4 movel 5f5e4 <_Per_CPU_Information+0xc>,%sp@- 49a32: 4e90 jsr %a0@ _Thread_Executing, the_thread ); if ( !status ) 49a34: 508f addql #8,%sp 49a36: 4a00 tstb %d0 49a38: 6718 beqs 49a52 <_User_extensions_Thread_create+0x4a> User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 49a3a: 2452 moveal %a2@,%a2 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); 49a3c: b5fc 0005 f598 cmpal #390552,%a2 49a42: 66de bnes 49a22 <_User_extensions_Thread_create+0x1a> return false; } } return true; } 49a44: 242e fff8 movel %fp@(-8),%d2 49a48: 246e fffc moveal %fp@(-4),%a2 49a4c: 4e5e unlk %fp if ( !status ) return false; } } return true; 49a4e: 7001 moveq #1,%d0 } 49a50: 4e75 rts 49a52: 242e fff8 movel %fp@(-8),%d2 49a56: 246e fffc moveal %fp@(-4),%a2 49a5a: 4e5e unlk %fp status = (*the_extension->Callouts.thread_create)( _Thread_Executing, the_thread ); if ( !status ) return false; 49a5c: 4200 clrb %d0 <== NOT EXECUTED } } return true; } =============================================================================== 00049a60 <_User_extensions_Thread_delete>: #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { 49a60: 4e56 0000 linkw %fp,#0 49a64: 2f0a movel %a2,%sp@- (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } 49a66: 2479 0005 f59c moveal 5f59c <_User_extensions_List+0x8>,%a2 #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { 49a6c: 2f02 movel %d2,%sp@- 49a6e: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 49a72: b5fc 0005 f594 cmpal #390548,%a2 49a78: 6720 beqs 49a9a <_User_extensions_Thread_delete+0x3a><== NEVER TAKEN !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_delete != NULL ) 49a7a: 206a 0020 moveal %a2@(32),%a0 49a7e: 4a88 tstl %a0 49a80: 670c beqs 49a8e <_User_extensions_Thread_delete+0x2e> (*the_extension->Callouts.thread_delete)( 49a82: 2f02 movel %d2,%sp@- 49a84: 2f39 0005 f5e4 movel 5f5e4 <_Per_CPU_Information+0xc>,%sp@- 49a8a: 4e90 jsr %a0@ 49a8c: 508f addql #8,%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 49a8e: 246a 0004 moveal %a2@(4),%a2 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 49a92: b5fc 0005 f594 cmpal #390548,%a2 49a98: 66e0 bnes 49a7a <_User_extensions_Thread_delete+0x1a> (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } 49a9a: 242e fff8 movel %fp@(-8),%d2 49a9e: 246e fffc moveal %fp@(-4),%a2 49aa2: 4e5e unlk %fp ... =============================================================================== 00049976 <_User_extensions_Thread_exitted>: void _User_extensions_Thread_exitted ( Thread_Control *executing ) { 49976: 4e56 0000 linkw %fp,#0 4997a: 2f0a movel %a2,%sp@- the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 4997c: 2479 0005 f59c moveal 5f59c <_User_extensions_List+0x8>,%a2 } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { 49982: 2f02 movel %d2,%sp@- 49984: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 49988: b5fc 0005 f594 cmpal #390548,%a2 4998e: 671a beqs 499aa <_User_extensions_Thread_exitted+0x34><== NEVER TAKEN !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) 49990: 206a 002c moveal %a2@(44),%a0 49994: 4a88 tstl %a0 49996: 6706 beqs 4999e <_User_extensions_Thread_exitted+0x28> (*the_extension->Callouts.thread_exitted)( executing ); 49998: 2f02 movel %d2,%sp@- 4999a: 4e90 jsr %a0@ 4999c: 588f addql #4,%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 4999e: 246a 0004 moveal %a2@(4),%a2 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 499a2: b5fc 0005 f594 cmpal #390548,%a2 499a8: 66e6 bnes 49990 <_User_extensions_Thread_exitted+0x1a> the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) (*the_extension->Callouts.thread_exitted)( executing ); } } 499aa: 242e fff8 movel %fp@(-8),%d2 499ae: 246e fffc moveal %fp@(-4),%a2 499b2: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 0004a74c <_User_extensions_Thread_restart>: #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { 4a74c: 4e56 0000 linkw %fp,#0 4a750: 2f0a movel %a2,%sp@- (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } 4a752: 2479 0006 052c moveal 6052c <_User_extensions_List>,%a2 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { 4a758: 2f02 movel %d2,%sp@- 4a75a: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4a75e: b5fc 0006 0530 cmpal #394544,%a2 4a764: 671e beqs 4a784 <_User_extensions_Thread_restart+0x38><== NEVER TAKEN !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_restart != NULL ) 4a766: 206a 001c moveal %a2@(28),%a0 4a76a: 4a88 tstl %a0 4a76c: 670c beqs 4a77a <_User_extensions_Thread_restart+0x2e> (*the_extension->Callouts.thread_restart)( 4a76e: 2f02 movel %d2,%sp@- 4a770: 2f39 0006 057c movel 6057c <_Per_CPU_Information+0xc>,%sp@- 4a776: 4e90 jsr %a0@ 4a778: 508f addql #8,%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 4a77a: 2452 moveal %a2@,%a2 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4a77c: b5fc 0006 0530 cmpal #394544,%a2 4a782: 66e2 bnes 4a766 <_User_extensions_Thread_restart+0x1a> (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } 4a784: 242e fff8 movel %fp@(-8),%d2 4a788: 246e fffc moveal %fp@(-4),%a2 4a78c: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00049aa8 <_User_extensions_Thread_start>: #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { 49aa8: 4e56 0000 linkw %fp,#0 49aac: 2f0a movel %a2,%sp@- (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } 49aae: 2479 0005 f594 moveal 5f594 <_User_extensions_List>,%a2 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { 49ab4: 2f02 movel %d2,%sp@- 49ab6: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 49aba: b5fc 0005 f598 cmpal #390552,%a2 49ac0: 671e beqs 49ae0 <_User_extensions_Thread_start+0x38><== NEVER TAKEN !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_start != NULL ) 49ac2: 206a 0018 moveal %a2@(24),%a0 49ac6: 4a88 tstl %a0 49ac8: 670c beqs 49ad6 <_User_extensions_Thread_start+0x2e> (*the_extension->Callouts.thread_start)( 49aca: 2f02 movel %d2,%sp@- 49acc: 2f39 0005 f5e4 movel 5f5e4 <_Per_CPU_Information+0xc>,%sp@- 49ad2: 4e90 jsr %a0@ 49ad4: 508f addql #8,%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 49ad6: 2452 moveal %a2@,%a2 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 49ad8: b5fc 0005 f598 cmpal #390552,%a2 49ade: 66e2 bnes 49ac2 <_User_extensions_Thread_start+0x1a> (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } 49ae0: 242e fff8 movel %fp@(-8),%d2 49ae4: 246e fffc moveal %fp@(-4),%a2 49ae8: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00049aec <_User_extensions_Thread_switch>: void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { 49aec: 4e56 fff4 linkw %fp,#-12 49af0: 48d7 040c moveml %d2-%d3/%a2,%sp@ 49af4: 262e 0008 movel %fp@(8),%d3 49af8: 242e 000c movel %fp@(12),%d2 the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } 49afc: 2479 0005 f44c moveal 5f44c <_User_extensions_Switches_list>,%a2 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); 49b02: b5fc 0005 f450 cmpal #390224,%a2 49b08: 6716 beqs 49b20 <_User_extensions_Thread_switch+0x34><== NEVER TAKEN !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); 49b0a: 2f02 movel %d2,%sp@- 49b0c: 2f03 movel %d3,%sp@- 49b0e: 206a 0008 moveal %a2@(8),%a0 49b12: 4e90 jsr %a0@ Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { 49b14: 2452 moveal %a2@,%a2 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); 49b16: 508f addql #8,%sp 49b18: b5fc 0005 f450 cmpal #390224,%a2 49b1e: 66ea bnes 49b0a <_User_extensions_Thread_switch+0x1e> the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } 49b20: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 49b26: 4e5e unlk %fp ... =============================================================================== 0004b700 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4b700: 4e56 ffe8 linkw %fp,#-24 4b704: 226e 000c moveal %fp@(12),%a1 4b708: 48d7 1c1c moveml %d2-%d4/%a2-%a4,%sp@ ISR_Level level; _ISR_Disable( level ); 4b70c: 283c 0000 0700 movel #1792,%d4 4b712: 2004 movel %d4,%d0 void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4b714: 266e 0008 moveal %fp@(8),%a3 4b718: 242e 0010 movel %fp@(16),%d2 ISR_Level level; _ISR_Disable( level ); 4b71c: 40c1 movew %sr,%d1 4b71e: 8081 orl %d1,%d0 4b720: 46c0 movew %d0,%sr } } _ISR_Enable( level ); } 4b722: 244b moveal %a3,%a2 4b724: 205a moveal %a2@+,%a0 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { 4b726: b5c8 cmpal %a0,%a2 4b728: 6748 beqs 4b772 <_Watchdog_Adjust+0x72> switch ( direction ) { 4b72a: 4a89 tstl %a1 4b72c: 6650 bnes 4b77e <_Watchdog_Adjust+0x7e> case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4b72e: 4a82 tstl %d2 4b730: 6740 beqs 4b772 <_Watchdog_Adjust+0x72> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { 4b732: 2628 0010 movel %a0@(16),%d3 4b736: 49f9 0004 b988 lea 4b988 <_Watchdog_Tickle>,%a4 4b73c: b682 cmpl %d2,%d3 4b73e: 622c bhis 4b76c <_Watchdog_Adjust+0x6c> <== NEVER TAKEN _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; 4b740: 7001 moveq #1,%d0 4b742: 2140 0010 movel %d0,%a0@(16) _ISR_Enable( level ); 4b746: 46c1 movew %d1,%sr _Watchdog_Tickle( header ); 4b748: 2f0b movel %a3,%sp@- 4b74a: 4e94 jsr %a4@ _ISR_Disable( level ); 4b74c: 2004 movel %d4,%d0 4b74e: 40c1 movew %sr,%d1 4b750: 8081 orl %d1,%d0 4b752: 46c0 movew %d0,%sr if ( _Chain_Is_empty( header ) ) 4b754: 588f addql #4,%sp while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; 4b756: 9483 subl %d3,%d2 } } _ISR_Enable( level ); } 4b758: 2013 movel %a3@,%d0 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); 4b75a: 2040 moveal %d0,%a0 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) 4b75c: b08a cmpl %a2,%d0 4b75e: 6712 beqs 4b772 <_Watchdog_Adjust+0x72> switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4b760: 4a82 tstl %d2 4b762: 670e beqs 4b772 <_Watchdog_Adjust+0x72> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { 4b764: 2628 0010 movel %a0@(16),%d3 4b768: b483 cmpl %d3,%d2 4b76a: 64d4 bccs 4b740 <_Watchdog_Adjust+0x40> _Watchdog_First( header )->delta_interval -= units; 4b76c: 9682 subl %d2,%d3 4b76e: 2143 0010 movel %d3,%a0@(16) } break; } } _ISR_Enable( level ); 4b772: 46c1 movew %d1,%sr } 4b774: 4cee 1c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a4 4b77a: 4e5e unlk %fp 4b77c: 4e75 rts * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { 4b77e: 7001 moveq #1,%d0 4b780: b089 cmpl %a1,%d0 4b782: 66ee bnes 4b772 <_Watchdog_Adjust+0x72> <== NEVER TAKEN case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4b784: d5a8 0010 addl %d2,%a0@(16) } break; } } _ISR_Enable( level ); 4b788: 46c1 movew %d1,%sr } 4b78a: 4cee 1c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a4 4b790: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00049b2c <_Watchdog_Insert>: void _Watchdog_Insert( Chain_Control *header, Watchdog_Control *the_watchdog ) { 49b2c: 4e56 ffec linkw %fp,#-20 49b30: 226e 000c moveal %fp@(12),%a1 49b34: 48d7 043c moveml %d2-%d5/%a2,%sp@ 49b38: 246e 0008 moveal %fp@(8),%a2 Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; _ISR_Disable( level ); 49b3c: 2a3c 0000 0700 movel #1792,%d5 49b42: 2005 movel %d5,%d0 Watchdog_Control *after; uint32_t insert_isr_nest_level; Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; 49b44: 2839 0005 f5e0 movel 5f5e0 <_Per_CPU_Information+0x8>,%d4 _ISR_Disable( level ); 49b4a: 40c3 movew %sr,%d3 49b4c: 8083 orl %d3,%d0 49b4e: 46c0 movew %d0,%sr /* * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_watchdog->state != WATCHDOG_INACTIVE ) { 49b50: 4aa9 0008 tstl %a1@(8) 49b54: 6600 00c6 bnew 49c1c <_Watchdog_Insert+0xf0> _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; _Watchdog_Sync_count++; 49b58: 2039 0005 f54c movel 5f54c <_Watchdog_Sync_count>,%d0 if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; 49b5e: 7201 moveq #1,%d1 _Watchdog_Sync_count++; 49b60: 5280 addql #1,%d0 if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; 49b62: 2341 0008 movel %d1,%a1@(8) _Watchdog_Sync_count++; 49b66: 23c0 0005 f54c movel %d0,5f54c <_Watchdog_Sync_count> restart: delta_interval = the_watchdog->initial; 49b6c: 2029 000c movel %a1@(12),%d0 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); 49b70: 2052 moveal %a2@,%a0 for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) 49b72: 6764 beqs 49bd8 <_Watchdog_Insert+0xac> 49b74: 4a90 tstl %a0@ 49b76: 6760 beqs 49bd8 <_Watchdog_Insert+0xac> break; if ( delta_interval < after->delta_interval ) { 49b78: 2228 0010 movel %a0@(16),%d1 49b7c: b280 cmpl %d0,%d1 49b7e: 6252 bhis 49bd2 <_Watchdog_Insert+0xa6> break; } delta_interval -= after->delta_interval; _ISR_Flash( level ); 49b80: 2405 movel %d5,%d2 49b82: 46c3 movew %d3,%sr 49b84: 8483 orl %d3,%d2 49b86: 46c2 movew %d2,%sr if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { 49b88: 7401 moveq #1,%d2 49b8a: b4a9 0008 cmpl %a1@(8),%d2 49b8e: 666e bnes 49bfe <_Watchdog_Insert+0xd2> goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { 49b90: 2439 0005 f4ec movel 5f4ec <_Watchdog_Sync_level>,%d2 49b96: b484 cmpl %d4,%d2 49b98: 6230 bhis 49bca <_Watchdog_Insert+0x9e> if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; 49b9a: 9081 subl %d1,%d0 exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; _Watchdog_Sync_count--; _ISR_Enable( level ); } 49b9c: 2050 moveal %a0@,%a0 for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) 49b9e: 4a80 tstl %d0 49ba0: 6736 beqs 49bd8 <_Watchdog_Insert+0xac> 49ba2: 4a90 tstl %a0@ 49ba4: 6732 beqs 49bd8 <_Watchdog_Insert+0xac> break; if ( delta_interval < after->delta_interval ) { 49ba6: 2228 0010 movel %a0@(16),%d1 49baa: b081 cmpl %d1,%d0 49bac: 6524 bcss 49bd2 <_Watchdog_Insert+0xa6> break; } delta_interval -= after->delta_interval; _ISR_Flash( level ); 49bae: 2405 movel %d5,%d2 49bb0: 46c3 movew %d3,%sr 49bb2: 8483 orl %d3,%d2 49bb4: 46c2 movew %d2,%sr if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; 49bb6: 9081 subl %d1,%d0 _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { 49bb8: 7201 moveq #1,%d1 49bba: b2a9 0008 cmpl %a1@(8),%d1 49bbe: 663e bnes 49bfe <_Watchdog_Insert+0xd2> <== NEVER TAKEN goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { 49bc0: 2239 0005 f4ec movel 5f4ec <_Watchdog_Sync_level>,%d1 49bc6: b284 cmpl %d4,%d1 49bc8: 63d2 blss 49b9c <_Watchdog_Insert+0x70> <== ALWAYS TAKEN _Watchdog_Sync_level = insert_isr_nest_level; 49bca: 23c4 0005 f4ec movel %d4,5f4ec <_Watchdog_Sync_level> goto restart; 49bd0: 609a bras 49b6c <_Watchdog_Insert+0x40> if ( delta_interval == 0 || !_Watchdog_Next( after ) ) break; if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; 49bd2: 9280 subl %d0,%d1 49bd4: 2141 0010 movel %d1,%a0@(16) _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); 49bd8: 2068 0004 moveal %a0@(4),%a0 RTEMS_INLINE_ROUTINE void _Watchdog_Activate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_ACTIVE; 49bdc: 7402 moveq #2,%d2 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 49bde: 2450 moveal %a0@,%a2 } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; 49be0: 2340 0010 movel %d0,%a1@(16) _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); the_watchdog->start_time = _Watchdog_Ticks_since_boot; 49be4: 2039 0005 f550 movel 5f550 <_Watchdog_Ticks_since_boot>,%d0 49bea: 2342 0008 movel %d2,%a1@(8) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 49bee: 2348 0004 movel %a0,%a1@(4) before_node = after_node->next; after_node->next = the_node; 49bf2: 2089 movel %a1,%a0@ the_node->next = before_node; before_node->previous = the_node; 49bf4: 2549 0004 movel %a1,%a2@(4) Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; 49bf8: 228a movel %a2,%a1@ 49bfa: 2340 0014 movel %d0,%a1@(20) exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; 49bfe: 23c4 0005 f4ec movel %d4,5f4ec <_Watchdog_Sync_level> _Watchdog_Sync_count--; 49c04: 2039 0005 f54c movel 5f54c <_Watchdog_Sync_count>,%d0 49c0a: 5380 subql #1,%d0 49c0c: 23c0 0005 f54c movel %d0,5f54c <_Watchdog_Sync_count> _ISR_Enable( level ); 49c12: 46c3 movew %d3,%sr } 49c14: 4cd7 043c moveml %sp@,%d2-%d5/%a2 49c18: 4e5e unlk %fp 49c1a: 4e75 rts * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); 49c1c: 46c3 movew %d3,%sr exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; _Watchdog_Sync_count--; _ISR_Enable( level ); } 49c1e: 4cd7 043c moveml %sp@,%d2-%d5/%a2 49c22: 4e5e unlk %fp ... =============================================================================== 00049c80 <_Watchdog_Remove>: { ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 49c80: 203c 0000 0700 movel #1792,%d0 */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 49c86: 4e56 0000 linkw %fp,#0 49c8a: 206e 0008 moveal %fp@(8),%a0 49c8e: 2f0a movel %a2,%sp@- 49c90: 2f02 movel %d2,%sp@- ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 49c92: 40c1 movew %sr,%d1 49c94: 8081 orl %d1,%d0 49c96: 46c0 movew %d0,%sr previous_state = the_watchdog->state; 49c98: 2028 0008 movel %a0@(8),%d0 switch ( previous_state ) { 49c9c: 7401 moveq #1,%d2 49c9e: b480 cmpl %d0,%d2 49ca0: 6764 beqs 49d06 <_Watchdog_Remove+0x86> 49ca2: 6314 blss 49cb8 <_Watchdog_Remove+0x38> _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 49ca4: 2279 0005 f550 moveal 5f550 <_Watchdog_Ticks_since_boot>,%a1 49caa: 2149 0018 movel %a1,%a0@(24) _ISR_Enable( level ); 49cae: 46c1 movew %d1,%sr return( previous_state ); } 49cb0: 241f movel %sp@+,%d2 49cb2: 245f moveal %sp@+,%a2 49cb4: 4e5e unlk %fp 49cb6: 4e75 rts Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; switch ( previous_state ) { 49cb8: 143c 0003 moveb #3,%d2 49cbc: b480 cmpl %d0,%d2 49cbe: 65e4 bcss 49ca4 <_Watchdog_Remove+0x24> <== NEVER TAKEN } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } 49cc0: 2250 moveal %a0@,%a1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 49cc2: 42a8 0008 clrl %a0@(8) next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 49cc6: 4a91 tstl %a1@ 49cc8: 6708 beqs 49cd2 <_Watchdog_Remove+0x52> next_watchdog->delta_interval += the_watchdog->delta_interval; 49cca: 2428 0010 movel %a0@(16),%d2 49cce: d5a9 0010 addl %d2,%a1@(16) if ( _Watchdog_Sync_count ) 49cd2: 2479 0005 f54c moveal 5f54c <_Watchdog_Sync_count>,%a2 49cd8: 4a8a tstl %a2 49cda: 670c beqs 49ce8 <_Watchdog_Remove+0x68> _Watchdog_Sync_level = _ISR_Nest_level; 49cdc: 45f9 0005 f5e0 lea 5f5e0 <_Per_CPU_Information+0x8>,%a2 49ce2: 23d2 0005 f4ec movel %a2@,5f4ec <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 49ce8: 2468 0004 moveal %a0@(4),%a2 next->previous = previous; 49cec: 234a 0004 movel %a2,%a1@(4) previous->next = next; 49cf0: 2489 movel %a1,%a2@ _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 49cf2: 2279 0005 f550 moveal 5f550 <_Watchdog_Ticks_since_boot>,%a1 49cf8: 2149 0018 movel %a1,%a0@(24) _ISR_Enable( level ); 49cfc: 46c1 movew %d1,%sr return( previous_state ); } 49cfe: 241f movel %sp@+,%d2 49d00: 245f moveal %sp@+,%a2 49d02: 4e5e unlk %fp 49d04: 4e75 rts _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 49d06: 2279 0005 f550 moveal 5f550 <_Watchdog_Ticks_since_boot>,%a1 /* * It is not actually on the chain so just change the state and * the Insert operation we interrupted will be aborted. */ the_watchdog->state = WATCHDOG_INACTIVE; 49d0c: 42a8 0008 clrl %a0@(8) _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 49d10: 2149 0018 movel %a1,%a0@(24) _ISR_Enable( level ); 49d14: 46c1 movew %d1,%sr return( previous_state ); } 49d16: 241f movel %sp@+,%d2 49d18: 245f moveal %sp@+,%a2 49d1a: 4e5e unlk %fp ... =============================================================================== 0004b0cc <_Watchdog_Report_chain>: ) { ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4b0cc: 203c 0000 0700 movel #1792,%d0 void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4b0d2: 4e56 ffe8 linkw %fp,#-24 4b0d6: 48d7 3c0c moveml %d2-%d3/%a2-%a5,%sp@ 4b0da: 242e 0008 movel %fp@(8),%d2 4b0de: 266e 000c moveal %fp@(12),%a3 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4b0e2: 40c3 movew %sr,%d3 4b0e4: 8083 orl %d3,%d0 4b0e6: 46c0 movew %d0,%sr printk( "Watchdog Chain: %s %p\n", name, header ); 4b0e8: 2f0b movel %a3,%sp@- 4b0ea: 4bf9 0004 4b88 lea 44b88 ,%a5 4b0f0: 2f02 movel %d2,%sp@- 4b0f2: 4879 0005 ee86 pea 5ee86 <_Status_Object_name_errors_to_status+0x14> 4b0f8: 4e95 jsr %a5@ printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 4b0fa: 245b moveal %a3@+,%a2 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { 4b0fc: 4fef 000c lea %sp@(12),%sp 4b100: b7ca cmpal %a2,%a3 4b102: 672c beqs 4b130 <_Watchdog_Report_chain+0x64> 4b104: 49f9 0004 b148 lea 4b148 <_Watchdog_Report>,%a4 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4b10a: 2f0a movel %a2,%sp@- 4b10c: 42a7 clrl %sp@- 4b10e: 4e94 jsr %a4@ _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; node != _Chain_Tail(header) ; node = node->next ) 4b110: 2452 moveal %a2@,%a2 Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; 4b112: 508f addql #8,%sp 4b114: b7ca cmpal %a2,%a3 4b116: 66f2 bnes 4b10a <_Watchdog_Report_chain+0x3e> <== NEVER TAKEN { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4b118: 2f02 movel %d2,%sp@- 4b11a: 4879 0005 ee9d pea 5ee9d <_Status_Object_name_errors_to_status+0x2b> 4b120: 4e95 jsr %a5@ 4b122: 508f addql #8,%sp } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); 4b124: 46c3 movew %d3,%sr } 4b126: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 4b12c: 4e5e unlk %fp 4b12e: 4e75 rts _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); 4b130: 4879 0005 eeac pea 5eeac <_Status_Object_name_errors_to_status+0x3a> 4b136: 4e95 jsr %a5@ 4b138: 588f addql #4,%sp } _ISR_Enable( level ); 4b13a: 46c3 movew %d3,%sr } 4b13c: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 4b142: 4e5e unlk %fp ... =============================================================================== 00049d20 <_Watchdog_Tickle>: * See the comment in watchdoginsert.c and watchdogadjust.c * about why it's safe not to declare header a pointer to * volatile data - till, 2003/7 */ _ISR_Disable( level ); 49d20: 203c 0000 0700 movel #1792,%d0 */ void _Watchdog_Tickle( Chain_Control *header ) { 49d26: 4e56 ffe8 linkw %fp,#-24 49d2a: 48d7 3c0c moveml %d2-%d3/%a2-%a5,%sp@ 49d2e: 286e 0008 moveal %fp@(8),%a4 * See the comment in watchdoginsert.c and watchdogadjust.c * about why it's safe not to declare header a pointer to * volatile data - till, 2003/7 */ _ISR_Disable( level ); 49d32: 40c2 movew %sr,%d2 49d34: 8082 orl %d2,%d0 49d36: 46c0 movew %d0,%sr } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); } 49d38: 264c moveal %a4,%a3 49d3a: 245b moveal %a3@+,%a2 * volatile data - till, 2003/7 */ _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) 49d3c: b7ca cmpal %a2,%a3 49d3e: 673e beqs 49d7e <_Watchdog_Tickle+0x5e> * to be inserted has already had its delta_interval adjusted to 0, and * so is added to the head of the chain with a delta_interval of 0. * * Steven Johnson - 12/2005 (gcc-3.2.3 -O3 on powerpc) */ if (the_watchdog->delta_interval != 0) { 49d40: 202a 0010 movel %a2@(16),%d0 49d44: 4bf9 0004 9c80 lea 49c80 <_Watchdog_Remove>,%a5 49d4a: 6708 beqs 49d54 <_Watchdog_Tickle+0x34> the_watchdog->delta_interval--; 49d4c: 5380 subql #1,%d0 49d4e: 2540 0010 movel %d0,%a2@(16) if ( the_watchdog->delta_interval != 0 ) 49d52: 662a bnes 49d7e <_Watchdog_Tickle+0x5e> case WATCHDOG_REMOVE_IT: break; } _ISR_Disable( level ); 49d54: 263c 0000 0700 movel #1792,%d3 if ( the_watchdog->delta_interval != 0 ) goto leave; } do { watchdog_state = _Watchdog_Remove( the_watchdog ); 49d5a: 2f0a movel %a2,%sp@- 49d5c: 4e95 jsr %a5@ _ISR_Enable( level ); 49d5e: 46c2 movew %d2,%sr switch( watchdog_state ) { 49d60: 7202 moveq #2,%d1 49d62: 588f addql #4,%sp 49d64: b280 cmpl %d0,%d1 49d66: 6722 beqs 49d8a <_Watchdog_Tickle+0x6a> <== ALWAYS TAKEN case WATCHDOG_REMOVE_IT: break; } _ISR_Disable( level ); 49d68: 2003 movel %d3,%d0 49d6a: 40c2 movew %sr,%d2 49d6c: 8082 orl %d2,%d0 49d6e: 46c0 movew %d0,%sr } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); } 49d70: 2014 movel %a4@,%d0 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); 49d72: 2440 moveal %d0,%a2 _ISR_Disable( level ); the_watchdog = _Watchdog_First( header ); } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); 49d74: b7c0 cmpal %d0,%a3 49d76: 6706 beqs 49d7e <_Watchdog_Tickle+0x5e> } _ISR_Disable( level ); the_watchdog = _Watchdog_First( header ); } while ( !_Chain_Is_empty( header ) && 49d78: 4aaa 0010 tstl %a2@(16) 49d7c: 67dc beqs 49d5a <_Watchdog_Tickle+0x3a> (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); 49d7e: 46c2 movew %d2,%sr } 49d80: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 49d86: 4e5e unlk %fp 49d88: 4e75 rts _ISR_Enable( level ); switch( watchdog_state ) { case WATCHDOG_ACTIVE: (*the_watchdog->routine)( 49d8a: 2f2a 0024 movel %a2@(36),%sp@- 49d8e: 2f2a 0020 movel %a2@(32),%sp@- 49d92: 206a 001c moveal %a2@(28),%a0 49d96: 4e90 jsr %a0@ the_watchdog->id, the_watchdog->user_data ); break; 49d98: 508f addql #8,%sp 49d9a: 60cc bras 49d68 <_Watchdog_Tickle+0x48> =============================================================================== 0004e4b0 : rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { 4e4b0: 4e56 ffe8 linkw %fp,#-24 4e4b4: 202e 0010 movel %fp@(16),%d0 4e4b8: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 4e4bc: 242e 0008 movel %fp@(8),%d2 4e4c0: 262e 000c movel %fp@(12),%d3 4e4c4: 246e 0014 moveal %fp@(20),%a2 Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) 4e4c8: 4a82 tstl %d2 4e4ca: 677a beqs 4e546 return RTEMS_INVALID_NAME; if ( !id ) 4e4cc: 4a8a tstl %a2 4e4ce: 6700 00cc beqw 4e59c return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { 4e4d2: 0803 0004 btst #4,%d3 4e4d6: 677a beqs 4e552 the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 4e4d8: 42ae fff8 clrl %fp@(-8) if ( maximum_waiters == 0 ) 4e4dc: 4a80 tstl %d0 4e4de: 6700 00b0 beqw 4e590 4e4e2: 2239 0006 1cfc movel 61cfc <_Thread_Dispatch_disable_level>,%d1 4e4e8: 5281 addql #1,%d1 return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; the_attributes.maximum_count = maximum_waiters; 4e4ea: 2d40 fffc movel %d0,%fp@(-4) 4e4ee: 23c1 0006 1cfc movel %d1,61cfc <_Thread_Dispatch_disable_level> * This function allocates a barrier control block from * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE Barrier_Control *_Barrier_Allocate( void ) { return (Barrier_Control *) _Objects_Allocate( &_Barrier_Information ); 4e4f4: 4879 0006 1ecc pea 61ecc <_Barrier_Information> 4e4fa: 4eb9 0004 9d6c jsr 49d6c <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { 4e500: 588f addql #4,%sp 4e502: 2640 moveal %d0,%a3 4e504: 4a80 tstl %d0 4e506: 6776 beqs 4e57e <== NEVER TAKEN _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } the_barrier->attribute_set = attribute_set; 4e508: 2743 0010 movel %d3,%a3@(16) _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 4e50c: 486e fff8 pea %fp@(-8) 4e510: 486b 0014 pea %a3@(20) 4e514: 4eb9 0004 ed60 jsr 4ed60 <_CORE_barrier_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 4e51a: 202b 0008 movel %a3@(8),%d0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 4e51e: 4281 clrl %d1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4e520: 2079 0006 1ee4 moveal 61ee4 <_Barrier_Information+0x18>,%a0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 4e526: 3200 movew %d0,%d1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4e528: 218b 1c00 movel %a3,%a0@(00000000,%d1:l:4) information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 4e52c: 2742 000c movel %d2,%a3@(12) &_Barrier_Information, &the_barrier->Object, (Objects_Name) name ); *id = the_barrier->Object.id; 4e530: 2480 movel %d0,%a2@ _Thread_Enable_dispatch(); 4e532: 4eb9 0004 ae6a jsr 4ae6a <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4e538: 508f addql #8,%sp 4e53a: 4280 clrl %d0 } 4e53c: 4cee 0c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a3 4e542: 4e5e unlk %fp 4e544: 4e75 rts { Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; 4e546: 7003 moveq #3,%d0 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 4e548: 4cee 0c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a3 4e54e: 4e5e unlk %fp 4e550: 4e75 rts if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; 4e552: 7201 moveq #1,%d1 4e554: 2d41 fff8 movel %d1,%fp@(-8) 4e558: 2239 0006 1cfc movel 61cfc <_Thread_Dispatch_disable_level>,%d1 4e55e: 5281 addql #1,%d1 the_attributes.maximum_count = maximum_waiters; 4e560: 2d40 fffc movel %d0,%fp@(-4) 4e564: 23c1 0006 1cfc movel %d1,61cfc <_Thread_Dispatch_disable_level> 4e56a: 4879 0006 1ecc pea 61ecc <_Barrier_Information> 4e570: 4eb9 0004 9d6c jsr 49d6c <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { 4e576: 588f addql #4,%sp 4e578: 2640 moveal %d0,%a3 4e57a: 4a80 tstl %d0 4e57c: 668a bnes 4e508 _Thread_Enable_dispatch(); 4e57e: 4eb9 0004 ae6a jsr 4ae6a <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; 4e584: 7005 moveq #5,%d0 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 4e586: 4cee 0c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a3 4e58c: 4e5e unlk %fp 4e58e: 4e75 rts /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; 4e590: 700a moveq #10,%d0 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 4e592: 4cee 0c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a3 4e598: 4e5e unlk %fp 4e59a: 4e75 rts if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !id ) return RTEMS_INVALID_ADDRESS; 4e59c: 7009 moveq #9,%d0 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 4e59e: 4cee 0c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a3 4e5a4: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00047490 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 47490: 4e56 0000 linkw %fp,#0 47494: 2f03 movel %d3,%sp@- 47496: 262e 0014 movel %fp@(20),%d3 4749a: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE bool rtems_chain_append_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Append_with_empty_check( chain, node ); 4749c: 2f2e 000c movel %fp@(12),%sp@- 474a0: 2f2e 0008 movel %fp@(8),%sp@- 474a4: 242e 0010 movel %fp@(16),%d2 474a8: 4eb9 0004 79fc jsr 479fc <_Chain_Append_with_empty_check> rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { 474ae: 508f addql #8,%sp 474b0: 4a00 tstb %d0 474b2: 660e bnes 474c2 sc = rtems_event_send( task, events ); } return sc; } 474b4: 242e fff8 movel %fp@(-8),%d2 474b8: 4280 clrl %d0 474ba: 262e fffc movel %fp@(-4),%d3 474be: 4e5e unlk %fp 474c0: 4e75 rts { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { sc = rtems_event_send( task, events ); 474c2: 2d43 000c movel %d3,%fp@(12) } return sc; } 474c6: 262e fffc movel %fp@(-4),%d3 { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { sc = rtems_event_send( task, events ); 474ca: 2d42 0008 movel %d2,%fp@(8) } return sc; } 474ce: 242e fff8 movel %fp@(-8),%d2 474d2: 4e5e unlk %fp { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { sc = rtems_event_send( task, events ); 474d4: 4ef9 0004 69c4 jmp 469c4 ... =============================================================================== 000474dc : rtems_chain_control *chain, rtems_id task, rtems_event_set events, rtems_chain_node **node ) { 474dc: 4e56 0000 linkw %fp,#0 474e0: 2f03 movel %d3,%sp@- 474e2: 262e 0010 movel %fp@(16),%d3 474e6: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE bool rtems_chain_get_with_empty_check( rtems_chain_control *chain, rtems_chain_node **node ) { return _Chain_Get_with_empty_check( chain, node ); 474e8: 2f2e 0014 movel %fp@(20),%sp@- 474ec: 2f2e 0008 movel %fp@(8),%sp@- 474f0: 242e 000c movel %fp@(12),%d2 474f4: 4eb9 0004 7a9c jsr 47a9c <_Chain_Get_with_empty_check> rtems_status_code sc = RTEMS_SUCCESSFUL; bool is_empty = rtems_chain_get_with_empty_check( chain, node ); if ( is_empty ) { 474fa: 508f addql #8,%sp 474fc: 4a00 tstb %d0 474fe: 660e bnes 4750e sc = rtems_event_send( task, events ); } return sc; } 47500: 242e fff8 movel %fp@(-8),%d2 47504: 4280 clrl %d0 47506: 262e fffc movel %fp@(-4),%d3 4750a: 4e5e unlk %fp 4750c: 4e75 rts { rtems_status_code sc = RTEMS_SUCCESSFUL; bool is_empty = rtems_chain_get_with_empty_check( chain, node ); if ( is_empty ) { sc = rtems_event_send( task, events ); 4750e: 2d43 000c movel %d3,%fp@(12) } return sc; } 47512: 262e fffc movel %fp@(-4),%d3 { rtems_status_code sc = RTEMS_SUCCESSFUL; bool is_empty = rtems_chain_get_with_empty_check( chain, node ); if ( is_empty ) { sc = rtems_event_send( task, events ); 47516: 2d42 0008 movel %d2,%fp@(8) } return sc; } 4751a: 242e fff8 movel %fp@(-8),%d2 4751e: 4e5e unlk %fp { rtems_status_code sc = RTEMS_SUCCESSFUL; bool is_empty = rtems_chain_get_with_empty_check( chain, node ); if ( is_empty ) { sc = rtems_event_send( task, events ); 47520: 4ef9 0004 69c4 jmp 469c4 ... =============================================================================== 00047528 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 47528: 4e56 ffe0 linkw %fp,#-32 4752c: 48d7 0c7c moveml %d2-%d6/%a2-%a3,%sp@ while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( 47530: 2c0e movel %fp,%d6 47532: 45f9 0004 7aec lea 47aec <_Chain_Get>,%a2 47538: 5986 subql #4,%d6 4753a: 47f9 0004 681c lea 4681c ,%a3 rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 47540: 262e 0008 movel %fp@(8),%d3 47544: 2a2e 000c movel %fp@(12),%d5 47548: 282e 0010 movel %fp@(16),%d4 */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); 4754c: 2f03 movel %d3,%sp@- 4754e: 4e92 jsr %a2@ rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 47550: 588f addql #4,%sp 47552: 2400 movel %d0,%d2 47554: 6622 bnes 47578 ) { rtems_event_set out; sc = rtems_event_receive( 47556: 2f06 movel %d6,%sp@- 47558: 2f04 movel %d4,%sp@- 4755a: 42a7 clrl %sp@- 4755c: 2f05 movel %d5,%sp@- 4755e: 4e93 jsr %a3@ ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 47560: 4fef 0010 lea %sp@(16),%sp 47564: 4a80 tstl %d0 47566: 67e4 beqs 4754c <== NEVER TAKEN timeout, &out ); } *node_ptr = node; 47568: 206e 0014 moveal %fp@(20),%a0 4756c: 2082 movel %d2,%a0@ return sc; } 4756e: 4cee 0c7c ffe0 moveml %fp@(-32),%d2-%d6/%a2-%a3 47574: 4e5e unlk %fp 47576: 4e75 rts timeout, &out ); } *node_ptr = node; 47578: 206e 0014 moveal %fp@(20),%a0 rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 4757c: 4280 clrl %d0 timeout, &out ); } *node_ptr = node; 4757e: 2082 movel %d2,%a0@ return sc; } 47580: 4cee 0c7c ffe0 moveml %fp@(-32),%d2-%d6/%a2-%a3 47586: 4e5e unlk %fp ... =============================================================================== 0004758c : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 4758c: 4e56 0000 linkw %fp,#0 47590: 2f03 movel %d3,%sp@- 47592: 262e 0014 movel %fp@(20),%d3 47596: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE bool rtems_chain_prepend_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Prepend_with_empty_check( chain, node ); 47598: 2f2e 000c movel %fp@(12),%sp@- 4759c: 2f2e 0008 movel %fp@(8),%sp@- 475a0: 242e 0010 movel %fp@(16),%d2 475a4: 4eb9 0004 7b58 jsr 47b58 <_Chain_Prepend_with_empty_check> rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { 475aa: 508f addql #8,%sp 475ac: 4a00 tstb %d0 475ae: 660e bnes 475be sc = rtems_event_send( task, events ); } return sc; } 475b0: 242e fff8 movel %fp@(-8),%d2 475b4: 4280 clrl %d0 475b6: 262e fffc movel %fp@(-4),%d3 475ba: 4e5e unlk %fp 475bc: 4e75 rts { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { sc = rtems_event_send( task, events ); 475be: 2d43 000c movel %d3,%fp@(12) } return sc; } 475c2: 262e fffc movel %fp@(-4),%d3 { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { sc = rtems_event_send( task, events ); 475c6: 2d42 0008 movel %d2,%fp@(8) } return sc; } 475ca: 242e fff8 movel %fp@(-8),%d2 475ce: 4e5e unlk %fp { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { sc = rtems_event_send( task, events ); 475d0: 4ef9 0004 69c4 jmp 469c4 ... =============================================================================== 00046e26 : 46e26: 7002 moveq #2,%d0 } void rtems_initialize_start_multitasking(void) { 46e28: 4e56 0000 linkw %fp,#0 ****** APPLICATION RUNS HERE ****** ****** RETURNS WHEN SYSTEM IS SHUT DOWN ****** ******************************************************************* ******************************************************************* *******************************************************************/ } 46e2c: 4e5e unlk %fp 46e2e: 23c0 0005 f590 movel %d0,5f590 <_System_state_Current> void rtems_initialize_start_multitasking(void) { _System_state_Set( SYSTEM_STATE_BEGIN_MULTITASKING ); _Thread_Start_multitasking(); 46e34: 4ef9 0004 96e0 jmp 496e0 <_Thread_Start_multitasking> ... =============================================================================== 00048388 : 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 ) { 48388: 4e56 fff4 linkw %fp,#-12 4838c: 226e 000c moveal %fp@(12),%a1 48390: 48d7 040c moveml %d2-%d3/%a2,%sp@ 48394: 242e 0008 movel %fp@(8),%d2 48398: 246e 0010 moveal %fp@(16),%a2 rtems_device_major_number major_limit = _IO_Number_of_drivers; 4839c: 2039 0006 382c movel 6382c <_IO_Number_of_drivers>,%d0 if ( rtems_interrupt_is_in_progress() ) 483a2: 4ab9 0006 37b8 tstl 637b8 <_Per_CPU_Information+0x8> 483a8: 6600 009c bnew 48446 return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) 483ac: 4a8a tstl %a2 483ae: 6700 00ea beqw 4849a return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; 483b2: 2480 movel %d0,%a2@ if ( driver_table == NULL ) 483b4: 4a89 tstl %a1 483b6: 6700 00e2 beqw 4849a static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 483ba: 4a91 tstl %a1@ 483bc: 6700 00d4 beqw 48492 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) 483c0: b480 cmpl %d0,%d2 483c2: 6476 bccs 4843a rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 483c4: 2039 0006 3620 movel 63620 <_Thread_Dispatch_disable_level>,%d0 483ca: 5280 addql #1,%d0 483cc: 23c0 0006 3620 movel %d0,63620 <_Thread_Dispatch_disable_level> return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { 483d2: 4a82 tstl %d2 483d4: 667c bnes 48452 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; 483d6: 2039 0006 382c movel 6382c <_IO_Number_of_drivers>,%d0 rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { 483dc: 6700 0106 beqw 484e4 483e0: 2239 0006 3830 movel 63830 <_IO_Driver_address_table>,%d1 483e6: 2041 moveal %d1,%a0 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 483e8: 4a90 tstl %a0@ 483ea: 6700 008e beqw 4847a 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 ) { 483ee: 5282 addql #1,%d2 483f0: 41e8 0018 lea %a0@(24),%a0 483f4: b480 cmpl %d0,%d2 483f6: 65f0 bcss 483e8 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 483f8: 2482 movel %d2,%a2@ if ( m != n ) 483fa: b480 cmpl %d0,%d2 483fc: 6700 00e8 beqw 484e6 48400: 2602 movel %d2,%d3 48402: 2002 movel %d2,%d0 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 48404: 2041 moveal %d1,%a0 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) 48406: e78b lsll #3,%d3 48408: eb88 lsll #5,%d0 4840a: 9083 subl %d3,%d0 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 4840c: d1c0 addal %d0,%a0 4840e: 20d9 movel %a1@+,%a0@+ 48410: 20d9 movel %a1@+,%a0@+ 48412: 20d9 movel %a1@+,%a0@+ 48414: 20d9 movel %a1@+,%a0@+ 48416: 20d9 movel %a1@+,%a0@+ 48418: 2091 movel %a1@,%a0@ _Thread_Enable_dispatch(); 4841a: 4eb9 0004 a296 jsr 4a296 <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); 48420: 2d42 0008 movel %d2,%fp@(8) } 48424: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 4842a: 42ae 0010 clrl %fp@(16) 4842e: 42ae 000c clrl %fp@(12) } 48432: 4e5e unlk %fp _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 48434: 4ef9 0004 ffc8 jmp 4ffc8 if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) return RTEMS_INVALID_NUMBER; 4843a: 700a moveq #10,%d0 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } 4843c: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 48442: 4e5e unlk %fp 48444: 4e75 rts ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; 48446: 7012 moveq #18,%d0 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } 48448: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 4844e: 4e5e unlk %fp 48450: 4e75 rts _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 48452: 2202 movel %d2,%d1 48454: 2002 movel %d2,%d0 48456: e789 lsll #3,%d1 48458: eb88 lsll #5,%d0 4845a: 2079 0006 3830 moveal 63830 <_IO_Driver_address_table>,%a0 48460: 9081 subl %d1,%d0 48462: d1c0 addal %d0,%a0 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 48464: 4a90 tstl %a0@ 48466: 673e beqs 484a6 major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); 48468: 4eb9 0004 a296 jsr 4a296 <_Thread_Enable_dispatch> return RTEMS_RESOURCE_IN_USE; 4846e: 700c moveq #12,%d0 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } 48470: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 48476: 4e5e unlk %fp 48478: 4e75 rts static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 4847a: 4aa8 0004 tstl %a0@(4) 4847e: 6700 ff78 beqw 483f8 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 ) { 48482: 5282 addql #1,%d2 48484: 41e8 0018 lea %a0@(24),%a0 48488: b480 cmpl %d0,%d2 4848a: 6500 ff5c bcsw 483e8 4848e: 6000 ff68 braw 483f8 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 48492: 4aa9 0004 tstl %a1@(4) 48496: 6600 ff28 bnew 483c0 if ( driver_table == NULL ) return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; 4849a: 7009 moveq #9,%d0 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } 4849c: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 484a2: 4e5e unlk %fp 484a4: 4e75 rts static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 484a6: 4aa8 0004 tstl %a0@(4) 484aa: 66bc bnes 48468 484ac: 2239 0006 3830 movel 63830 <_IO_Driver_address_table>,%d1 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 484b2: 2041 moveal %d1,%a0 484b4: d1c0 addal %d0,%a0 if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; 484b6: 2482 movel %d2,%a2@ } _IO_Driver_address_table [major] = *driver_table; 484b8: 20d9 movel %a1@+,%a0@+ 484ba: 20d9 movel %a1@+,%a0@+ 484bc: 20d9 movel %a1@+,%a0@+ 484be: 20d9 movel %a1@+,%a0@+ 484c0: 20d9 movel %a1@+,%a0@+ 484c2: 2091 movel %a1@,%a0@ _Thread_Enable_dispatch(); 484c4: 4eb9 0004 a296 jsr 4a296 <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); 484ca: 2d42 0008 movel %d2,%fp@(8) } 484ce: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 484d4: 42ae 0010 clrl %fp@(16) 484d8: 42ae 000c clrl %fp@(12) } 484dc: 4e5e unlk %fp _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 484de: 4ef9 0004 ffc8 jmp 4ffc8 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 484e4: 4292 clrl %a2@ <== NOT EXECUTED if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); 484e6: 4eb9 0004 a296 jsr 4a296 <_Thread_Enable_dispatch> *major = m; if ( m != n ) return RTEMS_SUCCESSFUL; return RTEMS_TOO_MANY; 484ec: 7005 moveq #5,%d0 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } 484ee: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 484f4: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00049568 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 49568: 4e56 fff0 linkw %fp,#-16 4956c: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 49570: 266e 0008 moveal %fp@(8),%a3 uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 49574: 4a8b tstl %a3 49576: 6742 beqs 495ba <== NEVER TAKEN 49578: 49f9 0006 1f38 lea 61f38 <_Objects_Information_table+0x4>,%a4 return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) 4957e: 205c moveal %a4@+,%a0 49580: 4a88 tstl %a0 49582: 672e beqs 495b2 continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; 49584: 2468 0004 moveal %a0@(4),%a2 if ( !information ) 49588: 4a8a tstl %a2 4958a: 6726 beqs 495b2 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 4958c: 4a6a 000e tstw %a2@(14) 49590: 6720 beqs 495b2 <== NEVER TAKEN 49592: 7401 moveq #1,%d2 the_thread = (Thread_Control *)information->local_table[ i ]; 49594: 206a 0018 moveal %a2@(24),%a0 49598: 2030 2c00 movel %a0@(00000000,%d2:l:4),%d0 information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 4959c: 5282 addql #1,%d2 the_thread = (Thread_Control *)information->local_table[ i ]; if ( !the_thread ) 4959e: 4a80 tstl %d0 495a0: 6706 beqs 495a8 <== NEVER TAKEN continue; (*routine)(the_thread); 495a2: 2f00 movel %d0,%sp@- 495a4: 4e93 jsr %a3@ 495a6: 588f addql #4,%sp information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 495a8: 4280 clrl %d0 495aa: 302a 000e movew %a2@(14),%d0 495ae: b480 cmpl %d0,%d2 495b0: 63e2 blss 49594 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 495b2: b9fc 0006 1f44 cmpal #401220,%a4 495b8: 66c4 bnes 4957e (*routine)(the_thread); } } } 495ba: 4cee 1c04 fff0 moveml %fp@(-16),%d2/%a2-%a4 495c0: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 000482b0 : ) { const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) 482b0: 7001 moveq #1,%d0 const char *rtems_object_get_api_class_name( int the_api, int the_class ) { 482b2: 4e56 0000 linkw %fp,#0 482b6: 222e 0008 movel %fp@(8),%d1 482ba: 2f02 movel %d2,%sp@- const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) 482bc: b081 cmpl %d1,%d0 482be: 673e beqs 482fe api_assoc = rtems_object_api_internal_assoc; else if ( the_api == OBJECTS_CLASSIC_API ) 482c0: 7402 moveq #2,%d2 #ifdef RTEMS_POSIX_API else if ( the_api == OBJECTS_POSIX_API ) api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; 482c2: 203c 0005 febc movel #392892,%d0 const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) api_assoc = rtems_object_api_internal_assoc; else if ( the_api == OBJECTS_CLASSIC_API ) 482c8: b481 cmpl %d1,%d2 482ca: 6708 beqs 482d4 return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); if ( class_assoc ) return class_assoc->name; return "BAD CLASS"; } 482cc: 242e fffc movel %fp@(-4),%d2 482d0: 4e5e unlk %fp 482d2: 4e75 rts const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) api_assoc = rtems_object_api_internal_assoc; else if ( the_api == OBJECTS_CLASSIC_API ) api_assoc = rtems_object_api_classic_assoc; 482d4: 203c 0006 0ea0 movel #396960,%d0 else if ( the_api == OBJECTS_POSIX_API ) api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); 482da: 2f2e 000c movel %fp@(12),%sp@- 482de: 2f00 movel %d0,%sp@- 482e0: 4eb9 0004 d23c jsr 4d23c if ( class_assoc ) 482e6: 508f addql #8,%sp else if ( the_api == OBJECTS_POSIX_API ) api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); 482e8: 2040 moveal %d0,%a0 if ( class_assoc ) return class_assoc->name; return "BAD CLASS"; 482ea: 203c 0005 fec4 movel #392900,%d0 api_assoc = rtems_object_api_posix_assoc; #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); if ( class_assoc ) 482f0: 4a88 tstl %a0 482f2: 67d8 beqs 482cc return class_assoc->name; return "BAD CLASS"; } 482f4: 242e fffc movel %fp@(-4),%d2 482f8: 4e5e unlk %fp #endif else return "BAD API"; class_assoc = rtems_assoc_ptr_by_local( api_assoc, the_class ); if ( class_assoc ) return class_assoc->name; 482fa: 2010 movel %a0@,%d0 return "BAD CLASS"; } 482fc: 4e75 rts { const rtems_assoc_t *api_assoc; const rtems_assoc_t *class_assoc; if ( the_api == OBJECTS_INTERNAL_API ) api_assoc = rtems_object_api_internal_assoc; 482fe: 203c 0006 0e88 movel #396936,%d0 48304: 60d4 bras 482da ... =============================================================================== 00048370 : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { 48370: 4e56 0000 linkw %fp,#0 48374: 2f0a movel %a2,%sp@- 48376: 246e 0010 moveal %fp@(16),%a2 4837a: 2f02 movel %d2,%sp@- int i; /* * Validate parameters and look up information structure. */ if ( !info ) 4837c: 4a8a tstl %a2 4837e: 6768 beqs 483e8 return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 48380: 3f2e 000e movew %fp@(14),%sp@- 48384: 4267 clrw %sp@- 48386: 2f2e 0008 movel %fp@(8),%sp@- 4838a: 4eb9 0004 a04c jsr 4a04c <_Objects_Get_information> if ( !obj_info ) 48390: 508f addql #8,%sp * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 48392: 2040 moveal %d0,%a0 if ( !obj_info ) 48394: 4a80 tstl %d0 48396: 675e beqs 483f6 return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; 48398: 24a8 0006 movel %a0@(6),%a2@ info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; 4839c: 4282 clrl %d2 /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; 4839e: 2568 000a 0004 movel %a0@(10),%a2@(4) info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; 483a4: 3428 000e movew %a0@(14),%d2 /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; 483a8: 1568 0010 000c moveb %a0@(16),%a2@(12) info->maximum = obj_info->maximum; 483ae: 2542 0008 movel %d2,%a2@(8) for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 483b2: 6750 beqs 48404 <== NEVER TAKEN 483b4: 2068 0018 moveal %a0@(24),%a0 483b8: 7201 moveq #1,%d1 483ba: 7001 moveq #1,%d0 483bc: 93c9 subal %a1,%a1 483be: 5280 addql #1,%d0 if ( !obj_info->local_table[i] ) 483c0: 4ab0 1c00 tstl %a0@(00000000,%d1:l:4) 483c4: 6718 beqs 483de info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 483c6: 2200 movel %d0,%d1 483c8: b082 cmpl %d2,%d0 483ca: 63f2 blss 483be <== ALWAYS TAKEN if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; 483cc: 2549 000e movel %a1,%a2@(14) return RTEMS_SUCCESSFUL; 483d0: 4280 clrl %d0 } 483d2: 242e fff8 movel %fp@(-8),%d2 483d6: 246e fffc moveal %fp@(-4),%a2 483da: 4e5e unlk %fp 483dc: 4e75 rts info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) if ( !obj_info->local_table[i] ) unallocated++; 483de: 5289 addql #1,%a1 info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 483e0: 2200 movel %d0,%d1 483e2: b082 cmpl %d2,%d0 483e4: 63d8 blss 483be <== NEVER TAKEN 483e6: 60e4 bras 483cc unallocated++; info->unallocated = unallocated; return RTEMS_SUCCESSFUL; } 483e8: 242e fff8 movel %fp@(-8),%d2 /* * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; 483ec: 7009 moveq #9,%d0 unallocated++; info->unallocated = unallocated; return RTEMS_SUCCESSFUL; } 483ee: 246e fffc moveal %fp@(-4),%a2 483f2: 4e5e unlk %fp 483f4: 4e75 rts 483f6: 242e fff8 movel %fp@(-8),%d2 if ( !info ) return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); if ( !obj_info ) return RTEMS_INVALID_NUMBER; 483fa: 700a moveq #10,%d0 unallocated++; info->unallocated = unallocated; return RTEMS_SUCCESSFUL; } 483fc: 246e fffc moveal %fp@(-4),%a2 48400: 4e5e unlk %fp 48402: 4e75 rts info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 48404: 93c9 subal %a1,%a1 <== NOT EXECUTED if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; return RTEMS_SUCCESSFUL; 48406: 4280 clrl %d0 <== NOT EXECUTED for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; 48408: 2549 000e movel %a1,%a2@(14) <== NOT EXECUTED 4840c: 60c4 bras 483d2 <== NOT EXECUTED ... =============================================================================== 00056b40 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 56b40: 4e56 ffe8 linkw %fp,#-24 56b44: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 56b48: 242e 0008 movel %fp@(8),%d2 56b4c: 2a2e 000c movel %fp@(12),%d5 56b50: 282e 0010 movel %fp@(16),%d4 56b54: 262e 0014 movel %fp@(20),%d3 56b58: 246e 001c moveal %fp@(28),%a2 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 56b5c: 4a82 tstl %d2 56b5e: 673a beqs 56b9a return RTEMS_INVALID_NAME; if ( !starting_address ) 56b60: 4a85 tstl %d5 56b62: 671e beqs 56b82 return RTEMS_INVALID_ADDRESS; if ( !id ) 56b64: 4a8a tstl %a2 56b66: 671a beqs 56b82 <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 56b68: 4a84 tstl %d4 56b6a: 6722 beqs 56b8e 56b6c: 4a83 tstl %d3 56b6e: 671e beqs 56b8e 56b70: b684 cmpl %d4,%d3 56b72: 621a bhis 56b8e */ RTEMS_INLINE_ROUTINE bool _Partition_Is_buffer_size_aligned ( uint32_t buffer_size ) { return ((buffer_size % CPU_PARTITION_ALIGNMENT) == 0); 56b74: 7003 moveq #3,%d0 56b76: c083 andl %d3,%d0 56b78: 6614 bnes 56b8e ) { #if (CPU_ALIGNMENT == 0) return true; #else return (((uintptr_t)address % CPU_ALIGNMENT) == 0); 56b7a: 103c 0003 moveb #3,%d0 56b7e: c085 andl %d5,%d0 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 56b80: 6724 beqs 56ba6 return RTEMS_INVALID_ADDRESS; 56b82: 7009 moveq #9,%d0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 56b84: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 56b8a: 4e5e unlk %fp 56b8c: 4e75 rts if ( !id ) return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; 56b8e: 7008 moveq #8,%d0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 56b90: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 56b96: 4e5e unlk %fp 56b98: 4e75 rts ) { register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; 56b9a: 7003 moveq #3,%d0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 56b9c: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 56ba2: 4e5e unlk %fp 56ba4: 4e75 rts 56ba6: 2039 0007 e244 movel 7e244 <_Thread_Dispatch_disable_level>,%d0 56bac: 5280 addql #1,%d0 56bae: 23c0 0007 e244 movel %d0,7e244 <_Thread_Dispatch_disable_level> * This function allocates a partition control block from * the inactive chain of free partition control blocks. */ RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Allocate ( void ) { return (Partition_Control *) _Objects_Allocate( &_Partition_Information ); 56bb4: 4879 0007 e0e4 pea 7e0e4 <_Partition_Information> 56bba: 4eb9 0005 b6bc jsr 5b6bc <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 56bc0: 588f addql #4,%sp 56bc2: 2640 moveal %d0,%a3 56bc4: 4a80 tstl %d0 56bc6: 6758 beqs 56c20 <== NEVER TAKEN return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; the_partition->length = length; 56bc8: 2744 0014 movel %d4,%a3@(20) the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; 56bcc: 276e 0018 001c movel %fp@(24),%a3@(28) the_partition->number_of_used_blocks = 0; _Chain_Initialize( &the_partition->Memory, starting_address, 56bd2: 4c43 4004 remul %d3,%d4,%d4 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 56bd6: 2745 0010 movel %d5,%a3@(16) the_partition->length = length; the_partition->buffer_size = buffer_size; 56bda: 2743 0018 movel %d3,%a3@(24) the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; 56bde: 42ab 0020 clrl %a3@(32) _Chain_Initialize( &the_partition->Memory, starting_address, 56be2: 2f03 movel %d3,%sp@- 56be4: 2f04 movel %d4,%sp@- 56be6: 2f05 movel %d5,%sp@- 56be8: 486b 0024 pea %a3@(36) 56bec: 4eb9 0005 a05c jsr 5a05c <_Chain_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 56bf2: 202b 0008 movel %a3@(8),%d0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 56bf6: 4281 clrl %d1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 56bf8: 2079 0007 e0fc moveal 7e0fc <_Partition_Information+0x18>,%a0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 56bfe: 3200 movew %d0,%d1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 56c00: 218b 1c00 movel %a3,%a0@(00000000,%d1:l:4) information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 56c04: 2742 000c movel %d2,%a3@(12) &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 56c08: 2480 movel %d0,%a2@ name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 56c0a: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 56c10: 4fef 0010 lea %sp@(16),%sp 56c14: 4280 clrl %d0 } 56c16: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 56c1c: 4e5e unlk %fp 56c1e: 4e75 rts _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); 56c20: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; 56c26: 7005 moveq #5,%d0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 56c28: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 56c2e: 4e5e unlk %fp ... =============================================================================== 00056d54 : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { 56d54: 4e56 fffc linkw %fp,#-4 56d58: 2f0a movel %a2,%sp@- 56d5a: 2f02 movel %d2,%sp@- Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) _Objects_Get( &_Partition_Information, id, location ); 56d5c: 486e fffc pea %fp@(-4) 56d60: 2f2e 0008 movel %fp@(8),%sp@- 56d64: 4879 0007 e0e4 pea 7e0e4 <_Partition_Information> 56d6a: 242e 000c movel %fp@(12),%d2 56d6e: 4eb9 0005 bbb0 jsr 5bbb0 <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { 56d74: 4fef 000c lea %sp@(12),%sp 56d78: 2440 moveal %d0,%a2 56d7a: 4aae fffc tstl %fp@(-4) 56d7e: 670e beqs 56d8e case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 56d80: 242e fff4 movel %fp@(-12),%d2 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 56d84: 7004 moveq #4,%d0 } 56d86: 246e fff8 moveal %fp@(-8),%a2 56d8a: 4e5e unlk %fp 56d8c: 4e75 rts ) { void *starting; void *ending; starting = the_partition->starting_address; 56d8e: 202a 0010 movel %a2@(16),%d0 ending = _Addresses_Add_offset( starting, the_partition->length ); 56d92: 222a 0014 movel %a2@(20),%d1 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); 56d96: b082 cmpl %d2,%d0 56d98: 623c bhis 56dd6 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); 56d9a: d280 addl %d0,%d1 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); 56d9c: b282 cmpl %d2,%d1 56d9e: 6536 bcss 56dd6 <== NEVER TAKEN RTEMS_INLINE_ROUTINE int32_t _Addresses_Subtract ( const void *left, const void *right ) { return (int32_t) ((const char *) left - (const char *) right); 56da0: 2202 movel %d2,%d1 56da2: 9280 subl %d0,%d1 56da4: 2001 movel %d1,%d0 offset = (uint32_t) _Addresses_Subtract( the_buffer, the_partition->starting_address ); return ((offset % the_partition->buffer_size) == 0); 56da6: 4c6a 0001 0018 remul %a2@(24),%d1,%d0 starting = the_partition->starting_address; ending = _Addresses_Add_offset( starting, the_partition->length ); return ( _Addresses_Is_in_range( the_buffer, starting, ending ) && 56dac: 4a81 tstl %d1 56dae: 6626 bnes 56dd6 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); 56db0: 2f02 movel %d2,%sp@- 56db2: 486a 0024 pea %a2@(36) 56db6: 4eb9 0005 9fc0 jsr 59fc0 <_Chain_Append> switch ( location ) { case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; 56dbc: 53aa 0020 subql #1,%a2@(32) _Thread_Enable_dispatch(); 56dc0: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 56dc6: 242e fff4 movel %fp@(-12),%d2 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(); return RTEMS_SUCCESSFUL; 56dca: 508f addql #8,%sp 56dcc: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 56dce: 246e fff8 moveal %fp@(-8),%a2 56dd2: 4e5e unlk %fp 56dd4: 4e75 rts _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 56dd6: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 56ddc: 242e fff4 movel %fp@(-12),%d2 the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); return RTEMS_INVALID_ADDRESS; 56de0: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 56de2: 246e fff8 moveal %fp@(-8),%a2 56de6: 4e5e unlk %fp ... =============================================================================== 00047800 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 47800: 4e56 fff8 linkw %fp,#-8 47804: 2f03 movel %d3,%sp@- 47806: 2f02 movel %d2,%sp@- Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); 47808: 486e fffc pea %fp@(-4) 4780c: 242e 0008 movel %fp@(8),%d2 47810: 2f02 movel %d2,%sp@- 47812: 4879 0006 1440 pea 61440 <_Rate_monotonic_Information> 47818: 4eb9 0004 9b68 jsr 49b68 <_Objects_Get> rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 4781e: 4fef 000c lea %sp@(12),%sp 47822: 4aae fffc tstl %fp@(-4) 47826: 6624 bnes 4784c <== NEVER TAKEN case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 47828: 2279 0006 16cc moveal 616cc <_Per_CPU_Information+0xc>,%a1 4782e: 2040 moveal %d0,%a0 47830: b3e8 0040 cmpal %a0@(64),%a1 47834: 6726 beqs 4785c _Thread_Enable_dispatch(); 47836: 4eb9 0004 a7fe jsr 4a7fe <_Thread_Enable_dispatch> return RTEMS_NOT_OWNER_OF_RESOURCE; 4783c: 7617 moveq #23,%d3 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4783e: 2003 movel %d3,%d0 47840: 242e fff0 movel %fp@(-16),%d2 47844: 262e fff4 movel %fp@(-12),%d3 47848: 4e5e unlk %fp 4784a: 4e75 rts #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 4784c: 7604 moveq #4,%d3 } 4784e: 2003 movel %d3,%d0 47850: 242e fff0 movel %fp@(-16),%d2 47854: 262e fff4 movel %fp@(-12),%d3 47858: 4e5e unlk %fp 4785a: 4e75 rts if ( !_Thread_Is_executing( the_period->owner ) ) { _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { 4785c: 4aae 000c tstl %fp@(12) 47860: 6624 bnes 47886 switch ( the_period->state ) { 47862: 2040 moveal %d0,%a0 47864: 7204 moveq #4,%d1 47866: 2028 0038 movel %a0@(56),%d0 4786a: b280 cmpl %d0,%d1 4786c: 6400 008a bccw 478f8 47870: 4283 clrl %d3 <== NOT EXECUTED case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); 47872: 4eb9 0004 a7fe jsr 4a7fe <_Thread_Enable_dispatch> <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47878: 2003 movel %d3,%d0 4787a: 242e fff0 movel %fp@(-16),%d2 4787e: 262e fff4 movel %fp@(-12),%d3 47882: 4e5e unlk %fp 47884: 4e75 rts } _Thread_Enable_dispatch(); return( return_value ); } _ISR_Disable( level ); 47886: 223c 0000 0700 movel #1792,%d1 4788c: 40c3 movew %sr,%d3 4788e: 8283 orl %d3,%d1 47890: 46c1 movew %d1,%sr if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 47892: 2040 moveal %d0,%a0 47894: 2228 0038 movel %a0@(56),%d1 47898: 6772 beqs 4790c _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 4789a: 7402 moveq #2,%d2 4789c: b481 cmpl %d1,%d2 4789e: 6700 00d2 beqw 47972 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 478a2: 7404 moveq #4,%d2 478a4: b481 cmpl %d1,%d2 478a6: 66a4 bnes 4784c <== NEVER TAKEN /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 478a8: 2f00 movel %d0,%sp@- 478aa: 2d40 fff8 movel %d0,%fp@(-8) 478ae: 4eb9 0004 76e6 jsr 476e6 <_Rate_monotonic_Update_statistics> _ISR_Enable( level ); 478b4: 46c3 movew %d3,%sr the_period->state = RATE_MONOTONIC_ACTIVE; 478b6: 7202 moveq #2,%d1 the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_TIMEOUT; 478b8: 7606 moveq #6,%d3 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; 478ba: 202e fff8 movel %fp@(-8),%d0 478be: 2040 moveal %d0,%a0 the_period->next_length = length; 478c0: 226e 000c moveal %fp@(12),%a1 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; 478c4: 2141 0038 movel %d1,%a0@(56) the_period->next_length = length; 478c8: 2149 003c movel %a1,%a0@(60) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 478cc: 2149 001c movel %a1,%a0@(28) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 478d0: 4868 0010 pea %a0@(16) 478d4: 4879 0006 15f0 pea 615f0 <_Watchdog_Ticks_chain> 478da: 4eb9 0004 b74c jsr 4b74c <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 478e0: 4eb9 0004 a7fe jsr 4a7fe <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 478e6: 242e fff0 movel %fp@(-16),%d2 478ea: 2003 movel %d3,%d0 the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_TIMEOUT; 478ec: 4fef 000c lea %sp@(12),%sp case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 478f0: 262e fff4 movel %fp@(-12),%d3 478f4: 4e5e unlk %fp 478f6: 4e75 rts _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { switch ( the_period->state ) { 478f8: 41f9 0005 ece6 lea 5ece6 ,%a0 478fe: 2630 0c00 movel %a0@(00000000,%d0:l:4),%d3 case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); 47902: 4eb9 0004 a7fe jsr 4a7fe <_Thread_Enable_dispatch> 47908: 6000 ff6e braw 47878 return( return_value ); } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { _ISR_Enable( level ); 4790c: 46c3 movew %d3,%sr /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 4790e: 2f00 movel %d0,%sp@- the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 47910: 4283 clrl %d3 _ISR_Enable( level ); /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 47912: 2d40 fff8 movel %d0,%fp@(-8) 47916: 4eb9 0004 7668 jsr 47668 <_Rate_monotonic_Initiate_statistics> Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 4791c: 202e fff8 movel %fp@(-8),%d0 47920: 2240 moveal %d0,%a1 47922: 223c 0004 7c84 movel #294020,%d1 the_watchdog->id = id; 47928: 2342 0030 movel %d2,%a1@(48) _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 4792c: 242e 000c movel %fp@(12),%d2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 47930: 2341 002c movel %d1,%a1@(44) /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); the_period->state = RATE_MONOTONIC_ACTIVE; 47934: 7202 moveq #2,%d1 _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 47936: 2342 003c movel %d2,%a1@(60) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4793a: 2342 001c movel %d2,%a1@(28) /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); the_period->state = RATE_MONOTONIC_ACTIVE; 4793e: 2341 0038 movel %d1,%a1@(56) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 47942: 42a9 0018 clrl %a1@(24) the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 47946: 42a9 0034 clrl %a1@(52) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4794a: 4869 0010 pea %a1@(16) 4794e: 4879 0006 15f0 pea 615f0 <_Watchdog_Ticks_chain> 47954: 4eb9 0004 b74c jsr 4b74c <_Watchdog_Insert> ); the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 4795a: 4eb9 0004 a7fe jsr 4a7fe <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47960: 242e fff0 movel %fp@(-16),%d2 47964: 2003 movel %d3,%d0 the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 47966: 4fef 000c lea %sp@(12),%sp case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4796a: 262e fff4 movel %fp@(-12),%d3 4796e: 4e5e unlk %fp 47970: 4e75 rts if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 47972: 2f00 movel %d0,%sp@- 47974: 2d40 fff8 movel %d0,%fp@(-8) 47978: 4eb9 0004 76e6 jsr 476e6 <_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; 4797e: 202e fff8 movel %fp@(-8),%d0 47982: 7201 moveq #1,%d1 47984: 2040 moveal %d0,%a0 the_period->next_length = length; 47986: 226e 000c moveal %fp@(12),%a1 /* * 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; 4798a: 2141 0038 movel %d1,%a0@(56) the_period->next_length = length; 4798e: 2149 003c movel %a1,%a0@(60) _ISR_Enable( level ); 47992: 46c3 movew %d3,%sr _Thread_Executing->Wait.id = the_period->Object.id; 47994: 2079 0006 16cc moveal 616cc <_Per_CPU_Information+0xc>,%a0 4799a: 2240 moveal %d0,%a1 4799c: 5089 addql #8,%a1 4799e: 2151 0020 movel %a1@,%a0@(32) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 479a2: 4878 4000 pea 4000 479a6: 2d40 fff8 movel %d0,%fp@(-8) 479aa: 2f08 movel %a0,%sp@- 479ac: 4eb9 0004 b0e4 jsr 4b0e4 <_Thread_Set_state> /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 479b2: 223c 0000 0700 movel #1792,%d1 479b8: 40c2 movew %sr,%d2 479ba: 8282 orl %d2,%d1 479bc: 46c1 movew %d1,%sr local_state = the_period->state; the_period->state = RATE_MONOTONIC_ACTIVE; 479be: 7602 moveq #2,%d3 /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; 479c0: 202e fff8 movel %fp@(-8),%d0 479c4: 2040 moveal %d0,%a0 479c6: 2228 0038 movel %a0@(56),%d1 the_period->state = RATE_MONOTONIC_ACTIVE; 479ca: 2143 0038 movel %d3,%a0@(56) _ISR_Enable( level ); 479ce: 46c2 movew %d2,%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 ) 479d0: 7003 moveq #3,%d0 479d2: 4fef 000c lea %sp@(12),%sp 479d6: b081 cmpl %d1,%d0 479d8: 6716 beqs 479f0 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); 479da: 4eb9 0004 a7fe jsr 4a7fe <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 479e0: 4283 clrl %d3 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 479e2: 2003 movel %d3,%d0 479e4: 242e fff0 movel %fp@(-16),%d2 479e8: 262e fff4 movel %fp@(-12),%d3 479ec: 4e5e unlk %fp 479ee: 4e75 rts /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 479f0: 4878 4000 pea 4000 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 479f4: 4283 clrl %d3 /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 479f6: 2f39 0006 16cc movel 616cc <_Per_CPU_Information+0xc>,%sp@- 479fc: 4eb9 0004 a430 jsr 4a430 <_Thread_Clear_state> 47a02: 508f addql #8,%sp _Thread_Enable_dispatch(); 47a04: 4eb9 0004 a7fe jsr 4a7fe <_Thread_Enable_dispatch> 47a0a: 60d6 bras 479e2 =============================================================================== 00047a0c : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 47a0c: 4e56 ff78 linkw %fp,#-136 47a10: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 47a14: 262e 0008 movel %fp@(8),%d3 47a18: 246e 000c moveal %fp@(12),%a2 rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) 47a1c: 4a8a tstl %a2 47a1e: 6700 0082 beqw 47aa2 return; (*print)( context, "Period information by period\n" ); 47a22: 4879 0005 ecfa pea 5ecfa 47a28: 2f03 movel %d3,%sp@- 47a2a: 4e92 jsr %a2@ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 47a2c: 4879 0005 ed18 pea 5ed18 47a32: 2f03 movel %d3,%sp@- 47a34: 4e92 jsr %a2@ (*print)( context, "--- Wall times are in seconds ---\n" ); 47a36: 4879 0005 ed3a pea 5ed3a 47a3c: 2f03 movel %d3,%sp@- 47a3e: 4e92 jsr %a2@ Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 47a40: 4879 0005 ed5d pea 5ed5d 47a46: 2f03 movel %d3,%sp@- 47a48: 4e92 jsr %a2@ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 47a4a: 4fef 001c lea %sp@(28),%sp 47a4e: 2ebc 0005 eda8 movel #388520,%sp@ 47a54: 2f03 movel %d3,%sp@- 47a56: 4e92 jsr %a2@ /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 47a58: 2439 0006 1446 movel 61446 <_Rate_monotonic_Information+0x6>,%d2 47a5e: 508f addql #8,%sp 47a60: b4b9 0006 144a cmpl 6144a <_Rate_monotonic_Information+0xa>,%d2 47a66: 623a bhis 47aa2 <== NEVER TAKEN 47a68: 280e movel %fp,%d4 continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 47a6a: 2a0e movel %fp,%d5 47a6c: 0684 ffff ffa2 addil #-94,%d4 47a72: 47f9 0004 d4e0 lea 4d4e0 ,%a3 #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 47a78: 4bf9 0004 d5a0 lea 4d5a0 ,%a5 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 47a7e: 5b85 subql #5,%d5 47a80: 49f9 0004 7d64 lea 47d64 ,%a4 struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 47a86: 2e3c 0004 b34c movel #308044,%d7 * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 47a8c: 2f04 movel %d4,%sp@- 47a8e: 2f02 movel %d2,%sp@- 47a90: 4e93 jsr %a3@ if ( status != RTEMS_SUCCESSFUL ) 47a92: 508f addql #8,%sp 47a94: 4a80 tstl %d0 47a96: 6714 beqs 47aac * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 47a98: 5282 addql #1,%d2 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 47a9a: b4b9 0006 144a cmpl 6144a <_Rate_monotonic_Information+0xa>,%d2 47aa0: 63ea blss 47a8c the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } 47aa2: 4cee 3cfc ff78 moveml %fp@(-136),%d2-%d7/%a2-%a5 47aa8: 4e5e unlk %fp 47aaa: 4e75 rts #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 47aac: 486e ffda pea %fp@(-38) 47ab0: 2f02 movel %d2,%sp@- 47ab2: 4e95 jsr %a5@ #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 47ab4: 2f05 movel %d5,%sp@- 47ab6: 4878 0005 pea 5 47aba: 2f2e ffda movel %fp@(-38),%sp@- 47abe: 4e94 jsr %a4@ /* * Print part of report line that is not dependent on granularity */ (*print)( context, 47ac0: 2f2e ffa6 movel %fp@(-90),%sp@- 47ac4: 2f2e ffa2 movel %fp@(-94),%sp@- 47ac8: 2f05 movel %d5,%sp@- 47aca: 2f02 movel %d2,%sp@- 47acc: 4879 0005 edf4 pea 5edf4 47ad2: 2f03 movel %d3,%sp@- 47ad4: 4e92 jsr %a2@ ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 47ad6: 202e ffa2 movel %fp@(-94),%d0 47ada: 4fef 002c lea %sp@(44),%sp 47ade: 6618 bnes 47af8 (*print)( context, "\n" ); 47ae0: 4879 0005 e3b6 pea 5e3b6 * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 47ae6: 5282 addql #1,%d2 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 47ae8: 2f03 movel %d3,%sp@- 47aea: 4e92 jsr %a2@ continue; 47aec: 508f addql #8,%sp /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 47aee: b4b9 0006 144a cmpl 6144a <_Rate_monotonic_Information+0xa>,%d2 47af4: 6396 blss 47a8c <== ALWAYS TAKEN 47af6: 60aa bras 47aa2 <== NOT EXECUTED struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 47af8: 486e fff2 pea %fp@(-14) 47afc: 2047 moveal %d7,%a0 * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 47afe: 5282 addql #1,%d2 struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 47b00: 2f00 movel %d0,%sp@- 47b02: 486e ffba pea %fp@(-70) 47b06: 4e90 jsr %a0@ (*print)( context, 47b08: 202e fff6 movel %fp@(-10),%d0 47b0c: 223c 0000 03e8 movel #1000,%d1 47b12: 4c41 0800 remsl %d1,%d0,%d0 47b16: 2c2e ffb6 movel %fp@(-74),%d6 47b1a: 2f00 movel %d0,%sp@- 47b1c: 2001 movel %d1,%d0 47b1e: 2f2e fff2 movel %fp@(-14),%sp@- 47b22: 4c40 6806 remsl %d0,%d6,%d6 47b26: 202e ffae movel %fp@(-82),%d0 47b2a: 2246 moveal %d6,%a1 47b2c: 223c 0000 03e8 movel #1000,%d1 47b32: 2f09 movel %a1,%sp@- 47b34: 2f2e ffb2 movel %fp@(-78),%sp@- 47b38: 4c41 0800 remsl %d1,%d0,%d0 struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, 47b3c: 2c3c 0000 03e8 movel #1000,%d6 struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); (*print)( context, 47b42: 2f00 movel %d0,%sp@- 47b44: 2f2e ffaa movel %fp@(-86),%sp@- 47b48: 4879 0005 ee0b pea 5ee0b 47b4e: 2f03 movel %d3,%sp@- 47b50: 4e92 jsr %a2@ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); 47b52: 4fef 002c lea %sp@(44),%sp 47b56: 2047 moveal %d7,%a0 47b58: 486e fff2 pea %fp@(-14) 47b5c: 2f2e ffa2 movel %fp@(-94),%sp@- 47b60: 486e ffd2 pea %fp@(-46) 47b64: 4e90 jsr %a0@ (*print)( context, 47b66: 202e fff6 movel %fp@(-10),%d0 47b6a: 4c46 0800 remsl %d6,%d0,%d0 47b6e: 222e ffce movel %fp@(-50),%d1 47b72: 2f00 movel %d0,%sp@- 47b74: 2f2e fff2 movel %fp@(-14),%sp@- 47b78: 4c46 1801 remsl %d6,%d1,%d1 47b7c: 202e ffc6 movel %fp@(-58),%d0 47b80: 2241 moveal %d1,%a1 47b82: 2f09 movel %a1,%sp@- 47b84: 2f2e ffca movel %fp@(-54),%sp@- 47b88: 4c46 0800 remsl %d6,%d0,%d0 47b8c: 2f00 movel %d0,%sp@- 47b8e: 2f2e ffc2 movel %fp@(-62),%sp@- 47b92: 4879 0005 ee2a pea 5ee2a 47b98: 2f03 movel %d3,%sp@- 47b9a: 4e92 jsr %a2@ 47b9c: 4fef 002c lea %sp@(44),%sp /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 47ba0: b4b9 0006 144a cmpl 6144a <_Rate_monotonic_Information+0xa>,%d2 47ba6: 6300 fee4 blsw 47a8c 47baa: 6000 fef6 braw 47aa2 <== NOT EXECUTED =============================================================================== 00047bc8 : /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { 47bc8: 4e56 0000 linkw %fp,#0 47bcc: 2039 0006 1530 movel 61530 <_Thread_Dispatch_disable_level>,%d0 47bd2: 5280 addql #1,%d0 47bd4: 2f0a movel %a2,%sp@- 47bd6: 23c0 0006 1530 movel %d0,61530 <_Thread_Dispatch_disable_level> 47bdc: 2f02 movel %d2,%sp@- /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 47bde: 2439 0006 1446 movel 61446 <_Rate_monotonic_Information+0x6>,%d2 47be4: b4b9 0006 144a cmpl 6144a <_Rate_monotonic_Information+0xa>,%d2 47bea: 6216 bhis 47c02 <== NEVER TAKEN 47bec: 45f9 0004 7c14 lea 47c14 ,%a2 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); 47bf2: 2f02 movel %d2,%sp@- * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 47bf4: 5282 addql #1,%d2 (void) rtems_rate_monotonic_reset_statistics( id ); 47bf6: 4e92 jsr %a2@ /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 47bf8: 588f addql #4,%sp 47bfa: b4b9 0006 144a cmpl 6144a <_Rate_monotonic_Information+0xa>,%d2 47c00: 63f0 blss 47bf2 /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); } 47c02: 242e fff8 movel %fp@(-8),%d2 47c06: 246e fffc moveal %fp@(-4),%a2 47c0a: 4e5e unlk %fp } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); 47c0c: 4ef9 0004 a7fe jmp 4a7fe <_Thread_Enable_dispatch> ... =============================================================================== 000576a4 : uintptr_t length, uintptr_t page_size, rtems_attribute attribute_set, rtems_id *id ) { 576a4: 4e56 ffe4 linkw %fp,#-28 576a8: 48d7 0c7c moveml %d2-%d6/%a2-%a3,%sp@ 576ac: 262e 0008 movel %fp@(8),%d3 576b0: 242e 000c movel %fp@(12),%d2 576b4: 2a2e 0010 movel %fp@(16),%d5 576b8: 282e 0014 movel %fp@(20),%d4 576bc: 2c2e 0018 movel %fp@(24),%d6 576c0: 266e 001c moveal %fp@(28),%a3 rtems_status_code return_status; Region_Control *the_region; if ( !rtems_is_name_valid( name ) ) 576c4: 4a83 tstl %d3 576c6: 6774 beqs 5773c return RTEMS_INVALID_NAME; if ( !starting_address ) 576c8: 4a82 tstl %d2 576ca: 6700 00dc beqw 577a8 return RTEMS_INVALID_ADDRESS; if ( !id ) 576ce: 4a8b tstl %a3 576d0: 6700 00d6 beqw 577a8 return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); /* to prevent deletion */ 576d4: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- 576da: 4eb9 0005 9f2c jsr 59f2c <_API_Mutex_Lock> * This function allocates a region control block from * the inactive chain of free region control blocks. */ RTEMS_INLINE_ROUTINE Region_Control *_Region_Allocate( void ) { return (Region_Control *) _Objects_Allocate( &_Region_Information ); 576e0: 4879 0007 e154 pea 7e154 <_Region_Information> 576e6: 4eb9 0005 b6bc jsr 5b6bc <_Objects_Allocate> the_region = _Region_Allocate(); if ( !the_region ) 576ec: 508f addql #8,%sp 576ee: 2440 moveal %d0,%a2 576f0: 4a80 tstl %d0 576f2: 6700 00c2 beqw 577b6 return_status = RTEMS_TOO_MANY; else { the_region->maximum_segment_size = _Heap_Initialize( 576f6: 2f04 movel %d4,%sp@- 576f8: 2f05 movel %d5,%sp@- 576fa: 2f02 movel %d2,%sp@- 576fc: 486a 0068 pea %a2@(104) 57700: 4eb9 0005 b246 jsr 5b246 <_Heap_Initialize> &the_region->Memory, starting_address, length, page_size ); if ( !the_region->maximum_segment_size ) { 57706: 4fef 0010 lea %sp@(16),%sp if ( !the_region ) return_status = RTEMS_TOO_MANY; else { the_region->maximum_segment_size = _Heap_Initialize( 5770a: 2540 005c movel %d0,%a2@(92) &the_region->Memory, starting_address, length, page_size ); if ( !the_region->maximum_segment_size ) { 5770e: 663a bnes 5774a */ RTEMS_INLINE_ROUTINE void _Region_Free ( Region_Control *the_region ) { _Objects_Free( &_Region_Information, &the_region->Object ); 57710: 2f0a movel %a2,%sp@- 57712: 4879 0007 e154 pea 7e154 <_Region_Information> _Region_Free( the_region ); return_status = RTEMS_INVALID_SIZE; 57718: 7408 moveq #8,%d2 5771a: 4eb9 0005 ba08 jsr 5ba08 <_Objects_Free> 57720: 508f addql #8,%sp *id = the_region->Object.id; return_status = RTEMS_SUCCESSFUL; } } _RTEMS_Unlock_allocator(); 57722: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- 57728: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 5772e: 588f addql #4,%sp } 57730: 2002 movel %d2,%d0 57732: 4cee 0c7c ffe4 moveml %fp@(-28),%d2-%d6/%a2-%a3 57738: 4e5e unlk %fp 5773a: 4e75 rts { rtems_status_code return_status; Region_Control *the_region; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; 5773c: 7403 moveq #3,%d2 } } _RTEMS_Unlock_allocator(); return return_status; } 5773e: 2002 movel %d2,%d0 57740: 4cee 0c7c ffe4 moveml %fp@(-28),%d2-%d6/%a2-%a3 57746: 4e5e unlk %fp 57748: 4e75 rts return_status = RTEMS_INVALID_SIZE; } else { the_region->starting_address = starting_address; 5774a: 2542 0050 movel %d2,%a2@(80) &the_region->Object, (Objects_Name) name ); *id = the_region->Object.id; return_status = RTEMS_SUCCESSFUL; 5774e: 4282 clrl %d2 } else { the_region->starting_address = starting_address; the_region->length = length; 57750: 2545 0054 movel %d5,%a2@(84) the_region->page_size = page_size; the_region->attribute_set = attribute_set; the_region->number_of_used_blocks = 0; _Thread_queue_Initialize( 57754: 44c6 movew %d6,%ccr 57756: 57c0 seq %d0 else { the_region->starting_address = starting_address; the_region->length = length; the_region->page_size = page_size; 57758: 2544 0058 movel %d4,%a2@(88) the_region->attribute_set = attribute_set; the_region->number_of_used_blocks = 0; _Thread_queue_Initialize( 5775c: 49c0 extbl %d0 5775e: 4480 negl %d0 else { the_region->starting_address = starting_address; the_region->length = length; the_region->page_size = page_size; the_region->attribute_set = attribute_set; 57760: 2546 0060 movel %d6,%a2@(96) the_region->number_of_used_blocks = 0; 57764: 42aa 0064 clrl %a2@(100) _Thread_queue_Initialize( 57768: 4878 0006 pea 6 5776c: 4878 0040 pea 40 57770: 2f00 movel %d0,%sp@- 57772: 486a 0010 pea %a2@(16) 57776: 4eb9 0005 cfd0 jsr 5cfd0 <_Thread_queue_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 5777c: 202a 0008 movel %a2@(8),%d0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 57780: 4281 clrl %d1 &_Region_Information, &the_region->Object, (Objects_Name) name ); *id = the_region->Object.id; 57782: 4fef 0010 lea %sp@(16),%sp #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 57786: 2079 0007 e16c moveal 7e16c <_Region_Information+0x18>,%a0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 5778c: 3200 movew %d0,%d1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 5778e: 218a 1c00 movel %a2,%a0@(00000000,%d1:l:4) information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 57792: 2543 000c movel %d3,%a2@(12) 57796: 2680 movel %d0,%a3@ return_status = RTEMS_SUCCESSFUL; } } _RTEMS_Unlock_allocator(); 57798: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- 5779e: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 577a4: 588f addql #4,%sp 577a6: 6088 bras 57730 if ( !starting_address ) return RTEMS_INVALID_ADDRESS; if ( !id ) return RTEMS_INVALID_ADDRESS; 577a8: 7409 moveq #9,%d2 } } _RTEMS_Unlock_allocator(); return return_status; } 577aa: 2002 movel %d2,%d0 577ac: 4cee 0c7c ffe4 moveml %fp@(-28),%d2-%d6/%a2-%a3 577b2: 4e5e unlk %fp 577b4: 4e75 rts *id = the_region->Object.id; return_status = RTEMS_SUCCESSFUL; } } _RTEMS_Unlock_allocator(); 577b6: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- _RTEMS_Lock_allocator(); /* to prevent deletion */ the_region = _Region_Allocate(); if ( !the_region ) return_status = RTEMS_TOO_MANY; 577bc: 7405 moveq #5,%d2 *id = the_region->Object.id; return_status = RTEMS_SUCCESSFUL; } } _RTEMS_Unlock_allocator(); 577be: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 577c4: 588f addql #4,%sp 577c6: 6000 ff68 braw 57730 ... =============================================================================== 0005787c : rtems_status_code rtems_region_extend( rtems_id id, void *starting_address, uintptr_t length ) { 5787c: 4e56 fff8 linkw %fp,#-8 57880: 2f0a movel %a2,%sp@- 57882: 2f02 movel %d2,%sp@- 57884: 242e 000c movel %fp@(12),%d2 bool extend_ok; Objects_Locations location; rtems_status_code return_status; Region_Control *the_region; if ( !starting_address ) 57888: 6700 0086 beqw 57910 return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); /* to prevent deletion */ 5788c: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- 57892: 4eb9 0005 9f2c jsr 59f2c <_API_Mutex_Lock> Objects_Id id, Objects_Locations *location ) { return (Region_Control *) _Objects_Get_no_protection( &_Region_Information, id, location ); 57898: 486e fff8 pea %fp@(-8) 5789c: 2f2e 0008 movel %fp@(8),%sp@- 578a0: 4879 0007 e154 pea 7e154 <_Region_Information> 578a6: 4eb9 0005 bb74 jsr 5bb74 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 578ac: 4fef 0010 lea %sp@(16),%sp 578b0: 2440 moveal %d0,%a2 578b2: 4aae fff8 tstl %fp@(-8) 578b6: 6646 bnes 578fe case OBJECTS_LOCAL: extend_ok = _Heap_Extend( 578b8: 486e fffc pea %fp@(-4) 578bc: 2f2e 0010 movel %fp@(16),%sp@- 578c0: 2f02 movel %d2,%sp@- 578c2: 486a 0068 pea %a2@(104) 578c6: 4eb9 0005 ac44 jsr 5ac44 <_Heap_Extend> starting_address, length, &amount_extended ); if ( extend_ok ) { 578cc: 4fef 0010 lea %sp@(16),%sp 578d0: 4a00 tstb %d0 578d2: 674c beqs 57920 the_region->length += amount_extended; 578d4: 202e fffc movel %fp@(-4),%d0 578d8: d1aa 0054 addl %d0,%a2@(84) the_region->maximum_segment_size += amount_extended; return_status = RTEMS_SUCCESSFUL; 578dc: 4282 clrl %d2 &amount_extended ); if ( extend_ok ) { the_region->length += amount_extended; the_region->maximum_segment_size += amount_extended; 578de: d1aa 005c addl %d0,%a2@(92) default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 578e2: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- 578e8: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 578ee: 588f addql #4,%sp } 578f0: 2002 movel %d2,%d0 578f2: 242e fff0 movel %fp@(-16),%d2 578f6: 246e fff4 moveal %fp@(-12),%a2 578fa: 4e5e unlk %fp 578fc: 4e75 rts default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 578fe: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- break; #endif case OBJECTS_ERROR: default: return_status = RTEMS_INVALID_ID; 57904: 7404 moveq #4,%d2 break; } _RTEMS_Unlock_allocator(); 57906: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 5790c: 588f addql #4,%sp 5790e: 60e0 bras 578f0 Objects_Locations location; rtems_status_code return_status; Region_Control *the_region; if ( !starting_address ) return RTEMS_INVALID_ADDRESS; 57910: 7409 moveq #9,%d2 break; } _RTEMS_Unlock_allocator(); return return_status; } 57912: 2002 movel %d2,%d0 57914: 242e fff0 movel %fp@(-16),%d2 57918: 246e fff4 moveal %fp@(-12),%a2 5791c: 4e5e unlk %fp 5791e: 4e75 rts default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 57920: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- if ( extend_ok ) { the_region->length += amount_extended; the_region->maximum_segment_size += amount_extended; return_status = RTEMS_SUCCESSFUL; } else { return_status = RTEMS_INVALID_ADDRESS; 57926: 7409 moveq #9,%d2 default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 57928: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 5792e: 588f addql #4,%sp 57930: 60be bras 578f0 ... =============================================================================== 00057bb8 : rtems_status_code rtems_region_get_segment_size( rtems_id id, void *segment, uintptr_t *size ) { 57bb8: 4e56 fffc linkw %fp,#-4 57bbc: 2f03 movel %d3,%sp@- 57bbe: 262e 0010 movel %fp@(16),%d3 57bc2: 2f02 movel %d2,%sp@- 57bc4: 242e 000c movel %fp@(12),%d2 Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; register Region_Control *the_region; if ( !segment ) 57bc8: 6700 0092 beqw 57c5c return RTEMS_INVALID_ADDRESS; if ( !size ) 57bcc: 4a83 tstl %d3 57bce: 6700 008c beqw 57c5c return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); 57bd2: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- 57bd8: 4eb9 0005 9f2c jsr 59f2c <_API_Mutex_Lock> 57bde: 486e fffc pea %fp@(-4) 57be2: 2f2e 0008 movel %fp@(8),%sp@- 57be6: 4879 0007 e154 pea 7e154 <_Region_Information> 57bec: 4eb9 0005 bb74 jsr 5bb74 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 57bf2: 222e fffc movel %fp@(-4),%d1 57bf6: 4fef 0010 lea %sp@(16),%sp 57bfa: 6636 bnes 57c32 <== NEVER TAKEN case OBJECTS_LOCAL: if ( !_Heap_Size_of_alloc_area( &the_region->Memory, segment, size ) ) 57bfc: 2f03 movel %d3,%sp@- 57bfe: 2040 moveal %d0,%a0 57c00: 2f02 movel %d2,%sp@- 57c02: 4868 0068 pea %a0@(104) 57c06: 4eb9 0005 b594 jsr 5b594 <_Heap_Size_of_alloc_area> 57c0c: 4fef 000c lea %sp@(12),%sp 57c10: 4a00 tstb %d0 57c12: 6624 bnes 57c38 <== ALWAYS TAKEN case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 57c14: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- <== NOT EXECUTED the_region = _Region_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Heap_Size_of_alloc_area( &the_region->Memory, segment, size ) ) return_status = RTEMS_INVALID_ADDRESS; 57c1a: 7409 moveq #9,%d2 <== NOT EXECUTED case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 57c1c: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> <== NOT EXECUTED return return_status; 57c22: 588f addql #4,%sp <== NOT EXECUTED } 57c24: 2002 movel %d2,%d0 57c26: 242e fff4 movel %fp@(-12),%d2 57c2a: 262e fff8 movel %fp@(-8),%d3 57c2e: 4e5e unlk %fp 57c30: 4e75 rts return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); the_region = _Region_Get( id, &location ); switch ( location ) { 57c32: 7001 moveq #1,%d0 57c34: b081 cmpl %d1,%d0 57c36: 6712 beqs 57c4a <== ALWAYS TAKEN case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 57c38: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- void *segment, uintptr_t *size ) { Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; 57c3e: 4282 clrl %d2 case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 57c40: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 57c46: 588f addql #4,%sp 57c48: 60da bras 57c24 case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 57c4a: 2f39 0007 e2e4 movel 7e2e4 <_RTEMS_Allocator_Mutex>,%sp@- case OBJECTS_REMOTE: /* this error cannot be returned */ break; #endif case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; 57c50: 7404 moveq #4,%d2 break; } _RTEMS_Unlock_allocator(); 57c52: 4eb9 0005 9f8c jsr 59f8c <_API_Mutex_Unlock> return return_status; 57c58: 588f addql #4,%sp 57c5a: 60c8 bras 57c24 if ( !segment ) return RTEMS_INVALID_ADDRESS; if ( !size ) return RTEMS_INVALID_ADDRESS; 57c5c: 7409 moveq #9,%d2 break; } _RTEMS_Unlock_allocator(); return return_status; } 57c5e: 2002 movel %d2,%d0 57c60: 242e fff4 movel %fp@(-12),%d2 57c64: 262e fff8 movel %fp@(-8),%d3 57c68: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00046690 : #endif rtems_status_code rtems_semaphore_delete( rtems_id id ) { 46690: 4e56 fffc linkw %fp,#-4 46694: 2f0a movel %a2,%sp@- Objects_Id id, Objects_Locations *location ) { return (Semaphore_Control *) _Objects_Get( &_Semaphore_Information, id, location ); 46696: 486e fffc pea %fp@(-4) 4669a: 2f2e 0008 movel %fp@(8),%sp@- 4669e: 4879 0005 f390 pea 5f390 <_Semaphore_Information> 466a4: 4eb9 0004 8040 jsr 48040 <_Objects_Get> register Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { 466aa: 4fef 000c lea %sp@(12),%sp 466ae: 2440 moveal %d0,%a2 466b0: 4aae fffc tstl %fp@(-4) 466b4: 670a beqs 466c0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 466b6: 246e fff8 moveal %fp@(-8),%a2 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 466ba: 7004 moveq #4,%d0 } 466bc: 4e5e unlk %fp 466be: 4e75 rts 466c0: 7030 moveq #48,%d0 466c2: c0aa 0010 andl %a2@(16),%d0 the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { 466c6: 6760 beqs 46728 if ( _CORE_mutex_Is_locked( &the_semaphore->Core_control.mutex ) && 466c8: 4aaa 0062 tstl %a2@(98) 466cc: 6616 bnes 466e4 466ce: 7220 moveq #32,%d1 466d0: b280 cmpl %d0,%d1 466d2: 6710 beqs 466e4 !_Attributes_Is_simple_binary_semaphore( the_semaphore->attribute_set ) ) { _Thread_Enable_dispatch(); 466d4: 4eb9 0004 8cd6 jsr 48cd6 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 466da: 246e fff8 moveal %fp@(-8),%a2 if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { if ( _CORE_mutex_Is_locked( &the_semaphore->Core_control.mutex ) && !_Attributes_Is_simple_binary_semaphore( the_semaphore->attribute_set ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; 466de: 700c moveq #12,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 466e0: 4e5e unlk %fp 466e2: 4e75 rts !_Attributes_Is_simple_binary_semaphore( the_semaphore->attribute_set ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } _CORE_mutex_Flush( 466e4: 4878 0003 pea 3 466e8: 42a7 clrl %sp@- 466ea: 486a 0014 pea %a2@(20) 466ee: 4eb9 0004 7220 jsr 47220 <_CORE_mutex_Flush> 466f4: 4fef 000c lea %sp@(12),%sp SEMAPHORE_MP_OBJECT_WAS_DELETED, CORE_SEMAPHORE_WAS_DELETED ); } _Objects_Close( &_Semaphore_Information, &the_semaphore->Object ); 466f8: 2f0a movel %a2,%sp@- 466fa: 4879 0005 f390 pea 5f390 <_Semaphore_Information> 46700: 4eb9 0004 7c18 jsr 47c18 <_Objects_Close> */ RTEMS_INLINE_ROUTINE void _Semaphore_Free ( Semaphore_Control *the_semaphore ) { _Objects_Free( &_Semaphore_Information, &the_semaphore->Object ); 46706: 2f0a movel %a2,%sp@- 46708: 4879 0005 f390 pea 5f390 <_Semaphore_Information> 4670e: 4eb9 0004 7ed4 jsr 47ed4 <_Objects_Free> 0, /* Not used */ 0 /* Not used */ ); } #endif _Thread_Enable_dispatch(); 46714: 4eb9 0004 8cd6 jsr 48cd6 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4671a: 4fef 0010 lea %sp@(16),%sp 4671e: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 46720: 246e fff8 moveal %fp@(-8),%a2 46724: 4e5e unlk %fp 46726: 4e75 rts &the_semaphore->Core_control.mutex, SEMAPHORE_MP_OBJECT_WAS_DELETED, CORE_MUTEX_WAS_DELETED ); } else { _CORE_semaphore_Flush( 46728: 4878 0002 pea 2 4672c: 42a7 clrl %sp@- 4672e: 486a 0014 pea %a2@(20) 46732: 4eb9 0004 7558 jsr 47558 <_CORE_semaphore_Flush> 46738: 4fef 000c lea %sp@(12),%sp SEMAPHORE_MP_OBJECT_WAS_DELETED, CORE_SEMAPHORE_WAS_DELETED ); } _Objects_Close( &_Semaphore_Information, &the_semaphore->Object ); 4673c: 2f0a movel %a2,%sp@- 4673e: 4879 0005 f390 pea 5f390 <_Semaphore_Information> 46744: 4eb9 0004 7c18 jsr 47c18 <_Objects_Close> 4674a: 2f0a movel %a2,%sp@- 4674c: 4879 0005 f390 pea 5f390 <_Semaphore_Information> 46752: 4eb9 0004 7ed4 jsr 47ed4 <_Objects_Free> 0, /* Not used */ 0 /* Not used */ ); } #endif _Thread_Enable_dispatch(); 46758: 4eb9 0004 8cd6 jsr 48cd6 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4675e: 4fef 0010 lea %sp@(16),%sp 46762: 4280 clrl %d0 46764: 60ba bras 46720 ... =============================================================================== 0004fae8 : #endif rtems_status_code rtems_semaphore_flush( rtems_id id ) { 4fae8: 4e56 fffc linkw %fp,#-4 4faec: 486e fffc pea %fp@(-4) 4faf0: 2f2e 0008 movel %fp@(8),%sp@- 4faf4: 4879 0006 3568 pea 63568 <_Semaphore_Information> 4fafa: 4eb9 0004 95f8 jsr 495f8 <_Objects_Get> register Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { 4fb00: 4fef 000c lea %sp@(12),%sp 4fb04: 4aae fffc tstl %fp@(-4) 4fb08: 6706 beqs 4fb10 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 4fb0a: 7004 moveq #4,%d0 } 4fb0c: 4e5e unlk %fp 4fb0e: 4e75 rts 4fb10: 7230 moveq #48,%d1 4fb12: 2040 moveal %d0,%a0 4fb14: c2a8 0010 andl %a0@(16),%d1 the_semaphore = _Semaphore_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { 4fb18: 6720 beqs 4fb3a _CORE_mutex_Flush( 4fb1a: 4878 0001 pea 1 4fb1e: 42a7 clrl %sp@- 4fb20: 4868 0014 pea %a0@(20) 4fb24: 4eb9 0004 87d8 jsr 487d8 <_CORE_mutex_Flush> 4fb2a: 4fef 000c lea %sp@(12),%sp &the_semaphore->Core_control.semaphore, SEND_OBJECT_WAS_DELETED, CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT ); } _Thread_Enable_dispatch(); 4fb2e: 4eb9 0004 a296 jsr 4a296 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4fb34: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4fb36: 4e5e unlk %fp 4fb38: 4e75 rts &the_semaphore->Core_control.mutex, SEND_OBJECT_WAS_DELETED, CORE_MUTEX_STATUS_UNSATISFIED_NOWAIT ); } else { _CORE_semaphore_Flush( 4fb3a: 4878 0001 pea 1 4fb3e: 2040 moveal %d0,%a0 4fb40: 42a7 clrl %sp@- 4fb42: 4868 0014 pea %a0@(20) 4fb46: 4eb9 0004 8b10 jsr 48b10 <_CORE_semaphore_Flush> 4fb4c: 4fef 000c lea %sp@(12),%sp &the_semaphore->Core_control.semaphore, SEND_OBJECT_WAS_DELETED, CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT ); } _Thread_Enable_dispatch(); 4fb50: 4eb9 0004 a296 jsr 4a296 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4fb56: 4280 clrl %d0 4fb58: 60dc bras 4fb36 ... =============================================================================== 00046768 : rtems_status_code rtems_semaphore_obtain( rtems_id id, rtems_option option_set, rtems_interval timeout ) { 46768: 4e56 ffec linkw %fp,#-20 4676c: 48d7 001c moveml %d2-%d4,%sp@ Objects_Locations *location, ISR_Level *level ) { return (Semaphore_Control *) _Objects_Get_isr_disable( &_Semaphore_Information, id, location, level ); 46770: 486e fff8 pea %fp@(-8) 46774: 486e fffc pea %fp@(-4) 46778: 242e 0008 movel %fp@(8),%d2 4677c: 2f02 movel %d2,%sp@- 4677e: 4879 0005 f390 pea 5f390 <_Semaphore_Information> 46784: 262e 000c movel %fp@(12),%d3 46788: 282e 0010 movel %fp@(16),%d4 4678c: 4eb9 0004 7fe0 jsr 47fe0 <_Objects_Get_isr_disable> register Semaphore_Control *the_semaphore; Objects_Locations location; ISR_Level level; the_semaphore = _Semaphore_Get_interrupt_disable( id, &location, &level ); switch ( location ) { 46792: 4fef 0010 lea %sp@(16),%sp 46796: 4aae fffc tstl %fp@(-4) 4679a: 670c beqs 467a8 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 4679c: 7004 moveq #4,%d0 } 4679e: 4cee 001c ffec moveml %fp@(-20),%d2-%d4 467a4: 4e5e unlk %fp 467a6: 4e75 rts 467a8: 7230 moveq #48,%d1 467aa: 2040 moveal %d0,%a0 467ac: c2a8 0010 andl %a0@(16),%d1 the_semaphore = _Semaphore_Get_interrupt_disable( id, &location, &level ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Attributes_Is_counting_semaphore(the_semaphore->attribute_set) ) { 467b0: 6738 beqs 467ea _CORE_mutex_Seize( 467b2: 2f2e fff8 movel %fp@(-8),%sp@- */ RTEMS_INLINE_ROUTINE bool _Options_Is_no_wait ( rtems_option option_set ) { return (option_set & RTEMS_NO_WAIT) ? true : false; 467b6: 7201 moveq #1,%d1 467b8: c681 andl %d1,%d3 467ba: 2f04 movel %d4,%sp@- 467bc: b781 eorl %d3,%d1 467be: 2f01 movel %d1,%sp@- 467c0: 2f02 movel %d2,%sp@- 467c2: 4868 0014 pea %a0@(20) 467c6: 4eb9 0004 73a8 jsr 473a8 <_CORE_mutex_Seize> ((_Options_Is_no_wait( option_set )) ? false : true), timeout, level ); return _Semaphore_Translate_core_mutex_return_code( _Thread_Executing->Wait.return_code ); 467cc: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 id, ((_Options_Is_no_wait( option_set )) ? false : true), timeout, level ); return _Semaphore_Translate_core_mutex_return_code( 467d2: 2f28 0034 movel %a0@(52),%sp@- 467d6: 4eb9 0004 6938 jsr 46938 <_Semaphore_Translate_core_mutex_return_code> 467dc: 4fef 0018 lea %sp@(24),%sp break; } return RTEMS_INVALID_ID; } 467e0: 4cee 001c ffec moveml %fp@(-20),%d2-%d4 467e6: 4e5e unlk %fp 467e8: 4e75 rts /* disabled when you get here */ executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( the_semaphore->count != 0 ) { 467ea: 2240 moveal %d0,%a1 { Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; 467ec: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( the_semaphore->count != 0 ) { 467f2: 2229 005c movel %a1@(92),%d1 Thread_Control *executing; /* disabled when you get here */ executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 467f6: 42a8 0034 clrl %a0@(52) if ( the_semaphore->count != 0 ) { 467fa: 4a81 tstl %d1 467fc: 662e bnes 4682c the_semaphore->count -= 1; _ISR_Enable( *level_p ); return; } if ( !wait ) { 467fe: 0803 0000 btst #0,%d3 46802: 6748 beqs 4684c _ISR_Enable( *level_p ); 46804: 202e fff8 movel %fp@(-8),%d0 46808: 46c0 movew %d0,%sr executing->Wait.return_code = CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT; 4680a: 7001 moveq #1,%d0 4680c: 2140 0034 movel %d0,%a0@(52) ((_Options_Is_no_wait( option_set )) ? false : true), timeout, &level ); return _Semaphore_Translate_core_semaphore_return_code( _Thread_Executing->Wait.return_code ); 46810: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 id, ((_Options_Is_no_wait( option_set )) ? false : true), timeout, &level ); return _Semaphore_Translate_core_semaphore_return_code( 46816: 2f28 0034 movel %a0@(52),%sp@- 4681a: 4eb9 0004 694e jsr 4694e <_Semaphore_Translate_core_semaphore_return_code> 46820: 588f addql #4,%sp break; } return RTEMS_INVALID_ID; } 46822: 4cee 001c ffec moveml %fp@(-20),%d2-%d4 46828: 4e5e unlk %fp 4682a: 4e75 rts /* disabled when you get here */ executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( the_semaphore->count != 0 ) { the_semaphore->count -= 1; 4682c: 5381 subql #1,%d1 4682e: 2341 005c movel %d1,%a1@(92) _ISR_Enable( *level_p ); 46832: 202e fff8 movel %fp@(-8),%d0 46836: 46c0 movew %d0,%sr ((_Options_Is_no_wait( option_set )) ? false : true), timeout, &level ); return _Semaphore_Translate_core_semaphore_return_code( _Thread_Executing->Wait.return_code ); 46838: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 id, ((_Options_Is_no_wait( option_set )) ? false : true), timeout, &level ); return _Semaphore_Translate_core_semaphore_return_code( 4683e: 2f28 0034 movel %a0@(52),%sp@- 46842: 4eb9 0004 694e jsr 4694e <_Semaphore_Translate_core_semaphore_return_code> 46848: 588f addql #4,%sp 4684a: 60d6 bras 46822 4684c: 2239 0005 f448 movel 5f448 <_Thread_Dispatch_disable_level>,%d1 46852: 5281 addql #1,%d1 46854: 23c1 0005 f448 movel %d1,5f448 <_Thread_Dispatch_disable_level> 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; 4685a: 7201 moveq #1,%d1 4685c: 2240 moveal %d0,%a1 return; } _Thread_Disable_dispatch(); _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; 4685e: 0680 0000 0014 addil #20,%d0 46864: 2341 0044 movel %d1,%a1@(68) executing->Wait.id = id; 46868: 2142 0020 movel %d2,%a0@(32) return; } _Thread_Disable_dispatch(); _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; 4686c: 2140 0044 movel %d0,%a0@(68) executing->Wait.id = id; _ISR_Enable( *level_p ); 46870: 222e fff8 movel %fp@(-8),%d1 46874: 46c1 movew %d1,%sr _Thread_queue_Enqueue( &the_semaphore->Wait_queue, timeout ); 46876: 4879 0004 956c pea 4956c <_Thread_queue_Timeout> 4687c: 2f04 movel %d4,%sp@- 4687e: 2f00 movel %d0,%sp@- 46880: 4eb9 0004 91a8 jsr 491a8 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); 46886: 4eb9 0004 8cd6 jsr 48cd6 <_Thread_Enable_dispatch> _Thread_Executing->Wait.return_code ); 4688c: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 46892: 4fef 000c lea %sp@(12),%sp id, ((_Options_Is_no_wait( option_set )) ? false : true), timeout, &level ); return _Semaphore_Translate_core_semaphore_return_code( 46896: 2f28 0034 movel %a0@(52),%sp@- 4689a: 4eb9 0004 694e jsr 4694e <_Semaphore_Translate_core_semaphore_return_code> 468a0: 588f addql #4,%sp 468a2: 6000 ff7e braw 46822 ... =============================================================================== 00046e3c : void rtems_shutdown_executive( uint32_t result ) { if ( _System_state_Is_up( _System_state_Get() ) ) { 46e3c: 7003 moveq #3,%d0 */ void rtems_shutdown_executive( uint32_t result ) { 46e3e: 4e56 0000 linkw %fp,#0 if ( _System_state_Is_up( _System_state_Get() ) ) { 46e42: b0b9 0005 f590 cmpl 5f590 <_System_state_Current>,%d0 46e48: 6710 beqs 46e5a _System_state_Set( SYSTEM_STATE_SHUTDOWN ); _Thread_Stop_multitasking(); } _Internal_error_Occurred( 46e4a: 4878 0014 pea 14 46e4e: 4878 0001 pea 1 46e52: 42a7 clrl %sp@- 46e54: 4eb9 0004 7ac4 jsr 47ac4 <_Internal_error_Occurred> * if we were running within the same context, it would work. * * And we will not return to this thread, so there is no point of * saving the context. */ _Context_Restart_self( &_Thread_BSP_context ); 46e5a: 4879 0005 f414 pea 5f414 <_Thread_BSP_context> 46e60: 103c 0004 moveb #4,%d0 46e64: 23c0 0005 f590 movel %d0,5f590 <_System_state_Current> 46e6a: 4eb9 0004 9e82 jsr 49e82 <_CPU_Context_Restart_self> 46e70: 588f addql #4,%sp <== NOT EXECUTED 46e72: 4878 0014 pea 14 <== NOT EXECUTED 46e76: 4878 0001 pea 1 <== NOT EXECUTED 46e7a: 42a7 clrl %sp@- <== NOT EXECUTED 46e7c: 4eb9 0004 7ac4 jsr 47ac4 <_Internal_error_Occurred> <== NOT EXECUTED ... =============================================================================== 00058338 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 58338: 4e56 fffc linkw %fp,#-4 5833c: 2f03 movel %d3,%sp@- 5833e: 2f02 movel %d2,%sp@- 58340: 242e 000c movel %fp@(12),%d2 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 58344: 660e bnes 58354 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 58346: 242e fff4 movel %fp@(-12),%d2 Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; 5834a: 700a moveq #10,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 5834c: 262e fff8 movel %fp@(-8),%d3 58350: 4e5e unlk %fp 58352: 4e75 rts ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 58354: 486e fffc pea %fp@(-4) 58358: 2f2e 0008 movel %fp@(8),%sp@- 5835c: 4eb9 0005 c86c jsr 5c86c <_Thread_Get> switch ( location ) { 58362: 508f addql #8,%sp 58364: 4aae fffc tstl %fp@(-4) 58368: 670e beqs 58378 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 5836a: 242e fff4 movel %fp@(-12),%d2 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 5836e: 7004 moveq #4,%d0 } 58370: 262e fff8 movel %fp@(-8),%d3 58374: 4e5e unlk %fp 58376: 4e75 rts the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 58378: 2240 moveal %d0,%a1 5837a: 2069 00fc moveal %a1@(252),%a0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 5837e: 4aa8 000a tstl %a0@(10) 58382: 676a beqs 583ee if ( asr->is_enabled ) { 58384: 4a28 0008 tstb %a0@(8) 58388: 6736 beqs 583c0 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 5838a: 223c 0000 0700 movel #1792,%d1 58390: 40c3 movew %sr,%d3 58392: 8283 orl %d3,%d1 58394: 46c1 movew %d1,%sr *signal_set |= signals; 58396: 85a8 0012 orl %d2,%a0@(18) _ISR_Enable( _level ); 5839a: 46c3 movew %d3,%sr _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 5839c: 4ab9 0007 e3e4 tstl 7e3e4 <_Per_CPU_Information+0x8> 583a2: 6708 beqs 583ac 583a4: b0b9 0007 e3e8 cmpl 7e3e8 <_Per_CPU_Information+0xc>,%d0 583aa: 6730 beqs 583dc <== ALWAYS TAKEN _Thread_Dispatch_necessary = true; } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 583ac: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 583b2: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 583b4: 242e fff4 movel %fp@(-12),%d2 583b8: 262e fff8 movel %fp@(-8),%d3 583bc: 4e5e unlk %fp 583be: 4e75 rts rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 583c0: 203c 0000 0700 movel #1792,%d0 583c6: 40c1 movew %sr,%d1 583c8: 8081 orl %d1,%d0 583ca: 46c0 movew %d0,%sr *signal_set |= signals; 583cc: 85a8 0016 orl %d2,%a0@(22) _ISR_Enable( _level ); 583d0: 46c1 movew %d1,%sr if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 583d2: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 583d8: 4280 clrl %d0 583da: 60d8 bras 583b4 if ( ! _ASR_Is_null_handler( asr->handler ) ) { if ( asr->is_enabled ) { _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; 583dc: 7001 moveq #1,%d0 583de: 13c0 0007 e3f4 moveb %d0,7e3f4 <_Per_CPU_Information+0x18> } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 583e4: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 583ea: 4280 clrl %d0 583ec: 60c6 bras 583b4 } _Thread_Enable_dispatch(); 583ee: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 583f4: 242e fff4 movel %fp@(-12),%d2 } _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); return RTEMS_NOT_DEFINED; 583f8: 700b moveq #11,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 583fa: 262e fff8 movel %fp@(-8),%d3 583fe: 4e5e unlk %fp ... =============================================================================== 0004d628 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4d628: 4e56 ffe4 linkw %fp,#-28 4d62c: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 4d630: 2a2e 0008 movel %fp@(8),%d5 4d634: 242e 000c movel %fp@(12),%d2 4d638: 286e 0010 moveal %fp@(16),%a4 ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) 4d63c: 4a8c tstl %a4 4d63e: 6700 015a beqw 4d79a return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4d642: 2479 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a2 api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4d648: 4a2a 0074 tstb %a2@(116) 4d64c: 57c3 seq %d3 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 4d64e: 266a 00fc moveal %a2@(252),%a3 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4d652: 49c3 extbl %d3 4d654: 0283 0000 0100 andil #256,%d3 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4d65a: 4aaa 007a tstl %a2@(122) 4d65e: 6600 00cc bnew 4d72c old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4d662: 4a2b 0008 tstb %a3@(8) 4d666: 57c4 seq %d4 old_mode |= _ISR_Get_level(); 4d668: 4eb9 0004 9f28 jsr 49f28 <_CPU_ISR_Get_level> if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4d66e: 49c4 extbl %d4 4d670: 0284 0000 0400 andil #1024,%d4 4d676: 8084 orl %d4,%d0 old_mode |= _ISR_Get_level(); 4d678: 8083 orl %d3,%d0 4d67a: 2880 movel %d0,%a4@ *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4d67c: 0802 0008 btst #8,%d2 4d680: 670c beqs 4d68e executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4d682: 0805 0008 btst #8,%d5 4d686: 57c0 seq %d0 4d688: 4480 negl %d0 4d68a: 1540 0074 moveb %d0,%a2@(116) if ( mask & RTEMS_TIMESLICE_MASK ) { 4d68e: 0802 0009 btst #9,%d2 4d692: 6718 beqs 4d6ac if ( _Modes_Is_timeslice(mode_set) ) { 4d694: 0805 0009 btst #9,%d5 4d698: 6700 00ee beqw 4d788 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4d69c: 7001 moveq #1,%d0 executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4d69e: 41f9 0005 f400 lea 5f400 <_Thread_Ticks_per_timeslice>,%a0 if ( mask & RTEMS_PREEMPT_MASK ) executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4d6a4: 2540 007a movel %d0,%a2@(122) executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4d6a8: 2550 0076 movel %a0@,%a2@(118) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4d6ac: 7007 moveq #7,%d0 4d6ae: c082 andl %d2,%d0 4d6b0: 6712 beqs 4d6c4 */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); 4d6b2: 40c0 movew %sr,%d0 */ RTEMS_INLINE_ROUTINE ISR_Level _Modes_Get_interrupt_level ( Modes_Control mode_set ) { return ( mode_set & RTEMS_INTERRUPT_MASK ); 4d6b4: 7207 moveq #7,%d1 4d6b6: c285 andl %d5,%d1 */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); 4d6b8: 0280 0000 f8ff andil #63743,%d0 4d6be: e189 lsll #8,%d1 4d6c0: 8081 orl %d1,%d0 4d6c2: 46c0 movew %d0,%sr * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 4d6c4: 0802 000a btst #10,%d2 4d6c8: 6754 beqs 4d71e is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4d6ca: 4282 clrl %d2 4d6cc: 142b 0008 moveb %a3@(8),%d2 4d6d0: 4280 clrl %d0 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 4d6d2: 0805 000a btst #10,%d5 4d6d6: 57c1 seq %d1 4d6d8: 4481 negl %d1 is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4d6da: 1001 moveb %d1,%d0 4d6dc: b082 cmpl %d2,%d0 4d6de: 673e beqs 4d71e ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4d6e0: 203c 0000 0700 movel #1792,%d0 asr->is_enabled = is_asr_enabled; 4d6e6: 1741 0008 moveb %d1,%a3@(8) 4d6ea: 40c1 movew %sr,%d1 4d6ec: 8081 orl %d1,%d0 4d6ee: 46c0 movew %d0,%sr _signals = information->signals_pending; 4d6f0: 202b 0016 movel %a3@(22),%d0 information->signals_pending = information->signals_posted; 4d6f4: 276b 0012 0016 movel %a3@(18),%a3@(22) information->signals_posted = _signals; 4d6fa: 2740 0012 movel %d0,%a3@(18) _ISR_Enable( _level ); 4d6fe: 46c1 movew %d1,%sr /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4d700: 4aab 0012 tstl %a3@(18) 4d704: 56c0 sne %d0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4d706: 7203 moveq #3,%d1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4d708: 4480 negl %d0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4d70a: b2b9 0005 f590 cmpl 5f590 <_System_state_Current>,%d1 4d710: 6744 beqs 4d756 <== ALWAYS TAKEN if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; 4d712: 4280 clrl %d0 } 4d714: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 4d71a: 4e5e unlk %fp 4d71c: 4e75 rts needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4d71e: 7203 moveq #3,%d1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4d720: 4200 clrb %d0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4d722: b2b9 0005 f590 cmpl 5f590 <_System_state_Current>,%d1 4d728: 66e8 bnes 4d712 4d72a: 602a bras 4d756 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4d72c: 4a2b 0008 tstb %a3@(8) 4d730: 57c4 seq %d4 old_mode |= _ISR_Get_level(); 4d732: 4eb9 0004 9f28 jsr 49f28 <_CPU_ISR_Get_level> if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4d738: 49c4 extbl %d4 4d73a: 0284 0000 0400 andil #1024,%d4 old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4d740: 08c3 0009 bset #9,%d3 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4d744: 8084 orl %d4,%d0 old_mode |= _ISR_Get_level(); 4d746: 8083 orl %d3,%d0 4d748: 2880 movel %d0,%a4@ *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4d74a: 0802 0008 btst #8,%d2 4d74e: 6700 ff3e beqw 4d68e 4d752: 6000 ff2e braw 4d682 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4d756: 2079 0005 f5e4 moveal 5f5e4 <_Per_CPU_Information+0xc>,%a0 if ( are_signals_pending || 4d75c: 4a00 tstb %d0 4d75e: 660e bnes 4d76e 4d760: b1f9 0005 f5e8 cmpal 5f5e8 <_Per_CPU_Information+0x10>,%a0 4d766: 67aa beqs 4d712 (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 4d768: 4a28 0074 tstb %a0@(116) 4d76c: 67a4 beqs 4d712 <== NEVER TAKEN _Thread_Dispatch_necessary = true; 4d76e: 7001 moveq #1,%d0 4d770: 13c0 0005 f5f0 moveb %d0,5f5f0 <_Per_CPU_Information+0x18> } } if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 4d776: 4eb9 0004 8b6c jsr 48b6c <_Thread_Dispatch> } return RTEMS_SUCCESSFUL; } 4d77c: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; 4d782: 4280 clrl %d0 } 4d784: 4e5e unlk %fp 4d786: 4e75 rts } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4d788: 7007 moveq #7,%d0 4d78a: c082 andl %d2,%d0 if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; } else executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4d78c: 42aa 007a clrl %a2@(122) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4d790: 4a80 tstl %d0 4d792: 6700 ff30 beqw 4d6c4 4d796: 6000 ff1a braw 4d6b2 bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; 4d79a: 7009 moveq #9,%d0 if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; } 4d79c: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 4d7a2: 4e5e unlk %fp ... =============================================================================== 0004b00c : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4b00c: 4e56 fffc linkw %fp,#-4 4b010: 2f0a movel %a2,%sp@- 4b012: 246e 0010 moveal %fp@(16),%a2 4b016: 2f02 movel %d2,%sp@- 4b018: 242e 000c movel %fp@(12),%d2 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4b01c: 670c beqs 4b02a RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && ( the_priority <= RTEMS_MAXIMUM_PRIORITY ) ); 4b01e: 4280 clrl %d0 4b020: 1039 0006 1f72 moveb 61f72 ,%d0 */ RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && 4b026: b082 cmpl %d2,%d0 4b028: 6566 bcss 4b090 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4b02a: 4a8a tstl %a2 4b02c: 6770 beqs 4b09e return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4b02e: 486e fffc pea %fp@(-4) 4b032: 2f2e 0008 movel %fp@(8),%sp@- 4b036: 4eb9 0004 d33c jsr 4d33c <_Thread_Get> switch ( location ) { 4b03c: 508f addql #8,%sp 4b03e: 4aae fffc tstl %fp@(-4) 4b042: 663e bnes 4b082 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4b044: 2040 moveal %d0,%a0 4b046: 24a8 0014 movel %a0@(20),%a2@ if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4b04a: 4a82 tstl %d2 4b04c: 6720 beqs 4b06e the_thread->real_priority = new_priority; 4b04e: 2142 0018 movel %d2,%a0@(24) if ( the_thread->resource_count == 0 || 4b052: 4aa8 001c tstl %a0@(28) 4b056: 6706 beqs 4b05e 4b058: b4a8 0014 cmpl %a0@(20),%d2 4b05c: 6410 bccs 4b06e <== ALWAYS TAKEN the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4b05e: 42a7 clrl %sp@- 4b060: 2f02 movel %d2,%sp@- 4b062: 2f00 movel %d0,%sp@- 4b064: 4eb9 0004 ce64 jsr 4ce64 <_Thread_Change_priority> 4b06a: 4fef 000c lea %sp@(12),%sp } _Thread_Enable_dispatch(); 4b06e: 4eb9 0004 d316 jsr 4d316 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4b074: 242e fff4 movel %fp@(-12),%d2 if ( the_thread->resource_count == 0 || the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); } _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 4b078: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4b07a: 246e fff8 moveal %fp@(-8),%a2 4b07e: 4e5e unlk %fp 4b080: 4e75 rts 4b082: 242e fff4 movel %fp@(-12),%d2 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 4b086: 7004 moveq #4,%d0 } 4b088: 246e fff8 moveal %fp@(-8),%a2 4b08c: 4e5e unlk %fp 4b08e: 4e75 rts 4b090: 242e fff4 movel %fp@(-12),%d2 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; 4b094: 7013 moveq #19,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4b096: 246e fff8 moveal %fp@(-8),%a2 4b09a: 4e5e unlk %fp 4b09c: 4e75 rts 4b09e: 242e fff4 movel %fp@(-12),%d2 if ( new_priority != RTEMS_CURRENT_PRIORITY && !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) return RTEMS_INVALID_ADDRESS; 4b0a2: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4b0a4: 246e fff8 moveal %fp@(-8),%a2 4b0a8: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 00047b78 : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { 47b78: 4e56 fffc linkw %fp,#-4 47b7c: 2f02 movel %d2,%sp@- 47b7e: 242e 000c movel %fp@(12),%d2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) 47b82: 6772 beqs 47bf6 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); 47b84: 486e fffc pea %fp@(-4) 47b88: 2f2e 0008 movel %fp@(8),%sp@- 47b8c: 4eb9 0004 9c98 jsr 49c98 <_Thread_Get> switch (location) { 47b92: 508f addql #8,%sp 47b94: 4aae fffc tstl %fp@(-4) 47b98: 6634 bnes 47bce case OBJECTS_LOCAL: tvp = the_thread->task_variables; 47b9a: 2040 moveal %d0,%a0 47b9c: 2268 0108 moveal %a0@(264),%a1 while (tvp) { 47ba0: 4a89 tstl %a1 47ba2: 671a beqs 47bbe if (tvp->ptr == ptr) { 47ba4: b4a9 0004 cmpl %a1@(4),%d2 47ba8: 6756 beqs 47c00 _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; 47baa: 2051 moveal %a1@,%a0 the_thread = _Thread_Get (tid, &location); switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { 47bac: 4a88 tstl %a0 47bae: 670e beqs 47bbe <== NEVER TAKEN if (tvp->ptr == ptr) { 47bb0: b4a8 0004 cmpl %a0@(4),%d2 47bb4: 6722 beqs 47bd8 47bb6: 2248 moveal %a0,%a1 _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; 47bb8: 2051 moveal %a1@,%a0 the_thread = _Thread_Get (tid, &location); switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { 47bba: 4a88 tstl %a0 47bbc: 66f2 bnes 47bb0 <== ALWAYS TAKEN return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 47bbe: 4eb9 0004 9c72 jsr 49c72 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47bc4: 242e fff8 movel %fp@(-8),%d2 } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); return RTEMS_INVALID_ADDRESS; 47bc8: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47bca: 4e5e unlk %fp 47bcc: 4e75 rts 47bce: 242e fff8 movel %fp@(-8),%d2 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 47bd2: 7004 moveq #4,%d0 } 47bd4: 4e5e unlk %fp 47bd6: 4e75 rts case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; 47bd8: 2290 movel %a0@,%a1@ else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); 47bda: 2f08 movel %a0,%sp@- 47bdc: 2f00 movel %d0,%sp@- 47bde: 4eb9 0004 7cac jsr 47cac <_RTEMS_Tasks_Invoke_task_variable_dtor> _Thread_Enable_dispatch(); 47be4: 4eb9 0004 9c72 jsr 49c72 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 47bea: 508f addql #8,%sp 47bec: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47bee: 242e fff8 movel %fp@(-8),%d2 47bf2: 4e5e unlk %fp 47bf4: 4e75 rts 47bf6: 242e fff8 movel %fp@(-8),%d2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) return RTEMS_INVALID_ADDRESS; 47bfa: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47bfc: 4e5e unlk %fp 47bfe: 4e75 rts while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 47c00: 2040 moveal %d0,%a0 47c02: 2151 0108 movel %a1@,%a0@(264) 47c06: 2049 moveal %a1,%a0 _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); 47c08: 2f08 movel %a0,%sp@- 47c0a: 2f00 movel %d0,%sp@- 47c0c: 4eb9 0004 7cac jsr 47cac <_RTEMS_Tasks_Invoke_task_variable_dtor> _Thread_Enable_dispatch(); 47c12: 4eb9 0004 9c72 jsr 49c72 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 47c18: 508f addql #8,%sp 47c1a: 4280 clrl %d0 47c1c: 60d0 bras 47bee ... =============================================================================== 00047c20 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { 47c20: 4e56 fffc linkw %fp,#-4 47c24: 2f0a movel %a2,%sp@- 47c26: 246e 0010 moveal %fp@(16),%a2 47c2a: 2f02 movel %d2,%sp@- 47c2c: 242e 000c movel %fp@(12),%d2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) 47c30: 6752 beqs 47c84 return RTEMS_INVALID_ADDRESS; if ( !result ) 47c32: 4a8a tstl %a2 47c34: 674e beqs 47c84 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); 47c36: 486e fffc pea %fp@(-4) 47c3a: 2f2e 0008 movel %fp@(8),%sp@- 47c3e: 4eb9 0004 9c98 jsr 49c98 <_Thread_Get> switch (location) { 47c44: 508f addql #8,%sp 47c46: 4aae fffc tstl %fp@(-4) 47c4a: 662a bnes 47c76 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; 47c4c: 2240 moveal %d0,%a1 47c4e: 2069 0108 moveal %a1@(264),%a0 while (tvp) { 47c52: 4a88 tstl %a0 47c54: 670c beqs 47c62 if (tvp->ptr == ptr) { 47c56: b4a8 0004 cmpl %a0@(4),%d2 47c5a: 6736 beqs 47c92 */ *result = tvp->tval; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; 47c5c: 2050 moveal %a0@,%a0 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; while (tvp) { 47c5e: 4a88 tstl %a0 47c60: 66f4 bnes 47c56 <== ALWAYS TAKEN _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 47c62: 4eb9 0004 9c72 jsr 49c72 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47c68: 242e fff4 movel %fp@(-12),%d2 return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); return RTEMS_INVALID_ADDRESS; 47c6c: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47c6e: 246e fff8 moveal %fp@(-8),%a2 47c72: 4e5e unlk %fp 47c74: 4e75 rts 47c76: 242e fff4 movel %fp@(-12),%d2 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 47c7a: 7004 moveq #4,%d0 } 47c7c: 246e fff8 moveal %fp@(-8),%a2 47c80: 4e5e unlk %fp 47c82: 4e75 rts 47c84: 242e fff4 movel %fp@(-12),%d2 if ( !ptr ) return RTEMS_INVALID_ADDRESS; if ( !result ) return RTEMS_INVALID_ADDRESS; 47c88: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47c8a: 246e fff8 moveal %fp@(-8),%a2 47c8e: 4e5e unlk %fp 47c90: 4e75 rts if (tvp->ptr == ptr) { /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; 47c92: 24a8 000c movel %a0@(12),%a2@ _Thread_Enable_dispatch(); 47c96: 4eb9 0004 9c72 jsr 49c72 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47c9c: 242e fff4 movel %fp@(-12),%d2 * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 47ca0: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 47ca2: 246e fff8 moveal %fp@(-8),%a2 47ca6: 4e5e unlk %fp ... =============================================================================== 00058d2c : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 58d2c: 4e56 fffc linkw %fp,#-4 Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 58d30: 486e fffc pea %fp@(-4) 58d34: 2f2e 0008 movel %fp@(8),%sp@- 58d38: 4879 0007 e458 pea 7e458 <_Timer_Information> 58d3e: 4eb9 0005 bbb0 jsr 5bbb0 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 58d44: 4fef 000c lea %sp@(12),%sp 58d48: 4aae fffc tstl %fp@(-4) 58d4c: 6706 beqs 58d54 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 58d4e: 7004 moveq #4,%d0 } 58d50: 4e5e unlk %fp 58d52: 4e75 rts the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 58d54: 7204 moveq #4,%d1 58d56: 2040 moveal %d0,%a0 58d58: b2a8 0038 cmpl %a0@(56),%d1 58d5c: 670c beqs 58d6a <== NEVER TAKEN (void) _Watchdog_Remove( &the_timer->Ticker ); 58d5e: 4868 0010 pea %a0@(16) 58d62: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> 58d68: 588f addql #4,%sp _Thread_Enable_dispatch(); 58d6a: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 58d70: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 58d72: 4e5e unlk %fp ... =============================================================================== 00058f60 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 58f60: 4e56 ffec linkw %fp,#-20 58f64: 48d7 041c moveml %d2-%d4/%a2,%sp@ 58f68: 242e 000c movel %fp@(12),%d2 58f6c: 262e 0010 movel %fp@(16),%d3 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; if ( !_TOD_Is_set ) 58f70: 4a39 0007 e254 tstb 7e254 <_TOD_Is_set> 58f76: 660c bnes 58f84 return RTEMS_NOT_DEFINED; 58f78: 700b moveq #11,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 58f7a: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 58f80: 4e5e unlk %fp 58f82: 4e75 rts rtems_interval seconds; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !_TOD_Validate( wall_time ) ) 58f84: 2f02 movel %d2,%sp@- 58f86: 4eb9 0005 5fac jsr 55fac <_TOD_Validate> 58f8c: 588f addql #4,%sp 58f8e: 4a00 tstb %d0 58f90: 671a beqs 58fac return RTEMS_INVALID_CLOCK; if ( !routine ) 58f92: 4a83 tstl %d3 58f94: 6700 00a8 beqw 5903e return RTEMS_INVALID_ADDRESS; seconds = _TOD_To_seconds( wall_time ); 58f98: 2f02 movel %d2,%sp@- 58f9a: 4eb9 0005 5ea4 jsr 55ea4 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) 58fa0: 588f addql #4,%sp return RTEMS_INVALID_CLOCK; if ( !routine ) return RTEMS_INVALID_ADDRESS; seconds = _TOD_To_seconds( wall_time ); 58fa2: 2400 movel %d0,%d2 if ( seconds <= _TOD_Seconds_since_epoch() ) 58fa4: b0b9 0007 e2ce cmpl 7e2ce <_TOD_Now>,%d0 58faa: 620c bhis 58fb8 return RTEMS_INVALID_CLOCK; 58fac: 7014 moveq #20,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 58fae: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 58fb4: 4e5e unlk %fp 58fb6: 4e75 rts 58fb8: 486e fffc pea %fp@(-4) 58fbc: 2f2e 0008 movel %fp@(8),%sp@- 58fc0: 4879 0007 e458 pea 7e458 <_Timer_Information> 58fc6: 4eb9 0005 bbb0 jsr 5bbb0 <_Objects_Get> seconds = _TOD_To_seconds( wall_time ); if ( seconds <= _TOD_Seconds_since_epoch() ) return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 58fcc: 4fef 000c lea %sp@(12),%sp 58fd0: 2440 moveal %d0,%a2 58fd2: 4aae fffc tstl %fp@(-4) 58fd6: 665a bnes 59032 <== NEVER TAKEN case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 58fd8: 2800 movel %d0,%d4 58fda: 0684 0000 0010 addil #16,%d4 58fe0: 2f04 movel %d4,%sp@- 58fe2: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 58fe8: 256e 0014 0034 movel %fp@(20),%a2@(52) the_timer->the_class = TIMER_TIME_OF_DAY; 58fee: 7002 moveq #2,%d0 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); _Watchdog_Insert_seconds( 58ff0: 94b9 0007 e2ce subl 7e2ce <_TOD_Now>,%d2 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; 58ff6: 2540 0038 movel %d0,%a2@(56) void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; 58ffa: 202e 0008 movel %fp@(8),%d0 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); _Watchdog_Insert_seconds( 58ffe: 2542 001c movel %d2,%a2@(28) 59002: 2540 0030 movel %d0,%a2@(48) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 59006: 42aa 0018 clrl %a2@(24) the_watchdog->routine = routine; 5900a: 2543 002c movel %d3,%a2@(44) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Seconds_chain, the_watchdog ); 5900e: 2f04 movel %d4,%sp@- 59010: 4879 0007 e2f8 pea 7e2f8 <_Watchdog_Seconds_chain> 59016: 4eb9 0005 d8f4 jsr 5d8f4 <_Watchdog_Insert> &the_timer->Ticker, seconds - _TOD_Seconds_since_epoch() ); _Thread_Enable_dispatch(); 5901c: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 59022: 4fef 000c lea %sp@(12),%sp 59026: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59028: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 5902e: 4e5e unlk %fp 59030: 4e75 rts #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 59032: 7004 moveq #4,%d0 } 59034: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 5903a: 4e5e unlk %fp 5903c: 4e75 rts if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; if ( !routine ) return RTEMS_INVALID_ADDRESS; 5903e: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59040: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 59046: 4e5e unlk %fp ... =============================================================================== 000597e2 : rtems_status_code rtems_timer_initiate_server( uint32_t priority, uint32_t stack_size, rtems_attribute attribute_set ) { 597e2: 4e56 fffc linkw %fp,#-4 597e6: 202e 0008 movel %fp@(8),%d0 597ea: 2f03 movel %d3,%sp@- 597ec: 2f02 movel %d2,%sp@- 597ee: 4a80 tstl %d0 597f0: 6748 beqs 5983a <== NEVER TAKEN ( the_priority <= RTEMS_MAXIMUM_PRIORITY ) ); 597f2: 4281 clrl %d1 597f4: 1239 0007 8632 moveb 78632 ,%d1 */ RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && 597fa: b280 cmpl %d0,%d1 597fc: 644a bccs 59848 * structured so we check it is invalid before looking for * a specific invalid value as the default. */ _priority = priority; if ( !_RTEMS_tasks_Priority_is_valid( priority ) ) { if ( priority != RTEMS_TIMER_SERVER_DEFAULT_PRIORITY ) 597fe: 72ff moveq #-1,%d1 59800: b280 cmpl %d0,%d1 59802: 6636 bnes 5983a 59804: 2239 0007 e244 movel 7e244 <_Thread_Dispatch_disable_level>,%d1 5980a: 5281 addql #1,%d1 return RTEMS_INVALID_PRIORITY; _priority = 0; 5980c: 4283 clrl %d3 5980e: 23c1 0007 e244 movel %d1,7e244 <_Thread_Dispatch_disable_level> /* * Just to make sure this is only called once. */ _Thread_Disable_dispatch(); tmpInitialized = initialized; initialized = true; 59814: 7001 moveq #1,%d0 /* * Just to make sure this is only called once. */ _Thread_Disable_dispatch(); tmpInitialized = initialized; 59816: 1439 0007 972e moveb 7972e ,%d2 initialized = true; 5981c: 13c0 0007 972e moveb %d0,7972e _Thread_Enable_dispatch(); 59822: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> if ( tmpInitialized ) 59828: 4a02 tstb %d2 5982a: 6744 beqs 59870 initialized = false; } #endif return status; } 5982c: 242e fff4 movel %fp@(-12),%d2 tmpInitialized = initialized; initialized = true; _Thread_Enable_dispatch(); if ( tmpInitialized ) return RTEMS_INCORRECT_STATE; 59830: 700e moveq #14,%d0 initialized = false; } #endif return status; } 59832: 262e fff8 movel %fp@(-8),%d3 59836: 4e5e unlk %fp 59838: 4e75 rts 5983a: 242e fff4 movel %fp@(-12),%d2 * a specific invalid value as the default. */ _priority = priority; if ( !_RTEMS_tasks_Priority_is_valid( priority ) ) { if ( priority != RTEMS_TIMER_SERVER_DEFAULT_PRIORITY ) return RTEMS_INVALID_PRIORITY; 5983e: 7013 moveq #19,%d0 initialized = false; } #endif return status; } 59840: 262e fff8 movel %fp@(-8),%d3 59844: 4e5e unlk %fp 59846: 4e75 rts 59848: 2239 0007 e244 movel 7e244 <_Thread_Dispatch_disable_level>,%d1 5984e: 5281 addql #1,%d1 59850: 2600 movel %d0,%d3 59852: 23c1 0007 e244 movel %d1,7e244 <_Thread_Dispatch_disable_level> /* * Just to make sure this is only called once. */ _Thread_Disable_dispatch(); tmpInitialized = initialized; initialized = true; 59858: 7001 moveq #1,%d0 /* * Just to make sure this is only called once. */ _Thread_Disable_dispatch(); tmpInitialized = initialized; 5985a: 1439 0007 972e moveb 7972e ,%d2 initialized = true; 59860: 13c0 0007 972e moveb %d0,7972e _Thread_Enable_dispatch(); 59866: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> if ( tmpInitialized ) 5986c: 4a02 tstb %d2 5986e: 66bc bnes 5982c <== NEVER TAKEN * other library rules. For example, if using a TSR written in Ada the * Server should run at the same priority as the priority Ada task. * Otherwise, the priority ceiling for the mutex used to protect the * GNAT run-time is violated. */ status = rtems_task_create( 59870: 222e 0010 movel %fp@(16),%d1 59874: 486e fffc pea %fp@(-4) 59878: 08c1 000f bset #15,%d1 5987c: 2f01 movel %d1,%sp@- 5987e: 4878 0100 pea 100 59882: 2f2e 000c movel %fp@(12),%sp@- 59886: 2f03 movel %d3,%sp@- 59888: 2f3c 5449 4d45 movel #1414090053,%sp@- 5988e: 4eb9 0005 8404 jsr 58404 /* user may want floating point but we need */ /* system task specified for 0 priority */ attribute_set | RTEMS_SYSTEM_TASK, &id /* get the id back */ ); if (status) { 59894: 4fef 0018 lea %sp@(24),%sp 59898: 4a80 tstl %d0 5989a: 6714 beqs 598b0 initialized = false; } #endif return status; } 5989c: 242e fff4 movel %fp@(-12),%d2 /* system task specified for 0 priority */ attribute_set | RTEMS_SYSTEM_TASK, &id /* get the id back */ ); if (status) { initialized = false; 598a0: 4201 clrb %d1 initialized = false; } #endif return status; } 598a2: 262e fff8 movel %fp@(-8),%d3 598a6: 4e5e unlk %fp /* system task specified for 0 priority */ attribute_set | RTEMS_SYSTEM_TASK, &id /* get the id back */ ); if (status) { initialized = false; 598a8: 13c1 0007 972e moveb %d1,7972e initialized = false; } #endif return status; } 598ae: 4e75 rts * We work with the TCB pointer, not the ID, so we need to convert * to a TCB pointer from here out. */ ts->thread = (Thread_Control *)_Objects_Get_local_object( &_RTEMS_tasks_Information, _Objects_Get_index(id) 598b0: 202e fffc movel %fp@(-4),%d0 */ #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return NULL; #endif return information->local_table[ index ]; 598b4: 4282 clrl %d2 /* * We work with the TCB pointer, not the ID, so we need to convert * to a TCB pointer from here out. */ ts->thread = (Thread_Control *)_Objects_Get_local_object( 598b6: 2079 0007 e1dc moveal 7e1dc <_RTEMS_tasks_Information+0x18>,%a0 598bc: 3400 movew %d0,%d2 * Initialize the pointer to the timer schedule method so applications that * do not use the Timer Server do not have to pull it in. */ ts->schedule_operation = _Timer_server_Schedule_operation_method; ts->Interval_watchdogs.last_snapshot = _Watchdog_Ticks_since_boot; 598be: 2239 0007 e34c movel 7e34c <_Watchdog_Ticks_since_boot>,%d1 /* * We work with the TCB pointer, not the ID, so we need to convert * to a TCB pointer from here out. */ ts->thread = (Thread_Control *)_Objects_Get_local_object( 598c4: 41f0 2c00 lea %a0@(00000000,%d2:l:4),%a0 598c8: 23d0 0007 96b0 movel %a0@,796b0 <_Timer_server_Default> ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 598ce: 41f9 0007 96e4 lea 796e4 <_Timer_server_Default+0x34>,%a0 _Timer_server = ts; /* * Start the timer server */ status = rtems_task_start( 598d4: 4879 0007 96b0 pea 796b0 <_Timer_server_Default> 598da: 487a fb6c pea %pc@(59448 <_Timer_server_Body>) 598de: 23c8 0007 96e0 movel %a0,796e0 <_Timer_server_Default+0x30> head->previous = NULL; tail->previous = head; 598e4: 41f9 0007 96e0 lea 796e0 <_Timer_server_Default+0x30>,%a0 598ea: 23c8 0007 96e8 movel %a0,796e8 <_Timer_server_Default+0x38> ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 598f0: 41f9 0007 971c lea 7971c <_Timer_server_Default+0x6c>,%a0 * Initialize the pointer to the timer schedule method so applications that * do not use the Timer Server do not have to pull it in. */ ts->schedule_operation = _Timer_server_Schedule_operation_method; ts->Interval_watchdogs.last_snapshot = _Watchdog_Ticks_since_boot; 598f6: 23c1 0007 96ec movel %d1,796ec <_Timer_server_Default+0x3c> head->previous = NULL; tail->previous = head; 598fc: 223c 0007 9718 movel #497432,%d1 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 59902: 23c8 0007 9718 movel %a0,79718 <_Timer_server_Default+0x68> ts->TOD_watchdogs.last_snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 59908: 41f9 0007 e2ce lea 7e2ce <_TOD_Now>,%a0 head->previous = NULL; tail->previous = head; 5990e: 23c1 0007 9720 movel %d1,79720 <_Timer_server_Default+0x70> 59914: 23d0 0007 9724 movel %a0@,79724 <_Timer_server_Default+0x74> Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 5991a: 223c 0005 c6a0 movel #378528,%d1 59920: 41f9 0005 c6a0 lea 5c6a0 <_Thread_Delay_ended>,%a0 59926: 23c1 0007 96d4 movel %d1,796d4 <_Timer_server_Default+0x24> ts->insert_chain = NULL; ts->active = false; 5992c: 4201 clrb %d1 ts->schedule_operation = _Timer_server_Schedule_operation_method; ts->Interval_watchdogs.last_snapshot = _Watchdog_Ticks_since_boot; ts->TOD_watchdogs.last_snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); ts->insert_chain = NULL; 5992e: 42b9 0007 9728 clrl 79728 <_Timer_server_Default+0x78> ts->active = false; 59934: 13c1 0007 972c moveb %d1,7972c <_Timer_server_Default+0x7c> 5993a: 23c8 0007 970c movel %a0,7970c <_Timer_server_Default+0x5c> /* * The default timer server is now available. */ _Timer_server = ts; 59940: 41f9 0007 96b0 lea 796b0 <_Timer_server_Default>,%a0 /* * Start the timer server */ status = rtems_task_start( 59946: 2f00 movel %d0,%sp@- /* * Initialize the pointer to the timer schedule method so applications that * do not use the Timer Server do not have to pull it in. */ ts->schedule_operation = _Timer_server_Schedule_operation_method; 59948: 223c 0005 9686 movel #366214,%d1 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 5994e: 42b9 0007 96e4 clrl 796e4 <_Timer_server_Default+0x34> 59954: 42b9 0007 971c clrl 7971c <_Timer_server_Default+0x6c> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 5995a: 42b9 0007 96c0 clrl 796c0 <_Timer_server_Default+0x10> 59960: 23c1 0007 96b4 movel %d1,796b4 <_Timer_server_Default+0x4> the_watchdog->routine = routine; the_watchdog->id = id; 59966: 23c0 0007 96d8 movel %d0,796d8 <_Timer_server_Default+0x28> ts->active = false; /* * The default timer server is now available. */ _Timer_server = ts; 5996c: 23c8 0007 e490 movel %a0,7e490 <_Timer_server> the_watchdog->user_data = user_data; 59972: 42b9 0007 96dc clrl 796dc <_Timer_server_Default+0x2c> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 59978: 42b9 0007 96f8 clrl 796f8 <_Timer_server_Default+0x48> the_watchdog->routine = routine; the_watchdog->id = id; 5997e: 23c0 0007 9710 movel %d0,79710 <_Timer_server_Default+0x60> the_watchdog->user_data = user_data; 59984: 42b9 0007 9714 clrl 79714 <_Timer_server_Default+0x64> /* * Start the timer server */ status = rtems_task_start( 5998a: 4eb9 0005 8b10 jsr 58b10 initialized = false; } #endif return status; } 59990: 242e fff4 movel %fp@(-12),%d2 if (status) { initialized = false; } #endif return status; 59994: 4fef 000c lea %sp@(12),%sp } 59998: 262e fff8 movel %fp@(-8),%d3 5999c: 4e5e unlk %fp <== NOT EXECUTED =============================================================================== 000590e4 : */ rtems_status_code rtems_timer_reset( rtems_id id ) { 590e4: 4e56 fff0 linkw %fp,#-16 590e8: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 590ec: 486e fffc pea %fp@(-4) 590f0: 2f2e 0008 movel %fp@(8),%sp@- 590f4: 4879 0007 e458 pea 7e458 <_Timer_Information> 590fa: 4eb9 0005 bbb0 jsr 5bbb0 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; rtems_status_code status = RTEMS_SUCCESSFUL; the_timer = _Timer_Get( id, &location ); switch ( location ) { 59100: 4fef 000c lea %sp@(12),%sp 59104: 2440 moveal %d0,%a2 59106: 4aae fffc tstl %fp@(-4) 5910a: 670e beqs 5911a #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 5910c: 7404 moveq #4,%d2 } 5910e: 2002 movel %d2,%d0 59110: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 59116: 4e5e unlk %fp 59118: 4e75 rts the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { 5911a: 202a 0038 movel %a2@(56),%d0 5911e: 671a beqs 5913a _Watchdog_Remove( &the_timer->Ticker ); _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); } else if ( the_timer->the_class == TIMER_INTERVAL_ON_TASK ) { 59120: 7201 moveq #1,%d1 59122: b280 cmpl %d0,%d1 59124: 673c beqs 59162 /* * Must be dormant or time of day timer (e.g. TIMER_DORMANT, * TIMER_TIME_OF_DAY, or TIMER_TIME_OF_DAY_ON_TASK). We * can only reset active interval timers. */ status = RTEMS_NOT_DEFINED; 59126: 740b moveq #11,%d2 } _Thread_Enable_dispatch(); 59128: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 5912e: 2002 movel %d2,%d0 59130: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 59136: 4e5e unlk %fp 59138: 4e75 rts the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { _Watchdog_Remove( &the_timer->Ticker ); 5913a: 45ea 0010 lea %a2@(16),%a2 rtems_id id ) { Timer_Control *the_timer; Objects_Locations location; rtems_status_code status = RTEMS_SUCCESSFUL; 5913e: 4282 clrl %d2 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { _Watchdog_Remove( &the_timer->Ticker ); 59140: 2f0a movel %a2,%sp@- 59142: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); 59148: 2f0a movel %a2,%sp@- 5914a: 4879 0007 e304 pea 7e304 <_Watchdog_Ticks_chain> 59150: 4eb9 0005 d8f4 jsr 5d8f4 <_Watchdog_Insert> 59156: 4fef 000c lea %sp@(12),%sp * TIMER_TIME_OF_DAY, or TIMER_TIME_OF_DAY_ON_TASK). We * can only reset active interval timers. */ status = RTEMS_NOT_DEFINED; } _Thread_Enable_dispatch(); 5915a: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> 59160: 60cc bras 5912e if ( !timer_server ) { _Thread_Enable_dispatch(); return RTEMS_INCORRECT_STATE; } #endif _Watchdog_Remove( &the_timer->Ticker ); 59162: 486a 0010 pea %a2@(16) rtems_id id ) { Timer_Control *the_timer; Objects_Locations location; rtems_status_code status = RTEMS_SUCCESSFUL; 59166: 4282 clrl %d2 case OBJECTS_LOCAL: if ( the_timer->the_class == TIMER_INTERVAL ) { _Watchdog_Remove( &the_timer->Ticker ); _Watchdog_Insert( &_Watchdog_Ticks_chain, &the_timer->Ticker ); } else if ( the_timer->the_class == TIMER_INTERVAL_ON_TASK ) { Timer_server_Control *timer_server = _Timer_server; 59168: 2679 0007 e490 moveal 7e490 <_Timer_server>,%a3 if ( !timer_server ) { _Thread_Enable_dispatch(); return RTEMS_INCORRECT_STATE; } #endif _Watchdog_Remove( &the_timer->Ticker ); 5916e: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> (*timer_server->schedule_operation)( timer_server, the_timer ); 59174: 2f0a movel %a2,%sp@- 59176: 2f0b movel %a3,%sp@- 59178: 206b 0004 moveal %a3@(4),%a0 5917c: 4e90 jsr %a0@ 5917e: 4fef 000c lea %sp@(12),%sp * TIMER_TIME_OF_DAY, or TIMER_TIME_OF_DAY_ON_TASK). We * can only reset active interval timers. */ status = RTEMS_NOT_DEFINED; } _Thread_Enable_dispatch(); 59182: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> 59188: 60a4 bras 5912e ... =============================================================================== 0005918c : rtems_id id, rtems_interval ticks, rtems_timer_service_routine_entry routine, void *user_data ) { 5918c: 4e56 ffe8 linkw %fp,#-24 59190: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 59194: 282e 0008 movel %fp@(8),%d4 59198: 262e 000c movel %fp@(12),%d3 5919c: 242e 0010 movel %fp@(16),%d2 Timer_Control *the_timer; Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server; 591a0: 2479 0007 e490 moveal 7e490 <_Timer_server>,%a2 if ( !timer_server ) 591a6: 4a8a tstl %a2 591a8: 6700 009c beqw 59246 return RTEMS_INCORRECT_STATE; if ( !routine ) 591ac: 4a82 tstl %d2 591ae: 6700 00a2 beqw 59252 return RTEMS_INVALID_ADDRESS; if ( ticks == 0 ) 591b2: 4a83 tstl %d3 591b4: 660c bnes 591c2 return RTEMS_INVALID_NUMBER; 591b6: 700a moveq #10,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 591b8: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 591be: 4e5e unlk %fp 591c0: 4e75 rts 591c2: 486e fffc pea %fp@(-4) 591c6: 2f04 movel %d4,%sp@- 591c8: 4879 0007 e458 pea 7e458 <_Timer_Information> 591ce: 4eb9 0005 bbb0 jsr 5bbb0 <_Objects_Get> if ( ticks == 0 ) return RTEMS_INVALID_NUMBER; the_timer = _Timer_Get( id, &location ); switch ( location ) { 591d4: 4fef 000c lea %sp@(12),%sp 591d8: 2640 moveal %d0,%a3 591da: 4aae fffc tstl %fp@(-4) 591de: 665a bnes 5923a case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 591e0: 486b 0010 pea %a3@(16) 591e4: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> _ISR_Disable( level ); 591ea: 203c 0000 0700 movel #1792,%d0 591f0: 40c1 movew %sr,%d1 591f2: 8081 orl %d1,%d0 591f4: 46c0 movew %d0,%sr /* * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) { 591f6: 588f addql #4,%sp 591f8: 4aab 0018 tstl %a3@(24) 591fc: 6660 bnes 5925e <== NEVER TAKEN /* * OK. Now we now the timer was not rescheduled by an interrupt * so we can atomically initialize it as in use. */ the_timer->the_class = TIMER_INTERVAL_ON_TASK; 591fe: 7001 moveq #1,%d0 ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 59200: 276e 0014 0034 movel %fp@(20),%a3@(52) 59206: 2740 0038 movel %d0,%a3@(56) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 5920a: 42ab 0018 clrl %a3@(24) the_watchdog->routine = routine; 5920e: 2742 002c movel %d2,%a3@(44) the_watchdog->id = id; 59212: 2744 0030 movel %d4,%a3@(48) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = ticks; 59216: 2743 001c movel %d3,%a3@(28) _ISR_Enable( level ); 5921a: 46c1 movew %d1,%sr (*timer_server->schedule_operation)( timer_server, the_timer ); 5921c: 2f0b movel %a3,%sp@- 5921e: 2f0a movel %a2,%sp@- 59220: 206a 0004 moveal %a2@(4),%a0 59224: 4e90 jsr %a0@ _Thread_Enable_dispatch(); 59226: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 5922c: 508f addql #8,%sp 5922e: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59230: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 59236: 4e5e unlk %fp 59238: 4e75 rts #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 5923a: 7004 moveq #4,%d0 } 5923c: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 59242: 4e5e unlk %fp 59244: 4e75 rts Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; 59246: 700e moveq #14,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59248: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 5924e: 4e5e unlk %fp 59250: 4e75 rts if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !routine ) return RTEMS_INVALID_ADDRESS; 59252: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59254: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 5925a: 4e5e unlk %fp 5925c: 4e75 rts * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_timer->Ticker.state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); 5925e: 46c1 movew %d1,%sr _Thread_Enable_dispatch(); 59260: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 59266: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59268: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 5926e: 4e5e unlk %fp ... =============================================================================== 00059274 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 59274: 4e56 ffec linkw %fp,#-20 59278: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 5927c: 242e 000c movel %fp@(12),%d2 59280: 262e 0010 movel %fp@(16),%d3 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; 59284: 2479 0007 e490 moveal 7e490 <_Timer_server>,%a2 if ( !timer_server ) 5928a: 4a8a tstl %a2 5928c: 6700 00c8 beqw 59356 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 59290: 4a39 0007 e254 tstb 7e254 <_TOD_Is_set> 59296: 6700 00a6 beqw 5933e return RTEMS_NOT_DEFINED; if ( !routine ) 5929a: 4a83 tstl %d3 5929c: 6700 00ac beqw 5934a return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 592a0: 2f02 movel %d2,%sp@- 592a2: 4eb9 0005 5fac jsr 55fac <_TOD_Validate> 592a8: 588f addql #4,%sp 592aa: 4a00 tstb %d0 592ac: 660c bnes 592ba return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); if ( seconds <= _TOD_Seconds_since_epoch() ) return RTEMS_INVALID_CLOCK; 592ae: 7014 moveq #20,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 592b0: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 592b6: 4e5e unlk %fp 592b8: 4e75 rts return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 592ba: 2f02 movel %d2,%sp@- 592bc: 4eb9 0005 5ea4 jsr 55ea4 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) 592c2: 588f addql #4,%sp return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 592c4: 2400 movel %d0,%d2 if ( seconds <= _TOD_Seconds_since_epoch() ) 592c6: b0b9 0007 e2ce cmpl 7e2ce <_TOD_Now>,%d0 592cc: 63e0 blss 592ae 592ce: 486e fffc pea %fp@(-4) 592d2: 2f2e 0008 movel %fp@(8),%sp@- 592d6: 4879 0007 e458 pea 7e458 <_Timer_Information> 592dc: 4eb9 0005 bbb0 jsr 5bbb0 <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 592e2: 4fef 000c lea %sp@(12),%sp 592e6: 2640 moveal %d0,%a3 592e8: 4aae fffc tstl %fp@(-4) 592ec: 6674 bnes 59362 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 592ee: 486b 0010 pea %a3@(16) 592f2: 4eb9 0005 da48 jsr 5da48 <_Watchdog_Remove> the_watchdog->user_data = user_data; 592f8: 276e 0014 0034 movel %fp@(20),%a3@(52) the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 592fe: 7003 moveq #3,%d0 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 59300: 94b9 0007 e2ce subl 7e2ce <_TOD_Now>,%d2 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; 59306: 2740 0038 movel %d0,%a3@(56) void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; 5930a: 202e 0008 movel %fp@(8),%d0 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 5930e: 2742 001c movel %d2,%a3@(28) 59312: 2740 0030 movel %d0,%a3@(48) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 59316: 42ab 0018 clrl %a3@(24) the_watchdog->routine = routine; 5931a: 2743 002c movel %d3,%a3@(44) (*timer_server->schedule_operation)( timer_server, the_timer ); 5931e: 2f0b movel %a3,%sp@- 59320: 2f0a movel %a2,%sp@- 59322: 206a 0004 moveal %a2@(4),%a0 59326: 4e90 jsr %a0@ _Thread_Enable_dispatch(); 59328: 4eb9 0005 c846 jsr 5c846 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 5932e: 4fef 000c lea %sp@(12),%sp 59332: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59334: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 5933a: 4e5e unlk %fp 5933c: 4e75 rts if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; 5933e: 700b moveq #11,%d0 <== NOT EXECUTED case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59340: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 <== NOT EXECUTED 59346: 4e5e unlk %fp <== NOT EXECUTED 59348: 4e75 rts <== NOT EXECUTED if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) return RTEMS_INVALID_ADDRESS; 5934a: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 5934c: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 59352: 4e5e unlk %fp 59354: 4e75 rts Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; 59356: 700e moveq #14,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 59358: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 5935e: 4e5e unlk %fp 59360: 4e75 rts #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 59362: 7004 moveq #4,%d0 } 59364: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 5936a: 4e5e unlk %fp ...