0004af70 : uint32_t TOD_MICROSECONDS_TO_TICKS( uint32_t microseconds ) { return (microseconds / rtems_configuration_get_microseconds_per_tick()); } 4af70: 41f9 0006 2100 lea 62100 ,%a0 #include uint32_t TOD_MICROSECONDS_TO_TICKS( uint32_t microseconds ) { 4af76: 4e56 0000 linkw %fp,#0 return (microseconds / rtems_configuration_get_microseconds_per_tick()); } 4af7a: 202e 0008 movel %fp@(8),%d0 4af7e: 4e5e unlk %fp 4af80: 4c50 0000 remul %a0@,%d0,%d0 4af84: 4e75 rts ... 000464c8 : #include uint32_t TOD_MILLISECONDS_TO_TICKS( uint32_t milliseconds ) { 464c8: 4e56 0000 linkw %fp,#0 464cc: 2039 0005 c660 movel 5c660 ,%d0 464d2: 2f02 movel %d2,%sp@- 464d4: 243c 0000 03e8 movel #1000,%d2 464da: 4c42 0000 remul %d2,%d0,%d0 return (milliseconds / rtems_configuration_get_milliseconds_per_tick()); } 464de: 242e 0008 movel %fp@(8),%d2 464e2: 4c40 2002 remul %d0,%d2,%d2 464e6: 2002 movel %d2,%d0 464e8: 241f movel %sp@+,%d2 464ea: 4e5e unlk %fp 464ec: 4e75 rts ... 0004583c <_API_Mutex_Lock>: API_Mutex_Control *the_mutex ) { ISR_Level level; _ISR_Disable( level ); 4583c: 203c 0000 0700 movel #1792,%d0 #include void _API_Mutex_Lock( API_Mutex_Control *the_mutex ) { 45842: 4e56 0000 linkw %fp,#0 45846: 206e 0008 moveal %fp@(8),%a0 ISR_Level level; _ISR_Disable( level ); 4584a: 40c1 movew %sr,%d1 4584c: 8081 orl %d1,%d0 4584e: 46c0 movew %d0,%sr _CORE_mutex_Seize( 45850: 2f01 movel %d1,%sp@- 45852: 42a7 clrl %sp@- 45854: 4878 0001 pea 1 45858: 2f28 0008 movel %a0@(8),%sp@- 4585c: 4868 0010 pea %a0@(16) 45860: 4eb9 0004 5a20 jsr 45a20 <_CORE_mutex_Seize> 45866: 4fef 0014 lea %sp@(20),%sp the_mutex->Object.id, true, 0, level ); } 4586a: 4e5e unlk %fp 4586c: 4e75 rts ... 0004589c <_API_Mutex_Unlock>: #include void _API_Mutex_Unlock( API_Mutex_Control *the_mutex ) { 4589c: 4e56 0000 linkw %fp,#0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 458a0: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 458a6: 5280 addql #1,%d0 458a8: 206e 0008 moveal %fp@(8),%a0 458ac: 23c0 0005 cc94 movel %d0,5cc94 <_Thread_Dispatch_disable_level> _Thread_Disable_dispatch(); _CORE_mutex_Surrender( 458b2: 42a7 clrl %sp@- 458b4: 2f28 0008 movel %a0@(8),%sp@- 458b8: 4868 0010 pea %a0@(16) 458bc: 4eb9 0004 5ac8 jsr 45ac8 <_CORE_mutex_Surrender> &the_mutex->Mutex, the_mutex->Object.id, NULL ); _Thread_Enable_dispatch(); 458c2: 4fef 000c lea %sp@(12),%sp } 458c6: 4e5e unlk %fp _CORE_mutex_Surrender( &the_mutex->Mutex, the_mutex->Object.id, NULL ); _Thread_Enable_dispatch(); 458c8: 4ef9 0004 6ce2 jmp 46ce2 <_Thread_Enable_dispatch> ... 000457b4 <_API_extensions_Add>: */ void _API_extensions_Add( API_extensions_Control *the_extension ) { 457b4: 4e56 0000 linkw %fp,#0 _Chain_Append( &_API_extensions_List, &the_extension->Node ); 457b8: 2f2e 0008 movel %fp@(8),%sp@- 457bc: 4879 0005 ce34 pea 5ce34 <_API_extensions_List> 457c2: 4eb9 0004 58d0 jsr 458d0 <_Chain_Append> 457c8: 508f addql #8,%sp } 457ca: 4e5e unlk %fp 457cc: 4e75 rts ... 0004c9d4 <_Barrier_Translate_core_barrier_return_code>: }; rtems_status_code _Barrier_Translate_core_barrier_return_code ( CORE_barrier_Status the_barrier_status ) { 4c9d4: 41f9 0005 b5fc lea 5b5fc <_Barrier_Translate_core_barrier_return_code_>,%a0 4c9da: 4e56 0000 linkw %fp,#0 #if defined(RTEMS_DEBUG) if ( the_barrier_status > CORE_BARRIER_STATUS_LAST ) return RTEMS_INTERNAL_ERROR; #endif return _Barrier_Translate_core_barrier_return_code_[the_barrier_status]; } 4c9de: 202e 0008 movel %fp@(8),%d0 4c9e2: 4e5e unlk %fp 4c9e4: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4c9e8: 4e75 rts ... 000478a8 <_CORE_RWLock_Obtain_for_writing>: * Otherwise, we have to block. * If locked for reading and no waiters, then OK to read. * If any thread is waiting, then we wait. */ _ISR_Disable( level ); 478a8: 223c 0000 0700 movel #1792,%d1 Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_RWLock_API_mp_support_callout api_rwlock_mp_support ) { 478ae: 4e56 fff4 linkw %fp,#-12 478b2: 226e 0008 moveal %fp@(8),%a1 478b6: 48d7 001c moveml %d2-%d4,%sp@ 478ba: 262e 000c movel %fp@(12),%d3 478be: 282e 0010 movel %fp@(16),%d4 478c2: 242e 0014 movel %fp@(20),%d2 ISR_Level level; Thread_Control *executing = _Thread_Executing; 478c6: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 * Otherwise, we have to block. * If locked for reading and no waiters, then OK to read. * If any thread is waiting, then we wait. */ _ISR_Disable( level ); 478cc: 40c0 movew %sr,%d0 478ce: 8280 orl %d0,%d1 478d0: 46c1 movew %d1,%sr switch ( the_rwlock->current_state ) { 478d2: 4aa9 0044 tstl %a1@(68) 478d6: 660e bnes 478e6 <_CORE_RWLock_Obtain_for_writing+0x3e> case CORE_RWLOCK_UNLOCKED: the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 478d8: 7202 moveq #2,%d1 478da: 2341 0044 movel %d1,%a1@(68) _ISR_Enable( level ); 478de: 46c0 movew %d0,%sr executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 478e0: 42a8 0034 clrl %a0@(52) return; 478e4: 6044 bras 4792a <_CORE_RWLock_Obtain_for_writing+0x82> /* * If the thread is not willing to wait, then return immediately. */ if ( !wait ) { 478e6: 4a04 tstb %d4 478e8: 660a bnes 478f4 <_CORE_RWLock_Obtain_for_writing+0x4c> _ISR_Enable( level ); 478ea: 46c0 movew %d0,%sr executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 478ec: 7002 moveq #2,%d0 478ee: 2140 0034 movel %d0,%a0@(52) 478f2: 6036 bras 4792a <_CORE_RWLock_Obtain_for_writing+0x82> */ _Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue ); executing->Wait.queue = &the_rwlock->Wait_queue; executing->Wait.id = id; executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE; 478f4: 7201 moveq #1,%d1 * We need to wait to enter this critical section */ _Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue ); executing->Wait.queue = &the_rwlock->Wait_queue; executing->Wait.id = id; 478f6: 2143 0020 movel %d3,%a0@(32) executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE; executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 478fa: 42a8 0034 clrl %a0@(52) /* * We need to wait to enter this critical section */ _Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue ); executing->Wait.queue = &the_rwlock->Wait_queue; 478fe: 2149 0044 movel %a1,%a0@(68) executing->Wait.id = id; executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE; 47902: 2141 0030 movel %d1,%a0@(48) 47906: 2341 0030 movel %d1,%a1@(48) executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; _ISR_Enable( level ); 4790a: 46c0 movew %d0,%sr _Thread_queue_Enqueue_with_handler( 4790c: 2d42 000c movel %d2,%fp@(12) 47910: 203c 0004 79e8 movel #293352,%d0 47916: 2d49 0008 movel %a1,%fp@(8) 4791a: 2d40 0010 movel %d0,%fp@(16) _CORE_RWLock_Timeout ); /* return to API level so it can dispatch and we block */ } 4791e: 4cd7 001c moveml %sp@,%d2-%d4 47922: 4e5e unlk %fp executing->Wait.id = id; executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_WRITE; executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; _ISR_Enable( level ); _Thread_queue_Enqueue_with_handler( 47924: 4ef9 0004 8ff0 jmp 48ff0 <_Thread_queue_Enqueue_with_handler> _CORE_RWLock_Timeout ); /* return to API level so it can dispatch and we block */ } 4792a: 4cd7 001c moveml %sp@,%d2-%d4 4792e: 4e5e unlk %fp 47930: 4e75 rts ... 00047934 <_CORE_RWLock_Release>: * Otherwise, we have to block. * If locked for reading and no waiters, then OK to read. * If any thread is waiting, then we wait. */ _ISR_Disable( level ); 47934: 223c 0000 0700 movel #1792,%d1 */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 4793a: 4e56 fff0 linkw %fp,#-16 ISR_Level level; Thread_Control *executing = _Thread_Executing; 4793e: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 47944: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 47948: 246e 0008 moveal %fp@(8),%a2 * Otherwise, we have to block. * If locked for reading and no waiters, then OK to read. * If any thread is waiting, then we wait. */ _ISR_Disable( level ); 4794c: 40c0 movew %sr,%d0 4794e: 8280 orl %d0,%d1 47950: 46c1 movew %d1,%sr if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 47952: 222a 0044 movel %a2@(68),%d1 47956: 660a bnes 47962 <_CORE_RWLock_Release+0x2e> _ISR_Enable( level ); 47958: 46c0 movew %d0,%sr executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 4795a: 7002 moveq #2,%d0 4795c: 2140 0034 movel %d0,%a0@(52) return CORE_RWLOCK_SUCCESSFUL; 47960: 6078 bras 479da <_CORE_RWLock_Release+0xa6> } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 47962: 7401 moveq #1,%d2 47964: b481 cmpl %d1,%d2 47966: 6610 bnes 47978 <_CORE_RWLock_Release+0x44> the_rwlock->number_of_readers -= 1; 47968: 222a 0048 movel %a2@(72),%d1 4796c: 5381 subql #1,%d1 4796e: 2541 0048 movel %d1,%a2@(72) if ( the_rwlock->number_of_readers != 0 ) { 47972: 6704 beqs 47978 <_CORE_RWLock_Release+0x44> /* must be unlocked again */ _ISR_Enable( level ); 47974: 46c0 movew %d0,%sr return CORE_RWLOCK_SUCCESSFUL; 47976: 6062 bras 479da <_CORE_RWLock_Release+0xa6> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 47978: 42a8 0034 clrl %a0@(52) /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; 4797c: 42aa 0044 clrl %a2@(68) _ISR_Enable( level ); 47980: 46c0 movew %d0,%sr next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 47982: 2f0a movel %a2,%sp@- 47984: 4eb9 0004 8eb0 jsr 48eb0 <_Thread_queue_Dequeue> if ( next ) { 4798a: 588f addql #4,%sp 4798c: 4a80 tstl %d0 4798e: 674a beqs 479da <_CORE_RWLock_Release+0xa6> if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 47990: 7201 moveq #1,%d1 47992: 2040 moveal %d0,%a0 47994: b2a8 0030 cmpl %a0@(48),%d1 47998: 6608 bnes 479a2 <_CORE_RWLock_Release+0x6e> the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 4799a: 7002 moveq #2,%d0 4799c: 2540 0044 movel %d0,%a2@(68) return CORE_RWLOCK_SUCCESSFUL; 479a0: 6038 bras 479da <_CORE_RWLock_Release+0xa6> /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 479a2: 7201 moveq #1,%d1 } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 479a4: 52aa 0048 addql #1,%a2@(72) /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); 479a8: 49f9 0004 92f0 lea 492f0 <_Thread_queue_First>,%a4 if ( !next || next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 479ae: 47f9 0004 91c4 lea 491c4 <_Thread_queue_Extract>,%a3 /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 479b4: 2541 0044 movel %d1,%a2@(68) /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); 479b8: 2f0a movel %a2,%sp@- 479ba: 4e94 jsr %a4@ if ( !next || 479bc: 588f addql #4,%sp 479be: 4a80 tstl %d0 479c0: 6718 beqs 479da <_CORE_RWLock_Release+0xa6> next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) 479c2: 7401 moveq #1,%d2 479c4: 2040 moveal %d0,%a0 479c6: b4a8 0030 cmpl %a0@(48),%d2 479ca: 670e beqs 479da <_CORE_RWLock_Release+0xa6> return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; 479cc: 52aa 0048 addql #1,%a2@(72) _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 479d0: 2f00 movel %d0,%sp@- 479d2: 2f0a movel %a2,%sp@- 479d4: 4e93 jsr %a3@ } 479d6: 508f addql #8,%sp 479d8: 60de bras 479b8 <_CORE_RWLock_Release+0x84> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 479da: 4280 clrl %d0 479dc: 4cee 1c04 fff0 moveml %fp@(-16),%d2/%a2-%a4 479e2: 4e5e unlk %fp 479e4: 4e75 rts ... 000479e8 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 479e8: 4e56 fffc linkw %fp,#-4 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 479ec: 486e fffc pea %fp@(-4) 479f0: 2f2e 0008 movel %fp@(8),%sp@- 479f4: 4eb9 0004 8b8c jsr 48b8c <_Thread_Get> switch ( location ) { 479fa: 508f addql #8,%sp 479fc: 4aae fffc tstl %fp@(-4) 47a00: 6618 bnes 47a1a <_CORE_RWLock_Timeout+0x32> #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 47a02: 2f00 movel %d0,%sp@- 47a04: 4eb9 0004 93d4 jsr 493d4 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 47a0a: 588f addql #4,%sp 47a0c: 2039 0005 f638 movel 5f638 <_Thread_Dispatch_disable_level>,%d0 47a12: 5380 subql #1,%d0 47a14: 23c0 0005 f638 movel %d0,5f638 <_Thread_Dispatch_disable_level> _Thread_Unnest_dispatch(); break; } } 47a1a: 4e5e unlk %fp 47a1c: 4e75 rts ... 0004bf0c <_CORE_barrier_Initialize>: void _CORE_barrier_Initialize( CORE_barrier_Control *the_barrier, CORE_barrier_Attributes *the_barrier_attributes ) { 4bf0c: 4e56 0000 linkw %fp,#0 the_barrier->Attributes = *the_barrier_attributes; 4bf10: 226e 000c moveal %fp@(12),%a1 the_barrier->number_of_waiting_threads = 0; _Thread_queue_Initialize( 4bf14: 4878 0003 pea 3 void _CORE_barrier_Initialize( CORE_barrier_Control *the_barrier, CORE_barrier_Attributes *the_barrier_attributes ) { 4bf18: 206e 0008 moveal %fp@(8),%a0 the_barrier->Attributes = *the_barrier_attributes; the_barrier->number_of_waiting_threads = 0; _Thread_queue_Initialize( 4bf1c: 2f3c 0001 0000 movel #65536,%sp@- 4bf22: 42a7 clrl %sp@- CORE_barrier_Control *the_barrier, CORE_barrier_Attributes *the_barrier_attributes ) { the_barrier->Attributes = *the_barrier_attributes; 4bf24: 2011 movel %a1@,%d0 4bf26: 2229 0004 movel %a1@(4),%d1 4bf2a: 2140 0040 movel %d0,%a0@(64) 4bf2e: 2141 0044 movel %d1,%a0@(68) the_barrier->number_of_waiting_threads = 0; _Thread_queue_Initialize( 4bf32: 2f08 movel %a0,%sp@- CORE_barrier_Attributes *the_barrier_attributes ) { the_barrier->Attributes = *the_barrier_attributes; the_barrier->number_of_waiting_threads = 0; 4bf34: 42a8 0048 clrl %a0@(72) _Thread_queue_Initialize( 4bf38: 4eb9 0004 739c jsr 4739c <_Thread_queue_Initialize> 4bf3e: 4fef 0010 lea %sp@(16),%sp &the_barrier->Wait_queue, THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_BARRIER, CORE_BARRIER_TIMEOUT ); } 4bf42: 4e5e unlk %fp 4bf44: 4e75 rts ... 0004bf48 <_CORE_barrier_Release>: #else Objects_Id id __attribute__((unused)), CORE_barrier_API_mp_support_callout api_barrier_mp_support __attribute__((unused)) #endif ) { 4bf48: 4e56 fff4 linkw %fp,#-12 4bf4c: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 4bf50: 246e 0008 moveal %fp@(8),%a2 Thread_Control *the_thread; uint32_t count; count = 0; while ( (the_thread = _Thread_queue_Dequeue(&the_barrier->Wait_queue)) ) { 4bf54: 4282 clrl %d2 4bf56: 47f9 0004 702c lea 4702c <_Thread_queue_Dequeue>,%a3 4bf5c: 6002 bras 4bf60 <_CORE_barrier_Release+0x18> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_barrier_mp_support) ( the_thread, id ); #endif count++; 4bf5e: 5282 addql #1,%d2 { Thread_Control *the_thread; uint32_t count; count = 0; while ( (the_thread = _Thread_queue_Dequeue(&the_barrier->Wait_queue)) ) { 4bf60: 2f0a movel %a2,%sp@- 4bf62: 4e93 jsr %a3@ 4bf64: 588f addql #4,%sp 4bf66: 4a80 tstl %d0 4bf68: 66f4 bnes 4bf5e <_CORE_barrier_Release+0x16> #endif count++; } the_barrier->number_of_waiting_threads = 0; return count; } 4bf6a: 2002 movel %d2,%d0 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_barrier_mp_support) ( the_thread, id ); #endif count++; } the_barrier->number_of_waiting_threads = 0; 4bf6c: 42aa 0048 clrl %a2@(72) return count; } 4bf70: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 4bf76: 4e5e unlk %fp 4bf78: 4e75 rts ... 0004bf7c <_CORE_barrier_Wait>: Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4bf7c: 203c 0000 0700 movel #1792,%d0 Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4bf82: 4e56 fff4 linkw %fp,#-12 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; 4bf86: 2279 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a1 Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4bf8c: 48d7 001c moveml %d2-%d4,%sp@ 4bf90: 242e 000c movel %fp@(12),%d2 4bf94: 262e 0014 movel %fp@(20),%d3 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_BARRIER_STATUS_SUCCESSFUL; 4bf98: 42a9 0034 clrl %a1@(52) Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_barrier_API_mp_support_callout api_barrier_mp_support ) { 4bf9c: 206e 0008 moveal %fp@(8),%a0 4bfa0: 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 ); 4bfa4: 40c1 movew %sr,%d1 4bfa6: 8081 orl %d1,%d0 4bfa8: 46c0 movew %d0,%sr the_barrier->number_of_waiting_threads++; 4bfaa: 2028 0048 movel %a0@(72),%d0 4bfae: 5280 addql #1,%d0 4bfb0: 2140 0048 movel %d0,%a0@(72) if ( _CORE_barrier_Is_automatic( &the_barrier->Attributes ) ) { 4bfb4: 4aa8 0040 tstl %a0@(64) 4bfb8: 6626 bnes 4bfe0 <_CORE_barrier_Wait+0x64> if ( the_barrier->number_of_waiting_threads == the_barrier->Attributes.maximum_count) { 4bfba: b0a8 0044 cmpl %a0@(68),%d0 4bfbe: 6620 bnes 4bfe0 <_CORE_barrier_Wait+0x64> executing->Wait.return_code = CORE_BARRIER_STATUS_AUTOMATICALLY_RELEASED; 4bfc0: 7001 moveq #1,%d0 4bfc2: 2340 0034 movel %d0,%a1@(52) _ISR_Enable( level ); 4bfc6: 46c1 movew %d1,%sr _CORE_barrier_Release( the_barrier, id, api_barrier_mp_support ); 4bfc8: 2d44 0010 movel %d4,%fp@(16) 4bfcc: 2d42 000c movel %d2,%fp@(12) 4bfd0: 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 ); } 4bfd4: 4cd7 001c moveml %sp@,%d2-%d4 4bfd8: 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 ); 4bfda: 4ef9 0004 bf48 jmp 4bf48 <_CORE_barrier_Release> 4bfe0: 7001 moveq #1,%d0 } } _Thread_queue_Enter_critical_section( &the_barrier->Wait_queue ); executing->Wait.queue = &the_barrier->Wait_queue; executing->Wait.id = id; 4bfe2: 2342 0020 movel %d2,%a1@(32) return; } } _Thread_queue_Enter_critical_section( &the_barrier->Wait_queue ); executing->Wait.queue = &the_barrier->Wait_queue; 4bfe6: 2348 0044 movel %a0,%a1@(68) 4bfea: 2140 0030 movel %d0,%a0@(48) executing->Wait.id = id; _ISR_Enable( level ); 4bfee: 46c1 movew %d1,%sr _Thread_queue_Enqueue( &the_barrier->Wait_queue, timeout ); 4bff0: 2d43 000c movel %d3,%fp@(12) 4bff4: 203c 0004 7458 movel #291928,%d0 4bffa: 2d48 0008 movel %a0,%fp@(8) 4bffe: 2d40 0010 movel %d0,%fp@(16) } 4c002: 4cd7 001c moveml %sp@,%d2-%d4 4c006: 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 ); 4c008: 4ef9 0004 716c jmp 4716c <_Thread_queue_Enqueue_with_handler> ... 00052088 <_CORE_message_queue_Broadcast>: Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 52088: 4e56 ffe0 linkw %fp,#-32 5208c: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 52090: 246e 0008 moveal %fp@(8),%a2 52094: 2a2e 000c movel %fp@(12),%d5 52098: 262e 0010 movel %fp@(16),%d3 5209c: 286e 001c moveal %fp@(28),%a4 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 520a0: b6aa 004c cmpl %a2@(76),%d3 520a4: 6304 blss 520aa <_CORE_message_queue_Broadcast+0x22> 520a6: 7001 moveq #1,%d0 <== NOT EXECUTED 520a8: 6042 bras 520ec <_CORE_message_queue_Broadcast+0x64><== NOT EXECUTED * NOTE: This check is critical because threads can block on * send and receive and this ensures that we are broadcasting * the message to threads waiting to receive -- not to send. */ if ( the_message_queue->number_of_pending_messages != 0 ) { 520aa: 4aaa 0048 tstl %a2@(72) 520ae: 6610 bnes 520c0 <_CORE_message_queue_Broadcast+0x38> * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 520b0: 4282 clrl %d2 520b2: 283c 0005 438c movel #344972,%d4 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 520b8: 4bf9 0005 a388 lea 5a388 ,%a5 520be: 601a bras 520da <_CORE_message_queue_Broadcast+0x52> * send and receive and this ensures that we are broadcasting * the message to threads waiting to receive -- not to send. */ if ( the_message_queue->number_of_pending_messages != 0 ) { *count = 0; 520c0: 4294 clrl %a4@ 520c2: 6026 bras 520ea <_CORE_message_queue_Broadcast+0x62> 520c4: 2f03 movel %d3,%sp@- */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 520c6: 5282 addql #1,%d2 520c8: 2f05 movel %d5,%sp@- 520ca: 2f2b 002c movel %a3@(44),%sp@- 520ce: 4e95 jsr %a5@ buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 520d0: 206b 0028 moveal %a3@(40),%a0 520d4: 4fef 000c lea %sp@(12),%sp 520d8: 2083 movel %d3,%a0@ * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 520da: 2f0a movel %a2,%sp@- 520dc: 2044 moveal %d4,%a0 520de: 4e90 jsr %a0@ /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 520e0: 588f addql #4,%sp _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 520e2: 2640 moveal %d0,%a3 /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 520e4: 4a80 tstl %d0 520e6: 66dc bnes 520c4 <_CORE_message_queue_Broadcast+0x3c> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 520e8: 2882 movel %d2,%a4@ 520ea: 4280 clrl %d0 return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } 520ec: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 520f2: 4e5e unlk %fp 520f4: 4e75 rts ... 0004dc30 <_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)) { 4dc30: 7003 moveq #3,%d0 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 ) { 4dc32: 4e56 fff4 linkw %fp,#-12 4dc36: 222e 0014 movel %fp@(20),%d1 4dc3a: 48d7 040c moveml %d2-%d3/%a2,%sp@ 4dc3e: 246e 0008 moveal %fp@(8),%a2 4dc42: 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)) { 4dc46: c081 andl %d1,%d0 ) { size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; 4dc48: 2542 0044 movel %d2,%a2@(68) the_message_queue->number_of_pending_messages = 0; 4dc4c: 42aa 0048 clrl %a2@(72) the_message_queue->maximum_message_size = maximum_message_size; 4dc50: 2541 004c movel %d1,%a2@(76) CORE_message_queue_Control *the_message_queue, CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; 4dc54: 42aa 0060 clrl %a2@(96) the_message_queue->notify_argument = the_argument; 4dc58: 42aa 0064 clrl %a2@(100) /* * 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)) { 4dc5c: 4a80 tstl %d0 4dc5e: 6604 bnes 4dc64 <_CORE_message_queue_Initialize+0x34> 4dc60: 2001 movel %d1,%d0 4dc62: 600c bras 4dc70 <_CORE_message_queue_Initialize+0x40> allocated_message_size += sizeof(uint32_t); 4dc64: 2001 movel %d1,%d0 4dc66: 5880 addql #4,%d0 allocated_message_size &= ~(sizeof(uint32_t) - 1); 4dc68: 76fc moveq #-4,%d3 4dc6a: c083 andl %d3,%d0 } if (allocated_message_size < maximum_message_size) 4dc6c: b280 cmpl %d0,%d1 4dc6e: 626e bhis 4dcde <_CORE_message_queue_Initialize+0xae> /* * 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)); 4dc70: 2600 movel %d0,%d3 4dc72: 0683 0000 0014 addil #20,%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 * 4dc78: 2203 movel %d3,%d1 4dc7a: 4c02 1800 mulsl %d2,%d1 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 4dc7e: b081 cmpl %d1,%d0 4dc80: 625c bhis 4dcde <_CORE_message_queue_Initialize+0xae> return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 4dc82: 2f01 movel %d1,%sp@- 4dc84: 4eb9 0005 05e8 jsr 505e8 <_Workspace_Allocate> _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 4dc8a: 588f addql #4,%sp return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 4dc8c: 2540 005c movel %d0,%a2@(92) _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 4dc90: 674c beqs 4dcde <_CORE_message_queue_Initialize+0xae> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 4dc92: 2f03 movel %d3,%sp@- 4dc94: 2f02 movel %d2,%sp@- 4dc96: 2f00 movel %d0,%sp@- 4dc98: 486a 0068 pea %a2@(104) 4dc9c: 4eb9 0005 2534 jsr 52534 <_Chain_Initialize> allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 4dca2: 4878 0006 pea 6 4dca6: 7001 moveq #1,%d0 4dca8: 206e 000c moveal %fp@(12),%a0 4dcac: b090 cmpl %a0@,%d0 4dcae: 57c0 seq %d0 4dcb0: 4878 0080 pea 80 4dcb4: 49c0 extbl %d0 4dcb6: 4480 negl %d0 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 4dcb8: 41ea 0054 lea %a2@(84),%a0 4dcbc: 2f00 movel %d0,%sp@- 4dcbe: 2548 0050 movel %a0,%a2@(80) the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 4dcc2: 41ea 0050 lea %a2@(80),%a0 4dcc6: 2548 0058 movel %a0,%a2@(88) 4dcca: 2f0a movel %a2,%sp@- RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 4dccc: 42aa 0054 clrl %a2@(84) 4dcd0: 4eb9 0004 faf4 jsr 4faf4 <_Thread_queue_Initialize> THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 4dcd6: 4fef 0020 lea %sp@(32),%sp allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 4dcda: 7001 moveq #1,%d0 THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 4dcdc: 6002 bras 4dce0 <_CORE_message_queue_Initialize+0xb0> 4dcde: 4200 clrb %d0 } 4dce0: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 4dce6: 4e5e unlk %fp 4dce8: 4e75 rts ... 00052574 <_CORE_message_queue_Insert_message>: void _CORE_message_queue_Insert_message( CORE_message_queue_Control *the_message_queue, CORE_message_queue_Buffer_control *the_message, CORE_message_queue_Submit_types submit_type ) { 52574: 4e56 0000 linkw %fp,#0 52578: 226e 000c moveal %fp@(12),%a1 5257c: 2f0b movel %a3,%sp@- 5257e: 202e 0010 movel %fp@(16),%d0 52582: 206e 0008 moveal %fp@(8),%a0 52586: 2f0a movel %a2,%sp@- 52588: 2340 0008 movel %d0,%a1@(8) _CORE_message_queue_Append_unprotected(the_message_queue, the_message); else _CORE_message_queue_Prepend_unprotected(the_message_queue, the_message); _ISR_Enable( level ); #else if ( submit_type == CORE_MESSAGE_QUEUE_SEND_REQUEST ) { 5258c: 0c80 7fff ffff cmpil #2147483647,%d0 52592: 6628 bnes 525bc <_CORE_message_queue_Insert_message+0x48> _ISR_Disable( level ); 52594: 203c 0000 0700 movel #1792,%d0 5259a: 40c1 movew %sr,%d1 5259c: 8081 orl %d1,%d0 5259e: 46c0 movew %d0,%sr Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 525a0: 45e8 0054 lea %a0@(84),%a2 SET_NOTIFY(); the_message_queue->number_of_pending_messages++; 525a4: 52a8 0048 addql #1,%a0@(72) 525a8: 228a movel %a2,%a1@ old_last_node = the_chain->last; 525aa: 2468 0058 moveal %a0@(88),%a2 the_chain->last = the_node; 525ae: 2149 0058 movel %a1,%a0@(88) old_last_node->next = the_node; the_node->previous = old_last_node; 525b2: 234a 0004 movel %a2,%a1@(4) Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 525b6: 2489 movel %a1,%a2@ _CORE_message_queue_Append_unprotected(the_message_queue, the_message); _ISR_Enable( level ); 525b8: 46c1 movew %d1,%sr 525ba: 606c bras 52628 <_CORE_message_queue_Insert_message+0xb4> } else if ( submit_type == CORE_MESSAGE_QUEUE_URGENT_REQUEST ) { 525bc: 0c80 8000 0000 cmpil #-2147483648,%d0 525c2: 6626 bnes 525ea <_CORE_message_queue_Insert_message+0x76> _ISR_Disable( level ); 525c4: 203c 0000 0700 movel #1792,%d0 525ca: 40c1 movew %sr,%d1 525cc: 8081 orl %d1,%d0 525ce: 46c0 movew %d0,%sr */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Head( Chain_Control *the_chain ) { return (Chain_Node *) the_chain; 525d0: 45e8 0050 lea %a0@(80),%a2 SET_NOTIFY(); the_message_queue->number_of_pending_messages++; 525d4: 52a8 0048 addql #1,%a0@(72) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 525d8: 2652 moveal %a2@,%a3 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 525da: 234a 0004 movel %a2,%a1@(4) before_node = after_node->next; after_node->next = the_node; 525de: 2489 movel %a1,%a2@ the_node->next = before_node; before_node->previous = the_node; 525e0: 2749 0004 movel %a1,%a3@(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; 525e4: 228b movel %a3,%a1@ _CORE_message_queue_Prepend_unprotected(the_message_queue, the_message); _ISR_Enable( level ); 525e6: 46c1 movew %d1,%sr 525e8: 603e bras 52628 <_CORE_message_queue_Insert_message+0xb4> */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 525ea: 2208 movel %a0,%d1 525ec: 0681 0000 0054 addil #84,%d1 Chain_Control *the_header; int the_priority; the_priority = _CORE_message_queue_Get_message_priority(the_message); the_header = &the_message_queue->Pending_messages; the_node = the_header->first; 525f2: 2468 0050 moveal %a0@(80),%a2 while ( !_Chain_Is_tail( the_header, the_node ) ) { 525f6: 6008 bras 52600 <_CORE_message_queue_Insert_message+0x8c> RTEMS_INLINE_ROUTINE int _CORE_message_queue_Get_message_priority ( CORE_message_queue_Buffer_control *the_message ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) return the_message->priority; 525f8: b0aa 0008 cmpl %a2@(8),%d0 525fc: 6d06 blts 52604 <_CORE_message_queue_Insert_message+0x90> this_message = (CORE_message_queue_Buffer_control *) the_node; this_priority = _CORE_message_queue_Get_message_priority(this_message); if ( this_priority <= the_priority ) { the_node = the_node->next; 525fe: 2452 moveal %a2@,%a2 int the_priority; the_priority = _CORE_message_queue_Get_message_priority(the_message); the_header = &the_message_queue->Pending_messages; the_node = the_header->first; while ( !_Chain_Is_tail( the_header, the_node ) ) { 52600: b28a cmpl %a2,%d1 52602: 66f4 bnes 525f8 <_CORE_message_queue_Insert_message+0x84> the_node = the_node->next; continue; } break; } _ISR_Disable( level ); 52604: 203c 0000 0700 movel #1792,%d0 5260a: 40c1 movew %sr,%d1 5260c: 8081 orl %d1,%d0 5260e: 46c0 movew %d0,%sr SET_NOTIFY(); the_message_queue->number_of_pending_messages++; _Chain_Insert_unprotected( the_node->previous, &the_message->Node ); 52610: 246a 0004 moveal %a2@(4),%a2 } break; } _ISR_Disable( level ); SET_NOTIFY(); the_message_queue->number_of_pending_messages++; 52614: 52a8 0048 addql #1,%a0@(72) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 52618: 2652 moveal %a2@,%a3 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 5261a: 234a 0004 movel %a2,%a1@(4) before_node = after_node->next; after_node->next = the_node; 5261e: 2489 movel %a1,%a2@ the_node->next = before_node; before_node->previous = the_node; 52620: 2749 0004 movel %a1,%a3@(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; 52624: 228b movel %a3,%a1@ _Chain_Insert_unprotected( the_node->previous, &the_message->Node ); _ISR_Enable( level ); 52626: 46c1 movew %d1,%sr /* * According to POSIX, does this happen before or after the message * is actually enqueued. It is logical to think afterwards, because * the message is actually in the queue at this point. */ if ( notify && the_message_queue->notify_handler ) 52628: 2268 0060 moveal %a0@(96),%a1 5262c: 4a89 tstl %a1 5262e: 670e beqs 5263e <_CORE_message_queue_Insert_message+0xca> (*the_message_queue->notify_handler)(the_message_queue->notify_argument); 52630: 2d68 0064 0008 movel %a0@(100),%fp@(8) #endif } 52636: 245f moveal %sp@+,%a2 52638: 265f moveal %sp@+,%a3 5263a: 4e5e unlk %fp * According to POSIX, does this happen before or after the message * is actually enqueued. It is logical to think afterwards, because * the message is actually in the queue at this point. */ if ( notify && the_message_queue->notify_handler ) (*the_message_queue->notify_handler)(the_message_queue->notify_argument); 5263c: 4ed1 jmp %a1@ #endif } 5263e: 245f moveal %sp@+,%a2 52640: 265f moveal %sp@+,%a3 52642: 4e5e unlk %fp 52644: 4e75 rts ... 0004dcec <_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 ); 4dcec: 223c 0000 0700 movel #1792,%d1 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4dcf2: 4e56 ffe0 linkw %fp,#-32 ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 4dcf6: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4dcfc: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 4dd00: 282e 000c movel %fp@(12),%d4 4dd04: 242e 001c movel %fp@(28),%d2 4dd08: 246e 0008 moveal %fp@(8),%a2 ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 4dd0c: 42a8 0034 clrl %a0@(52) void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4dd10: 262e 0010 movel %fp@(16),%d3 4dd14: 226e 0014 moveal %fp@(20),%a1 4dd18: 1a2e 001b moveb %fp@(27),%d5 CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4dd1c: 40c0 movew %sr,%d0 4dd1e: 8280 orl %d0,%d1 4dd20: 46c1 movew %d1,%sr */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4dd22: 220a movel %a2,%d1 4dd24: 0681 0000 0054 addil #84,%d1 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 4dd2a: 266a 0050 moveal %a2@(80),%a3 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4dd2e: b28b cmpl %a3,%d1 4dd30: 6700 00a6 beqw 4ddd8 <_CORE_message_queue_Seize+0xec> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 4dd34: 2853 moveal %a3@,%a4 the_chain->first = new_first; new_first->previous = _Chain_Head(the_chain); 4dd36: 4bea 0050 lea %a2@(80),%a5 Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; the_chain->first = new_first; 4dd3a: 254c 0050 movel %a4,%a2@(80) new_first->previous = _Chain_Head(the_chain); 4dd3e: 294d 0004 movel %a5,%a4@(4) the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { 4dd42: 4a8b tstl %a3 4dd44: 6700 0092 beqw 4ddd8 <_CORE_message_queue_Seize+0xec> the_message_queue->number_of_pending_messages -= 1; 4dd48: 53aa 0048 subql #1,%a2@(72) _ISR_Enable( level ); 4dd4c: 46c0 movew %d0,%sr *size_p = the_message->Contents.size; _Thread_Executing->Wait.count = 4dd4e: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0 the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; _ISR_Enable( level ); *size_p = the_message->Contents.size; 4dd54: 22ab 000c movel %a3@(12),%a1@ _Thread_Executing->Wait.count = _CORE_message_queue_Get_message_priority( the_message ); _CORE_message_queue_Copy_buffer( the_message->Contents.buffer, 4dd58: 240b movel %a3,%d2 4dd5a: 0682 0000 0010 addil #16,%d2 if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; _ISR_Enable( level ); *size_p = the_message->Contents.size; _Thread_Executing->Wait.count = 4dd60: 216b 0008 0024 movel %a3@(8),%a0@(36) const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4dd66: 49f9 0005 5548 lea 55548 ,%a4 4dd6c: 2f11 movel %a1@,%sp@- 4dd6e: 2f02 movel %d2,%sp@- 4dd70: 2f03 movel %d3,%sp@- 4dd72: 4e94 jsr %a4@ * is not, then we can go ahead and free the buffer. * * NOTE: If we note that the queue was not full before this receive, * then we can avoid this dequeue. */ the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 4dd74: 2f0a movel %a2,%sp@- 4dd76: 4eb9 0004 f784 jsr 4f784 <_Thread_queue_Dequeue> if ( !the_thread ) { 4dd7c: 4fef 0010 lea %sp@(16),%sp * is not, then we can go ahead and free the buffer. * * NOTE: If we note that the queue was not full before this receive, * then we can avoid this dequeue. */ the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 4dd80: 2040 moveal %d0,%a0 if ( !the_thread ) { 4dd82: 4a80 tstl %d0 4dd84: 661a bnes 4dda0 <_CORE_message_queue_Seize+0xb4> RTEMS_INLINE_ROUTINE void _CORE_message_queue_Free_message_buffer ( CORE_message_queue_Control *the_message_queue, CORE_message_queue_Buffer_control *the_message ) { _Chain_Append( &the_message_queue->Inactive_messages, &the_message->Node ); 4dd86: 45ea 0068 lea %a2@(104),%a2 4dd8a: 2d4b 000c movel %a3,%fp@(12) 4dd8e: 2d4a 0008 movel %a2,%fp@(8) executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4dd92: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4dd98: 4e5e unlk %fp 4dd9a: 4ef9 0004 db6c jmp 4db6c <_Chain_Append> */ _CORE_message_queue_Set_message_priority( the_message, the_thread->Wait.count ); the_message->Contents.size = (size_t) the_thread->Wait.option; 4dda0: 2028 0030 movel %a0@(48),%d0 CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 4dda4: 2768 0024 0008 movel %a0@(36),%a3@(8) 4ddaa: 2740 000c movel %d0,%a3@(12) const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4ddae: 2f00 movel %d0,%sp@- 4ddb0: 2f28 002c movel %a0@(44),%sp@- 4ddb4: 2f02 movel %d2,%sp@- 4ddb6: 4e94 jsr %a4@ the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 4ddb8: 2d6b 0008 0010 movel %a3@(8),%fp@(16) 4ddbe: 4fef 000c lea %sp@(12),%sp 4ddc2: 2d4b 000c movel %a3,%fp@(12) 4ddc6: 2d4a 0008 movel %a2,%fp@(8) executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4ddca: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4ddd0: 4e5e unlk %fp the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 4ddd2: 4ef9 0005 2574 jmp 52574 <_CORE_message_queue_Insert_message> return; } #endif } if ( !wait ) { 4ddd8: 4a05 tstb %d5 4ddda: 6612 bnes 4ddee <_CORE_message_queue_Seize+0x102> _ISR_Enable( level ); 4dddc: 46c0 movew %d0,%sr executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 4ddde: 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 ); } 4dde0: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 #endif } if ( !wait ) { _ISR_Enable( level ); executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 4dde6: 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 ); } 4ddea: 4e5e unlk %fp 4ddec: 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; 4ddee: 7201 moveq #1,%d1 4ddf0: 2541 0030 movel %d1,%a2@(48) _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; 4ddf4: 2149 0028 movel %a1,%a0@(40) } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; 4ddf8: 2143 002c movel %d3,%a0@(44) return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; 4ddfc: 2144 0020 movel %d4,%a0@(32) executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; 4de00: 214a 0044 movel %a2,%a0@(68) executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 4de04: 46c0 movew %d0,%sr _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 4de06: 4bf9 0004 fbb0 lea 4fbb0 <_Thread_queue_Timeout>,%a5 4de0c: 2d42 000c movel %d2,%fp@(12) 4de10: 2d4d 0010 movel %a5,%fp@(16) 4de14: 2d4a 0008 movel %a2,%fp@(8) } 4de18: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 4de1e: 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 ); 4de20: 4ef9 0004 f8c4 jmp 4f8c4 <_Thread_queue_Enqueue_with_handler> ... 0004de28 <_CORE_message_queue_Submit>: #endif CORE_message_queue_Submit_types submit_type, bool wait, Watchdog_Interval timeout ) { 4de28: 4e56 ffe8 linkw %fp,#-24 4de2c: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 4de30: 246e 0008 moveal %fp@(8),%a2 4de34: 282e 000c movel %fp@(12),%d4 4de38: 242e 0010 movel %fp@(16),%d2 4de3c: 262e 001c movel %fp@(28),%d3 4de40: 1a2e 0023 moveb %fp@(35),%d5 CORE_message_queue_Buffer_control *the_message; Thread_Control *the_thread; if ( size > the_message_queue->maximum_message_size ) { 4de44: b4aa 004c cmpl %a2@(76),%d2 4de48: 6306 blss 4de50 <_CORE_message_queue_Submit+0x28> 4de4a: 7001 moveq #1,%d0 4de4c: 6000 00d6 braw 4df24 <_CORE_message_queue_Submit+0xfc> } /* * Is there a thread currently waiting on this message queue? */ if ( the_message_queue->number_of_pending_messages == 0 ) { 4de50: 4aaa 0048 tstl %a2@(72) 4de54: 6632 bnes 4de88 <_CORE_message_queue_Submit+0x60> the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 4de56: 2f0a movel %a2,%sp@- 4de58: 4eb9 0004 f784 jsr 4f784 <_Thread_queue_Dequeue> if ( the_thread ) { 4de5e: 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 ); 4de60: 2640 moveal %d0,%a3 if ( the_thread ) { 4de62: 4a80 tstl %d0 4de64: 6722 beqs 4de88 <_CORE_message_queue_Submit+0x60> 4de66: 2f02 movel %d2,%sp@- 4de68: 2f04 movel %d4,%sp@- 4de6a: 2f2b 002c movel %a3@(44),%sp@- 4de6e: 4eb9 0005 5548 jsr 55548 _CORE_message_queue_Copy_buffer( buffer, the_thread->Wait.return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 4de74: 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; 4de78: 4fef 000c lea %sp@(12),%sp buffer, the_thread->Wait.return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; the_thread->Wait.count = (uint32_t) submit_type; 4de7c: 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; 4de7e: 2082 movel %d2,%a0@ the_thread->Wait.count = (uint32_t) submit_type; 4de80: 2743 0024 movel %d3,%a3@(36) #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; 4de84: 6000 009e braw 4df24 <_CORE_message_queue_Submit+0xfc> /* * 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 < the_message_queue->maximum_pending_messages ) { 4de88: 202a 0044 movel %a2@(68),%d0 4de8c: b0aa 0048 cmpl %a2@(72),%d0 4de90: 6336 blss 4dec8 <_CORE_message_queue_Submit+0xa0> RTEMS_INLINE_ROUTINE CORE_message_queue_Buffer_control * _CORE_message_queue_Allocate_message_buffer ( CORE_message_queue_Control *the_message_queue ) { return (CORE_message_queue_Buffer_control *) 4de92: 486a 0068 pea %a2@(104) 4de96: 4eb9 0004 dbcc jsr 4dbcc <_Chain_Get> 4de9c: 2640 moveal %d0,%a3 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4de9e: 2f02 movel %d2,%sp@- 4dea0: 2f04 movel %d4,%sp@- 4dea2: 486b 0010 pea %a3@(16) 4dea6: 4eb9 0005 5548 jsr 55548 _CORE_message_queue_Copy_buffer( buffer, the_message->Contents.buffer, size ); the_message->Contents.size = size; 4deac: 2742 000c movel %d2,%a3@(12) CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 4deb0: 2743 0008 movel %d3,%a3@(8) _CORE_message_queue_Set_message_priority( the_message, submit_type ); _CORE_message_queue_Insert_message( 4deb4: 2f03 movel %d3,%sp@- 4deb6: 2f0b movel %a3,%sp@- 4deb8: 2f0a movel %a2,%sp@- 4deba: 4eb9 0005 2574 jsr 52574 <_CORE_message_queue_Insert_message> the_message_queue, the_message, submit_type ); return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 4dec0: 4fef 001c lea %sp@(28),%sp size ); the_message->Contents.size = size; _CORE_message_queue_Set_message_priority( the_message, submit_type ); _CORE_message_queue_Insert_message( 4dec4: 4280 clrl %d0 the_message_queue, the_message, submit_type ); return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 4dec6: 605c bras 4df24 <_CORE_message_queue_Submit+0xfc> /* * No message buffers were available so we may need to return an * overflow error or block the sender until the message is placed * on the queue. */ if ( !wait ) { 4dec8: 4a05 tstb %d5 4deca: 6604 bnes 4ded0 <_CORE_message_queue_Submit+0xa8> 4decc: 7002 moveq #2,%d0 4dece: 6054 bras 4df24 <_CORE_message_queue_Submit+0xfc> /* * Do NOT block on a send if the caller is in an ISR. It is * deadly to block in an ISR. */ if ( _ISR_Is_in_progress() ) { 4ded0: 2039 0006 62e2 movel 662e2 <_ISR_Nest_level>,%d0 4ded6: 6704 beqs 4dedc <_CORE_message_queue_Submit+0xb4> 4ded8: 7003 moveq #3,%d0 4deda: 6048 bras 4df24 <_CORE_message_queue_Submit+0xfc> * Thus the unusual choice to open a new scope and declare * it as a variable. Doing this emphasizes how dangerous it * would be to use this variable prior to here. */ { Thread_Control *executing = _Thread_Executing; 4dedc: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0 ISR_Level level; _ISR_Disable( level ); 4dee2: 203c 0000 0700 movel #1792,%d0 4dee8: 40c1 movew %sr,%d1 4deea: 8081 orl %d1,%d0 4deec: 46c0 movew %d0,%sr 4deee: 7001 moveq #1,%d0 _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; 4def0: 216e 0014 0020 movel %fp@(20),%a0@(32) 4def6: 2540 0030 movel %d0,%a2@(48) executing->Wait.return_argument_second.immutable_object = buffer; executing->Wait.option = (uint32_t) size; executing->Wait.count = submit_type; 4defa: 2143 0024 movel %d3,%a0@(36) _ISR_Disable( level ); _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; executing->Wait.return_argument_second.immutable_object = buffer; 4defe: 2144 002c movel %d4,%a0@(44) executing->Wait.option = (uint32_t) size; 4df02: 2142 0030 movel %d2,%a0@(48) Thread_Control *executing = _Thread_Executing; ISR_Level level; _ISR_Disable( level ); _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; 4df06: 214a 0044 movel %a2,%a0@(68) executing->Wait.id = id; executing->Wait.return_argument_second.immutable_object = buffer; executing->Wait.option = (uint32_t) size; executing->Wait.count = submit_type; _ISR_Enable( level ); 4df0a: 46c1 movew %d1,%sr _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 4df0c: 4879 0004 fbb0 pea 4fbb0 <_Thread_queue_Timeout> 4df12: 2f2e 0024 movel %fp@(36),%sp@- 4df16: 2f0a movel %a2,%sp@- 4df18: 4eb9 0004 f8c4 jsr 4f8c4 <_Thread_queue_Enqueue_with_handler> } return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT; 4df1e: 4fef 000c lea %sp@(12),%sp executing->Wait.return_argument_second.immutable_object = buffer; executing->Wait.option = (uint32_t) size; executing->Wait.count = submit_type; _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 4df22: 7007 moveq #7,%d0 } return CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT; #endif } 4df24: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 4df2a: 4e5e unlk %fp 4df2c: 4e75 rts ... 00045a20 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 45a20: 4e56 0000 linkw %fp,#0 45a24: 202e 0010 movel %fp@(16),%d0 45a28: 2f0a movel %a2,%sp@- 45a2a: 246e 0008 moveal %fp@(8),%a2 45a2e: 2f02 movel %d2,%sp@- _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 45a30: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 45a36: 1400 moveb %d0,%d2 _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 45a38: 4a81 tstl %d1 45a3a: 671c beqs 45a58 <_CORE_mutex_Seize+0x38> 45a3c: 4a00 tstb %d0 45a3e: 6718 beqs 45a58 <_CORE_mutex_Seize+0x38> 45a40: 7001 moveq #1,%d0 45a42: b0b9 0005 ce1c cmpl 5ce1c <_System_state_Current>,%d0 45a48: 640e bccs 45a58 <_CORE_mutex_Seize+0x38> 45a4a: 4878 0013 pea 13 45a4e: 42a7 clrl %sp@- 45a50: 42a7 clrl %sp@- 45a52: 4eb9 0004 5fd8 jsr 45fd8 <_Internal_error_Occurred> 45a58: 486e 0018 pea %fp@(24) 45a5c: 2f0a movel %a2,%sp@- 45a5e: 4eb9 0004 a07c jsr 4a07c <_CORE_mutex_Seize_interrupt_trylock> 45a64: 508f addql #8,%sp 45a66: 4a80 tstl %d0 45a68: 6750 beqs 45aba <_CORE_mutex_Seize+0x9a> 45a6a: 4a02 tstb %d2 45a6c: 6614 bnes 45a82 <_CORE_mutex_Seize+0x62> 45a6e: 202e 0018 movel %fp@(24),%d0 45a72: 46c0 movew %d0,%sr 45a74: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 45a7a: 7001 moveq #1,%d0 45a7c: 2140 0034 movel %d0,%a0@(52) 45a80: 6038 bras 45aba <_CORE_mutex_Seize+0x9a> 45a82: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 45a88: 5280 addql #1,%d0 45a8a: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 45a90: 216e 000c 0020 movel %fp@(12),%a0@(32) 45a96: 23c0 0005 cc94 movel %d0,5cc94 <_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; 45a9c: 7001 moveq #1,%d0 45a9e: 214a 0044 movel %a2,%a0@(68) 45aa2: 2540 0030 movel %d0,%a2@(48) 45aa6: 202e 0018 movel %fp@(24),%d0 45aaa: 46c0 movew %d0,%sr 45aac: 2f2e 0014 movel %fp@(20),%sp@- 45ab0: 2f0a movel %a2,%sp@- 45ab2: 4eb9 0004 59bc jsr 459bc <_CORE_mutex_Seize_interrupt_blocking> 45ab8: 508f addql #8,%sp } 45aba: 242e fff8 movel %fp@(-8),%d2 45abe: 246e fffc moveal %fp@(-4),%a2 45ac2: 4e5e unlk %fp 45ac4: 4e75 rts ... 00045ac8 <_CORE_mutex_Surrender>: #else Objects_Id id __attribute__((unused)), CORE_mutex_API_mp_support_callout api_mutex_mp_support __attribute__((unused)) #endif ) { 45ac8: 4e56 0000 linkw %fp,#0 45acc: 2f0a movel %a2,%sp@- 45ace: 246e 0008 moveal %fp@(8),%a2 Thread_Control *the_thread; Thread_Control *holder; #ifdef __RTEMS_STRICT_ORDER_MUTEX__ Chain_Node *first_node; #endif holder = the_mutex->holder; 45ad2: 206a 005a moveal %a2@(90),%a0 * allowed when the mutex in quetion is FIFO or simple Priority * discipline. But Priority Ceiling or Priority Inheritance mutexes * must be released by the thread which acquired them. */ if ( the_mutex->Attributes.only_owner_release ) { 45ad6: 4a2a 0044 tstb %a2@(68) 45ada: 670e beqs 45aea <_CORE_mutex_Surrender+0x22> if ( !_Thread_Is_executing( holder ) ) 45adc: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 45ae2: 6706 beqs 45aea <_CORE_mutex_Surrender+0x22> 45ae4: 7003 moveq #3,%d0 45ae6: 6000 00ce braw 45bb6 <_CORE_mutex_Surrender+0xee> return CORE_MUTEX_STATUS_NOT_OWNER_OF_RESOURCE; } /* XXX already unlocked -- not right status */ if ( !the_mutex->nest_count ) 45aea: 202a 0052 movel %a2@(82),%d0 45aee: 6700 00c4 beqw 45bb4 <_CORE_mutex_Surrender+0xec> return CORE_MUTEX_STATUS_SUCCESSFUL; the_mutex->nest_count--; 45af2: 5380 subql #1,%d0 45af4: 2540 0052 movel %d0,%a2@(82) if ( the_mutex->nest_count != 0 ) { 45af8: 6600 00ba bnew 45bb4 <_CORE_mutex_Surrender+0xec> 45afc: 202a 0046 movel %a2@(70),%d0 /* * Formally release the mutex before possibly transferring it to a * blocked thread. */ if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || 45b00: 7202 moveq #2,%d1 45b02: b280 cmpl %d0,%d1 45b04: 6708 beqs 45b0e <_CORE_mutex_Surrender+0x46> 45b06: 123c 0003 moveb #3,%d1 45b0a: b280 cmpl %d0,%d1 45b0c: 6604 bnes 45b12 <_CORE_mutex_Surrender+0x4a> the_mutex->nest_count++; return CORE_MUTEX_RELEASE_NOT_ORDER; } first_node = _Chain_Get_first_unprotected(&holder->lock_mutex); #endif holder->resource_count--; 45b0e: 53a8 001c subql #1,%a0@(28) 45b12: 202a 0046 movel %a2@(70),%d0 /* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || 45b16: 7202 moveq #2,%d1 } first_node = _Chain_Get_first_unprotected(&holder->lock_mutex); #endif holder->resource_count--; } the_mutex->holder = NULL; 45b18: 42aa 005a clrl %a2@(90) the_mutex->holder_id = 0; 45b1c: 42aa 005e clrl %a2@(94) /* * Whether or not someone is waiting for the mutex, an * inherited priority must be lowered if this is the last * mutex (i.e. resource) this task has. */ if ( _CORE_mutex_Is_inherit_priority( &the_mutex->Attributes ) || 45b20: b280 cmpl %d0,%d1 45b22: 6708 beqs 45b2c <_CORE_mutex_Surrender+0x64> 45b24: 123c 0003 moveb #3,%d1 45b28: b280 cmpl %d0,%d1 45b2a: 6622 bnes 45b4e <_CORE_mutex_Surrender+0x86> _CORE_mutex_Is_priority_ceiling( &the_mutex->Attributes ) ) { #ifdef __RTEMS_STRICT_ORDER_MUTEX__ if(the_mutex->queue.priority_before != holder->current_priority) _Thread_Change_priority(holder,the_mutex->queue.priority_before,true); #endif if ( holder->resource_count == 0 && 45b2c: 4aa8 001c tstl %a0@(28) 45b30: 661c bnes 45b4e <_CORE_mutex_Surrender+0x86> holder->real_priority != holder->current_priority ) { 45b32: 2028 0018 movel %a0@(24),%d0 45b36: b0a8 0014 cmpl %a0@(20),%d0 45b3a: 6712 beqs 45b4e <_CORE_mutex_Surrender+0x86> _Thread_Change_priority( holder, holder->real_priority, true ); 45b3c: 4878 0001 pea 1 45b40: 2f00 movel %d0,%sp@- 45b42: 2f08 movel %a0,%sp@- 45b44: 4eb9 0004 67e8 jsr 467e8 <_Thread_Change_priority> 45b4a: 4fef 000c lea %sp@(12),%sp /* * Now we check if another thread was waiting for this mutex. If so, * transfer the mutex to that thread. */ if ( ( the_thread = _Thread_queue_Dequeue( &the_mutex->Wait_queue ) ) ) { 45b4e: 2f0a movel %a2,%sp@- 45b50: 4eb9 0004 702c jsr 4702c <_Thread_queue_Dequeue> 45b56: 588f addql #4,%sp 45b58: 2040 moveal %d0,%a0 45b5a: 4a80 tstl %d0 45b5c: 674c beqs 45baa <_CORE_mutex_Surrender+0xe2> #endif { the_mutex->holder = the_thread; the_mutex->holder_id = the_thread->Object.id; the_mutex->nest_count = 1; 45b5e: 7201 moveq #1,%d1 } else #endif { the_mutex->holder = the_thread; the_mutex->holder_id = the_thread->Object.id; 45b60: 2568 0008 005e movel %a0@(8),%a2@(94) the_mutex->nest_count = 1; switch ( the_mutex->Attributes.discipline ) { 45b66: 202a 0046 movel %a2@(70),%d0 #endif { the_mutex->holder = the_thread; the_mutex->holder_id = the_thread->Object.id; the_mutex->nest_count = 1; 45b6a: 2541 0052 movel %d1,%a2@(82) switch ( the_mutex->Attributes.discipline ) { 45b6e: 123c 0002 moveb #2,%d1 } else #endif { the_mutex->holder = the_thread; 45b72: 2548 005a movel %a0,%a2@(90) the_mutex->holder_id = the_thread->Object.id; the_mutex->nest_count = 1; switch ( the_mutex->Attributes.discipline ) { 45b76: b280 cmpl %d0,%d1 45b78: 670a beqs 45b84 <_CORE_mutex_Surrender+0xbc> 45b7a: 123c 0003 moveb #3,%d1 45b7e: b280 cmpl %d0,%d1 45b80: 6632 bnes 45bb4 <_CORE_mutex_Surrender+0xec> 45b82: 6006 bras 45b8a <_CORE_mutex_Surrender+0xc2> case CORE_MUTEX_DISCIPLINES_PRIORITY_INHERIT: #ifdef __RTEMS_STRICT_ORDER_MUTEX__ _Chain_Prepend_unprotected(&the_thread->lock_mutex,&the_mutex->queue.lock_queue); the_mutex->queue.priority_before = the_thread->current_priority; #endif the_thread->resource_count++; 45b84: 52a8 001c addql #1,%a0@(28) 45b88: 602a bras 45bb4 <_CORE_mutex_Surrender+0xec> case CORE_MUTEX_DISCIPLINES_PRIORITY_CEILING: #ifdef __RTEMS_STRICT_ORDER_MUTEX__ _Chain_Prepend_unprotected(&the_thread->lock_mutex,&the_mutex->queue.lock_queue); the_mutex->queue.priority_before = the_thread->current_priority; #endif the_thread->resource_count++; 45b8a: 52a8 001c addql #1,%a0@(28) if (the_mutex->Attributes.priority_ceiling < 45b8e: 202a 004a movel %a2@(74),%d0 the_thread->current_priority){ 45b92: b0a8 0014 cmpl %a0@(20),%d0 45b96: 641c bccs 45bb4 <_CORE_mutex_Surrender+0xec> _Thread_Change_priority( 45b98: 42a7 clrl %sp@- 45b9a: 2f00 movel %d0,%sp@- 45b9c: 2f08 movel %a0,%sp@- 45b9e: 4eb9 0004 67e8 jsr 467e8 <_Thread_Change_priority> 45ba4: 4fef 000c lea %sp@(12),%sp 45ba8: 600a bras 45bb4 <_CORE_mutex_Surrender+0xec> } break; } } } else the_mutex->lock = CORE_MUTEX_UNLOCKED; 45baa: 7001 moveq #1,%d0 45bac: 2540 004e movel %d0,%a2@(78) 45bb0: 4200 clrb %d0 45bb2: 6002 bras 45bb6 <_CORE_mutex_Surrender+0xee> 45bb4: 4280 clrl %d0 return CORE_MUTEX_STATUS_SUCCESSFUL; } 45bb6: 246e fffc moveal %fp@(-4),%a2 45bba: 4e5e unlk %fp 45bbc: 4e75 rts ... 00045bcc <_CORE_semaphore_Initialize>: void _CORE_semaphore_Initialize( CORE_semaphore_Control *the_semaphore, CORE_semaphore_Attributes *the_semaphore_attributes, uint32_t initial_value ) { 45bcc: 4e56 0000 linkw %fp,#0 45bd0: 226e 000c moveal %fp@(12),%a1 the_semaphore->Attributes = *the_semaphore_attributes; the_semaphore->count = initial_value; _Thread_queue_Initialize( 45bd4: 4878 0003 pea 3 45bd8: 4878 0200 pea 200 void _CORE_semaphore_Initialize( CORE_semaphore_Control *the_semaphore, CORE_semaphore_Attributes *the_semaphore_attributes, uint32_t initial_value ) { 45bdc: 206e 0008 moveal %fp@(8),%a0 the_semaphore->Attributes = *the_semaphore_attributes; 45be0: 2011 movel %a1@,%d0 45be2: 2229 0004 movel %a1@(4),%d1 the_semaphore->count = initial_value; 45be6: 216e 0010 0048 movel %fp@(16),%a0@(72) CORE_semaphore_Attributes *the_semaphore_attributes, uint32_t initial_value ) { the_semaphore->Attributes = *the_semaphore_attributes; 45bec: 2140 0040 movel %d0,%a0@(64) 45bf0: 2141 0044 movel %d1,%a0@(68) the_semaphore->count = initial_value; _Thread_queue_Initialize( 45bf4: 7201 moveq #1,%d1 45bf6: b2a9 0004 cmpl %a1@(4),%d1 45bfa: 57c0 seq %d0 45bfc: 49c0 extbl %d0 45bfe: 4480 negl %d0 45c00: 2f00 movel %d0,%sp@- 45c02: 2f08 movel %a0,%sp@- 45c04: 4eb9 0004 739c jsr 4739c <_Thread_queue_Initialize> 45c0a: 4fef 0010 lea %sp@(16),%sp _CORE_semaphore_Is_priority( the_semaphore_attributes ) ? THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_SEMAPHORE, CORE_SEMAPHORE_TIMEOUT ); } 45c0e: 4e5e unlk %fp 45c10: 4e75 rts ... 0004dcc0 <_CORE_semaphore_Seize>: Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4dcc0: 223c 0000 0700 movel #1792,%d1 CORE_semaphore_Control *the_semaphore, Objects_Id id, bool wait, Watchdog_Interval timeout ) { 4dcc6: 4e56 fff4 linkw %fp,#-12 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; 4dcca: 2279 0006 1b4a moveal 61b4a <_Thread_Executing>,%a1 CORE_semaphore_Control *the_semaphore, Objects_Id id, bool wait, Watchdog_Interval timeout ) { 4dcd0: 48d7 001c moveml %d2-%d4,%sp@ 4dcd4: 262e 000c movel %fp@(12),%d3 4dcd8: 242e 0014 movel %fp@(20),%d2 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 4dcdc: 42a9 0034 clrl %a1@(52) CORE_semaphore_Control *the_semaphore, Objects_Id id, bool wait, Watchdog_Interval timeout ) { 4dce0: 206e 0008 moveal %fp@(8),%a0 4dce4: 282e 0010 movel %fp@(16),%d4 Thread_Control *executing; ISR_Level level; executing = _Thread_Executing; executing->Wait.return_code = CORE_SEMAPHORE_STATUS_SUCCESSFUL; _ISR_Disable( level ); 4dce8: 40c0 movew %sr,%d0 4dcea: 8280 orl %d0,%d1 4dcec: 46c1 movew %d1,%sr if ( the_semaphore->count != 0 ) { 4dcee: 2228 0048 movel %a0@(72),%d1 4dcf2: 670a beqs 4dcfe <_CORE_semaphore_Seize+0x3e> the_semaphore->count -= 1; 4dcf4: 5381 subql #1,%d1 4dcf6: 2141 0048 movel %d1,%a0@(72) _ISR_Enable( level ); 4dcfa: 46c0 movew %d0,%sr return; 4dcfc: 603c bras 4dd3a <_CORE_semaphore_Seize+0x7a> /* * If the semaphore was not available and the caller was not willing * to block, then return immediately with a status indicating that * the semaphore was not available and the caller never blocked. */ if ( !wait ) { 4dcfe: 4a04 tstb %d4 4dd00: 660a bnes 4dd0c <_CORE_semaphore_Seize+0x4c> _ISR_Enable( level ); 4dd02: 46c0 movew %d0,%sr executing->Wait.return_code = CORE_SEMAPHORE_STATUS_UNSATISFIED_NOWAIT; 4dd04: 7001 moveq #1,%d0 4dd06: 2340 0034 movel %d0,%a1@(52) 4dd0a: 602e bras 4dd3a <_CORE_semaphore_Seize+0x7a> 4dd0c: 7201 moveq #1,%d1 * If the semaphore is not available and the caller is willing to * block, then we now block the caller with optional timeout. */ _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; executing->Wait.id = id; 4dd0e: 2343 0020 movel %d3,%a1@(32) /* * If the semaphore is not available and the caller is willing to * block, then we now block the caller with optional timeout. */ _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; 4dd12: 2348 0044 movel %a0,%a1@(68) 4dd16: 2141 0030 movel %d1,%a0@(48) executing->Wait.id = id; _ISR_Enable( level ); 4dd1a: 46c0 movew %d0,%sr _Thread_queue_Enqueue( &the_semaphore->Wait_queue, timeout ); 4dd1c: 2d42 000c movel %d2,%fp@(12) 4dd20: 203c 0004 aa68 movel #305768,%d0 4dd26: 2d48 0008 movel %a0,%fp@(8) 4dd2a: 2d40 0010 movel %d0,%fp@(16) } 4dd2e: 4cd7 001c moveml %sp@,%d2-%d4 4dd32: 4e5e unlk %fp */ _Thread_queue_Enter_critical_section( &the_semaphore->Wait_queue ); executing->Wait.queue = &the_semaphore->Wait_queue; executing->Wait.id = id; _ISR_Enable( level ); _Thread_queue_Enqueue( &the_semaphore->Wait_queue, timeout ); 4dd34: 4ef9 0004 a77c jmp 4a77c <_Thread_queue_Enqueue_with_handler> } 4dd3a: 4cd7 001c moveml %sp@,%d2-%d4 4dd3e: 4e5e unlk %fp 4dd40: 4e75 rts ... 00045c14 <_CORE_semaphore_Surrender>: CORE_semaphore_Status _CORE_semaphore_Surrender( CORE_semaphore_Control *the_semaphore, Objects_Id id, CORE_semaphore_API_mp_support_callout api_semaphore_mp_support ) { 45c14: 4e56 0000 linkw %fp,#0 45c18: 2f0a movel %a2,%sp@- 45c1a: 246e 0008 moveal %fp@(8),%a2 ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 45c1e: 2f0a movel %a2,%sp@- 45c20: 4eb9 0004 702c jsr 4702c <_Thread_queue_Dequeue> 45c26: 588f addql #4,%sp 45c28: 4a80 tstl %d0 45c2a: 6704 beqs 45c30 <_CORE_semaphore_Surrender+0x1c> 45c2c: 4280 clrl %d0 45c2e: 6024 bras 45c54 <_CORE_semaphore_Surrender+0x40> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 45c30: 203c 0000 0700 movel #1792,%d0 45c36: 40c1 movew %sr,%d1 45c38: 8081 orl %d1,%d0 45c3a: 46c0 movew %d0,%sr if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 45c3c: 202a 0048 movel %a2@(72),%d0 45c40: b0aa 0040 cmpl %a2@(64),%d0 45c44: 6504 bcss 45c4a <_CORE_semaphore_Surrender+0x36> 45c46: 7004 moveq #4,%d0 <== NOT EXECUTED 45c48: 6008 bras 45c52 <_CORE_semaphore_Surrender+0x3e> <== NOT EXECUTED the_semaphore->count += 1; 45c4a: 5280 addql #1,%d0 45c4c: 2540 0048 movel %d0,%a2@(72) 45c50: 4280 clrl %d0 else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 45c52: 46c1 movew %d1,%sr } return status; } 45c54: 246e fffc moveal %fp@(-4),%a2 45c58: 4e5e unlk %fp 45c5a: 4e75 rts 00046558 <_CORE_spinlock_Initialize>: void _CORE_spinlock_Initialize( CORE_spinlock_Control *the_spinlock, CORE_spinlock_Attributes *the_spinlock_attributes ) { 46558: 4e56 0000 linkw %fp,#0 4655c: 206e 0008 moveal %fp@(8),%a0 46560: 226e 000c moveal %fp@(12),%a1 the_spinlock->Attributes = *the_spinlock_attributes; the_spinlock->lock = 0; the_spinlock->users = 0; the_spinlock->holder = 0; } 46564: 4e5e unlk %fp CORE_spinlock_Control *the_spinlock, CORE_spinlock_Attributes *the_spinlock_attributes ) { the_spinlock->Attributes = *the_spinlock_attributes; 46566: 2091 movel %a1@,%a0@ the_spinlock->lock = 0; 46568: 42a8 0004 clrl %a0@(4) the_spinlock->users = 0; 4656c: 42a8 0008 clrl %a0@(8) the_spinlock->holder = 0; 46570: 42a8 000c clrl %a0@(12) } 46574: 4e75 rts ... 000465c8 <_CORE_spinlock_Wait>: ISR_Level level; #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) Watchdog_Interval limit = _Watchdog_Ticks_since_boot + timeout; #endif _ISR_Disable( level ); 465c8: 223c 0000 0700 movel #1792,%d1 CORE_spinlock_Status _CORE_spinlock_Wait( CORE_spinlock_Control *the_spinlock, bool wait, Watchdog_Interval timeout ) { 465ce: 4e56 fff0 linkw %fp,#-16 465d2: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 465d6: 246e 0008 moveal %fp@(8),%a2 465da: 162e 000f moveb %fp@(15),%d3 ISR_Level level; #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) Watchdog_Interval limit = _Watchdog_Ticks_since_boot + timeout; #endif _ISR_Disable( level ); 465de: 40c0 movew %sr,%d0 465e0: 8280 orl %d0,%d1 465e2: 46c1 movew %d1,%sr if ( (the_spinlock->lock == CORE_SPINLOCK_LOCKED) && 465e4: 222a 0004 movel %a2@(4),%d1 465e8: 7401 moveq #1,%d2 465ea: b481 cmpl %d1,%d2 465ec: 6616 bnes 46604 <_CORE_spinlock_Wait+0x3c> (the_spinlock->holder == _Thread_Executing->Object.id) ) { 465ee: 222a 000c movel %a2@(12),%d1 465f2: 2079 0005 dd2e moveal 5dd2e <_Thread_Executing>,%a0 465f8: b2a8 0008 cmpl %a0@(8),%d1 465fc: 6606 bnes 46604 <_CORE_spinlock_Wait+0x3c> _ISR_Enable( level ); 465fe: 46c0 movew %d0,%sr 46600: 7001 moveq #1,%d0 return CORE_SPINLOCK_HOLDER_RELOCKING; 46602: 6068 bras 4666c <_CORE_spinlock_Wait+0xa4> } the_spinlock->users += 1; 46604: 222a 0008 movel %a2@(8),%d1 46608: 5281 addql #1,%d1 */ _ISR_Enable( level ); /* An ISR could occur here */ _Thread_Enable_dispatch(); 4660a: 47f9 0004 768e lea 4768e <_Thread_Enable_dispatch>,%a3 /* Another thread could get dispatched here */ /* Reenter the critical sections so we can attempt the lock again. */ _Thread_Disable_dispatch(); _ISR_Disable( level ); 46610: 243c 0000 0700 movel #1792,%d2 if ( (the_spinlock->lock == CORE_SPINLOCK_LOCKED) && (the_spinlock->holder == _Thread_Executing->Object.id) ) { _ISR_Enable( level ); return CORE_SPINLOCK_HOLDER_RELOCKING; } the_spinlock->users += 1; 46616: 2541 0008 movel %d1,%a2@(8) for ( ;; ) { if ( the_spinlock->lock == CORE_SPINLOCK_UNLOCKED ) { 4661a: 222a 0004 movel %a2@(4),%d1 4661e: 661c bnes 4663c <_CORE_spinlock_Wait+0x74> the_spinlock->lock = CORE_SPINLOCK_LOCKED; 46620: 123c 0001 moveb #1,%d1 the_spinlock->holder = _Thread_Executing->Object.id; 46624: 2079 0005 dd2e moveal 5dd2e <_Thread_Executing>,%a0 return CORE_SPINLOCK_HOLDER_RELOCKING; } the_spinlock->users += 1; for ( ;; ) { if ( the_spinlock->lock == CORE_SPINLOCK_UNLOCKED ) { the_spinlock->lock = CORE_SPINLOCK_LOCKED; 4662a: 2541 0004 movel %d1,%a2@(4) the_spinlock->holder = _Thread_Executing->Object.id; 4662e: 2228 0008 movel %a0@(8),%d1 46632: 2541 000c movel %d1,%a2@(12) _ISR_Enable( level ); 46636: 46c0 movew %d0,%sr 46638: 4280 clrl %d0 return CORE_SPINLOCK_SUCCESSFUL; 4663a: 6030 bras 4666c <_CORE_spinlock_Wait+0xa4> } /* * Spinlock is unavailable. If not willing to wait, return. */ if ( !wait ) { 4663c: 4a03 tstb %d3 4663e: 6610 bnes 46650 <_CORE_spinlock_Wait+0x88> the_spinlock->users -= 1; 46640: 222a 0008 movel %a2@(8),%d1 46644: 5381 subql #1,%d1 46646: 2541 0008 movel %d1,%a2@(8) _ISR_Enable( level ); 4664a: 46c0 movew %d0,%sr 4664c: 7005 moveq #5,%d0 return CORE_SPINLOCK_UNAVAILABLE; 4664e: 601c bras 4666c <_CORE_spinlock_Wait+0xa4> * * A spinlock cannot be deleted while it is being used so we are * safe from deletion. */ _ISR_Enable( level ); 46650: 46c0 movew %d0,%sr /* An ISR could occur here */ _Thread_Enable_dispatch(); 46652: 4e93 jsr %a3@ 46654: 2039 0005 dc74 movel 5dc74 <_Thread_Dispatch_disable_level>,%d0 4665a: 5280 addql #1,%d0 4665c: 23c0 0005 dc74 movel %d0,5dc74 <_Thread_Dispatch_disable_level> /* Another thread could get dispatched here */ /* Reenter the critical sections so we can attempt the lock again. */ _Thread_Disable_dispatch(); _ISR_Disable( level ); 46662: 2202 movel %d2,%d1 46664: 40c0 movew %sr,%d0 46666: 8280 orl %d0,%d1 46668: 46c1 movew %d1,%sr } 4666a: 60ae bras 4661a <_CORE_spinlock_Wait+0x52> } 4666c: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 46672: 4e5e unlk %fp 46674: 4e75 rts ... 000458d0 <_Chain_Append>: Chain_Node *node ) { ISR_Level level; _ISR_Disable( level ); 458d0: 203c 0000 0700 movel #1792,%d0 void _Chain_Append( Chain_Control *the_chain, Chain_Node *node ) { 458d6: 4e56 0000 linkw %fp,#0 458da: 206e 000c moveal %fp@(12),%a0 458de: 2f0a movel %a2,%sp@- 458e0: 226e 0008 moveal %fp@(8),%a1 ISR_Level level; _ISR_Disable( level ); 458e4: 40c1 movew %sr,%d1 458e6: 8081 orl %d1,%d0 458e8: 46c0 movew %d0,%sr Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 458ea: 2009 movel %a1,%d0 458ec: 5880 addql #4,%d0 458ee: 2080 movel %d0,%a0@ old_last_node = the_chain->last; 458f0: 2469 0008 moveal %a1@(8),%a2 the_chain->last = the_node; 458f4: 2348 0008 movel %a0,%a1@(8) old_last_node->next = the_node; the_node->previous = old_last_node; 458f8: 214a 0004 movel %a2,%a0@(4) Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 458fc: 2488 movel %a0,%a2@ _Chain_Append_unprotected( the_chain, node ); _ISR_Enable( level ); 458fe: 46c1 movew %d1,%sr } 45900: 245f moveal %sp@+,%a2 45902: 4e5e unlk %fp 45904: 4e75 rts ... 00049fe0 <_Chain_Extract>: Chain_Node *node ) { ISR_Level level; _ISR_Disable( level ); 49fe0: 203c 0000 0700 movel #1792,%d0 */ void _Chain_Extract( Chain_Node *node ) { 49fe6: 4e56 0000 linkw %fp,#0 49fea: 206e 0008 moveal %fp@(8),%a0 ISR_Level level; _ISR_Disable( level ); 49fee: 40c1 movew %sr,%d1 49ff0: 8081 orl %d1,%d0 49ff2: 46c0 movew %d0,%sr { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 49ff4: 2268 0004 moveal %a0@(4),%a1 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 49ff8: 2050 moveal %a0@,%a0 previous = the_node->previous; next->previous = previous; previous->next = next; 49ffa: 2288 movel %a0,%a1@ Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 49ffc: 2149 0004 movel %a1,%a0@(4) _Chain_Extract_unprotected( node ); _ISR_Enable( level ); 4a000: 46c1 movew %d1,%sr } 4a002: 4e5e unlk %fp 4a004: 4e75 rts ... 0004a03c <_Chain_Initialize>: Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { 4a03c: 4e56 0000 linkw %fp,#0 4a040: 202e 0010 movel %fp@(16),%d0 4a044: 2f0a movel %a2,%sp@- 4a046: 246e 0008 moveal %fp@(8),%a2 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Head( Chain_Control *the_chain ) { return (Chain_Node *) the_chain; 4a04a: 204a moveal %a2,%a0 Chain_Node *current; Chain_Node *next; count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; 4a04c: 42aa 0004 clrl %a2@(4) Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { 4a050: 222e 0014 movel %fp@(20),%d1 Chain_Node *next; count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; next = starting_address; 4a054: 226e 000c moveal %fp@(12),%a1 while ( count-- ) { 4a058: 600c bras 4a066 <_Chain_Initialize+0x2a> current->next = next; next->previous = current; 4a05a: 2348 0004 movel %a0,%a1@(4) current = next; next = (Chain_Node *) 4a05e: 5380 subql #1,%d0 count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; next = starting_address; while ( count-- ) { current->next = next; 4a060: 2089 movel %a1,%a0@ next->previous = current; current = next; next = (Chain_Node *) 4a062: 2049 moveal %a1,%a0 4a064: d3c1 addal %d1,%a1 count = number_nodes; current = _Chain_Head( the_chain ); the_chain->permanent_null = NULL; next = starting_address; while ( count-- ) { 4a066: 4a80 tstl %d0 4a068: 66f0 bnes 4a05a <_Chain_Initialize+0x1e> next->previous = current; current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = _Chain_Tail( the_chain ); 4a06a: 200a movel %a2,%d0 4a06c: 5880 addql #4,%d0 4a06e: 2080 movel %d0,%a0@ the_chain->last = current; 4a070: 2548 0008 movel %a0,%a2@(8) } 4a074: 245f moveal %sp@+,%a2 4a076: 4e5e unlk %fp 4a078: 4e75 rts ... 00049bd8 <_Event_Manager_initialization>: * * This routine performs the initialization necessary for this manager. */ void _Event_Manager_initialization( void ) { 49bd8: 4e56 0000 linkw %fp,#0 */ #if defined(RTEMS_MULTIPROCESSING) _MPCI_Register_packet_processor( MP_PACKET_EVENT, _Event_MP_Process_packet ); #endif } 49bdc: 4e5e unlk %fp * This routine performs the initialization necessary for this manager. */ void _Event_Manager_initialization( void ) { _Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 49bde: 42b9 0005 d4e2 clrl 5d4e2 <_Event_Sync_state> */ #if defined(RTEMS_MULTIPROCESSING) _MPCI_Register_packet_processor( MP_PACKET_EVENT, _Event_MP_Process_packet ); #endif } 49be4: 4e75 rts ... 000449d8 <_Event_Seize>: executing = _Thread_Executing; executing->Wait.return_code = RTEMS_SUCCESSFUL; api = executing->API_Extensions[ THREAD_API_RTEMS ]; _ISR_Disable( level ); 449d8: 203c 0000 0700 movel #1792,%d0 rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { 449de: 4e56 ffec linkw %fp,#-20 449e2: 226e 0010 moveal %fp@(16),%a1 449e6: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ rtems_event_set pending_events; ISR_Level level; RTEMS_API_Control *api; Thread_blocking_operation_States sync_state; executing = _Thread_Executing; 449ea: 2479 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a2 rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { 449f0: 242e 0008 movel %fp@(8),%d2 449f4: 262e 000c movel %fp@(12),%d3 ISR_Level level; RTEMS_API_Control *api; Thread_blocking_operation_States sync_state; executing = _Thread_Executing; executing->Wait.return_code = RTEMS_SUCCESSFUL; 449f8: 42aa 0034 clrl %a2@(52) rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { 449fc: 206e 0014 moveal %fp@(20),%a0 Thread_blocking_operation_States sync_state; executing = _Thread_Executing; executing->Wait.return_code = RTEMS_SUCCESSFUL; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 44a00: 266a 010a moveal %a2@(266),%a3 _ISR_Disable( level ); 44a04: 40c1 movew %sr,%d1 44a06: 8081 orl %d1,%d0 44a08: 46c0 movew %d0,%sr pending_events = api->pending_events; 44a0a: 2813 movel %a3@,%d4 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 ); 44a0c: 2002 movel %d2,%d0 44a0e: c084 andl %d4,%d0 seized_events = _Event_sets_Get( pending_events, event_in ); if ( !_Event_sets_Is_empty( seized_events ) && 44a10: 6716 beqs 44a28 <_Event_Seize+0x50> 44a12: b480 cmpl %d0,%d2 44a14: 6706 beqs 44a1c <_Event_Seize+0x44> 44a16: 0803 0001 btst #1,%d3 44a1a: 670c beqs 44a28 <_Event_Seize+0x50> (seized_events == event_in || _Options_Is_any( option_set )) ) { api->pending_events = 44a1c: 2400 movel %d0,%d2 44a1e: 4682 notl %d2 44a20: c484 andl %d4,%d2 44a22: 2682 movel %d2,%a3@ _Event_sets_Clear( pending_events, seized_events ); _ISR_Enable( level ); 44a24: 46c1 movew %d1,%sr 44a26: 600e bras 44a36 <_Event_Seize+0x5e> *event_out = seized_events; return; } if ( _Options_Is_no_wait( option_set ) ) { 44a28: 0803 0000 btst #0,%d3 44a2c: 670e beqs 44a3c <_Event_Seize+0x64> _ISR_Enable( level ); 44a2e: 46c1 movew %d1,%sr executing->Wait.return_code = RTEMS_UNSATISFIED; 44a30: 720d moveq #13,%d1 44a32: 2541 0034 movel %d1,%a2@(52) *event_out = seized_events; 44a36: 2080 movel %d0,%a0@ return; 44a38: 6000 0096 braw 44ad0 <_Event_Seize+0xf8> * * NOTE: Since interrupts are disabled, this isn't that much of an * issue but better safe than sorry. */ executing->Wait.option = (uint32_t) option_set; executing->Wait.count = (uint32_t) event_in; 44a3c: 2542 0024 movel %d2,%a2@(36) executing->Wait.return_argument = event_out; _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 44a40: 7401 moveq #1,%d2 * set properly when we are marked as in the event critical section. * * NOTE: Since interrupts are disabled, this isn't that much of an * issue but better safe than sorry. */ executing->Wait.option = (uint32_t) option_set; 44a42: 2543 0030 movel %d3,%a2@(48) executing->Wait.count = (uint32_t) event_in; executing->Wait.return_argument = event_out; 44a46: 2548 0028 movel %a0,%a2@(40) _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 44a4a: 23c2 0005 d4e2 movel %d2,5d4e2 <_Event_Sync_state> _ISR_Enable( level ); 44a50: 46c1 movew %d1,%sr if ( ticks ) { 44a52: 4a89 tstl %a1 44a54: 6730 beqs 44a86 <_Event_Seize+0xae> _Watchdog_Initialize( 44a56: 202a 0008 movel %a2@(8),%d0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 44a5a: 223c 0004 4c38 movel #281656,%d1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 44a60: 2549 0054 movel %a1,%a2@(84) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 44a64: 2541 0064 movel %d1,%a2@(100) the_watchdog->id = id; 44a68: 2540 0068 movel %d0,%a2@(104) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 44a6c: 42aa 0050 clrl %a2@(80) the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 44a70: 42aa 006c clrl %a2@(108) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 44a74: 486a 0048 pea %a2@(72) 44a78: 4879 0005 cd6c pea 5cd6c <_Watchdog_Ticks_chain> 44a7e: 4eb9 0004 7c48 jsr 47c48 <_Watchdog_Insert> 44a84: 508f addql #8,%sp NULL ); _Watchdog_Insert_ticks( &executing->Timer, ticks ); } _Thread_Set_state( executing, STATES_WAITING_FOR_EVENT ); 44a86: 4878 0100 pea 100 44a8a: 2f0a movel %a2,%sp@- 44a8c: 4eb9 0004 7500 jsr 47500 <_Thread_Set_state> _ISR_Disable( level ); 44a92: 203c 0000 0700 movel #1792,%d0 44a98: 40c1 movew %sr,%d1 44a9a: 8081 orl %d1,%d0 44a9c: 46c0 movew %d0,%sr sync_state = _Event_Sync_state; _Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) { 44a9e: 7401 moveq #1,%d2 44aa0: 508f addql #8,%sp _Thread_Set_state( executing, STATES_WAITING_FOR_EVENT ); _ISR_Disable( level ); sync_state = _Event_Sync_state; 44aa2: 2039 0005 d4e2 movel 5d4e2 <_Event_Sync_state>,%d0 _Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 44aa8: 42b9 0005 d4e2 clrl 5d4e2 <_Event_Sync_state> if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) { 44aae: b480 cmpl %d0,%d2 44ab0: 6604 bnes 44ab6 <_Event_Seize+0xde> _ISR_Enable( level ); 44ab2: 46c1 movew %d1,%sr 44ab4: 601a bras 44ad0 <_Event_Seize+0xf8> * An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level ); 44ab6: 2d4a 000c movel %a2,%fp@(12) 44aba: 2d41 0010 movel %d1,%fp@(16) } 44abe: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 * An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level ); 44ac4: 2d40 0008 movel %d0,%fp@(8) } 44ac8: 4e5e unlk %fp * An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level ); 44aca: 4ef9 0004 6798 jmp 46798 <_Thread_blocking_operation_Cancel> } 44ad0: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 44ad6: 4e5e unlk %fp 44ad8: 4e75 rts ... 00044b30 <_Event_Surrender>: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; option_set = (rtems_option) the_thread->Wait.option; _ISR_Disable( level ); 44b30: 203c 0000 0700 movel #1792,%d0 */ void _Event_Surrender( Thread_Control *the_thread ) { 44b36: 4e56 ffe8 linkw %fp,#-24 44b3a: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 44b3e: 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 ]; 44b42: 206a 010a moveal %a2@(266),%a0 option_set = (rtems_option) the_thread->Wait.option; 44b46: 282a 0030 movel %a2@(48),%d4 _ISR_Disable( level ); 44b4a: 40c1 movew %sr,%d1 44b4c: 8081 orl %d1,%d0 44b4e: 46c0 movew %d0,%sr pending_events = api->pending_events; event_condition = (rtems_event_set) the_thread->Wait.count; 44b50: 262a 0024 movel %a2@(36),%d3 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 ); 44b54: 2003 movel %d3,%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; 44b56: 2410 movel %a0@,%d2 44b58: 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 ) ) { 44b5a: 6606 bnes 44b62 <_Event_Surrender+0x32> _ISR_Enable( level ); 44b5c: 46c1 movew %d1,%sr return; 44b5e: 6000 00cc braw 44c2c <_Event_Surrender+0xfc> /* * 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() && 44b62: 2279 0005 cd2e moveal 5cd2e <_ISR_Nest_level>,%a1 44b68: 4a89 tstl %a1 44b6a: 674a beqs 44bb6 <_Event_Surrender+0x86> 44b6c: b5f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a2 44b72: 6642 bnes 44bb6 <_Event_Surrender+0x86> _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 44b74: 2279 0005 d4e2 moveal 5d4e2 <_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() && 44b7a: 7a02 moveq #2,%d5 44b7c: ba89 cmpl %a1,%d5 44b7e: 670e beqs 44b8e <_Event_Surrender+0x5e> _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 44b80: 2279 0005 d4e2 moveal 5d4e2 <_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() && 44b86: 1a3c 0001 moveb #1,%d5 44b8a: ba89 cmpl %a1,%d5 44b8c: 6628 bnes 44bb6 <_Event_Surrender+0x86> _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) ) { 44b8e: b680 cmpl %d0,%d3 44b90: 6706 beqs 44b98 <_Event_Surrender+0x68> 44b92: 0804 0001 btst #1,%d4 44b96: 671a beqs 44bb2 <_Event_Surrender+0x82> api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 44b98: 2600 movel %d0,%d3 44b9a: 4683 notl %d3 44b9c: c682 andl %d2,%d3 44b9e: 2083 movel %d3,%a0@ the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 44ba0: 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; 44ba4: 42aa 0024 clrl %a2@(36) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 44ba8: 2080 movel %d0,%a0@ _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 44baa: 7003 moveq #3,%d0 44bac: 23c0 0005 d4e2 movel %d0,5d4e2 <_Event_Sync_state> } _ISR_Enable( level ); 44bb2: 46c1 movew %d1,%sr return; 44bb4: 6076 bras 44c2c <_Event_Surrender+0xfc> } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 44bb6: 2a2a 0010 movel %a2@(16),%d5 44bba: 0285 0000 0100 andil #256,%d5 44bc0: 6768 beqs 44c2a <_Event_Surrender+0xfa> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 44bc2: b680 cmpl %d0,%d3 44bc4: 6706 beqs 44bcc <_Event_Surrender+0x9c> 44bc6: 0804 0001 btst #1,%d4 44bca: 675e beqs 44c2a <_Event_Surrender+0xfa> api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 44bcc: 2600 movel %d0,%d3 44bce: 4683 notl %d3 44bd0: c682 andl %d2,%d3 44bd2: 2083 movel %d3,%a0@ the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 44bd4: 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; 44bd8: 42aa 0024 clrl %a2@(36) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 44bdc: 2080 movel %d0,%a0@ _ISR_Flash( level ); 44bde: 203c 0000 0700 movel #1792,%d0 44be4: 46c1 movew %d1,%sr 44be6: 8081 orl %d1,%d0 44be8: 46c0 movew %d0,%sr 44bea: 47f9 0004 6928 lea 46928 <_Thread_Clear_state>,%a3 if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 44bf0: 7a02 moveq #2,%d5 44bf2: baaa 0050 cmpl %a2@(80),%d5 44bf6: 6710 beqs 44c08 <_Event_Surrender+0xd8> _ISR_Enable( level ); 44bf8: 46c1 movew %d1,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 44bfa: 2f3c 1003 fff8 movel #268697592,%sp@- 44c00: 2f0a movel %a2,%sp@- 44c02: 4e93 jsr %a3@ 44c04: 508f addql #8,%sp 44c06: 6024 bras 44c2c <_Event_Surrender+0xfc> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 44c08: 7003 moveq #3,%d0 44c0a: 2540 0050 movel %d0,%a2@(80) _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 44c0e: 46c1 movew %d1,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 44c10: 486a 0048 pea %a2@(72) 44c14: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 44c1a: 2f3c 1003 fff8 movel #268697592,%sp@- 44c20: 2f0a movel %a2,%sp@- 44c22: 4e93 jsr %a3@ 44c24: 4fef 000c lea %sp@(12),%sp 44c28: 6002 bras 44c2c <_Event_Surrender+0xfc> _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 44c2a: 46c1 movew %d1,%sr } 44c2c: 4cee 0c3c ffe8 moveml %fp@(-24),%d2-%d5/%a2-%a3 44c32: 4e5e unlk %fp 44c34: 4e75 rts ... 00045ee2 <_Heap_Block_allocate>: Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { 45ee2: 70fe moveq #-2,%d0 Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { 45ee4: 4e56 ffe0 linkw %fp,#-32 45ee8: 222e 0010 movel %fp@(16),%d1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 45eec: 2241 moveal %d1,%a1 45eee: 5189 subql #8,%a1 45ef0: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 45ef4: 246e 000c moveal %fp@(12),%a2 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { 45ef8: 7601 moveq #1,%d3 ) { 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; 45efa: 2a49 moveal %a1,%a5 45efc: 240a movel %a2,%d2 45efe: 9bca subal %a2,%a5 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { 45f00: c0aa 0004 andl %a2@(4),%d0 Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { 45f04: 266e 0008 moveal %fp@(8),%a3 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { 45f08: c6b2 0804 andl %a2@(00000004,%d0:l),%d3 Heap_Control *heap, Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { 45f0c: 2a2e 0014 movel %fp@(20),%d5 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { 45f10: 4a03 tstb %d3 45f12: 6626 bnes 45f3a <_Heap_Block_allocate+0x58> free_list_anchor = block->prev; _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; 45f14: 53ab 0038 subql #1,%a3@(56) ++stats->used_blocks; stats->free_size -= _Heap_Block_size( block ); 45f18: 76fe moveq #-2,%d3 _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; ++stats->used_blocks; 45f1a: 52ab 0040 addql #1,%a3@(64) return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 45f1e: 202a 0008 movel %a2@(8),%d0 Heap_Block *prev = block->prev; prev->next = next; next->prev = prev; 45f22: 2840 moveal %d0,%a4 stats->free_size -= _Heap_Block_size( block ); 45f24: c6aa 0004 andl %a2@(4),%d3 Heap_Block *free_list_anchor = NULL; _HAssert( alloc_area_begin <= alloc_begin ); if ( _Heap_Is_free( block ) ) { free_list_anchor = block->prev; 45f28: 206a 000c moveal %a2@(12),%a0 _Heap_Free_list_remove( block ); /* Statistics */ --stats->free_blocks; ++stats->used_blocks; stats->free_size -= _Heap_Block_size( block ); 45f2c: 97ab 0030 subl %d3,%a3@(48) 45f30: 2948 000c movel %a0,%a4@(12) RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 45f34: 2140 0008 movel %d0,%a0@(8) 45f38: 6002 bras 45f3c <_Heap_Block_allocate+0x5a> } else { free_list_anchor = _Heap_Free_list_head( heap ); 45f3a: 204b moveal %a3,%a0 } if ( alloc_area_offset < heap->page_size ) { 45f3c: 202b 0010 movel %a3@(16),%d0 45f40: b08d cmpl %a5,%d0 45f42: 630a blss 45f4e <_Heap_Block_allocate+0x6c> Heap_Block *block, Heap_Block *free_list_anchor, uintptr_t alloc_size ) { _Heap_Block_split( heap, block, free_list_anchor, alloc_size ); 45f44: 4875 5800 pea %a5@(00000000,%d5:l) 45f48: 2f08 movel %a0,%sp@- 45f4a: 2f0a movel %a2,%sp@- 45f4c: 6062 bras 45fb0 <_Heap_Block_allocate+0xce> - 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; 45f4e: 262a 0004 movel %a2@(4),%d3 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 ) 45f52: 4c40 1004 remul %d0,%d4,%d1 _HAssert( new_block_size >= heap->min_block_size ); /* Statistics */ stats->free_size += block_size; if ( _Heap_Is_prev_used( block ) ) { 45f56: 7201 moveq #1,%d1 45f58: 93c4 subal %d4,%a1 _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; 45f5a: 2009 movel %a1,%d0 45f5c: 908a subl %a2,%d0 _HAssert( block_size >= heap->min_block_size ); _HAssert( new_block_size >= heap->min_block_size ); /* Statistics */ stats->free_size += block_size; 45f5e: d1ab 0030 addl %d0,%a3@(48) if ( _Heap_Is_prev_used( block ) ) { 45f62: c2aa 0004 andl %a2@(4),%d1 45f66: 671c beqs 45f84 <_Heap_Block_allocate+0xa2> RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; 45f68: 2a68 0008 moveal %a0@(8),%a5 _Heap_Free_list_insert_after( free_list_anchor, block ); free_list_anchor = block; /* Statistics */ ++stats->free_blocks; 45f6c: 52ab 0038 addql #1,%a3@(56) 45f70: 220a movel %a2,%d1 new_block->next = next; 45f72: 254d 0008 movel %a5,%a2@(8) new_block->prev = block_before; 45f76: 2548 000c movel %a0,%a2@(12) block_before->next = new_block; 45f7a: 214a 0008 movel %a2,%a0@(8) next->prev = new_block; 45f7e: 2b4a 000c movel %a2,%a5@(12) 45f82: 600c bras 45f90 <_Heap_Block_allocate+0xae> RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Prev_block( const Heap_Block *block ) { return (Heap_Block *) ((uintptr_t) block - block->prev_size); 45f84: 95d2 subal %a2@,%a2 Heap_Block *const prev_block = _Heap_Prev_block( block ); uintptr_t const prev_block_size = _Heap_Block_size( prev_block ); block = prev_block; block_begin = (uintptr_t) block; block_size += prev_block_size; 45f86: 78fe moveq #-2,%d4 45f88: 2208 movel %a0,%d1 45f8a: c8aa 0004 andl %a2@(4),%d4 45f8e: d084 addl %d4,%d0 } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; new_block->prev_size = block_size; new_block->size_and_flag = new_block_size; 45f90: 78fe moveq #-2,%d4 45f92: c684 andl %d4,%d3 block = prev_block; block_begin = (uintptr_t) block; block_size += prev_block_size; } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 45f94: 7801 moveq #1,%d4 45f96: 8880 orl %d0,%d4 new_block->prev_size = block_size; 45f98: 2280 movel %d0,%a1@ new_block->size_and_flag = new_block_size; 45f9a: 2002 movel %d2,%d0 45f9c: d083 addl %d3,%d0 45f9e: 9089 subl %a1,%d0 block = prev_block; block_begin = (uintptr_t) block; block_size += prev_block_size; } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 45fa0: 2544 0004 movel %d4,%a2@(4) new_block->prev_size = block_size; new_block->size_and_flag = new_block_size; _Heap_Block_split( heap, new_block, free_list_anchor, alloc_size ); 45fa4: 2449 moveal %a1,%a2 } block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; new_block->prev_size = block_size; new_block->size_and_flag = new_block_size; 45fa6: 2340 0004 movel %d0,%a1@(4) _Heap_Block_split( heap, new_block, free_list_anchor, alloc_size ); 45faa: 2f05 movel %d5,%sp@- 45fac: 2f01 movel %d1,%sp@- 45fae: 2f09 movel %a1,%sp@- 45fb0: 2f0b movel %a3,%sp@- 45fb2: 4eb9 0004 5e14 jsr 45e14 <_Heap_Block_split> alloc_size ); } /* Statistics */ if ( stats->min_free_size > stats->free_size ) { 45fb8: 202b 0030 movel %a3@(48),%d0 block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; new_block->prev_size = block_size; new_block->size_and_flag = new_block_size; _Heap_Block_split( heap, new_block, free_list_anchor, alloc_size ); 45fbc: 4fef 0010 lea %sp@(16),%sp Heap_Block *block, uintptr_t alloc_begin, uintptr_t alloc_size ) { Heap_Statistics *const stats = &heap->stats; 45fc0: b0ab 0034 cmpl %a3@(52),%d0 45fc4: 6404 bccs 45fca <_Heap_Block_allocate+0xe8> ); } /* Statistics */ if ( stats->min_free_size > stats->free_size ) { stats->min_free_size = stats->free_size; 45fc6: 2740 0034 movel %d0,%a3@(52) } return block; } 45fca: 200a movel %a2,%d0 45fcc: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 45fd2: 4e5e unlk %fp 45fd4: 4e75 rts ... 0004a39c <_Heap_Free>: #include #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4a39c: 4e56 ffe8 linkw %fp,#-24 4a3a0: 202e 000c movel %fp@(12),%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 ) 4a3a4: 2240 moveal %d0,%a1 4a3a6: 5189 subql #8,%a1 4a3a8: 206e 0008 moveal %fp@(8),%a0 4a3ac: 4c68 0001 0010 remul %a0@(16),%d1,%d0 4a3b2: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 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; 4a3b6: 2828 0020 movel %a0@(32),%d4 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 ) 4a3ba: 93c1 subal %d1,%a1 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 4a3bc: b889 cmpl %a1,%d4 4a3be: 6200 0140 bhiw 4a500 <_Heap_Free+0x164> 4a3c2: b3e8 0024 cmpal %a0@(36),%a1 4a3c6: 53c0 sls %d0 4a3c8: 49c0 extbl %d0 4a3ca: 4480 negl %d0 Heap_Block *next_block = NULL; uintptr_t block_size = 0; uintptr_t next_block_size = 0; bool next_is_free = false; if ( !_Heap_Is_block_in_heap( heap, block ) ) { 4a3cc: 4a00 tstb %d0 4a3ce: 6700 0130 beqw 4a500 <_Heap_Free+0x164> - 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; 4a3d2: 2629 0004 movel %a1@(4),%d3 4a3d6: 70fe moveq #-2,%d0 4a3d8: c083 andl %d3,%d0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4a3da: 45f1 0800 lea %a1@(00000000,%d0:l),%a2 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 4a3de: b88a cmpl %a2,%d4 4a3e0: 6200 011e bhiw 4a500 <_Heap_Free+0x164> 4a3e4: b5e8 0024 cmpal %a0@(36),%a2 4a3e8: 53c1 sls %d1 4a3ea: 49c1 extbl %d1 4a3ec: 4481 negl %d1 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 4a3ee: 4a01 tstb %d1 4a3f0: 6700 010e beqw 4a500 <_Heap_Free+0x164> 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; 4a3f4: 222a 0004 movel %a2@(4),%d1 _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 4a3f8: 7401 moveq #1,%d2 4a3fa: c481 andl %d1,%d2 4a3fc: 4a02 tstb %d2 4a3fe: 6700 0100 beqw 4a500 <_Heap_Free+0x164> - 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; 4a402: 74fe moveq #-2,%d2 return false; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4a404: 2668 0024 moveal %a0@(36),%a3 4a408: c282 andl %d2,%d1 _HAssert( false ); return false; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 4a40a: b7ca cmpal %a2,%a3 4a40c: 6604 bnes 4a412 <_Heap_Free+0x76> 4a40e: 4282 clrl %d2 4a410: 6010 bras 4a422 <_Heap_Free+0x86> 4a412: 7401 moveq #1,%d2 4a414: 7a01 moveq #1,%d5 4a416: c4b2 1804 andl %a2@(00000004,%d1:l),%d2 4a41a: bb82 eorl %d5,%d2 4a41c: 0282 0000 00ff andil #255,%d2 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { 4a422: 7a01 moveq #1,%d5 4a424: c685 andl %d5,%d3 4a426: 4a03 tstb %d3 4a428: 6662 bnes 4a48c <_Heap_Free+0xf0> uintptr_t const prev_size = block->prev_size; 4a42a: 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); 4a42c: 93c3 subal %d3,%a1 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 4a42e: b889 cmpl %a1,%d4 4a430: 6200 00ce bhiw 4a500 <_Heap_Free+0x164> 4a434: b3cb cmpal %a3,%a1 4a436: 53c4 sls %d4 4a438: 49c4 extbl %d4 4a43a: 4484 negl %d4 Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { 4a43c: 4a04 tstb %d4 4a43e: 6700 00c0 beqw 4a500 <_Heap_Free+0x164> 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) ) { 4a442: 7801 moveq #1,%d4 4a444: c8a9 0004 andl %a1@(4),%d4 4a448: 4a04 tstb %d4 4a44a: 6700 00b4 beqw 4a500 <_Heap_Free+0x164> _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4a44e: 4a02 tstb %d2 4a450: 6726 beqs 4a478 <_Heap_Free+0xdc> uintptr_t const size = block_size + prev_size + next_block_size; 4a452: d280 addl %d0,%d1 4a454: d681 addl %d1,%d3 _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4a456: 53a8 0038 subql #1,%a0@(56) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4a45a: 7201 moveq #1,%d1 } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; 4a45c: 266a 000c moveal %a2@(12),%a3 4a460: 8283 orl %d3,%d1 return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 4a462: 246a 0008 moveal %a2@(8),%a2 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 4a466: 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; 4a46a: 2341 0004 movel %d1,%a1@(4) Heap_Block *prev = block->prev; prev->next = next; next->prev = prev; 4a46e: 254b 000c movel %a3,%a2@(12) RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 4a472: 274a 0008 movel %a2,%a3@(8) 4a476: 6078 bras 4a4f0 <_Heap_Free+0x154> 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; 4a478: d680 addl %d0,%d3 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4a47a: 7401 moveq #1,%d2 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4a47c: 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; 4a47e: 8483 orl %d3,%d2 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; 4a480: 2483 movel %d3,%a2@ 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; 4a482: 2342 0004 movel %d2,%a1@(4) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4a486: cbaa 0004 andl %d5,%a2@(4) 4a48a: 6064 bras 4a4f0 <_Heap_Free+0x154> next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4a48c: 4a02 tstb %d2 4a48e: 6728 beqs 4a4b8 <_Heap_Free+0x11c> Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; 4a490: 266a 000c moveal %a2@(12),%a3 uintptr_t const size = block_size + next_block_size; 4a494: d280 addl %d0,%d1 _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4a496: 7401 moveq #1,%d2 RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace( Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; 4a498: 246a 0008 moveal %a2@(8),%a2 Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; 4a49c: 234b 000c movel %a3,%a1@(12) 4a4a0: 8481 orl %d1,%d2 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; 4a4a2: 234a 0008 movel %a2,%a1@(8) next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4a4a6: 2381 1800 movel %d1,%a1@(00000000,%d1: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; 4a4aa: 2342 0004 movel %d2,%a1@(4) new_block->prev = prev; next->prev = new_block; 4a4ae: 2549 000c movel %a1,%a2@(12) prev->next = new_block; 4a4b2: 2749 0008 movel %a1,%a3@(8) 4a4b6: 6038 bras 4a4f0 <_Heap_Free+0x154> 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; 4a4b8: 7a01 moveq #1,%d5 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4a4ba: 72fe moveq #-2,%d1 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; 4a4bc: 8a80 orl %d0,%d5 RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; 4a4be: 2668 0008 moveal %a0@(8),%a3 4a4c2: 2345 0004 movel %d5,%a1@(4) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4a4c6: c3aa 0004 andl %d1,%a2@(4) next_block->prev_size = block_size; 4a4ca: 2480 movel %d0,%a2@ /* Statistics */ ++stats->free_blocks; 4a4cc: 2228 0038 movel %a0@(56),%d1 4a4d0: 5281 addql #1,%d1 new_block->next = next; 4a4d2: 234b 0008 movel %a3,%a1@(8) new_block->prev = block_before; 4a4d6: 2348 000c movel %a0,%a1@(12) block_before->next = new_block; 4a4da: 2149 0008 movel %a1,%a0@(8) next->prev = new_block; 4a4de: 2749 000c movel %a1,%a3@(12) 4a4e2: 2141 0038 movel %d1,%a0@(56) #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { Heap_Statistics *const stats = &heap->stats; 4a4e6: b2a8 003c cmpl %a0@(60),%d1 4a4ea: 6304 blss 4a4f0 <_Heap_Free+0x154> 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; 4a4ec: 2141 003c movel %d1,%a0@(60) } /* Statistics */ --stats->used_blocks; ++stats->frees; stats->free_size += block_size; 4a4f0: d1a8 0030 addl %d0,%a0@(48) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4a4f4: 53a8 0040 subql #1,%a0@(64) ++stats->frees; 4a4f8: 52a8 0050 addql #1,%a0@(80) stats->free_size += block_size; 4a4fc: 7001 moveq #1,%d0 return( true ); 4a4fe: 6002 bras 4a502 <_Heap_Free+0x166> 4a500: 4200 clrb %d0 } 4a502: 4cd7 0c3c moveml %sp@,%d2-%d5/%a2-%a3 4a506: 4e5e unlk %fp 4a508: 4e75 rts ... 00063b88 <_Heap_Get_free_information>: void _Heap_Get_free_information( Heap_Control *the_heap, Heap_Information *info ) { 63b88: 4e56 0000 linkw %fp,#0 63b8c: 206e 000c moveal %fp@(12),%a0 63b90: 2f0a movel %a2,%sp@- 63b92: 246e 0008 moveal %fp@(8),%a2 Heap_Block *the_block; Heap_Block *const tail = _Heap_Free_list_tail(the_heap); info->number = 0; 63b96: 4290 clrl %a0@ return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 63b98: 226a 0008 moveal %a2@(8),%a1 info->largest = 0; 63b9c: 42a8 0004 clrl %a0@(4) info->total = 0; 63ba0: 42a8 0008 clrl %a0@(8) for(the_block = _Heap_Free_list_first(the_heap); 63ba4: 601a bras 63bc0 <_Heap_Get_free_information+0x38> - 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; 63ba6: 70fe moveq #-2,%d0 63ba8: c0a9 0004 andl %a1@(4),%d0 uint32_t const the_size = _Heap_Block_size(the_block); /* As we always coalesce free blocks, prev block must have been used. */ _HAssert(_Heap_Is_prev_used(the_block)); info->number++; 63bac: 5290 addql #1,%a0@ info->total += the_size; 63bae: d1a8 0008 addl %d0,%a0@(8) if ( info->largest < the_size ) 63bb2: b0a8 0004 cmpl %a0@(4),%d0 63bb6: 6304 blss 63bbc <_Heap_Get_free_information+0x34> info->largest = the_size; 63bb8: 2140 0004 movel %d0,%a0@(4) info->largest = 0; info->total = 0; for(the_block = _Heap_Free_list_first(the_heap); the_block != tail; the_block = the_block->next) 63bbc: 2269 0008 moveal %a1@(8),%a1 info->number = 0; info->largest = 0; info->total = 0; for(the_block = _Heap_Free_list_first(the_heap); 63bc0: b5c9 cmpal %a1,%a2 63bc2: 66e2 bnes 63ba6 <_Heap_Get_free_information+0x1e> info->number++; info->total += the_size; if ( info->largest < the_size ) info->largest = the_size; } } 63bc4: 245f moveal %sp@+,%a2 63bc6: 4e5e unlk %fp 63bc8: 4e75 rts ... 00059754 <_Heap_Resize_block>: void *alloc_begin_ptr, uintptr_t new_alloc_size, uintptr_t *old_size, uintptr_t *new_size ) { 59754: 4e56 ffe0 linkw %fp,#-32 59758: 48d7 1c7c moveml %d2-%d6/%a2-%a4,%sp@ 5975c: 242e 000c movel %fp@(12),%d2 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 ) 59760: 2202 movel %d2,%d1 59762: 2042 moveal %d2,%a0 59764: 5188 subql #8,%a0 59766: 246e 0008 moveal %fp@(8),%a2 5976a: 286e 0014 moveal %fp@(20),%a4 5976e: 4c6a 1000 0010 remul %a2@(16),%d0,%d1 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; 59774: 4294 clrl %a4@ void *alloc_begin_ptr, uintptr_t new_alloc_size, uintptr_t *old_size, uintptr_t *new_size ) { 59776: 266e 0018 moveal %fp@(24),%a3 5977a: 91c0 subal %d0,%a0 5977c: 2a2e 0010 movel %fp@(16),%d5 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; 59780: 4293 clrl %a3@ 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 59782: b1ea 0020 cmpal %a2@(32),%a0 59786: 6500 0096 bcsw 5981e <_Heap_Resize_block+0xca> 5978a: b1ea 0024 cmpal %a2@(36),%a0 5978e: 6200 008e bhiw 5981e <_Heap_Resize_block+0xca> - 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; 59792: 70fe moveq #-2,%d0 59794: 72fe moveq #-2,%d1 RTEMS_INLINE_ROUTINE bool _Heap_Is_free( const Heap_Block *block ) { return !_Heap_Is_used( block ); 59796: 7801 moveq #1,%d4 59798: 7c01 moveq #1,%d6 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_BLOCK_SIZE_OFFSET; 5979a: 7604 moveq #4,%d3 5979c: 9682 subl %d2,%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; 5979e: c0a8 0004 andl %a0@(4),%d0 { 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; 597a2: 43f0 0800 lea %a0@(00000000,%d0:l),%a1 uintptr_t alloc_size = block_end - alloc_begin + HEAP_BLOCK_SIZE_OFFSET; 597a6: d689 addl %a1,%d3 597a8: c2a9 0004 andl %a1@(4),%d1 RTEMS_INLINE_ROUTINE bool _Heap_Is_free( const Heap_Block *block ) { return !_Heap_Is_used( block ); 597ac: c8b1 1804 andl %a1@(00000004,%d1:l),%d4 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; 597b0: 2883 movel %d3,%a4@ 597b2: bd84 eorl %d6,%d4 597b4: 1c04 moveb %d4,%d6 if ( next_block_is_free ) { 597b6: 6704 beqs 597bc <_Heap_Resize_block+0x68> block_size += next_block_size; 597b8: d081 addl %d1,%d0 alloc_size += next_block_size; 597ba: d681 addl %d1,%d3 } if ( new_alloc_size > alloc_size ) { 597bc: b685 cmpl %d5,%d3 597be: 6404 bccs 597c4 <_Heap_Resize_block+0x70> 597c0: 7001 moveq #1,%d0 597c2: 605c bras 59820 <_Heap_Resize_block+0xcc> return HEAP_RESIZE_UNSATISFIED; } if ( next_block_is_free ) { 597c4: 4a06 tstb %d6 597c6: 672a beqs 597f2 <_Heap_Resize_block+0x9e> uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; block->size_and_flag = size | flag; 597c8: 7601 moveq #1,%d3 597ca: c6a8 0004 andl %a0@(4),%d3 } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; 597ce: 2869 000c moveal %a1@(12),%a4 uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; block->size_and_flag = size | flag; 597d2: 8680 orl %d0,%d3 return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 597d4: 2269 0008 moveal %a1@(8),%a1 uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; block->size_and_flag = size | flag; 597d8: 2143 0004 movel %d3,%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; 597dc: 7601 moveq #1,%d3 597de: 87b0 0804 orl %d3,%a0@(00000004,%d0:l) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; next->prev = prev; 597e2: 234c 000c movel %a4,%a1@(12) /* Statistics */ --stats->free_blocks; stats->free_size -= next_block_size; 597e6: 93aa 0030 subl %d1,%a2@(48) next_block = _Heap_Block_at( block, block_size ); next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; /* Statistics */ --stats->free_blocks; 597ea: 53aa 0038 subql #1,%a2@(56) RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 597ee: 2949 0008 movel %a1,%a4@(8) stats->free_size -= next_block_size; } block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size ); 597f2: 2f05 movel %d5,%sp@- 597f4: 2f02 movel %d2,%sp@- 597f6: 2f08 movel %a0,%sp@- 597f8: 2f0a movel %a2,%sp@- 597fa: 4eb9 0004 5ee2 jsr 45ee2 <_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_BLOCK_SIZE_OFFSET; /* Statistics */ ++stats->resizes; 59800: 4fef 0010 lea %sp@(16),%sp 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_BLOCK_SIZE_OFFSET; 59804: 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 ); 59806: 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_BLOCK_SIZE_OFFSET; 59808: 2240 moveal %d0,%a1 5980a: 93c2 subal %d2,%a1 /* Statistics */ ++stats->resizes; 5980c: 4280 clrl %d0 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_BLOCK_SIZE_OFFSET; 5980e: c2a8 0004 andl %a0@(4),%d1 59812: 43f1 1804 lea %a1@(00000004,%d1:l),%a1 59816: 2689 movel %a1,%a3@ /* Statistics */ ++stats->resizes; 59818: 52aa 0054 addql #1,%a2@(84) 5981c: 6002 bras 59820 <_Heap_Resize_block+0xcc> 5981e: 7002 moveq #2,%d0 new_size ); } else { return HEAP_RESIZE_FATAL_ERROR; } } 59820: 4cee 1c7c ffe0 moveml %fp@(-32),%d2-%d6/%a2-%a4 59826: 4e5e unlk %fp 59828: 4e75 rts ... 00046cc4 <_Heap_Walk_print>: { /* Do nothing */ } static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { 46cc4: 41f9 0004 3474 lea 43474 ,%a0 46cca: 4e56 0000 linkw %fp,#0 46cce: 202e 0008 movel %fp@(8),%d0 va_list ap; if ( error ) { 46cd2: 4a2e 000f tstb %fp@(15) 46cd6: 670a beqs 46ce2 <_Heap_Walk_print+0x1e> printk( "FAIL[%d]: ", source ); 46cd8: 2f00 movel %d0,%sp@- 46cda: 4879 0005 b723 pea 5b723 46ce0: 6008 bras 46cea <_Heap_Walk_print+0x26> } else { printk( "PASS[%d]: ", source ); 46ce2: 2f00 movel %d0,%sp@- 46ce4: 4879 0005 b72e pea 5b72e 46cea: 4e90 jsr %a0@ 46cec: 508f addql #8,%sp } va_start( ap, fmt ); vprintk( fmt, ap ); 46cee: 486e 0014 pea %fp@(20) 46cf2: 2f2e 0010 movel %fp@(16),%sp@- 46cf6: 4eb9 0004 4df8 jsr 44df8 46cfc: 508f addql #8,%sp va_end( ap ); } 46cfe: 4e5e unlk %fp 46d00: 4e75 rts ... 00045fd8 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 45fd8: 4e56 0000 linkw %fp,#0 45fdc: 222e 000c movel %fp@(12),%d1 45fe0: 2f03 movel %d3,%sp@- _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 45fe2: 4283 clrl %d3 45fe4: 1601 moveb %d1,%d3 void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 45fe6: 2f02 movel %d2,%sp@- 45fe8: 242e 0010 movel %fp@(16),%d2 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 45fec: 2f02 movel %d2,%sp@- void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 45fee: 202e 0008 movel %fp@(8),%d0 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 45ff2: 2f03 movel %d3,%sp@- _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 45ff4: 263c 0000 0700 movel #1792,%d3 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 45ffa: 2f00 movel %d0,%sp@- Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; 45ffc: 13c1 0005 cd3e moveb %d1,5cd3e <_Internal_errors_What_happened+0x4> bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; 46002: 23c0 0005 cd3a movel %d0,5cd3a <_Internal_errors_What_happened> _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; 46008: 23c2 0005 cd40 movel %d2,5cd40 <_Internal_errors_What_happened+0x6> _User_extensions_Fatal( the_source, is_internal, the_error ); 4600e: 4eb9 0004 7b02 jsr 47b02 <_User_extensions_Fatal> _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 46014: 40c0 movew %sr,%d0 46016: 8083 orl %d3,%d0 46018: 46c0 movew %d0,%sr 4601a: 2002 movel %d2,%d0 <== NOT EXECUTED 4601c: 223c dead beef movel #-559038737,%d1 <== NOT EXECUTED 46022: 4ac8 halt <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 46024: 7005 moveq #5,%d0 46026: 4fef 000c lea %sp@(12),%sp 4602a: 23c0 0005 ce1c movel %d0,5ce1c <_System_state_Current> 46030: 60fe bras 46030 <_Internal_error_Occurred+0x58> ... 0004cc78 <_Message_queue_Translate_core_message_queue_return_code>: }; rtems_status_code _Message_queue_Translate_core_message_queue_return_code ( uint32_t status ) { 4cc78: 41f9 0006 49e4 lea 649e4 <_Message_queue_Translate_core_return_code_>,%a0 4cc7e: 4e56 0000 linkw %fp,#0 if ( status > CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ) return RTEMS_INTERNAL_ERROR; #endif return _Message_queue_Translate_core_return_code_[status]; } 4cc82: 202e 0008 movel %fp@(8),%d0 4cc86: 4e5e unlk %fp 4cc88: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4cc8c: 4e75 rts ... 0004a50c <_Objects_API_maximum_class>: case OBJECTS_NO_API: default: break; } return 0; } 4a50c: 7203 moveq #3,%d1 #include unsigned int _Objects_API_maximum_class( uint32_t api ) { 4a50e: 4e56 0000 linkw %fp,#0 case OBJECTS_NO_API: default: break; } return 0; } 4a512: 202e 0008 movel %fp@(8),%d0 4a516: 5380 subql #1,%d0 4a518: b280 cmpl %d0,%d1 4a51a: 6404 bccs 4a520 <_Objects_API_maximum_class+0x14> 4a51c: 4280 clrl %d0 4a51e: 600a bras 4a52a <_Objects_API_maximum_class+0x1e> 4a520: 41f9 0005 a984 lea 5a984 ,%a0 4a526: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4a52a: 4e5e unlk %fp 4a52c: 4e75 rts ... 0004609c <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 4609c: 4e56 fff0 linkw %fp,#-16 460a0: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ 460a4: 246e 0008 moveal %fp@(8),%a2 * If the application is using the optional manager stubs and * still attempts to create the object, the information block * should be all zeroed out because it is in the BSS. So let's * check that code for this manager is even present. */ if ( information->size == 0 ) 460a8: 4aaa 0014 tstl %a2@(20) 460ac: 6604 bnes 460b2 <_Objects_Allocate+0x16> 460ae: 4280 clrl %d0 <== NOT EXECUTED 460b0: 605e bras 46110 <_Objects_Allocate+0x74> <== NOT EXECUTED /* * OK. The manager should be initialized and configured to have objects. * With any luck, it is safe to attempt to allocate an object. */ the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 460b2: 240a movel %a2,%d2 460b4: 0682 0000 001c addil #28,%d2 460ba: 47f9 0004 a008 lea 4a008 <_Chain_Get>,%a3 460c0: 2f02 movel %d2,%sp@- 460c2: 4e93 jsr %a3@ if ( information->auto_extend ) { 460c4: 588f addql #4,%sp 460c6: 4a2a 0010 tstb %a2@(16) 460ca: 6744 beqs 46110 <_Objects_Allocate+0x74> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { 460cc: 4a80 tstl %d0 460ce: 6612 bnes 460e2 <_Objects_Allocate+0x46> _Objects_Extend_information( information ); 460d0: 2f0a movel %a2,%sp@- 460d2: 4eb9 0004 6148 jsr 46148 <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 460d8: 2f02 movel %d2,%sp@- 460da: 4e93 jsr %a3@ } if ( the_object ) { 460dc: 508f addql #8,%sp 460de: 4a80 tstl %d0 460e0: 672e beqs 46110 <_Objects_Allocate+0x74> uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 460e2: 2040 moveal %d0,%a0 460e4: 4281 clrl %d1 460e6: 4283 clrl %d3 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 460e8: 4282 clrl %d2 } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 460ea: 362a 0008 movew %a2@(8),%d3 460ee: 3228 000a movew %a0@(10),%d1 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 460f2: 342a 0012 movew %a2@(18),%d2 information->inactive--; 460f6: 306a 0028 moveaw %a2@(40),%a0 } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 460fa: 9283 subl %d3,%d1 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 460fc: 4c42 1001 remul %d2,%d1,%d1 information->inactive--; 46100: 5388 subql #1,%a0 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 46102: e589 lsll #2,%d1 information->inactive--; 46104: 3548 0028 movew %a0,%a2@(40) block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 46108: 206a 002a moveal %a2@(42),%a0 4610c: d1c1 addal %d1,%a0 4610e: 5390 subql #1,%a0@ information->inactive--; } } return the_object; } 46110: 4cee 0c0c fff0 moveml %fp@(-16),%d2-%d3/%a2-%a3 46116: 4e5e unlk %fp 46118: 4e75 rts ... 0004611c <_Objects_Close>: #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4611c: 4280 clrl %d0 void _Objects_Close( Objects_Information *information, Objects_Control *the_object ) { 4611e: 4e56 0000 linkw %fp,#0 46122: 226e 000c moveal %fp@(12),%a1 46126: 206e 0008 moveal %fp@(8),%a0 4612a: 2f0a movel %a2,%sp@- 4612c: 2468 0018 moveal %a0@(24),%a2 46130: 3029 000a movew %a1@(10),%d0 46134: 42b2 0c00 clrl %a2@(00000000,%d0:l:4) _Objects_Invalidate_Id( information, the_object ); _Objects_Namespace_remove( information, the_object ); 46138: 2d49 000c movel %a1,%fp@(12) } 4613c: 245f moveal %sp@+,%a2 4613e: 4e5e unlk %fp Objects_Control *the_object ) { _Objects_Invalidate_Id( information, the_object ); _Objects_Namespace_remove( information, the_object ); 46140: 4ef9 0004 6640 jmp 46640 <_Objects_Namespace_remove> ... 00046148 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { 46148: 4e56 ffc8 linkw %fp,#-56 4614c: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 46150: 246e 0008 moveal %fp@(8),%a2 /* * Search for a free block of indexes. The block variable ends up set * to block_count + 1 if the table needs to be extended. */ minimum_index = _Objects_Get_index( information->minimum_id ); 46154: 4283 clrl %d3 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 46156: 206a 002e moveal %a2@(46),%a0 /* * Search for a free block of indexes. The block variable ends up set * to block_count + 1 if the table needs to be extended. */ minimum_index = _Objects_Get_index( information->minimum_id ); 4615a: 362a 0008 movew %a2@(8),%d3 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 4615e: 4a88 tstl %a0 46160: 6608 bnes 4616a <_Objects_Extend_information+0x22> 46162: 2403 movel %d3,%d2 46164: 4284 clrl %d4 46166: 4285 clrl %d5 46168: 602a bras 46194 <_Objects_Extend_information+0x4c> block_count = 0; else { block_count = information->maximum / information->allocation_size; 4616a: 4280 clrl %d0 4616c: 2403 movel %d3,%d2 4616e: 4284 clrl %d4 46170: 302a 0012 movew %a2@(18),%d0 46174: 3a2a 000e movew %a2@(14),%d5 46178: 0285 0000 ffff andil #65535,%d5 4617e: 8ac0 divuw %d0,%d5 46180: 0285 0000 ffff andil #65535,%d5 for ( ; block < block_count; block++ ) { 46186: 6008 bras 46190 <_Objects_Extend_information+0x48> if ( information->object_blocks[ block ] == NULL ) 46188: 4a98 tstl %a0@+ 4618a: 6708 beqs 46194 <_Objects_Extend_information+0x4c> 4618c: d480 addl %d0,%d2 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 4618e: 5284 addql #1,%d4 46190: ba84 cmpl %d4,%d5 46192: 62f4 bhis 46188 <_Objects_Extend_information+0x40> else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 46194: 4280 clrl %d0 46196: 4287 clrl %d7 46198: 302a 0012 movew %a2@(18),%d0 4619c: 3e2a 000e movew %a2@(14),%d7 461a0: de80 addl %d0,%d7 /* * 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 ) { 461a2: 0c87 0000 ffff cmpil #65535,%d7 461a8: 6200 01da bhiw 46384 <_Objects_Extend_information+0x23c> /* * 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; 461ac: 41ea 0014 lea %a2@(20),%a0 461b0: 4c10 0800 mulsl %a0@,%d0 if ( information->auto_extend ) { 461b4: 4a2a 0010 tstb %a2@(16) 461b8: 6712 beqs 461cc <_Objects_Extend_information+0x84> new_object_block = _Workspace_Allocate( block_size ); 461ba: 2f00 movel %d0,%sp@- 461bc: 4eb9 0004 7e90 jsr 47e90 <_Workspace_Allocate> if ( !new_object_block ) 461c2: 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 ); 461c4: 2c00 movel %d0,%d6 if ( !new_object_block ) 461c6: 6610 bnes 461d8 <_Objects_Extend_information+0x90> 461c8: 6000 01ba braw 46384 <_Objects_Extend_information+0x23c> return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); 461cc: 2f00 movel %d0,%sp@- 461ce: 4eb9 0004 7e5c jsr 47e5c <_Workspace_Allocate_or_fatal_error> 461d4: 588f addql #4,%sp 461d6: 2c00 movel %d0,%d6 } /* * If the index_base is the maximum we need to grow the tables. */ if (index_base >= information->maximum ) { 461d8: 4280 clrl %d0 461da: 302a 000e movew %a2@(14),%d0 461de: b082 cmpl %d2,%d0 461e0: 6200 0112 bhiw 462f4 <_Objects_Extend_information+0x1ac> */ /* * Up the block count and maximum */ block_count++; 461e4: 2845 moveal %d5,%a4 461e6: 528c addql #1,%a4 * 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 ); 461e8: 2007 movel %d7,%d0 461ea: d083 addl %d3,%d0 461ec: 41f4 ca00 lea %a4@(00000000,%a4:l:2),%a0 461f0: d088 addl %a0,%d0 461f2: e588 lsll #2,%d0 461f4: 2f00 movel %d0,%sp@- 461f6: 4eb9 0004 7e90 jsr 47e90 <_Workspace_Allocate> if ( !object_blocks ) { 461fc: 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 ); 461fe: 2640 moveal %d0,%a3 if ( !object_blocks ) { 46200: 4a80 tstl %d0 46202: 660e bnes 46212 <_Objects_Extend_information+0xca> _Workspace_Free( new_object_block ); 46204: 2f06 movel %d6,%sp@- 46206: 4eb9 0004 7eac jsr 47eac <_Workspace_Free> return; 4620c: 588f addql #4,%sp 4620e: 6000 0174 braw 46384 <_Objects_Extend_information+0x23c> } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( 46212: 200c movel %a4,%d0 46214: e588 lsll #2,%d0 46216: 2840 moveal %d0,%a4 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 46218: 4280 clrl %d0 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); 4621a: 4bf3 c800 lea %a3@(00000000,%a4:l),%a5 4621e: 49f5 c800 lea %a5@(00000000,%a4:l),%a4 46222: 302a 000e movew %a2@(14),%d0 46226: b680 cmpl %d0,%d3 46228: 6506 bcss 46230 <_Objects_Extend_information+0xe8> 4622a: 204c moveal %a4,%a0 4622c: 4280 clrl %d0 4622e: 604a bras 4627a <_Objects_Extend_information+0x132> /* * 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, 46230: 2205 movel %d5,%d1 46232: e589 lsll #2,%d1 46234: 2f01 movel %d1,%sp@- 46236: 2f2a 002e movel %a2@(46),%sp@- 4623a: 2d41 fff0 movel %d1,%fp@(-16) 4623e: 2f0b movel %a3,%sp@- 46240: 4eb9 0004 d23c jsr 4d23c information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, 46246: 222e fff0 movel %fp@(-16),%d1 4624a: 2f01 movel %d1,%sp@- 4624c: 2f2a 002a movel %a2@(42),%sp@- 46250: 2f0d movel %a5,%sp@- 46252: 4eb9 0004 d23c jsr 4d23c information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 46258: 4280 clrl %d0 4625a: 302a 000e movew %a2@(14),%d0 4625e: d680 addl %d0,%d3 46260: e58b lsll #2,%d3 46262: 2f03 movel %d3,%sp@- 46264: 2f2a 0018 movel %a2@(24),%sp@- 46268: 2f0c movel %a4,%sp@- 4626a: 4eb9 0004 d23c jsr 4d23c 46270: 4fef 0024 lea %sp@(36),%sp 46274: 6008 bras 4627e <_Objects_Extend_information+0x136> /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { local_table[ index ] = NULL; 46276: 4298 clrl %a0@+ } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 46278: 5280 addql #1,%d0 4627a: b680 cmpl %d0,%d3 4627c: 62f8 bhis 46276 <_Objects_Extend_information+0x12e> */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 4627e: 4281 clrl %d1 46280: 2002 movel %d2,%d0 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 46282: e58d lsll #2,%d5 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 46284: 322a 0012 movew %a2@(18),%d1 46288: 41f4 2c00 lea %a4@(00000000,%d2:l:4),%a0 /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; 4628c: 42b5 5800 clrl %a5@(00000000,%d5:l) for ( index=index_base ; index < ( information->allocation_size + index_base ); 46290: d282 addl %d2,%d1 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 46292: 42b3 5800 clrl %a3@(00000000,%d5:l) inactive_per_block[block_count] = 0; for ( index=index_base ; 46296: 6004 bras 4629c <_Objects_Extend_information+0x154> index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; 46298: 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++ ) { 4629a: 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 ; 4629c: b280 cmpl %d0,%d1 4629e: 62f8 bhis 46298 <_Objects_Extend_information+0x150> index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; } _ISR_Disable( level ); 462a0: 203c 0000 0700 movel #1792,%d0 462a6: 40c3 movew %sr,%d3 462a8: 8083 orl %d3,%d0 462aa: 46c0 movew %d0,%sr 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( 462ac: 2012 movel %a2@,%d0 462ae: 7218 moveq #24,%d1 462b0: 4285 clrl %d5 462b2: e3a8 lsll %d1,%d0 462b4: 3a07 movew %d7,%d5 462b6: 4281 clrl %d1 462b8: 2245 moveal %d5,%a1 462ba: 7a1b moveq #27,%d5 462bc: 322a 0004 movew %a2@(4),%d1 462c0: 08c0 0010 bset #16,%d0 old_tables = information->object_blocks; information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; 462c4: 3547 000e movew %d7,%a2@(14) information->maximum_id = _Objects_Build_id( 462c8: eba9 lsll %d5,%d1 462ca: 2e09 movel %a1,%d7 462cc: 8081 orl %d1,%d0 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; 462ce: 206a 002e moveal %a2@(46),%a0 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( 462d2: 8e80 orl %d0,%d7 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; 462d4: 254b 002e movel %a3,%a2@(46) information->inactive_per_block = inactive_per_block; 462d8: 254d 002a movel %a5,%a2@(42) information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 462dc: 2547 000a movel %d7,%a2@(10) old_tables = information->object_blocks; information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; 462e0: 254c 0018 movel %a4,%a2@(24) information->the_class, _Objects_Local_node, information->maximum ); _ISR_Enable( level ); 462e4: 46c3 movew %d3,%sr if ( old_tables ) 462e6: 4a88 tstl %a0 462e8: 670a beqs 462f4 <_Objects_Extend_information+0x1ac> _Workspace_Free( old_tables ); 462ea: 2f08 movel %a0,%sp@- 462ec: 4eb9 0004 7eac jsr 47eac <_Workspace_Free> 462f2: 588f addql #4,%sp } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 462f4: 206a 002e moveal %a2@(46),%a0 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 462f8: 4281 clrl %d1 462fa: 200e movel %fp,%d0 462fc: 0680 ffff fff4 addil #-12,%d0 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 46302: 2a00 movel %d0,%d5 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 46304: 260a movel %a2,%d3 46306: 0683 0000 001c addil #28,%d3 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 4630c: 49f9 0004 a008 lea 4a008 <_Chain_Get>,%a4 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 46312: 47f9 0004 58d0 lea 458d0 <_Chain_Append>,%a3 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 46318: e58c lsll #2,%d4 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 4631a: 322a 0012 movew %a2@(18),%d1 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 4631e: 2186 4800 movel %d6,%a0@(00000000,%d4:l) /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 46322: 2f2a 0014 movel %a2@(20),%sp@- 46326: 2f01 movel %d1,%sp@- 46328: 2f06 movel %d6,%sp@- 4632a: 2f00 movel %d0,%sp@- 4632c: 4eb9 0004 a03c jsr 4a03c <_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 ) { 46332: 4fef 0010 lea %sp@(16),%sp 46336: 6028 bras 46360 <_Objects_Extend_information+0x218> the_object->id = _Objects_Build_id( 46338: 2212 movel %a2@,%d1 4633a: 7c18 moveq #24,%d6 4633c: 7e1b moveq #27,%d7 4633e: 2040 moveal %d0,%a0 46340: eda9 lsll %d6,%d1 46342: 4286 clrl %d6 46344: 3c2a 0004 movew %a2@(4),%d6 46348: 08c1 0010 bset #16,%d1 4634c: efae lsll %d7,%d6 4634e: 8286 orl %d6,%d1 46350: 8282 orl %d2,%d1 index ); _Chain_Append( &information->Inactive, &the_object->Node ); index++; 46352: 5282 addql #1,%d2 */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { the_object->id = _Objects_Build_id( 46354: 2141 0008 movel %d1,%a0@(8) information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 46358: 2f00 movel %d0,%sp@- 4635a: 2f03 movel %d3,%sp@- 4635c: 4e93 jsr %a3@ index++; 4635e: 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 ) { 46360: 2f05 movel %d5,%sp@- 46362: 4e94 jsr %a4@ 46364: 588f addql #4,%sp 46366: 4a80 tstl %d0 46368: 66ce bnes 46338 <_Objects_Extend_information+0x1f0> _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 4636a: 4280 clrl %d0 information->inactive = 4636c: 322a 0028 movew %a2@(40),%d1 46370: 326a 0012 moveaw %a2@(18),%a1 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 46374: 206a 002a moveal %a2@(42),%a0 information->inactive = 46378: d289 addl %a1,%d1 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 4637a: 3009 movew %a1,%d0 information->inactive = 4637c: 3541 0028 movew %d1,%a2@(40) _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 46380: 2180 4800 movel %d0,%a0@(00000000,%d4:l) information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); } 46384: 4cee 3cfc ffc8 moveml %fp@(-56),%d2-%d7/%a2-%a5 4638a: 4e5e unlk %fp 4638c: 4e75 rts ... 00046440 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint32_t the_class ) { 46440: 4e56 0000 linkw %fp,#0 46444: 2f03 movel %d3,%sp@- 46446: 262e 0008 movel %fp@(8),%d3 4644a: 2f02 movel %d2,%sp@- 4644c: 242e 000c movel %fp@(12),%d2 Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 46450: 672e beqs 46480 <_Objects_Get_information+0x40> /* * 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 ); 46452: 2f03 movel %d3,%sp@- 46454: 4eb9 0004 a50c jsr 4a50c <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) 4645a: 588f addql #4,%sp 4645c: 4a80 tstl %d0 4645e: 6720 beqs 46480 <_Objects_Get_information+0x40> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 46460: b082 cmpl %d2,%d0 46462: 651c bcss 46480 <_Objects_Get_information+0x40> return NULL; if ( !_Objects_Information_table[ the_api ] ) 46464: 41f9 0005 cc4c lea 5cc4c <_Objects_Information_table>,%a0 4646a: 2070 3c00 moveal %a0@(00000000,%d3:l:4),%a0 4646e: 4a88 tstl %a0 46470: 670e beqs 46480 <_Objects_Get_information+0x40> return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 46472: 2030 2c00 movel %a0@(00000000,%d2:l:4),%d0 if ( !info ) 46476: 670a beqs 46482 <_Objects_Get_information+0x42> * In a multprocessing configuration, we may access remote objects. * Thus we may have 0 local instances and still have a valid object * pointer. */ #if !defined(RTEMS_MULTIPROCESSING) if ( info->maximum == 0 ) 46478: 2040 moveal %d0,%a0 4647a: 4a68 000e tstw %a0@(14) 4647e: 6602 bnes 46482 <_Objects_Get_information+0x42> 46480: 4280 clrl %d0 return NULL; #endif return info; } 46482: 242e fff8 movel %fp@(-8),%d2 46486: 262e fffc movel %fp@(-4),%d3 4648a: 4e5e unlk %fp 4648c: 4e75 rts ... 00053090 <_Objects_Get_next>: Objects_Information *information, Objects_Id id, Objects_Locations *location_p, Objects_Id *next_id_p ) { 53090: 4e56 ffec linkw %fp,#-20 53094: 48d7 3c04 moveml %d2/%a2-%a5,%sp@ 53098: 266e 0008 moveal %fp@(8),%a3 5309c: 242e 000c movel %fp@(12),%d2 530a0: 246e 0010 moveal %fp@(16),%a2 530a4: 286e 0014 moveal %fp@(20),%a4 Objects_Control *object; Objects_Id next_id; if ( !information ) 530a8: 4a8b tstl %a3 530aa: 6746 beqs 530f2 <_Objects_Get_next+0x62> return NULL; if ( !location_p ) 530ac: 4a8a tstl %a2 530ae: 6742 beqs 530f2 <_Objects_Get_next+0x62> return NULL; if ( !next_id_p ) 530b0: 4a8c tstl %a4 530b2: 673e beqs 530f2 <_Objects_Get_next+0x62> return NULL; if (_Objects_Get_index(id) == OBJECTS_ID_INITIAL_INDEX) 530b4: 4a42 tstw %d2 530b6: 6604 bnes 530bc <_Objects_Get_next+0x2c> next_id = information->minimum_id; 530b8: 242b 0006 movel %a3@(6),%d2 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 530bc: 4bf9 0004 9e20 lea 49e20 <_Objects_Get>,%a5 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) 530c2: 4281 clrl %d1 530c4: 4280 clrl %d0 530c6: 322b 000e movew %a3@(14),%d1 530ca: 3002 movew %d2,%d0 530cc: b081 cmpl %d1,%d0 530ce: 630c blss 530dc <_Objects_Get_next+0x4c> { *location_p = OBJECTS_ERROR; 530d0: 7401 moveq #1,%d2 *next_id_p = next_id; return object; final: *next_id_p = OBJECTS_ID_FINAL; 530d2: 72ff moveq #-1,%d1 530d4: 4280 clrl %d0 do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) { *location_p = OBJECTS_ERROR; 530d6: 2482 movel %d2,%a2@ *next_id_p = next_id; return object; final: *next_id_p = OBJECTS_ID_FINAL; 530d8: 2881 movel %d1,%a4@ return 0; 530da: 6018 bras 530f4 <_Objects_Get_next+0x64> *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 530dc: 2f0a movel %a2,%sp@- 530de: 2f02 movel %d2,%sp@- next_id++; 530e0: 5282 addql #1,%d2 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 530e2: 2f0b movel %a3,%sp@- 530e4: 4e95 jsr %a5@ next_id++; } while (*location_p != OBJECTS_LOCAL); 530e6: 4fef 000c lea %sp@(12),%sp 530ea: 4a92 tstl %a2@ 530ec: 66d4 bnes 530c2 <_Objects_Get_next+0x32> *next_id_p = next_id; 530ee: 2882 movel %d2,%a4@ return object; 530f0: 6002 bras 530f4 <_Objects_Get_next+0x64> final: *next_id_p = OBJECTS_ID_FINAL; return 0; 530f2: 4280 clrl %d0 } 530f4: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 530fa: 4e5e unlk %fp 530fc: 4e75 rts ... 00049e80 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 49e80: 4e56 fffc linkw %fp,#-4 49e84: 222e 0008 movel %fp@(8),%d1 49e88: 2f02 movel %d2,%sp@- /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 49e8a: 4a81 tstl %d1 49e8c: 660a bnes 49e98 <_Objects_Id_to_name+0x18> 49e8e: 2079 0006 85a6 moveal 685a6 <_Thread_Executing>,%a0 49e94: 2228 0008 movel %a0@(8),%d1 */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); 49e98: 7418 moveq #24,%d2 49e9a: 2001 movel %d1,%d0 49e9c: e4a8 lsrl %d2,%d0 49e9e: 143c 0007 moveb #7,%d2 49ea2: c082 andl %d2,%d0 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) 49ea4: 143c 0003 moveb #3,%d2 49ea8: 2040 moveal %d0,%a0 49eaa: 5388 subql #1,%a0 49eac: b488 cmpl %a0,%d2 49eae: 6540 bcss 49ef0 <_Objects_Id_to_name+0x70> 49eb0: 6048 bras 49efa <_Objects_Id_to_name+0x7a> if ( !_Objects_Information_table[ the_api ] ) return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 49eb2: 2001 movel %d1,%d0 49eb4: 741b moveq #27,%d2 49eb6: e4a8 lsrl %d2,%d0 49eb8: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0 if ( !information ) 49ebc: 4a88 tstl %a0 49ebe: 6730 beqs 49ef0 <_Objects_Id_to_name+0x70> return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 49ec0: 4a28 0032 tstb %a0@(50) 49ec4: 662a bnes 49ef0 <_Objects_Id_to_name+0x70> return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 49ec6: 486e fffc pea %fp@(-4) 49eca: 2f01 movel %d1,%sp@- 49ecc: 2f08 movel %a0,%sp@- 49ece: 4eb9 0004 9e20 jsr 49e20 <_Objects_Get> if ( !the_object ) 49ed4: 4fef 000c lea %sp@(12),%sp 49ed8: 4a80 tstl %d0 49eda: 6714 beqs 49ef0 <_Objects_Id_to_name+0x70> return OBJECTS_INVALID_ID; *name = the_object->name; 49edc: 206e 000c moveal %fp@(12),%a0 49ee0: 2240 moveal %d0,%a1 49ee2: 20a9 000c movel %a1@(12),%a0@ _Thread_Enable_dispatch(); 49ee6: 4eb9 0004 a71e jsr 4a71e <_Thread_Enable_dispatch> 49eec: 4280 clrl %d0 return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 49eee: 6002 bras 49ef2 <_Objects_Id_to_name+0x72> 49ef0: 7003 moveq #3,%d0 } 49ef2: 242e fff8 movel %fp@(-8),%d2 49ef6: 4e5e unlk %fp 49ef8: 4e75 rts the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 49efa: 41f9 0006 84a4 lea 684a4 <_Objects_Information_table>,%a0 49f00: 2070 0c00 moveal %a0@(00000000,%d0:l:4),%a0 49f04: 4a88 tstl %a0 49f06: 66aa bnes 49eb2 <_Objects_Id_to_name+0x32> 49f08: 60e6 bras 49ef0 <_Objects_Id_to_name+0x70> ... 00050684 <_Objects_Name_to_id_string>: Objects_Name_or_id_lookup_errors _Objects_Name_to_id_string( Objects_Information *information, const char *name, Objects_Id *id ) { 50684: 4e56 ffe4 linkw %fp,#-28 50688: 48d7 3c1c moveml %d2-%d4/%a2-%a5,%sp@ 5068c: 266e 0008 moveal %fp@(8),%a3 50690: 262e 000c movel %fp@(12),%d3 50694: 286e 0010 moveal %fp@(16),%a4 uint32_t index; uint32_t name_length; /* ASSERT: information->is_string == true */ if ( !id ) 50698: 4a8c tstl %a4 5069a: 6604 bnes 506a0 <_Objects_Name_to_id_string+0x1c> 5069c: 7002 moveq #2,%d0 5069e: 6050 bras 506f0 <_Objects_Name_to_id_string+0x6c> return OBJECTS_INVALID_ADDRESS; if ( !name ) 506a0: 4a83 tstl %d3 506a2: 674a beqs 506ee <_Objects_Name_to_id_string+0x6a> return OBJECTS_INVALID_NAME; if ( information->maximum != 0 ) { 506a4: 382b 000e movew %a3@(14),%d4 506a8: 6744 beqs 506ee <_Objects_Name_to_id_string+0x6a> 506aa: 7401 moveq #1,%d2 continue; if ( !the_object->name.name_p ) continue; if (!strncmp( name, the_object->name.name_p, information->name_length)) { 506ac: 4bf9 0005 4274 lea 54274 ,%a5 return OBJECTS_INVALID_NAME; if ( information->maximum != 0 ) { name_length = information->name_length; for ( index = 1; index <= information->maximum; index++ ) { 506b2: 0284 0000 ffff andil #65535,%d4 506b8: 6030 bras 506ea <_Objects_Name_to_id_string+0x66> the_object = information->local_table[ index ]; 506ba: 206b 0018 moveal %a3@(24),%a0 506be: 2470 2c00 moveal %a0@(00000000,%d2:l:4),%a2 return OBJECTS_INVALID_NAME; if ( information->maximum != 0 ) { name_length = information->name_length; for ( index = 1; index <= information->maximum; index++ ) { 506c2: 5282 addql #1,%d2 the_object = information->local_table[ index ]; if ( !the_object ) 506c4: 4a8a tstl %a2 506c6: 6722 beqs 506ea <_Objects_Name_to_id_string+0x66> continue; if ( !the_object->name.name_p ) 506c8: 202a 000c movel %a2@(12),%d0 506cc: 671c beqs 506ea <_Objects_Name_to_id_string+0x66> continue; if (!strncmp( name, the_object->name.name_p, information->name_length)) { 506ce: 4281 clrl %d1 506d0: 322b 0034 movew %a3@(52),%d1 506d4: 2f01 movel %d1,%sp@- 506d6: 2f00 movel %d0,%sp@- 506d8: 2f03 movel %d3,%sp@- 506da: 4e95 jsr %a5@ 506dc: 4fef 000c lea %sp@(12),%sp 506e0: 4a80 tstl %d0 506e2: 6606 bnes 506ea <_Objects_Name_to_id_string+0x66> *id = the_object->id; 506e4: 28aa 0008 movel %a2@(8),%a4@ return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 506e8: 6006 bras 506f0 <_Objects_Name_to_id_string+0x6c> return OBJECTS_INVALID_NAME; if ( information->maximum != 0 ) { name_length = information->name_length; for ( index = 1; index <= information->maximum; index++ ) { 506ea: b882 cmpl %d2,%d4 506ec: 64cc bccs 506ba <_Objects_Name_to_id_string+0x36> 506ee: 7001 moveq #1,%d0 } } } return OBJECTS_INVALID_NAME; } 506f0: 4cee 3c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a5 506f6: 4e5e unlk %fp 506f8: 4e75 rts ... 00046a50 <_Objects_Set_name>: { size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a50: 4280 clrl %d0 bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 46a52: 4e56 ffe0 linkw %fp,#-32 46a56: 48d7 3c3c moveml %d2-%d5/%a2-%a5,%sp@ 46a5a: 2a6e 0008 moveal %fp@(8),%a5 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a5e: 302d 0034 movew %a5@(52),%d0 bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 46a62: 246e 0010 moveal %fp@(16),%a2 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a66: 2f00 movel %d0,%sp@- bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 46a68: 286e 000c moveal %fp@(12),%a4 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a6c: 2f0a movel %a2,%sp@- 46a6e: 4eb9 0004 e554 jsr 4e554 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 46a74: 508f addql #8,%sp { size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 46a76: 2640 moveal %d0,%a3 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 46a78: 4a2d 0032 tstb %a5@(50) 46a7c: 6748 beqs 46ac6 <_Objects_Set_name+0x76> char *d; d = _Workspace_Allocate( length + 1 ); 46a7e: 486b 0001 pea %a3@(1) 46a82: 4eb9 0004 82d4 jsr 482d4 <_Workspace_Allocate> if ( !d ) 46a88: 588f addql #4,%sp #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { char *d; d = _Workspace_Allocate( length + 1 ); 46a8a: 2a40 moveal %d0,%a5 if ( !d ) 46a8c: 4a80 tstl %d0 46a8e: 6604 bnes 46a94 <_Objects_Set_name+0x44> 46a90: 4200 clrb %d0 <== NOT EXECUTED 46a92: 6076 bras 46b0a <_Objects_Set_name+0xba> <== NOT EXECUTED return false; if ( the_object->name.name_p ) { 46a94: 202c 000c movel %a4@(12),%d0 46a98: 670e beqs 46aa8 <_Objects_Set_name+0x58> _Workspace_Free( (void *)the_object->name.name_p ); 46a9a: 2f00 movel %d0,%sp@- 46a9c: 4eb9 0004 82f0 jsr 482f0 <_Workspace_Free> the_object->name.name_p = NULL; 46aa2: 588f addql #4,%sp 46aa4: 42ac 000c clrl %a4@(12) } strncpy( d, name, length ); 46aa8: 2f0b movel %a3,%sp@- 46aaa: 2f0a movel %a2,%sp@- 46aac: 2f0d movel %a5,%sp@- 46aae: 4eb9 0004 e4cc jsr 4e4cc d[length] = '\0'; the_object->name.name_p = d; 46ab4: 4fef 000c lea %sp@(12),%sp _Workspace_Free( (void *)the_object->name.name_p ); the_object->name.name_p = NULL; } strncpy( d, name, length ); d[length] = '\0'; 46ab8: 4200 clrb %d0 46aba: 1b80 b800 moveb %d0,%a5@(00000000,%a3:l) the_object->name.name_p = d; 46abe: 7001 moveq #1,%d0 46ac0: 294d 000c movel %a5,%a4@(12) 46ac4: 6044 bras 46b0a <_Objects_Set_name+0xba> } else #endif { the_object->name.name_u32 = _Objects_Build_name( 46ac6: 7201 moveq #1,%d1 46ac8: 1012 moveb %a2@,%d0 46aca: b28b cmpl %a3,%d1 46acc: 6446 bccs 46b14 <_Objects_Set_name+0xc4> 46ace: 7602 moveq #2,%d3 46ad0: 142a 0001 moveb %a2@(1),%d2 46ad4: 49c2 extbl %d2 46ad6: 4842 swap %d2 46ad8: 4242 clrw %d2 46ada: b68b cmpl %a3,%d3 46adc: 643a bccs 46b18 <_Objects_Set_name+0xc8> 46ade: 7a03 moveq #3,%d5 46ae0: 122a 0002 moveb %a2@(2),%d1 46ae4: 49c1 extbl %d1 46ae6: e189 lsll #8,%d1 46ae8: ba8b cmpl %a3,%d5 46aea: 6506 bcss 46af2 <_Objects_Set_name+0xa2> 46aec: 163c 0020 moveb #32,%d3 46af0: 6006 bras 46af8 <_Objects_Set_name+0xa8> 46af2: 162a 0003 moveb %a2@(3),%d3 46af6: 49c3 extbl %d3 46af8: 2800 movel %d0,%d4 46afa: 7a18 moveq #24,%d5 46afc: ebac lsll %d5,%d4 46afe: 7001 moveq #1,%d0 46b00: 8484 orl %d4,%d2 46b02: 8481 orl %d1,%d2 46b04: 8483 orl %d3,%d2 46b06: 2942 000c movel %d2,%a4@(12) ); } return true; } 46b0a: 4cee 3c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a5 46b10: 4e5e unlk %fp 46b12: 4e75 rts d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( 46b14: 7420 moveq #32,%d2 46b16: 4842 swap %d2 46b18: 223c 0000 2000 movel #8192,%d1 46b1e: 7620 moveq #32,%d3 46b20: 60d6 bras 46af8 <_Objects_Set_name+0xa8> ... 000466e0 <_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) / 466e0: 4280 clrl %d0 466e2: 4281 clrl %d1 */ void _Objects_Shrink_information( Objects_Information *information ) { 466e4: 4e56 ffec linkw %fp,#-20 466e8: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 466ec: 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 ); 466f0: 4283 clrl %d3 block_count = (information->maximum - index_base) / 466f2: 4284 clrl %d4 /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); 466f4: 362a 0008 movew %a2@(8),%d3 block_count = (information->maximum - index_base) / 466f8: 302a 000e movew %a2@(14),%d0 466fc: 322a 0012 movew %a2@(18),%d1 46700: 9083 subl %d3,%d0 46702: 4c41 0000 remul %d1,%d0,%d0 information->allocation_size; for ( block = 0; block < block_count; block++ ) { 46706: 6070 bras 46778 <_Objects_Shrink_information+0x98> 46708: 2404 movel %d4,%d2 4670a: 5284 addql #1,%d4 4670c: e58a lsll #2,%d2 if ( information->inactive_per_block[ block ] == 4670e: 206a 002a moveal %a2@(42),%a0 46712: b2b0 2800 cmpl %a0@(00000000,%d2:l),%d1 46716: 665e bnes 46776 <_Objects_Shrink_information+0x96> information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) information->Inactive.first; 46718: 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 ); 4671c: 47f9 0004 9fe0 lea 49fe0 <_Chain_Extract>,%a3 * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) information->Inactive.first; do { index = _Objects_Get_index( the_object->id ); 46722: 4280 clrl %d0 46724: 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; 46728: 2810 movel %a0@,%d4 if ((index >= index_base) && 4672a: b680 cmpl %d0,%d3 4672c: 6212 bhis 46740 <_Objects_Shrink_information+0x60> (index < (index_base + information->allocation_size))) { 4672e: 4281 clrl %d1 46730: 322a 0012 movew %a2@(18),%d1 46734: d283 addl %d3,%d1 46736: b280 cmpl %d0,%d1 46738: 6306 blss 46740 <_Objects_Shrink_information+0x60> _Chain_Extract( &extract_me->Node ); 4673a: 2f08 movel %a0,%sp@- 4673c: 4e93 jsr %a3@ 4673e: 588f addql #4,%sp } } while ( the_object ); 46740: 2044 moveal %d4,%a0 46742: 4a84 tstl %d4 46744: 66dc bnes 46722 <_Objects_Shrink_information+0x42> /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); 46746: 206a 002e moveal %a2@(46),%a0 4674a: 2f30 2800 movel %a0@(00000000,%d2:l),%sp@- 4674e: 4eb9 0004 7eac jsr 47eac <_Workspace_Free> information->object_blocks[ block ] = NULL; 46754: 206a 002e moveal %a2@(46),%a0 information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; return; 46758: 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; information->inactive_per_block[ block ] = 0; 4675a: 226a 002a moveal %a2@(42),%a1 information->inactive -= information->allocation_size; 4675e: 302a 0028 movew %a2@(40),%d0 46762: 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; 46766: 42b1 2800 clrl %a1@(00000000,%d2:l) information->inactive -= information->allocation_size; 4676a: 9081 subl %d1,%d0 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; 4676c: 42b0 2800 clrl %a0@(00000000,%d2:l) information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; 46770: 3540 0028 movew %d0,%a2@(40) return; 46774: 6006 bras 4677c <_Objects_Shrink_information+0x9c> } index_base += information->allocation_size; 46776: d681 addl %d1,%d3 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 46778: b084 cmpl %d4,%d0 4677a: 628c bhis 46708 <_Objects_Shrink_information+0x28> return; } index_base += information->allocation_size; } } 4677c: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 46782: 4e5e unlk %fp 46784: 4e75 rts ... 000495f8 <_POSIX_Barrier_Manager_initialization>: /** * @brief _POSIX_Barrier_Manager_initialization */ void _POSIX_Barrier_Manager_initialization(void) { 495f8: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 495fc: 4878 00ff pea ff 49600: 4878 0001 pea 1 49604: 4878 005c pea 5c 49608: 2f39 0005 baf6 movel 5baf6 ,%sp@- 4960e: 4878 000a pea a 49612: 4878 0003 pea 3 49616: 4879 0005 cfd6 pea 5cfd6 <_POSIX_Barrier_Information> 4961c: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49622: 4fef 001c lea %sp@(28),%sp , false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 49626: 4e5e unlk %fp 49628: 4e75 rts ... 0004a76c <_POSIX_Barrier_Translate_core_barrier_return_code>: int _POSIX_Barrier_Translate_core_barrier_return_code( CORE_barrier_Status the_barrier_status ) { 4a76c: 41f9 0005 bcb0 lea 5bcb0 <_POSIX_Barrier_Return_codes>,%a0 4a772: 4e56 0000 linkw %fp,#0 #if defined(RTEMS_DEBUG) if ( the_barrier_status > CORE_BARRIER_STATUS_LAST ) return EINVAL; #endif return _POSIX_Barrier_Return_codes[the_barrier_status]; } 4a776: 202e 0008 movel %fp@(8),%d0 4a77a: 4e5e unlk %fp 4a77c: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4a780: 4e75 rts ... 000459ec <_POSIX_Condition_variables_Get>: POSIX_Condition_variables_Control *_POSIX_Condition_variables_Get ( pthread_cond_t *cond, Objects_Locations *location ) { 459ec: 4e56 0000 linkw %fp,#0 459f0: 2f0b movel %a3,%sp@- 459f2: 266e 000c moveal %fp@(12),%a3 459f6: 2f0a movel %a2,%sp@- 459f8: 246e 0008 moveal %fp@(8),%a2 int status; if ( !cond ) { 459fc: 4a8a tstl %a2 459fe: 6716 beqs 45a16 <_POSIX_Condition_variables_Get+0x2a> *location = OBJECTS_ERROR; return (POSIX_Condition_variables_Control *) 0; } if ( *cond == PTHREAD_COND_INITIALIZER ) { 45a00: 70ff moveq #-1,%d0 45a02: b092 cmpl %a2@,%d0 45a04: 6618 bnes 45a1e <_POSIX_Condition_variables_Get+0x32> /* * Do an "auto-create" here. */ status = pthread_cond_init( cond, 0 ); 45a06: 42a7 clrl %sp@- 45a08: 2f0a movel %a2,%sp@- 45a0a: 4eb9 0004 5a40 jsr 45a40 if ( status ) { 45a10: 508f addql #8,%sp 45a12: 4a80 tstl %d0 45a14: 6708 beqs 45a1e <_POSIX_Condition_variables_Get+0x32> *location = OBJECTS_ERROR; 45a16: 7001 moveq #1,%d0 45a18: 2680 movel %d0,%a3@ 45a1a: 4280 clrl %d0 return (POSIX_Condition_variables_Control *) 0; 45a1c: 6014 bras 45a32 <_POSIX_Condition_variables_Get+0x46> } /* * Now call Objects_Get() */ return (POSIX_Condition_variables_Control *)_Objects_Get( 45a1e: 2f0b movel %a3,%sp@- 45a20: 2f12 movel %a2@,%sp@- 45a22: 4879 0005 f592 pea 5f592 <_POSIX_Condition_variables_Information> 45a28: 4eb9 0004 821c jsr 4821c <_Objects_Get> 45a2e: 4fef 000c lea %sp@(12),%sp &_POSIX_Condition_variables_Information, (Objects_Id) *cond, location ); } 45a32: 246e fff8 moveal %fp@(-8),%a2 45a36: 266e fffc moveal %fp@(-4),%a3 45a3a: 4e5e unlk %fp 45a3c: 4e75 rts ... 000494d0 <_POSIX_Condition_variables_Manager_initialization>: * * Output parameters: NONE */ void _POSIX_Condition_variables_Manager_initialization(void) { 494d0: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 494d4: 4878 00ff pea ff 494d8: 4878 0001 pea 1 494dc: 4878 0058 pea 58 494e0: 2f39 0005 bada movel 5bada ,%sp@- 494e6: 4878 0008 pea 8 494ea: 4878 0003 pea 3 494ee: 4879 0005 d062 pea 5d062 <_POSIX_Condition_variables_Information> 494f4: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 494fa: 4fef 001c lea %sp@(28),%sp , false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 494fe: 4e5e unlk %fp 49500: 4e75 rts ... 00045af8 <_POSIX_Condition_variables_Signal_support>: int _POSIX_Condition_variables_Signal_support( pthread_cond_t *cond, bool is_broadcast ) { 45af8: 4e56 ffec linkw %fp,#-20 45afc: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; Thread_Control *the_thread; the_cond = _POSIX_Condition_variables_Get( cond, &location ); 45b00: 486e fffc pea %fp@(-4) 45b04: 2f2e 0008 movel %fp@(8),%sp@- int _POSIX_Condition_variables_Signal_support( pthread_cond_t *cond, bool is_broadcast ) { 45b08: 162e 000f moveb %fp@(15),%d3 register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; Thread_Control *the_thread; the_cond = _POSIX_Condition_variables_Get( cond, &location ); 45b0c: 4eb9 0004 59ec jsr 459ec <_POSIX_Condition_variables_Get> switch ( location ) { 45b12: 508f addql #8,%sp { register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; Thread_Control *the_thread; the_cond = _POSIX_Condition_variables_Get( cond, &location ); 45b14: 2440 moveal %d0,%a2 switch ( location ) { 45b16: 4aae fffc tstl %fp@(-4) 45b1a: 6704 beqs 45b20 <_POSIX_Condition_variables_Signal_support+0x28> 45b1c: 7016 moveq #22,%d0 45b1e: 602c bras 45b4c <_POSIX_Condition_variables_Signal_support+0x54> case OBJECTS_LOCAL: do { the_thread = _Thread_queue_Dequeue( &the_cond->Wait_queue ); 45b20: 2400 movel %d0,%d2 45b22: 0682 0000 0018 addil #24,%d2 45b28: 47f9 0004 8cf0 lea 48cf0 <_Thread_queue_Dequeue>,%a3 45b2e: 2f02 movel %d2,%sp@- 45b30: 4e93 jsr %a3@ if ( !the_thread ) 45b32: 588f addql #4,%sp 45b34: 4a80 tstl %d0 45b36: 6604 bnes 45b3c <_POSIX_Condition_variables_Signal_support+0x44> the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; 45b38: 42aa 0014 clrl %a2@(20) } while ( is_broadcast && the_thread ); 45b3c: 4a03 tstb %d3 45b3e: 6704 beqs 45b44 <_POSIX_Condition_variables_Signal_support+0x4c> 45b40: 4a80 tstl %d0 45b42: 66ea bnes 45b2e <_POSIX_Condition_variables_Signal_support+0x36> _Thread_Enable_dispatch(); 45b44: 4eb9 0004 89a6 jsr 489a6 <_Thread_Enable_dispatch> 45b4a: 4280 clrl %d0 case OBJECTS_ERROR: break; } return EINVAL; } 45b4c: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 45b52: 4e5e unlk %fp 45b54: 4e75 rts ... 00049504 <_POSIX_Key_Manager_initialization>: * * Output parameters: NONE */ void _POSIX_Key_Manager_initialization(void) { 49504: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 49508: 4878 00ff pea ff 4950c: 4878 0001 pea 1 49510: 4878 0028 pea 28 49514: 2f39 0005 bade movel 5bade ,%sp@- 4951a: 4878 0002 pea 2 4951e: 4878 0003 pea 3 49522: 4879 0005 d028 pea 5d028 <_POSIX_Keys_Information> 49528: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 4952e: 4fef 001c lea %sp@(28),%sp , false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 49532: 4e5e unlk %fp 49534: 4e75 rts ... 0004b794 <_POSIX_Keys_Run_destructors>: */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); 4b794: 7218 moveq #24,%d1 */ void _POSIX_Keys_Run_destructors( Thread_Control *thread ) { 4b796: 4e56 ffe8 linkw %fp,#-24 uint32_t iterations; bool are_all_null; POSIX_Keys_Control *the_key; void *value; thread_index = _Objects_Get_index( thread->Object.id ); 4b79a: 206e 0008 moveal %fp@(8),%a0 */ void _POSIX_Keys_Run_destructors( Thread_Control *thread ) { 4b79e: 48d7 047c moveml %d2-%d6/%a2,%sp@ uint32_t iterations; bool are_all_null; POSIX_Keys_Control *the_key; void *value; thread_index = _Objects_Get_index( thread->Object.id ); 4b7a2: 2428 0008 movel %a0@(8),%d2 4b7a6: 2002 movel %d2,%d0 4b7a8: e2a8 lsrl %d1,%d0 4b7aa: 123c 0007 moveb #7,%d1 if ( !the_key ) continue; if ( !the_key->destructor ) continue; value = the_key->Values[ thread_api ][ thread_index ]; 4b7ae: 4284 clrl %d4 4b7b0: 0282 0000 ffff andil #65535,%d2 4b7b6: c081 andl %d1,%d0 4b7b8: e58a lsll #2,%d2 4b7ba: 2c00 movel %d0,%d6 4b7bc: 5a86 addql #5,%d6 4b7be: 7601 moveq #1,%d3 4b7c0: 7a01 moveq #1,%d5 for ( ; ; ) { are_all_null = true; for ( index=1 ; index <= _POSIX_Keys_Information.maximum ; index++ ) { 4b7c2: 6034 bras 4b7f8 <_POSIX_Keys_Run_destructors+0x64> the_key = (POSIX_Keys_Control *) 4b7c4: 2079 0005 d040 moveal 5d040 <_POSIX_Keys_Information+0x18>,%a0 4b7ca: 2470 3c00 moveal %a0@(00000000,%d3:l:4),%a2 for ( ; ; ) { are_all_null = true; for ( index=1 ; index <= _POSIX_Keys_Information.maximum ; index++ ) { 4b7ce: 5283 addql #1,%d3 the_key = (POSIX_Keys_Control *) _POSIX_Keys_Information.local_table[ index ]; if ( !the_key ) 4b7d0: 4a8a tstl %a2 4b7d2: 6724 beqs 4b7f8 <_POSIX_Keys_Run_destructors+0x64> continue; if ( !the_key->destructor ) 4b7d4: 206a 0010 moveal %a2@(16),%a0 4b7d8: 4a88 tstl %a0 4b7da: 671c beqs 4b7f8 <_POSIX_Keys_Run_destructors+0x64> continue; value = the_key->Values[ thread_api ][ thread_index ]; 4b7dc: 2272 6c00 moveal %a2@(00000000,%d6:l:4),%a1 4b7e0: 2031 2800 movel %a1@(00000000,%d2:l),%d0 if ( value ) { 4b7e4: 6712 beqs 4b7f8 <_POSIX_Keys_Run_destructors+0x64> (*the_key->destructor)( value ); 4b7e6: 2f00 movel %d0,%sp@- 4b7e8: 4e90 jsr %a0@ if ( the_key->Values[ thread_api ][ thread_index ] ) 4b7ea: 588f addql #4,%sp 4b7ec: 2072 6c00 moveal %a2@(00000000,%d6:l:4),%a0 4b7f0: 4ab0 2800 tstl %a0@(00000000,%d2:l) 4b7f4: 57c0 seq %d0 4b7f6: ca80 andl %d0,%d5 for ( ; ; ) { are_all_null = true; for ( index=1 ; index <= _POSIX_Keys_Information.maximum ; index++ ) { 4b7f8: 4280 clrl %d0 4b7fa: 3039 0005 d036 movew 5d036 <_POSIX_Keys_Information+0xe>,%d0 4b800: b083 cmpl %d3,%d0 4b802: 64c0 bccs 4b7c4 <_POSIX_Keys_Run_destructors+0x30> if ( the_key->Values[ thread_api ][ thread_index ] ) are_all_null = false; } } if ( are_all_null == true ) 4b804: 4a05 tstb %d5 4b806: 6608 bnes 4b810 <_POSIX_Keys_Run_destructors+0x7c> return; iterations++; 4b808: 5284 addql #1,%d4 * loop. It seems rude to unnecessarily lock up a system. * * Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99. */ if ( iterations >= PTHREAD_DESTRUCTOR_ITERATIONS ) 4b80a: 7004 moveq #4,%d0 4b80c: b084 cmpl %d4,%d0 4b80e: 66ae bnes 4b7be <_POSIX_Keys_Run_destructors+0x2a> return; } } 4b810: 4cee 047c ffe8 moveml %fp@(-24),%d2-%d6/%a2 4b816: 4e5e unlk %fp 4b818: 4e75 rts ... 00049134 <_POSIX_Message_queue_Delete>: */ void _POSIX_Message_queue_Delete( POSIX_Message_queue_Control *the_mq ) { 49134: 4e56 0000 linkw %fp,#0 49138: 2f0a movel %a2,%sp@- 4913a: 246e 0008 moveal %fp@(8),%a2 if ( !the_mq->linked && !the_mq->open_count ) { 4913e: 4a2a 0015 tstb %a2@(21) 49142: 6636 bnes 4917a <_POSIX_Message_queue_Delete+0x46> 49144: 4aaa 0016 tstl %a2@(22) 49148: 6630 bnes 4917a <_POSIX_Message_queue_Delete+0x46> ); _Workspace_Free( (void *)the_object->name.name_p ); } #endif _Objects_Close( &_POSIX_Message_queue_Information, the_object ); 4914a: 2f0a movel %a2,%sp@- 4914c: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 49152: 4eb9 0004 bdbc jsr 4bdbc <_Objects_Close> _CORE_message_queue_Close( 49158: 4878 0005 pea 5 4915c: 42a7 clrl %sp@- 4915e: 486a 001a pea %a2@(26) 49162: 4eb9 0004 b234 jsr 4b234 <_CORE_message_queue_Close> RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free ( POSIX_Message_queue_Control *the_mq ) { _Objects_Free( &_POSIX_Message_queue_Information, &the_mq->Object ); 49168: 2f0a movel %a2,%sp@- 4916a: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 49170: 4eb9 0004 c030 jsr 4c030 <_Objects_Free> 49176: 4fef 001c lea %sp@(28),%sp ); _POSIX_Message_queue_Free( the_mq ); } } 4917a: 246e fffc moveal %fp@(-4),%a2 4917e: 4e5e unlk %fp 49180: 4e75 rts ... 0004948c <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4948c: 4e56 ffe4 linkw %fp,#-28 49490: 48d7 043c moveml %d2-%d5/%a2,%sp@ RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd *_POSIX_Message_queue_Get_fd ( mqd_t id, Objects_Locations *location ) { return (POSIX_Message_queue_Control_fd *) _Objects_Get( 49494: 486e fffc pea %fp@(-4) 49498: 242e 0008 movel %fp@(8),%d2 4949c: 2f02 movel %d2,%sp@- 4949e: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 494a4: 246e 0014 moveal %fp@(20),%a2 494a8: 262e 0018 movel %fp@(24),%d3 494ac: 4eb9 0004 c188 jsr 4c188 <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 494b2: 4fef 000c lea %sp@(12),%sp 494b6: 4aae fffc tstl %fp@(-4) 494ba: 6600 00c4 bnew 49580 <_POSIX_Message_queue_Receive_support+0xf4> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 494be: 2040 moveal %d0,%a0 494c0: 7803 moveq #3,%d4 494c2: 7a01 moveq #1,%d5 494c4: 2228 0014 movel %a0@(20),%d1 494c8: c881 andl %d1,%d4 494ca: ba84 cmpl %d4,%d5 494cc: 660a bnes 494d8 <_POSIX_Message_queue_Receive_support+0x4c> _Thread_Enable_dispatch(); 494ce: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> 494d4: 6000 00aa braw 49580 <_POSIX_Message_queue_Receive_support+0xf4> rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 494d8: 2240 moveal %d0,%a1 494da: 2069 0010 moveal %a1@(16),%a0 if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 494de: 2028 0066 movel %a0@(102),%d0 494e2: b0ae 0010 cmpl %fp@(16),%d0 494e6: 6318 blss 49500 <_POSIX_Message_queue_Receive_support+0x74> _Thread_Enable_dispatch(); 494e8: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); 494ee: 747a moveq #122,%d2 494f0: 4eb9 0005 2858 jsr 52858 <__errno> 494f6: 72ff moveq #-1,%d1 494f8: 2040 moveal %d0,%a0 494fa: 2082 movel %d2,%a0@ 494fc: 6000 0090 braw 4958e <_POSIX_Message_queue_Receive_support+0x102> length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 49500: 4a03 tstb %d3 49502: 6604 bnes 49508 <_POSIX_Message_queue_Receive_support+0x7c> 49504: 4200 clrb %d0 <== NOT EXECUTED 49506: 600c bras 49514 <_POSIX_Message_queue_Receive_support+0x88><== NOT EXECUTED do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 49508: 2001 movel %d1,%d0 4950a: 760e moveq #14,%d3 4950c: 7a01 moveq #1,%d5 4950e: e6a8 lsrl %d3,%d0 49510: bb80 eorl %d5,%d0 49512: c085 andl %d5,%d0 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 49514: 2f2e 001c movel %fp@(28),%sp@- 49518: 7201 moveq #1,%d1 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 4951a: 76ff moveq #-1,%d3 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4951c: c280 andl %d0,%d1 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 4951e: 2d43 fff8 movel %d3,%fp@(-8) do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 49522: 2f01 movel %d1,%sp@- 49524: 486e fff8 pea %fp@(-8) 49528: 2f2e 000c movel %fp@(12),%sp@- 4952c: 2f02 movel %d2,%sp@- 4952e: 4868 001a pea %a0@(26) 49532: 4eb9 0004 b2d0 jsr 4b2d0 <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 49538: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4953e: 2079 0006 4c6a moveal 64c6a <_Thread_Executing>,%a0 do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = 49544: 24a8 0024 movel %a0@(36),%a2@ 49548: 6c06 bges 49550 <_POSIX_Message_queue_Receive_support+0xc4> 4954a: 2a12 movel %a2@,%d5 4954c: 4485 negl %d5 4954e: 2485 movel %d5,%a2@ _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) 49550: 4fef 0018 lea %sp@(24),%sp 49554: 4aa8 0034 tstl %a0@(52) 49558: 6606 bnes 49560 <_POSIX_Message_queue_Receive_support+0xd4> return length_out; 4955a: 222e fff8 movel %fp@(-8),%d1 4955e: 602e bras 4958e <_POSIX_Message_queue_Receive_support+0x102> rtems_set_errno_and_return_minus_one( 49560: 4eb9 0005 2858 jsr 52858 <__errno> 49566: 2079 0006 4c6a moveal 64c6a <_Thread_Executing>,%a0 4956c: 2440 moveal %d0,%a2 4956e: 2f28 0034 movel %a0@(52),%sp@- 49572: 4eb9 0004 97b8 jsr 497b8 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 49578: 588f addql #4,%sp 4957a: 72ff moveq #-1,%d1 4957c: 2480 movel %d0,%a2@ 4957e: 600e bras 4958e <_POSIX_Message_queue_Receive_support+0x102> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 49580: 4eb9 0005 2858 jsr 52858 <__errno> 49586: 72ff moveq #-1,%d1 49588: 2040 moveal %d0,%a0 4958a: 7009 moveq #9,%d0 4958c: 2080 movel %d0,%a0@ } 4958e: 2001 movel %d1,%d0 49590: 4cee 043c ffe4 moveml %fp@(-28),%d2-%d5/%a2 49596: 4e5e unlk %fp 49598: 4e75 rts ... 000495c0 <_POSIX_Message_queue_Send_support>: /* * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) 495c0: 7020 moveq #32,%d0 size_t msg_len, uint32_t msg_prio, bool wait, Watchdog_Interval timeout ) { 495c2: 4e56 ffe8 linkw %fp,#-24 495c6: 48d7 043c moveml %d2-%d5/%a2,%sp@ 495ca: 242e 0008 movel %fp@(8),%d2 495ce: 262e 0014 movel %fp@(20),%d3 495d2: 282e 0018 movel %fp@(24),%d4 /* * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) 495d6: b083 cmpl %d3,%d0 495d8: 6412 bccs 495ec <_POSIX_Message_queue_Send_support+0x2c> rtems_set_errno_and_return_minus_one( EINVAL ); 495da: 4eb9 0005 2858 jsr 52858 <__errno> 495e0: 7416 moveq #22,%d2 495e2: 72ff moveq #-1,%d1 495e4: 2040 moveal %d0,%a0 495e6: 2082 movel %d2,%a0@ 495e8: 6000 00bc braw 496a6 <_POSIX_Message_queue_Send_support+0xe6> 495ec: 486e fffc pea %fp@(-4) 495f0: 2f02 movel %d2,%sp@- 495f2: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 495f8: 4eb9 0004 c188 jsr 4c188 <_Objects_Get> the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 495fe: 4fef 000c lea %sp@(12),%sp 49602: 4aae fffc tstl %fp@(-4) 49606: 6600 0090 bnew 49698 <_POSIX_Message_queue_Send_support+0xd8> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { 4960a: 2240 moveal %d0,%a1 4960c: 7a03 moveq #3,%d5 4960e: 2229 0014 movel %a1@(20),%d1 49612: ca81 andl %d1,%d5 49614: 6608 bnes 4961e <_POSIX_Message_queue_Send_support+0x5e> _Thread_Enable_dispatch(); 49616: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> 4961c: 607a bras 49698 <_POSIX_Message_queue_Send_support+0xd8> rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 4961e: 2240 moveal %d0,%a1 49620: 2069 0010 moveal %a1@(16),%a0 /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 49624: 4a04 tstb %d4 49626: 6604 bnes 4962c <_POSIX_Message_queue_Send_support+0x6c> 49628: 4200 clrb %d0 4962a: 600c bras 49638 <_POSIX_Message_queue_Send_support+0x78> do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4962c: 2001 movel %d1,%d0 4962e: 780e moveq #14,%d4 49630: 7201 moveq #1,%d1 49632: e8a8 lsrl %d4,%d0 49634: b380 eorl %d1,%d0 49636: c081 andl %d1,%d0 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( 49638: 2f2e 001c movel %fp@(28),%sp@- 4963c: 7801 moveq #1,%d4 4963e: 4483 negl %d3 49640: c880 andl %d0,%d4 49642: 2f04 movel %d4,%sp@- 49644: 2f03 movel %d3,%sp@- 49646: 42a7 clrl %sp@- 49648: 2f02 movel %d2,%sp@- 4964a: 2f2e 0010 movel %fp@(16),%sp@- 4964e: 2f2e 000c movel %fp@(12),%sp@- 49652: 4868 001a pea %a0@(26) 49656: 4eb9 0004 b40c jsr 4b40c <_CORE_message_queue_Submit> _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); 4965c: 4fef 0020 lea %sp@(32),%sp do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( 49660: 2400 movel %d0,%d2 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); 49662: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> * after it wakes up. The returned status is correct for * non-blocking operations but if we blocked, then we need * to look at the status in our TCB. */ if ( msg_status == CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT ) 49668: 7007 moveq #7,%d0 4966a: b082 cmpl %d2,%d0 4966c: 660a bnes 49678 <_POSIX_Message_queue_Send_support+0xb8> msg_status = _Thread_Executing->Wait.return_code; 4966e: 2079 0006 4c6a moveal 64c6a <_Thread_Executing>,%a0 49674: 2428 0034 movel %a0@(52),%d2 if ( !msg_status ) 49678: 4a82 tstl %d2 4967a: 6604 bnes 49680 <_POSIX_Message_queue_Send_support+0xc0> 4967c: 4281 clrl %d1 4967e: 6026 bras 496a6 <_POSIX_Message_queue_Send_support+0xe6> return msg_status; rtems_set_errno_and_return_minus_one( 49680: 4eb9 0005 2858 jsr 52858 <__errno> 49686: 2440 moveal %d0,%a2 49688: 2f02 movel %d2,%sp@- 4968a: 4eb9 0004 97b8 jsr 497b8 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 49690: 588f addql #4,%sp 49692: 72ff moveq #-1,%d1 49694: 2480 movel %d0,%a2@ 49696: 600e bras 496a6 <_POSIX_Message_queue_Send_support+0xe6> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 49698: 4eb9 0005 2858 jsr 52858 <__errno> 4969e: 72ff moveq #-1,%d1 496a0: 2040 moveal %d0,%a0 496a2: 7009 moveq #9,%d0 496a4: 2080 movel %d0,%a0@ } 496a6: 2001 movel %d1,%d0 496a8: 4cee 043c ffe8 moveml %fp@(-24),%d2-%d5/%a2 496ae: 4e5e unlk %fp 496b0: 4e75 rts ... 000497b8 <_POSIX_Message_queue_Translate_core_message_queue_return_code>: int _POSIX_Message_queue_Translate_core_message_queue_return_code( uint32_t the_message_queue_status ) { 497b8: 41f9 0006 1c98 lea 61c98 <_POSIX_Message_queue_Return_codes>,%a0 497be: 4e56 0000 linkw %fp,#0 #if defined(RTEMS_DEBUG) if ( the_message_queue_status > CORE_MESSAGE_QUEUE_STATUS_LAST ) return EINVAL; #endif return _POSIX_Message_queue_Return_codes[the_message_queue_status]; } 497c2: 202e 0008 movel %fp@(8),%d0 497c6: 4e5e unlk %fp 497c8: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 497cc: 4e75 rts ... 00046c38 <_POSIX_Mutex_Lock_support>: int _POSIX_Mutex_Lock_support( pthread_mutex_t *mutex, bool blocking, Watchdog_Interval timeout ) { 46c38: 4e56 fff8 linkw %fp,#-8 46c3c: 2f02 movel %d2,%sp@- register POSIX_Mutex_Control *the_mutex; Objects_Locations location; ISR_Level level; the_mutex = _POSIX_Mutex_Get_interrupt_disable( mutex, &location, &level ); 46c3e: 486e fff8 pea %fp@(-8) 46c42: 486e fffc pea %fp@(-4) 46c46: 2f2e 0008 movel %fp@(8),%sp@- int _POSIX_Mutex_Lock_support( pthread_mutex_t *mutex, bool blocking, Watchdog_Interval timeout ) { 46c4a: 142e 000f moveb %fp@(15),%d2 register POSIX_Mutex_Control *the_mutex; Objects_Locations location; ISR_Level level; the_mutex = _POSIX_Mutex_Get_interrupt_disable( mutex, &location, &level ); 46c4e: 4eb9 0004 6a14 jsr 46a14 <_POSIX_Mutex_Get_interrupt_disable> switch ( location ) { 46c54: 4fef 000c lea %sp@(12),%sp 46c58: 4aae fffc tstl %fp@(-4) 46c5c: 6704 beqs 46c62 <_POSIX_Mutex_Lock_support+0x2a> 46c5e: 7016 moveq #22,%d0 46c60: 6034 bras 46c96 <_POSIX_Mutex_Lock_support+0x5e> case OBJECTS_LOCAL: _CORE_mutex_Seize( 46c62: 2f2e fff8 movel %fp@(-8),%sp@- 46c66: 2040 moveal %d0,%a0 46c68: 2f2e 0010 movel %fp@(16),%sp@- 46c6c: 0282 0000 00ff andil #255,%d2 46c72: 2f02 movel %d2,%sp@- 46c74: 2f28 0008 movel %a0@(8),%sp@- 46c78: 4868 0014 pea %a0@(20) 46c7c: 4eb9 0004 8698 jsr 48698 <_CORE_mutex_Seize> the_mutex->Object.id, blocking, timeout, level ); return _POSIX_Mutex_Translate_core_mutex_return_code( 46c82: 2079 0006 184e moveal 6184e <_Thread_Executing>,%a0 46c88: 2f28 0034 movel %a0@(52),%sp@- 46c8c: 4eb9 0004 6d60 jsr 46d60 <_POSIX_Mutex_Translate_core_mutex_return_code> 46c92: 4fef 0018 lea %sp@(24),%sp case OBJECTS_ERROR: break; } return EINVAL; } 46c96: 242e fff4 movel %fp@(-12),%d2 46c9a: 4e5e unlk %fp 46c9c: 4e75 rts ... 00046d60 <_POSIX_Mutex_Translate_core_mutex_return_code>: int _POSIX_Mutex_Translate_core_mutex_return_code( CORE_mutex_Status the_mutex_status ) { 46d60: 41f9 0005 ed58 lea 5ed58 <_POSIX_Mutex_Return_codes>,%a0 46d66: 4e56 0000 linkw %fp,#0 #if defined(RTEMS_DEBUG) if ( the_mutex_status > CORE_MUTEX_STATUS_LAST ) return EINVAL; #endif return _POSIX_Mutex_Return_codes[the_mutex_status]; } 46d6a: 202e 0008 movel %fp@(8),%d0 46d6e: 4e5e unlk %fp 46d70: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 46d74: 4e75 rts ... 0004a88c <_POSIX_Priority_Is_valid>: #include bool _POSIX_Priority_Is_valid( int priority ) { 4a88c: 4e56 0000 linkw %fp,#0 4a890: 202e 0008 movel %fp@(8),%d0 return ((priority >= POSIX_SCHEDULER_MINIMUM_PRIORITY) && 4a894: 6e04 bgts 4a89a <_POSIX_Priority_Is_valid+0xe> 4a896: 4280 clrl %d0 4a898: 6010 bras 4a8aa <_POSIX_Priority_Is_valid+0x1e> 4a89a: 4281 clrl %d1 4a89c: 1239 0005 c516 moveb 5c516 ,%d1 4a8a2: b081 cmpl %d1,%d0 4a8a4: 5dc0 slt %d0 4a8a6: 49c0 extbl %d0 4a8a8: 4480 negl %d0 (priority <= POSIX_SCHEDULER_MAXIMUM_PRIORITY)); } 4a8aa: 4e5e unlk %fp 4a8ac: 4e75 rts ... 0004962c <_POSIX_RWLock_Manager_initialization>: /** * @brief _POSIX_RWLock_Manager_initialization */ void _POSIX_RWLock_Manager_initialization(void) { 4962c: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 49630: 4878 00ff pea ff 49634: 4878 0001 pea 1 49638: 4878 005c pea 5c 4963c: 2f39 0005 bafa movel 5bafa ,%sp@- 49642: 4878 000b pea b 49646: 4878 0003 pea 3 4964a: 4879 0005 ce40 pea 5ce40 <_POSIX_RWLock_Information> 49650: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49656: 4fef 001c lea %sp@(28),%sp , false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 4965a: 4e5e unlk %fp 4965c: 4e75 rts ... 00045e4c <_POSIX_RWLock_Translate_core_RWLock_return_code>: int _POSIX_RWLock_Translate_core_RWLock_return_code( CORE_RWLock_Status the_rwlock_status ) { 45e4c: 41f9 0005 cd1a lea 5cd1a <_POSIX_RWLock_Return_codes>,%a0 45e52: 4e56 0000 linkw %fp,#0 #if defined(RTEMS_DEBUG) if ( the_rwlock_status > CORE_RWLOCK_STATUS_LAST ) return EINVAL; #endif return _POSIX_RWLock_Return_codes[the_rwlock_status]; } 45e56: 202e 0008 movel %fp@(8),%d0 45e5a: 4e5e unlk %fp 45e5c: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 45e60: 4e75 rts ... 0004d448 <_POSIX_Semaphore_Create_support>: const char *name, int pshared, unsigned int value, POSIX_Semaphore_Control **the_sem ) { 4d448: 4e56 0000 linkw %fp,#0 4d44c: 2f0a movel %a2,%sp@- 4d44e: 2f02 movel %d2,%sp@- 4d450: 242e 0008 movel %fp@(8),%d2 POSIX_Semaphore_Control *the_semaphore; CORE_semaphore_Attributes *the_sem_attr; char *name_p = (char *)name; /* Sharing semaphores among processes is not currently supported */ if (pshared != 0) 4d454: 4aae 000c tstl %fp@(12) 4d458: 6712 beqs 4d46c <_POSIX_Semaphore_Create_support+0x24> rtems_set_errno_and_return_minus_one( ENOSYS ); 4d45a: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d460: 72ff moveq #-1,%d1 4d462: 2040 moveal %d0,%a0 4d464: 7058 moveq #88,%d0 4d466: 2080 movel %d0,%a0@ 4d468: 6000 00c6 braw 4d530 <_POSIX_Semaphore_Create_support+0xe8> if ( name ) { 4d46c: 4a82 tstl %d2 4d46e: 6728 beqs 4d498 <_POSIX_Semaphore_Create_support+0x50> if ( strnlen( name, NAME_MAX ) >= NAME_MAX ) 4d470: 4878 00ff pea ff 4d474: 2f02 movel %d2,%sp@- 4d476: 4eb9 0005 1cb0 jsr 51cb0 4d47c: 508f addql #8,%sp 4d47e: 0c80 0000 00fe cmpil #254,%d0 4d484: 6312 blss 4d498 <_POSIX_Semaphore_Create_support+0x50> rtems_set_errno_and_return_minus_one( ENAMETOOLONG ); 4d486: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d48c: 745b moveq #91,%d2 4d48e: 72ff moveq #-1,%d1 4d490: 2040 moveal %d0,%a0 4d492: 2082 movel %d2,%a0@ 4d494: 6000 009a braw 4d530 <_POSIX_Semaphore_Create_support+0xe8> 4d498: 2039 0006 1a90 movel 61a90 <_Thread_Dispatch_disable_level>,%d0 4d49e: 5280 addql #1,%d0 4d4a0: 23c0 0006 1a90 movel %d0,61a90 <_Thread_Dispatch_disable_level> * _POSIX_Semaphore_Allocate */ RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Allocate( void ) { return (POSIX_Semaphore_Control *) 4d4a6: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d4ac: 4eb9 0004 9654 jsr 49654 <_Objects_Allocate> _Thread_Disable_dispatch(); the_semaphore = _POSIX_Semaphore_Allocate(); if ( !the_semaphore ) { 4d4b2: 588f addql #4,%sp 4d4b4: 2440 moveal %d0,%a2 4d4b6: 4a80 tstl %d0 4d4b8: 6616 bnes 4d4d0 <_POSIX_Semaphore_Create_support+0x88> _Thread_Enable_dispatch(); 4d4ba: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( ENOSPC ); 4d4c0: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d4c6: 72ff moveq #-1,%d1 4d4c8: 2040 moveal %d0,%a0 4d4ca: 701c moveq #28,%d0 4d4cc: 2080 movel %d0,%a0@ 4d4ce: 6060 bras 4d530 <_POSIX_Semaphore_Create_support+0xe8> } the_semaphore->process_shared = pshared; 4d4d0: 42aa 0010 clrl %a2@(16) if ( name ) { 4d4d4: 4a82 tstl %d2 4d4d6: 6708 beqs 4d4e0 <_POSIX_Semaphore_Create_support+0x98> the_semaphore->named = true; the_semaphore->open_count = 1; 4d4d8: 7001 moveq #1,%d0 4d4da: 2540 0016 movel %d0,%a2@(22) 4d4de: 6006 bras 4d4e6 <_POSIX_Semaphore_Create_support+0x9e> the_semaphore->linked = true; } else { the_semaphore->named = false; the_semaphore->open_count = 0; 4d4e0: 42aa 0016 clrl %a2@(22) if ( name ) { the_semaphore->named = true; the_semaphore->open_count = 1; the_semaphore->linked = true; } else { the_semaphore->named = false; 4d4e4: 4200 clrb %d0 * blocking tasks on this semaphore should be. It could somehow * be derived from the current scheduling policy. One * thing is certain, no matter what we decide, it won't be * the same as all other POSIX implementations. :) */ the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO; 4d4e6: 42aa 005e clrl %a2@(94) if ( name ) { the_semaphore->named = true; the_semaphore->open_count = 1; the_semaphore->linked = true; } else { the_semaphore->named = false; 4d4ea: 1540 0014 moveb %d0,%a2@(20) the_semaphore->open_count = 0; the_semaphore->linked = false; 4d4ee: 1540 0015 moveb %d0,%a2@(21) the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO; /* * This effectively disables limit checking. */ the_sem_attr->maximum_count = 0xFFFFFFFF; 4d4f2: 70ff moveq #-1,%d0 4d4f4: 2540 005a movel %d0,%a2@(90) _CORE_semaphore_Initialize( &the_semaphore->Semaphore, the_sem_attr, value ); 4d4f8: 2f2e 0010 movel %fp@(16),%sp@- 4d4fc: 486a 005a pea %a2@(90) 4d500: 486a 001a pea %a2@(26) 4d504: 4eb9 0004 9184 jsr 49184 <_CORE_semaphore_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4d50a: 2079 0006 1d02 moveal 61d02 <_POSIX_Semaphore_Information+0x18>,%a0 4d510: 4280 clrl %d0 4d512: 302a 000a movew %a2@(10),%d0 4d516: 218a 0c00 movel %a2,%a0@(00000000,%d0:l:4) the_object ); #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) /* ASSERT: information->is_string */ the_object->name.name_p = name; 4d51a: 2542 000c movel %d2,%a2@(12) &_POSIX_Semaphore_Information, &the_semaphore->Object, name_p ); *the_sem = the_semaphore; 4d51e: 206e 0014 moveal %fp@(20),%a0 4d522: 208a movel %a2,%a0@ _Thread_Enable_dispatch(); 4d524: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch> return 0; 4d52a: 4fef 000c lea %sp@(12),%sp name_p ); *the_sem = the_semaphore; _Thread_Enable_dispatch(); 4d52e: 4281 clrl %d1 return 0; } 4d530: 242e fff8 movel %fp@(-8),%d2 4d534: 2001 movel %d1,%d0 4d536: 246e fffc moveal %fp@(-4),%a2 4d53a: 4e5e unlk %fp 4d53c: 4e75 rts ... 0004d540 <_POSIX_Semaphore_Delete>: */ void _POSIX_Semaphore_Delete( POSIX_Semaphore_Control *the_semaphore ) { 4d540: 4e56 0000 linkw %fp,#0 4d544: 2f0a movel %a2,%sp@- 4d546: 246e 0008 moveal %fp@(8),%a2 if ( !the_semaphore->linked && !the_semaphore->open_count ) { 4d54a: 4a2a 0015 tstb %a2@(21) 4d54e: 6636 bnes 4d586 <_POSIX_Semaphore_Delete+0x46> 4d550: 4aaa 0016 tstl %a2@(22) 4d554: 6630 bnes 4d586 <_POSIX_Semaphore_Delete+0x46> _Objects_Close( &_POSIX_Semaphore_Information, &the_semaphore->Object ); 4d556: 2f0a movel %a2,%sp@- 4d558: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d55e: 4eb9 0004 96d4 jsr 496d4 <_Objects_Close> _CORE_semaphore_Flush( 4d564: 4878 ffff pea ffffffff 4d568: 42a7 clrl %sp@- 4d56a: 486a 001a pea %a2@(26) 4d56e: 4eb9 0004 9178 jsr 49178 <_CORE_semaphore_Flush> RTEMS_INLINE_ROUTINE void _POSIX_Semaphore_Free ( POSIX_Semaphore_Control *the_semaphore ) { _Objects_Free( &_POSIX_Semaphore_Information, &the_semaphore->Object ); 4d574: 2f0a movel %a2,%sp@- 4d576: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d57c: 4eb9 0004 9948 jsr 49948 <_Objects_Free> 4d582: 4fef 001c lea %sp@(28),%sp -1 ); _POSIX_Semaphore_Free( the_semaphore ); } } 4d586: 246e fffc moveal %fp@(-4),%a2 4d58a: 4e5e unlk %fp 4d58c: 4e75 rts ... 00049b20 <_POSIX_Semaphore_Manager_initialization>: * * Output parameters: NONE */ void _POSIX_Semaphore_Manager_initialization(void) { 49b20: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 49b24: 4878 00ff pea ff 49b28: 4878 0001 pea 1 49b2c: 4878 0066 pea 66 49b30: 2f39 0005 baf2 movel 5baf2 ,%sp@- 49b36: 4878 0007 pea 7 49b3a: 4878 0003 pea 3 49b3e: 4879 0005 ceee pea 5ceee <_POSIX_Semaphore_Information> 49b44: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49b4a: 4fef 001c lea %sp@(28),%sp , false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 49b4e: 4e5e unlk %fp 49b50: 4e75 rts ... 0004f7b4 <_POSIX_Semaphore_Translate_core_semaphore_return_code>: int _POSIX_Semaphore_Translate_core_semaphore_return_code( CORE_semaphore_Status the_semaphore_status ) { 4f7b4: 41f9 0005 f610 lea 5f610 <_POSIX_Semaphore_Return_codes>,%a0 4f7ba: 4e56 0000 linkw %fp,#0 #if defined(RTEMS_DEBUG) if ( the_semaphore_status > CORE_SEMAPHORE_STATUS_LAST ) return EINVAL; #endif return _POSIX_Semaphore_Return_codes[the_semaphore_status]; } 4f7be: 202e 0008 movel %fp@(8),%d0 4f7c2: 4e5e unlk %fp 4f7c4: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4f7c8: 4e75 rts ... 0004d604 <_POSIX_Semaphore_Wait_support>: int _POSIX_Semaphore_Wait_support( sem_t *sem, bool blocking, Watchdog_Interval timeout ) { 4d604: 4e56 fffc linkw %fp,#-4 4d608: 206e 0008 moveal %fp@(8),%a0 4d60c: 2f0a movel %a2,%sp@- 4d60e: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Get ( sem_t *id, Objects_Locations *location ) { return (POSIX_Semaphore_Control *) 4d610: 486e fffc pea %fp@(-4) 4d614: 2f10 movel %a0@,%sp@- 4d616: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 4d61c: 142e 000f moveb %fp@(15),%d2 4d620: 4eb9 0004 9aa0 jsr 49aa0 <_Objects_Get> POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _POSIX_Semaphore_Get( sem, &location ); switch ( location ) { 4d626: 4fef 000c lea %sp@(12),%sp 4d62a: 4aae fffc tstl %fp@(-4) 4d62e: 6656 bnes 4d686 <_POSIX_Semaphore_Wait_support+0x82> case OBJECTS_LOCAL: _CORE_semaphore_Seize( 4d630: 2f2e 0010 movel %fp@(16),%sp@- 4d634: 2040 moveal %d0,%a0 4d636: 0282 0000 00ff andil #255,%d2 4d63c: 2f02 movel %d2,%sp@- 4d63e: 2f28 0008 movel %a0@(8),%sp@- 4d642: 4868 001a pea %a0@(26) 4d646: 4eb9 0004 dcc0 jsr 4dcc0 <_CORE_semaphore_Seize> &the_semaphore->Semaphore, the_semaphore->Object.id, blocking, timeout ); _Thread_Enable_dispatch(); 4d64c: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch> if ( !_Thread_Executing->Wait.return_code ) 4d652: 2079 0006 1b4a moveal 61b4a <_Thread_Executing>,%a0 4d658: 4fef 0010 lea %sp@(16),%sp 4d65c: 4aa8 0034 tstl %a0@(52) 4d660: 6604 bnes 4d666 <_POSIX_Semaphore_Wait_support+0x62> 4d662: 4281 clrl %d1 4d664: 602e bras 4d694 <_POSIX_Semaphore_Wait_support+0x90> return 0; rtems_set_errno_and_return_minus_one( 4d666: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d66c: 2079 0006 1b4a moveal 61b4a <_Thread_Executing>,%a0 4d672: 2440 moveal %d0,%a2 4d674: 2f28 0034 movel %a0@(52),%sp@- 4d678: 4eb9 0004 f7b4 jsr 4f7b4 <_POSIX_Semaphore_Translate_core_semaphore_return_code> 4d67e: 588f addql #4,%sp 4d680: 72ff moveq #-1,%d1 4d682: 2480 movel %d0,%a2@ 4d684: 600e bras 4d694 <_POSIX_Semaphore_Wait_support+0x90> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 4d686: 4eb9 0005 07a0 jsr 507a0 <__errno> 4d68c: 72ff moveq #-1,%d1 4d68e: 2040 moveal %d0,%a0 4d690: 7016 moveq #22,%d0 4d692: 2080 movel %d0,%a0@ } 4d694: 242e fff4 movel %fp@(-12),%d2 4d698: 2001 movel %d1,%d0 4d69a: 246e fff8 moveal %fp@(-8),%a2 4d69e: 4e5e unlk %fp 4d6a0: 4e75 rts ... 000497e4 <_POSIX_Spinlock_Manager_initialization>: /** * @brief _POSIX_Spinlock_Manager_initialization */ void _POSIX_Spinlock_Manager_initialization(void) { 497e4: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 497e8: 4878 00ff pea ff 497ec: 4878 0001 pea 1 497f0: 4878 0020 pea 20 497f4: 2f39 0005 bafe movel 5bafe ,%sp@- 497fa: 4878 000b pea b 497fe: 4878 0003 pea 3 49802: 4879 0005 ceb4 pea 5ceb4 <_POSIX_Spinlock_Information> 49808: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 4980e: 4fef 001c lea %sp@(28),%sp , false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 49812: 4e5e unlk %fp 49814: 4e75 rts ... 00045178 <_POSIX_Spinlock_Translate_core_spinlock_return_code>: int _POSIX_Spinlock_Translate_core_spinlock_return_code( CORE_spinlock_Status the_spinlock_status ) { 45178: 41f9 0005 b356 lea 5b356 <_POSIX_Spinlock_Return_codes>,%a0 4517e: 4e56 0000 linkw %fp,#0 #if defined(RTEMS_DEBUG) if ( the_spinlock_status > CORE_SPINLOCK_STATUS_LAST ) return EINVAL; #endif return _POSIX_Spinlock_Return_codes[the_spinlock_status]; } 45182: 202e 0008 movel %fp@(8),%d0 45186: 4e5e unlk %fp 45188: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4518c: 4e75 rts ... 0004a8b0 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4a8b0: 4e56 ffec linkw %fp,#-20 4a8b4: 48d7 3c04 moveml %d2/%a2-%a5,%sp@ 4a8b8: 246e 000c moveal %fp@(12),%a2 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4a8bc: 2f12 movel %a2@,%sp@- int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4a8be: 242e 0008 movel %fp@(8),%d2 4a8c2: 266e 0010 moveal %fp@(16),%a3 4a8c6: 286e 0014 moveal %fp@(20),%a4 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4a8ca: 4eb9 0004 a88c jsr 4a88c <_POSIX_Priority_Is_valid> 4a8d0: 588f addql #4,%sp 4a8d2: 4a00 tstb %d0 4a8d4: 677c beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4a8d6: 4293 clrl %a3@ *budget_callout = NULL; 4a8d8: 4294 clrl %a4@ if ( policy == SCHED_OTHER ) { 4a8da: 4a82 tstl %d2 4a8dc: 6608 bnes 4a8e6 <_POSIX_Thread_Translate_sched_param+0x36> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4a8de: 7201 moveq #1,%d1 4a8e0: 4280 clrl %d0 4a8e2: 2681 movel %d1,%a3@ return 0; 4a8e4: 606e bras 4a954 <_POSIX_Thread_Translate_sched_param+0xa4> } if ( policy == SCHED_FIFO ) { 4a8e6: 7001 moveq #1,%d0 4a8e8: b082 cmpl %d2,%d0 4a8ea: 6604 bnes 4a8f0 <_POSIX_Thread_Translate_sched_param+0x40> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4a8ec: 4293 clrl %a3@ 4a8ee: 6008 bras 4a8f8 <_POSIX_Thread_Translate_sched_param+0x48> return 0; } if ( policy == SCHED_RR ) { 4a8f0: 7002 moveq #2,%d0 4a8f2: b082 cmpl %d2,%d0 4a8f4: 6606 bnes 4a8fc <_POSIX_Thread_Translate_sched_param+0x4c> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 4a8f6: 2680 movel %d0,%a3@ 4a8f8: 4200 clrb %d0 return 0; 4a8fa: 6058 bras 4a954 <_POSIX_Thread_Translate_sched_param+0xa4> } if ( policy == SCHED_SPORADIC ) { 4a8fc: 7004 moveq #4,%d0 4a8fe: b082 cmpl %d2,%d0 4a900: 6650 bnes 4a952 <_POSIX_Thread_Translate_sched_param+0xa2> if ( (param->sched_ss_repl_period.tv_sec == 0) && 4a902: 4aaa 0008 tstl %a2@(8) 4a906: 6606 bnes 4a90e <_POSIX_Thread_Translate_sched_param+0x5e> (param->sched_ss_repl_period.tv_nsec == 0) ) 4a908: 4aaa 000c tstl %a2@(12) 4a90c: 6744 beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2> return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4a90e: 4aaa 0010 tstl %a2@(16) 4a912: 6606 bnes 4a91a <_POSIX_Thread_Translate_sched_param+0x6a> (param->sched_ss_init_budget.tv_nsec == 0) ) 4a914: 4aaa 0014 tstl %a2@(20) 4a918: 6738 beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2> return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 4a91a: 486a 0008 pea %a2@(8) 4a91e: 4bf9 0004 88d4 lea 488d4 <_Timespec_To_ticks>,%a5 4a924: 4e95 jsr %a5@ 4a926: 486a 0010 pea %a2@(16) 4a92a: 2400 movel %d0,%d2 4a92c: 4e95 jsr %a5@ 4a92e: 508f addql #8,%sp 4a930: b082 cmpl %d2,%d0 4a932: 621e bhis 4a952 <_POSIX_Thread_Translate_sched_param+0xa2> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) 4a934: 2f2a 0004 movel %a2@(4),%sp@- 4a938: 4eb9 0004 a88c jsr 4a88c <_POSIX_Priority_Is_valid> 4a93e: 588f addql #4,%sp 4a940: 4a00 tstb %d0 4a942: 670e beqs 4a952 <_POSIX_Thread_Translate_sched_param+0xa2> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4a944: 7003 moveq #3,%d0 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 4a946: 28bc 0004 5568 movel #284008,%a4@ return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4a94c: 2680 movel %d0,%a3@ *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 4a94e: 4280 clrl %d0 return 0; 4a950: 6002 bras 4a954 <_POSIX_Thread_Translate_sched_param+0xa4> 4a952: 7016 moveq #22,%d0 } return EINVAL; } 4a954: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4a95a: 4e5e unlk %fp 4a95c: 4e75 rts ... 0004b730 <_POSIX_Threads_cancel_run>: thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; 4b730: 7001 moveq #1,%d0 #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { 4b732: 4e56 ffec linkw %fp,#-20 POSIX_Cancel_Handler_control *handler; Chain_Control *handler_stack; POSIX_API_Control *thread_support; ISR_Level level; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4b736: 206e 0008 moveal %fp@(8),%a0 #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { 4b73a: 48d7 3c04 moveml %d2/%a2-%a5,%sp@ POSIX_Cancel_Handler_control *handler; Chain_Control *handler_stack; POSIX_API_Control *thread_support; ISR_Level level; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4b73e: 2468 010e moveal %a0@(270),%a2 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { _ISR_Disable( level ); 4b742: 243c 0000 0700 movel #1792,%d2 _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); (*handler->routine)( handler->arg ); _Workspace_Free( handler ); 4b748: 49f9 0004 7eac lea 47eac <_Workspace_Free>,%a4 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4b74e: 47ea 00e4 lea %a2@(228),%a3 thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; 4b752: 2540 00d4 movel %d0,%a2@(212) while ( !_Chain_Is_empty( handler_stack ) ) { 4b756: 6028 bras 4b780 <_POSIX_Threads_cancel_run+0x50> _ISR_Disable( level ); 4b758: 40c1 movew %sr,%d1 4b75a: 8081 orl %d1,%d0 4b75c: 46c0 movew %d0,%sr handler = (POSIX_Cancel_Handler_control *) 4b75e: 2a6b 0004 moveal %a3@(4),%a5 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4b762: 2055 moveal %a5@,%a0 previous = the_node->previous; 4b764: 226d 0004 moveal %a5@(4),%a1 next->previous = previous; previous->next = next; 4b768: 2288 movel %a0,%a1@ Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 4b76a: 2149 0004 movel %a1,%a0@(4) _Chain_Tail( handler_stack )->previous; _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); 4b76e: 46c1 movew %d1,%sr (*handler->routine)( handler->arg ); 4b770: 2f2d 000c movel %a5@(12),%sp@- 4b774: 206d 0008 moveal %a5@(8),%a0 4b778: 4e90 jsr %a0@ _Workspace_Free( handler ); 4b77a: 2f0d movel %a5,%sp@- 4b77c: 4e94 jsr %a4@ 4b77e: 508f addql #8,%sp handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { _ISR_Disable( level ); 4b780: 2002 movel %d2,%d0 POSIX_API_Control *thread_support; ISR_Level level; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; 4b782: b7ea 00e0 cmpal %a2@(224),%a3 4b786: 66d0 bnes 4b758 <_POSIX_Threads_cancel_run+0x28> (*handler->routine)( handler->arg ); _Workspace_Free( handler ); } } 4b788: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 4b78e: 4e5e unlk %fp 4b790: 4e75 rts ... 0004a3a0 <_POSIX_Timer_Insert_helper>: Watchdog_Interval ticks, Objects_Id id, Watchdog_Service_routine_entry TSR, void *arg ) { 4a3a0: 4e56 0000 linkw %fp,#0 4a3a4: 2f0a movel %a2,%sp@- 4a3a6: 246e 0008 moveal %fp@(8),%a2 4a3aa: 2f02 movel %d2,%sp@- ISR_Level level; (void) _Watchdog_Remove( timer ); 4a3ac: 2f0a movel %a2,%sp@- 4a3ae: 4eb9 0004 84cc jsr 484cc <_Watchdog_Remove> _ISR_Disable( level ); 4a3b4: 203c 0000 0700 movel #1792,%d0 4a3ba: 40c2 movew %sr,%d2 4a3bc: 8082 orl %d2,%d0 4a3be: 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 ( timer->state != WATCHDOG_INACTIVE ) { 4a3c0: 588f addql #4,%sp 4a3c2: 4aaa 0008 tstl %a2@(8) 4a3c6: 6706 beqs 4a3ce <_POSIX_Timer_Insert_helper+0x2e> _ISR_Enable( level ); 4a3c8: 46c2 movew %d2,%sr 4a3ca: 4200 clrb %d0 return false; 4a3cc: 6030 bras 4a3fe <_POSIX_Timer_Insert_helper+0x5e> 4a3ce: 2f0a movel %a2,%sp@- 4a3d0: 4879 0005 d8cc pea 5d8cc <_Watchdog_Ticks_chain> void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; 4a3d6: 256e 0010 0020 movel %fp@(16),%a2@(32) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 4a3dc: 256e 0014 001c movel %fp@(20),%a2@(28) the_watchdog->id = id; the_watchdog->user_data = user_data; 4a3e2: 256e 0018 0024 movel %fp@(24),%a2@(36) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4a3e8: 256e 000c 000c movel %fp@(12),%a2@(12) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 4a3ee: 42aa 0008 clrl %a2@(8) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4a3f2: 4eb9 0004 83b0 jsr 483b0 <_Watchdog_Insert> * OK. Now we now the timer was not rescheduled by an interrupt * so we can atomically initialize it as in use. */ _Watchdog_Initialize( timer, TSR, id, arg ); _Watchdog_Insert_ticks( timer, ticks ); _ISR_Enable( level ); 4a3f8: 46c2 movew %d2,%sr return true; 4a3fa: 508f addql #8,%sp * OK. Now we now the timer was not rescheduled by an interrupt * so we can atomically initialize it as in use. */ _Watchdog_Initialize( timer, TSR, id, arg ); _Watchdog_Insert_ticks( timer, ticks ); _ISR_Enable( level ); 4a3fc: 7001 moveq #1,%d0 return true; } 4a3fe: 242e fff8 movel %fp@(-8),%d2 4a402: 246e fffc moveal %fp@(-4),%a2 4a406: 4e5e unlk %fp 4a408: 4e75 rts ... 00049aec <_POSIX_Timer_Manager_initialization>: * Initialize the internal structure in which the data of all * the timers are stored */ void _POSIX_Timer_Manager_initialization(void) { 49aec: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 49af0: 4878 00ff pea ff 49af4: 4878 0001 pea 1 49af8: 4878 0072 pea 72 49afc: 2f39 0005 bae2 movel 5bae2 ,%sp@- 49b02: 4878 0009 pea 9 49b06: 4878 0003 pea 3 49b0a: 4879 0005 cf28 pea 5cf28 <_POSIX_Timer_Information> 49b10: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> 49b16: 4fef 001c lea %sp@(28),%sp , false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 49b1a: 4e5e unlk %fp 49b1c: 4e75 rts ... 00044e70 <_POSIX_Timer_TSR>: * This is the operation that is run when a timer expires */ void _POSIX_Timer_TSR( Objects_Id timer __attribute__((unused)), void *data) { 44e70: 4e56 0000 linkw %fp,#0 44e74: 2f0a movel %a2,%sp@- 44e76: 246e 000c moveal %fp@(12),%a2 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 44e7a: 52aa 0066 addql #1,%a2@(102) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 44e7e: 4aaa 0052 tstl %a2@(82) 44e82: 6606 bnes 44e8a <_POSIX_Timer_TSR+0x1a> ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { 44e84: 4aaa 0056 tstl %a2@(86) 44e88: 6732 beqs 44ebc <_POSIX_Timer_TSR+0x4c> activated = _POSIX_Timer_Insert_helper( 44e8a: 2f0a movel %a2,%sp@- 44e8c: 4879 0004 4e70 pea 44e70 <_POSIX_Timer_TSR> 44e92: 2f2a 0008 movel %a2@(8),%sp@- 44e96: 2f2a 0062 movel %a2@(98),%sp@- 44e9a: 486a 0010 pea %a2@(16) 44e9e: 4eb9 0004 a3a0 jsr 4a3a0 <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 44ea4: 4fef 0014 lea %sp@(20),%sp 44ea8: 4a00 tstb %d0 44eaa: 672a beqs 44ed6 <_POSIX_Timer_TSR+0x66> return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 44eac: 486a 006a pea %a2@(106) 44eb0: 4eb9 0004 6348 jsr 46348 <_TOD_Get> /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 44eb6: 588f addql #4,%sp /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 44eb8: 7003 moveq #3,%d0 44eba: 6002 bras 44ebe <_POSIX_Timer_TSR+0x4e> } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 44ebc: 7004 moveq #4,%d0 <== NOT EXECUTED 44ebe: 1540 003c moveb %d0,%a2@(60) /* * The sending of the signal to the process running the handling function * specified for that signal is simulated */ if ( pthread_kill ( ptimer->thread_id, ptimer->inf.sigev_signo ) ) { 44ec2: 2f2a 0042 movel %a2@(66),%sp@- 44ec6: 2f2a 0038 movel %a2@(56),%sp@- 44eca: 4eb9 0004 9f80 jsr 49f80 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 44ed0: 508f addql #8,%sp 44ed2: 42aa 0066 clrl %a2@(102) } 44ed6: 246e fffc moveal %fp@(-4),%a2 44eda: 4e5e unlk %fp 44edc: 4e75 rts ... 0004c76c <_POSIX_signals_Clear_process_signals>: clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4c76c: 203c 0000 0700 movel #1792,%d0 */ void _POSIX_signals_Clear_process_signals( int signo ) { 4c772: 4e56 0000 linkw %fp,#0 4c776: 222e 0008 movel %fp@(8),%d1 4c77a: 2f03 movel %d3,%sp@- 4c77c: 2f02 movel %d2,%sp@- clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4c77e: 40c2 movew %sr,%d2 4c780: 8082 orl %d2,%d0 4c782: 46c0 movew %d0,%sr if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4c784: 2601 movel %d1,%d3 4c786: 2001 movel %d1,%d0 4c788: 41f9 0005 d142 lea 5d142 <_POSIX_signals_Vectors>,%a0 4c78e: e58b lsll #2,%d3 4c790: e988 lsll #4,%d0 4c792: 9083 subl %d3,%d0 4c794: 7602 moveq #2,%d3 4c796: b6b0 0800 cmpl %a0@(00000000,%d0:l),%d3 4c79a: 6610 bnes 4c7ac <_POSIX_signals_Clear_process_signals+0x40> if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 4c79c: 2040 moveal %d0,%a0 4c79e: d1fc 0005 d33a addal #381754,%a0 4c7a4: 2008 movel %a0,%d0 4c7a6: 5880 addql #4,%d0 4c7a8: b090 cmpl %a0@,%d0 4c7aa: 661c bnes 4c7c8 <_POSIX_signals_Clear_process_signals+0x5c> clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 4c7ac: 5381 subql #1,%d1 4c7ae: 7001 moveq #1,%d0 4c7b0: e3a8 lsll %d1,%d0 4c7b2: 4680 notl %d0 4c7b4: c0b9 0005 d336 andl 5d336 <_POSIX_signals_Pending>,%d0 4c7ba: 23c0 0005 d336 movel %d0,5d336 <_POSIX_signals_Pending> if ( !_POSIX_signals_Pending ) 4c7c0: 6606 bnes 4c7c8 <_POSIX_signals_Clear_process_signals+0x5c> _Thread_Do_post_task_switch_extension--; 4c7c2: 53b9 0005 cd36 subql #1,5cd36 <_Thread_Do_post_task_switch_extension> } _ISR_Enable( level ); 4c7c8: 46c2 movew %d2,%sr } 4c7ca: 241f movel %sp@+,%d2 4c7cc: 261f movel %sp@+,%d3 4c7ce: 4e5e unlk %fp 4c7d0: 4e75 rts ... 0004c7d4 <_POSIX_signals_Set_process_signals>: sigset_t mask ) { ISR_Level level; _ISR_Disable( level ); 4c7d4: 203c 0000 0700 movel #1792,%d0 */ void _POSIX_signals_Set_process_signals( sigset_t mask ) { 4c7da: 4e56 0000 linkw %fp,#0 ISR_Level level; _ISR_Disable( level ); 4c7de: 40c1 movew %sr,%d1 4c7e0: 8081 orl %d1,%d0 4c7e2: 46c0 movew %d0,%sr if ( !_POSIX_signals_Pending ) 4c7e4: 2039 0005 d336 movel 5d336 <_POSIX_signals_Pending>,%d0 4c7ea: 6606 bnes 4c7f2 <_POSIX_signals_Set_process_signals+0x1e> _Thread_Do_post_task_switch_extension++; 4c7ec: 52b9 0005 cd36 addql #1,5cd36 <_Thread_Do_post_task_switch_extension> _POSIX_signals_Pending |= mask; 4c7f2: 80ae 0008 orl %fp@(8),%d0 4c7f6: 23c0 0005 d336 movel %d0,5d336 <_POSIX_signals_Pending> _ISR_Enable( level ); 4c7fc: 46c1 movew %d1,%sr } 4c7fe: 4e5e unlk %fp 4c800: 4e75 rts ... 00044e4c <_POSIX_signals_Ualarm_TSR>: void _POSIX_signals_Ualarm_TSR( Objects_Id id __attribute__((unused)), void *argument __attribute__((unused)) ) { 44e4c: 4e56 0000 linkw %fp,#0 /* * Send a SIGALRM but if there is a problem, ignore it. * It's OK, there isn't a way this should fail. */ (void) kill( getpid(), SIGALRM ); 44e50: 4eb9 0004 24e8 jsr 424e8 44e56: 4878 000e pea e 44e5a: 2f00 movel %d0,%sp@- 44e5c: 4eb9 0004 4b6c jsr 44b6c RTEMS_INLINE_ROUTINE void _Watchdog_Reset( Watchdog_Control *the_watchdog ) { (void) _Watchdog_Remove( the_watchdog ); 44e62: 4879 0005 ec5a pea 5ec5a <_POSIX_signals_Ualarm_timer> 44e68: 4eb9 0004 8330 jsr 48330 <_Watchdog_Remove> _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 44e6e: 4fef 000c lea %sp@(12),%sp 44e72: 203c 0005 ec5a movel #388186,%d0 44e78: 2d40 000c movel %d0,%fp@(12) 44e7c: 203c 0005 e50c movel #386316,%d0 44e82: 2d40 0008 movel %d0,%fp@(8) /* * If the reset interval is non-zero, reschedule ourselves. */ _Watchdog_Reset( &_POSIX_signals_Ualarm_timer ); } 44e86: 4e5e unlk %fp 44e88: 4ef9 0004 8214 jmp 48214 <_Watchdog_Insert> ... 0004a530 <_Protected_heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t size, uintptr_t alignment, uintptr_t boundary ) { 4a530: 4e56 fffc linkw %fp,#-4 void *p; _RTEMS_Lock_allocator(); 4a534: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a53a: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock> p = _Heap_Allocate_aligned_with_boundary( 4a540: 2f2e 0014 movel %fp@(20),%sp@- 4a544: 2f2e 0010 movel %fp@(16),%sp@- 4a548: 2f2e 000c movel %fp@(12),%sp@- 4a54c: 2f2e 0008 movel %fp@(8),%sp@- 4a550: 4eb9 0004 a248 jsr 4a248 <_Heap_Allocate_aligned_with_boundary> heap, size, alignment, boundary ); _RTEMS_Unlock_allocator(); 4a556: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a55c: 2d40 fffc movel %d0,%fp@(-4) 4a560: 4eb9 0004 589c jsr 4589c <_API_Mutex_Unlock> return p; } 4a566: 202e fffc movel %fp@(-4),%d0 4a56a: 4e5e unlk %fp 4a56c: 4e75 rts ... 0004a570 <_Protected_heap_Free>: bool _Protected_heap_Free( Heap_Control *the_heap, void *start_address ) { 4a570: 4e56 fffc linkw %fp,#-4 bool status; _RTEMS_Lock_allocator(); 4a574: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a57a: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock> status = _Heap_Free( the_heap, start_address ); 4a580: 2f2e 000c movel %fp@(12),%sp@- 4a584: 2f2e 0008 movel %fp@(8),%sp@- 4a588: 4eb9 0004 a39c jsr 4a39c <_Heap_Free> _RTEMS_Unlock_allocator(); 4a58e: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4a594: 2d40 fffc movel %d0,%fp@(-4) 4a598: 4eb9 0004 589c jsr 4589c <_API_Mutex_Unlock> return status; } 4a59e: 202e fffc movel %fp@(-4),%d0 4a5a2: 4e5e unlk %fp 4a5a4: 4e75 rts ... 000596cc <_Protected_heap_Get_block_size>: bool _Protected_heap_Get_block_size( Heap_Control *the_heap, void *starting_address, uintptr_t *size ) { 596cc: 4e56 fffc linkw %fp,#-4 bool status; _RTEMS_Lock_allocator(); 596d0: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 596d6: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock> status = _Heap_Size_of_alloc_area( the_heap, starting_address, size ); 596dc: 2f2e 0010 movel %fp@(16),%sp@- 596e0: 2f2e 000c movel %fp@(12),%sp@- 596e4: 2f2e 0008 movel %fp@(8),%sp@- 596e8: 4eb9 0005 982c jsr 5982c <_Heap_Size_of_alloc_area> _RTEMS_Unlock_allocator(); 596ee: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 596f4: 2d40 fffc movel %d0,%fp@(-4) 596f8: 4eb9 0004 589c jsr 4589c <_API_Mutex_Unlock> return status; } 596fe: 202e fffc movel %fp@(-4),%d0 59702: 4e5e unlk %fp 59704: 4e75 rts ... 00063da8 <_Protected_heap_Get_information>: bool _Protected_heap_Get_information( Heap_Control *the_heap, Heap_Information_block *the_info ) { 63da8: 4e56 0000 linkw %fp,#0 63dac: 2f03 movel %d3,%sp@- 63dae: 262e 000c movel %fp@(12),%d3 63db2: 2f02 movel %d2,%sp@- 63db4: 242e 0008 movel %fp@(8),%d2 if ( !the_heap ) 63db8: 672e beqs 63de8 <_Protected_heap_Get_information+0x40> return false; if ( !the_info ) 63dba: 4a83 tstl %d3 63dbc: 672a beqs 63de8 <_Protected_heap_Get_information+0x40> return false; _RTEMS_Lock_allocator(); 63dbe: 2f39 0009 bd3a movel 9bd3a <_RTEMS_Allocator_Mutex>,%sp@- 63dc4: 4eb9 0004 99e4 jsr 499e4 <_API_Mutex_Lock> _Heap_Get_information( the_heap, the_info ); 63dca: 2f03 movel %d3,%sp@- 63dcc: 2f02 movel %d2,%sp@- 63dce: 4eb9 0007 1e44 jsr 71e44 <_Heap_Get_information> _RTEMS_Unlock_allocator(); 63dd4: 2f39 0009 bd3a movel 9bd3a <_RTEMS_Allocator_Mutex>,%sp@- 63dda: 4eb9 0004 9a44 jsr 49a44 <_API_Mutex_Unlock> return true; 63de0: 4fef 0010 lea %sp@(16),%sp if ( !the_info ) return false; _RTEMS_Lock_allocator(); _Heap_Get_information( the_heap, the_info ); _RTEMS_Unlock_allocator(); 63de4: 7001 moveq #1,%d0 return true; 63de6: 6002 bras 63dea <_Protected_heap_Get_information+0x42> 63de8: 4200 clrb %d0 } 63dea: 242e fff8 movel %fp@(-8),%d2 63dee: 262e fffc movel %fp@(-4),%d3 63df2: 4e5e unlk %fp 63df4: 4e75 rts ... 000572f8 <_Region_Process_queue>: */ void _Region_Process_queue( Region_Control *the_region ) { 572f8: 4e56 ffe4 linkw %fp,#-28 572fc: 2039 0007 53e8 movel 753e8 <_Thread_Dispatch_disable_level>,%d0 57302: 5280 addql #1,%d0 57304: 48d7 3c1c moveml %d2-%d4/%a2-%a5,%sp@ 57308: 266e 0008 moveal %fp@(8),%a3 5730c: 23c0 0007 53e8 movel %d0,753e8 <_Thread_Dispatch_disable_level> * NOTE: Be sure to disable dispatching before unlocking the mutex * since we do not want to open a window where a context * switch could occur. */ _Thread_Disable_dispatch(); _RTEMS_Unlock_allocator(); 57312: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- /* * NOTE: The following loop is O(n) where n is the number of * threads whose memory request is satisfied. */ for ( ; ; ) { the_thread = _Thread_queue_First( &the_region->Wait_queue ); 57318: 240b movel %a3,%d2 RTEMS_INLINE_ROUTINE void *_Region_Allocate_segment ( Region_Control *the_region, uintptr_t size ) { return _Heap_Allocate( &the_region->Memory, size ); 5731a: 280b movel %a3,%d4 5731c: 0682 0000 0010 addil #16,%d2 57322: 0684 0000 0068 addil #104,%d4 57328: 4bf9 0005 2a14 lea 52a14 <_Heap_Allocate_aligned_with_boundary>,%a5 if ( the_segment == NULL ) break; *(void **)the_thread->Wait.return_argument = the_segment; the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); 5732e: 49f9 0005 7a04 lea 57a04 <_Thread_queue_Extract>,%a4 * NOTE: Be sure to disable dispatching before unlocking the mutex * since we do not want to open a window where a context * switch could occur. */ _Thread_Disable_dispatch(); _RTEMS_Unlock_allocator(); 57334: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> 5733a: 588f addql #4,%sp /* * NOTE: The following loop is O(n) where n is the number of * threads whose memory request is satisfied. */ for ( ; ; ) { the_thread = _Thread_queue_First( &the_region->Wait_queue ); 5733c: 263c 0005 7b08 movel #359176,%d3 57342: 2f02 movel %d2,%sp@- 57344: 2043 moveal %d3,%a0 57346: 4e90 jsr %a0@ if ( the_thread == NULL ) 57348: 588f addql #4,%sp /* * NOTE: The following loop is O(n) where n is the number of * threads whose memory request is satisfied. */ for ( ; ; ) { the_thread = _Thread_queue_First( &the_region->Wait_queue ); 5734a: 2440 moveal %d0,%a2 if ( the_thread == NULL ) 5734c: 4a80 tstl %d0 5734e: 672c beqs 5737c <_Region_Process_queue+0x84> 57350: 42a7 clrl %sp@- 57352: 42a7 clrl %sp@- 57354: 2f2a 0024 movel %a2@(36),%sp@- 57358: 2f04 movel %d4,%sp@- 5735a: 4e95 jsr %a5@ the_segment = (void **) _Region_Allocate_segment( the_region, the_thread->Wait.count ); if ( the_segment == NULL ) 5735c: 4fef 0010 lea %sp@(16),%sp 57360: 4a80 tstl %d0 57362: 6718 beqs 5737c <_Region_Process_queue+0x84> break; *(void **)the_thread->Wait.return_argument = the_segment; 57364: 206a 0028 moveal %a2@(40),%a0 the_region->number_of_used_blocks += 1; 57368: 52ab 0064 addql #1,%a3@(100) ); if ( the_segment == NULL ) break; *(void **)the_thread->Wait.return_argument = the_segment; 5736c: 2080 movel %d0,%a0@ the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); 5736e: 2f0a movel %a2,%sp@- 57370: 2f02 movel %d2,%sp@- 57372: 4e94 jsr %a4@ the_thread->Wait.return_code = RTEMS_SUCCESSFUL; } 57374: 508f addql #8,%sp break; *(void **)the_thread->Wait.return_argument = the_segment; the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); the_thread->Wait.return_code = RTEMS_SUCCESSFUL; 57376: 42aa 0034 clrl %a2@(52) } 5737a: 60c6 bras 57342 <_Region_Process_queue+0x4a> _Thread_Enable_dispatch(); } 5737c: 4cee 3c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a5 57382: 4e5e unlk %fp *(void **)the_thread->Wait.return_argument = the_segment; the_region->number_of_used_blocks += 1; _Thread_queue_Extract( &the_region->Wait_queue, the_thread ); the_thread->Wait.return_code = RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 57384: 4ef9 0005 4012 jmp 54012 <_Thread_Enable_dispatch> ... 0004a170 <_TOD_Get>: /* assume time checked for NULL by caller */ /* _TOD_Now is the native current time */ nanoseconds = 0; _ISR_Disable( level ); 4a170: 203c 0000 0700 movel #1792,%d0 */ void _TOD_Get( struct timespec *time ) { 4a176: 4e56 fff0 linkw %fp,#-16 4a17a: 2f02 movel %d2,%sp@- /* assume time checked for NULL by caller */ /* _TOD_Now is the native current time */ nanoseconds = 0; _ISR_Disable( level ); 4a17c: 40c2 movew %sr,%d2 4a17e: 8082 orl %d2,%d0 4a180: 46c0 movew %d0,%sr now = _TOD_Now; if ( _Watchdog_Nanoseconds_since_tick_handler ) 4a182: 2079 0005 ce20 moveal 5ce20 <_Watchdog_Nanoseconds_since_tick_handler>,%a0 /* assume time checked for NULL by caller */ /* _TOD_Now is the native current time */ nanoseconds = 0; _ISR_Disable( level ); now = _TOD_Now; 4a188: 2039 0005 cd26 movel 5cd26 <_TOD_Now>,%d0 4a18e: 2239 0005 cd2a movel 5cd2a <_TOD_Now+0x4>,%d1 4a194: 2d40 fff0 movel %d0,%fp@(-16) 4a198: 2d41 fff4 movel %d1,%fp@(-12) if ( _Watchdog_Nanoseconds_since_tick_handler ) 4a19c: 4a88 tstl %a0 4a19e: 6604 bnes 4a1a4 <_TOD_Get+0x34> 4a1a0: 4280 clrl %d0 4a1a2: 6002 bras 4a1a6 <_TOD_Get+0x36> nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); 4a1a4: 4e90 jsr %a0@ _ISR_Enable( level ); 4a1a6: 46c2 movew %d2,%sr _Timestamp_Set( &offset, 0, nanoseconds ); _Timestamp_Add_to( &now, &offset ); 4a1a8: 486e fff8 pea %fp@(-8) 4a1ac: 486e fff0 pea %fp@(-16) now = _TOD_Now; if ( _Watchdog_Nanoseconds_since_tick_handler ) nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); _ISR_Enable( level ); _Timestamp_Set( &offset, 0, nanoseconds ); 4a1b0: 2d40 fffc movel %d0,%fp@(-4) 4a1b4: 42ae fff8 clrl %fp@(-8) _Timestamp_Add_to( &now, &offset ); 4a1b8: 4eb9 0004 7958 jsr 47958 <_Timespec_Add_to> _Timestamp_To_timespec( &now, time ); 4a1be: 206e 0008 moveal %fp@(8),%a0 4a1c2: 508f addql #8,%sp 4a1c4: 202e fff0 movel %fp@(-16),%d0 4a1c8: 222e fff4 movel %fp@(-12),%d1 } 4a1cc: 242e ffec movel %fp@(-20),%d2 4a1d0: 4e5e unlk %fp nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); _ISR_Enable( level ); _Timestamp_Set( &offset, 0, nanoseconds ); _Timestamp_Add_to( &now, &offset ); _Timestamp_To_timespec( &now, time ); 4a1d2: 2080 movel %d0,%a0@ 4a1d4: 2141 0004 movel %d1,%a0@(4) } 4a1d8: 4e75 rts ... 0004a1dc <_TOD_Get_uptime>: /* assume time checked for NULL by caller */ /* _TOD_Uptime is in native timestamp format */ nanoseconds = 0; _ISR_Disable( level ); 4a1dc: 203c 0000 0700 movel #1792,%d0 */ void _TOD_Get_uptime( Timestamp_Control *uptime ) { 4a1e2: 4e56 fff0 linkw %fp,#-16 4a1e6: 2f02 movel %d2,%sp@- /* assume time checked for NULL by caller */ /* _TOD_Uptime is in native timestamp format */ nanoseconds = 0; _ISR_Disable( level ); 4a1e8: 40c2 movew %sr,%d2 4a1ea: 8082 orl %d2,%d0 4a1ec: 46c0 movew %d0,%sr up = _TOD_Uptime; if ( _Watchdog_Nanoseconds_since_tick_handler ) 4a1ee: 2079 0005 ce20 moveal 5ce20 <_Watchdog_Nanoseconds_since_tick_handler>,%a0 /* assume time checked for NULL by caller */ /* _TOD_Uptime is in native timestamp format */ nanoseconds = 0; _ISR_Disable( level ); up = _TOD_Uptime; 4a1f4: 2039 0005 cd12 movel 5cd12 <_TOD_Uptime>,%d0 4a1fa: 2239 0005 cd16 movel 5cd16 <_TOD_Uptime+0x4>,%d1 4a200: 2d40 fff0 movel %d0,%fp@(-16) 4a204: 2d41 fff4 movel %d1,%fp@(-12) if ( _Watchdog_Nanoseconds_since_tick_handler ) 4a208: 4a88 tstl %a0 4a20a: 6604 bnes 4a210 <_TOD_Get_uptime+0x34> 4a20c: 4280 clrl %d0 4a20e: 6002 bras 4a212 <_TOD_Get_uptime+0x36> nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); 4a210: 4e90 jsr %a0@ _ISR_Enable( level ); 4a212: 46c2 movew %d2,%sr _Timestamp_Set( &offset, 0, nanoseconds ); _Timestamp_Add_to( &up, &offset ); 4a214: 486e fff8 pea %fp@(-8) 4a218: 486e fff0 pea %fp@(-16) up = _TOD_Uptime; if ( _Watchdog_Nanoseconds_since_tick_handler ) nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); _ISR_Enable( level ); _Timestamp_Set( &offset, 0, nanoseconds ); 4a21c: 2d40 fffc movel %d0,%fp@(-4) 4a220: 42ae fff8 clrl %fp@(-8) _Timestamp_Add_to( &up, &offset ); 4a224: 4eb9 0004 7958 jsr 47958 <_Timespec_Add_to> *uptime = up; 4a22a: 206e 0008 moveal %fp@(8),%a0 4a22e: 508f addql #8,%sp 4a230: 202e fff0 movel %fp@(-16),%d0 4a234: 222e fff4 movel %fp@(-12),%d1 } 4a238: 242e ffec movel %fp@(-20),%d2 4a23c: 4e5e unlk %fp nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); _ISR_Enable( level ); _Timestamp_Set( &offset, 0, nanoseconds ); _Timestamp_Add_to( &up, &offset ); *uptime = up; 4a23e: 2080 movel %d0,%a0@ 4a240: 2141 0004 movel %d1,%a0@(4) } 4a244: 4e75 rts ... 00063834 <_TOD_Get_uptime_as_timespec>: */ void _TOD_Get_uptime_as_timespec( struct timespec *uptime ) { 63834: 4e56 fff8 linkw %fp,#-8 Timestamp_Control uptime_ts; /* assume time checked for NULL by caller */ _TOD_Get_uptime( &uptime_ts ); 63838: 486e fff8 pea %fp@(-8) 6383c: 4eb9 0006 37c8 jsr 637c8 <_TOD_Get_uptime> _Timestamp_To_timespec( &uptime_ts, uptime ); 63842: 206e 0008 moveal %fp@(8),%a0 63846: 588f addql #4,%sp 63848: 202e fff8 movel %fp@(-8),%d0 6384c: 222e fffc movel %fp@(-4),%d1 } 63850: 4e5e unlk %fp { Timestamp_Control uptime_ts; /* assume time checked for NULL by caller */ _TOD_Get_uptime( &uptime_ts ); _Timestamp_To_timespec( &uptime_ts, uptime ); 63852: 2080 movel %d0,%a0@ 63854: 2141 0004 movel %d1,%a0@(4) } 63858: 4e75 rts ... 00045c5c <_TOD_Handler_initialization>: * * Output parameters: NONE */ void _TOD_Handler_initialization(void) { 45c5c: 4e56 0000 linkw %fp,#0 /* Uptime (timespec) */ _Timestamp_Set_to_zero( &_TOD_Uptime ); /* TOD has not been set */ _TOD_Is_set = false; 45c60: 4200 clrb %d0 _TOD_Activate(); } 45c62: 4e5e unlk %fp /* Uptime (timespec) */ _Timestamp_Set_to_zero( &_TOD_Uptime ); /* TOD has not been set */ _TOD_Is_set = false; 45c64: 13c0 0005 cca8 moveb %d0,5cca8 <_TOD_Is_set> */ void _TOD_Handler_initialization(void) { /* POSIX format TOD (timespec) */ _Timestamp_Set( &_TOD_Now, TOD_SECONDS_1970_THROUGH_1988, 0 ); 45c6a: 203c 21da e500 movel #567993600,%d0 45c70: 42b9 0005 cd2a clrl 5cd2a <_TOD_Now+0x4> 45c76: 23c0 0005 cd26 movel %d0,5cd26 <_TOD_Now> /* Uptime (timespec) */ _Timestamp_Set_to_zero( &_TOD_Uptime ); 45c7c: 42b9 0005 cd12 clrl 5cd12 <_TOD_Uptime> 45c82: 42b9 0005 cd16 clrl 5cd16 <_TOD_Uptime+0x4> /* TOD has not been set */ _TOD_Is_set = false; _TOD_Activate(); } 45c88: 4e75 rts ... 00045844 <_TOD_To_seconds>: */ uint32_t _TOD_To_seconds( const rtems_time_of_day *the_tod ) { 45844: 43f9 0005 c3c2 lea 5c3c2 <_TOD_Days_to_date>,%a1 4584a: 4e56 fff0 linkw %fp,#-16 4584e: 206e 0008 moveal %fp@(8),%a0 45852: 48d7 041c moveml %d2-%d4/%a2,%sp@ uint32_t time; uint32_t year_mod_4; time = the_tod->day - 1; year_mod_4 = the_tod->year & 3; 45856: 2210 movel %a0@,%d1 45858: 7603 moveq #3,%d3 ) { uint32_t time; uint32_t year_mod_4; time = the_tod->day - 1; 4585a: 2028 0008 movel %a0@(8),%d0 4585e: 5380 subql #1,%d0 year_mod_4 = the_tod->year & 3; 45860: c681 andl %d1,%d3 if ( year_mod_4 == 0 ) 45862: 660c bnes 45870 <_TOD_To_seconds+0x2c> time += _TOD_Days_to_date[ 1 ][ the_tod->month ]; 45864: 2428 0004 movel %a0@(4),%d2 45868: 0682 0000 000d addil #13,%d2 4586e: 6004 bras 45874 <_TOD_To_seconds+0x30> else time += _TOD_Days_to_date[ 0 ][ the_tod->month ]; 45870: 2428 0004 movel %a0@(4),%d2 time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) * 45874: 45f9 0005 c3f6 lea 5c3f6 <_TOD_Days_since_last_leap_year>,%a2 4587a: 283c 0000 05b5 movel #1461,%d4 year_mod_4 = the_tod->year & 3; if ( year_mod_4 == 0 ) time += _TOD_Days_to_date[ 1 ][ the_tod->month ]; else time += _TOD_Days_to_date[ 0 ][ the_tod->month ]; 45880: 3431 2a00 movew %a1@(00000000,%d2:l:2),%d2 time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) * 45884: 3632 3a00 movew %a2@(00000000,%d3:l:2),%d3 year_mod_4 = the_tod->year & 3; if ( year_mod_4 == 0 ) time += _TOD_Days_to_date[ 1 ][ the_tod->month ]; else time += _TOD_Days_to_date[ 0 ][ the_tod->month ]; 45888: 0282 0000 ffff andil #65535,%d2 time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) * 4588e: 0283 0000 ffff andil #65535,%d3 year_mod_4 = the_tod->year & 3; if ( year_mod_4 == 0 ) time += _TOD_Days_to_date[ 1 ][ the_tod->month ]; else time += _TOD_Days_to_date[ 0 ][ the_tod->month ]; 45894: 2242 moveal %d2,%a1 45896: d3c0 addal %d0,%a1 time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) * 45898: 2001 movel %d1,%d0 4589a: 0680 ffff f83c addil #-1988,%d0 458a0: e488 lsrl #2,%d0 458a2: 4c04 0800 mulsl %d4,%d0 time *= TOD_SECONDS_PER_DAY; time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute) * TOD_SECONDS_PER_MINUTE; time += the_tod->second; 458a6: 2428 000c movel %a0@(12),%d2 458aa: 2202 movel %d2,%d1 if ( year_mod_4 == 0 ) time += _TOD_Days_to_date[ 1 ][ the_tod->month ]; else time += _TOD_Days_to_date[ 0 ][ the_tod->month ]; time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) * 458ac: d083 addl %d3,%d0 ( (TOD_DAYS_PER_YEAR * 4) + 1); time += _TOD_Days_since_last_leap_year[ year_mod_4 ]; time *= TOD_SECONDS_PER_DAY; 458ae: 263c 0001 5180 movel #86400,%d3 time += _TOD_Days_to_date[ 0 ][ the_tod->month ]; time += ( (the_tod->year - TOD_BASE_YEAR) / 4 ) * ( (TOD_DAYS_PER_YEAR * 4) + 1); time += _TOD_Days_since_last_leap_year[ year_mod_4 ]; 458b4: d089 addl %a1,%d0 time *= TOD_SECONDS_PER_DAY; 458b6: 4c03 0800 mulsl %d3,%d0 time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute) * TOD_SECONDS_PER_MINUTE; time += the_tod->second; 458ba: e58a lsll #2,%d2 458bc: ed89 lsll #6,%d1 458be: 9282 subl %d2,%d1 458c0: d2a8 0010 addl %a0@(16),%d1 458c4: 2401 movel %d1,%d2 458c6: e589 lsll #2,%d1 458c8: ed8a lsll #6,%d2 time += _TOD_Days_since_last_leap_year[ year_mod_4 ]; time *= TOD_SECONDS_PER_DAY; time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute) 458ca: 2068 0014 moveal %a0@(20),%a0 * TOD_SECONDS_PER_MINUTE; time += the_tod->second; 458ce: 9481 subl %d1,%d2 time += _TOD_Days_since_last_leap_year[ year_mod_4 ]; time *= TOD_SECONDS_PER_DAY; time += ((the_tod->hour * TOD_MINUTES_PER_HOUR) + the_tod->minute) 458d0: d1fc 21da e500 addal #567993600,%a0 * TOD_SECONDS_PER_MINUTE; time += the_tod->second; 458d6: d488 addl %a0,%d2 time += TOD_SECONDS_1970_THROUGH_1988; return( time ); } 458d8: d082 addl %d2,%d0 458da: 4cd7 041c moveml %sp@,%d2-%d4/%a2 458de: 4e5e unlk %fp 458e0: 4e75 rts ... 000458e4 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 458e4: 4e56 0000 linkw %fp,#0 458e8: 206e 0008 moveal %fp@(8),%a0 458ec: 2f03 movel %d3,%sp@- uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 458ee: 2039 0005 d630 movel 5d630 ,%d0 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 458f4: 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) || 458f6: 4a88 tstl %a0 458f8: 6762 beqs 4595c <_TOD_Validate+0x78> (the_tod->ticks >= ticks_per_second) || 458fa: 243c 000f 4240 movel #1000000,%d2 45900: 4c40 2002 remul %d0,%d2,%d2 45904: b4a8 0018 cmpl %a0@(24),%d2 45908: 6352 blss 4595c <_TOD_Validate+0x78> (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 4590a: 763b moveq #59,%d3 4590c: b6a8 0014 cmpl %a0@(20),%d3 45910: 654a bcss 4595c <_TOD_Validate+0x78> (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 45912: b6a8 0010 cmpl %a0@(16),%d3 45916: 6544 bcss 4595c <_TOD_Validate+0x78> (the_tod->hour >= TOD_HOURS_PER_DAY) || 45918: 7017 moveq #23,%d0 4591a: b0a8 000c cmpl %a0@(12),%d0 4591e: 653c bcss 4595c <_TOD_Validate+0x78> (the_tod->month == 0) || 45920: 2028 0004 movel %a0@(4),%d0 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) || 45924: 6736 beqs 4595c <_TOD_Validate+0x78> 45926: 720c moveq #12,%d1 45928: b280 cmpl %d0,%d1 4592a: 6530 bcss 4595c <_TOD_Validate+0x78> (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) || 4592c: 2410 movel %a0@,%d2 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) || 4592e: 0c82 0000 07c3 cmpil #1987,%d2 45934: 6326 blss 4595c <_TOD_Validate+0x78> (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) || (the_tod->day == 0) ) 45936: 2228 0008 movel %a0@(8),%d1 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) || 4593a: 6720 beqs 4595c <_TOD_Validate+0x78> (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 4593c: 163c 0003 moveb #3,%d3 45940: 41f9 0005 c3fe lea 5c3fe <_TOD_Days_per_month>,%a0 45946: c483 andl %d3,%d2 45948: 6606 bnes 45950 <_TOD_Validate+0x6c> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 4594a: 2030 0c34 movel %a0@(00000034,%d0:l:4),%d0 4594e: 6004 bras 45954 <_TOD_Validate+0x70> else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 45950: 2030 0c00 movel %a0@(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( 45954: b081 cmpl %d1,%d0 45956: 54c0 scc %d0 45958: 4480 negl %d0 4595a: 6002 bras 4595e <_TOD_Validate+0x7a> 4595c: 4200 clrb %d0 if ( the_tod->day > days_in_month ) return false; return true; } 4595e: 241f movel %sp@+,%d2 45960: 261f movel %sp@+,%d3 45962: 4e5e unlk %fp 45964: 4e75 rts ... 000467e8 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 467e8: 4e56 fff0 linkw %fp,#-16 467ec: 48d7 041c moveml %d2-%d4/%a2,%sp@ 467f0: 246e 0008 moveal %fp@(8),%a2 /* * 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 ); 467f4: 2f0a movel %a2,%sp@- void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 467f6: 262e 000c movel %fp@(12),%d3 */ /* * Save original state */ original_state = the_thread->current_state; 467fa: 242a 0010 movel %a2@(16),%d2 void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 467fe: 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 ); 46802: 4eb9 0004 75e8 jsr 475e8 <_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 ) 46808: 588f addql #4,%sp 4680a: b6aa 0014 cmpl %a2@(20),%d3 4680e: 670c beqs 4681c <_Thread_Change_priority+0x34> _Thread_Set_priority( the_thread, new_priority ); 46810: 2f03 movel %d3,%sp@- 46812: 2f0a movel %a2,%sp@- 46814: 4eb9 0004 7490 jsr 47490 <_Thread_Set_priority> 4681a: 508f addql #8,%sp _ISR_Disable( level ); 4681c: 223c 0000 0700 movel #1792,%d1 46822: 40c0 movew %sr,%d0 46824: 8280 orl %d0,%d1 46826: 46c1 movew %d1,%sr 46828: 7604 moveq #4,%d3 /* * 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; 4682a: 222a 0010 movel %a2@(16),%d1 4682e: c483 andl %d3,%d2 if ( state != STATES_TRANSIENT ) { 46830: b681 cmpl %d1,%d3 46832: 6730 beqs 46864 <_Thread_Change_priority+0x7c> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 46834: 4a82 tstl %d2 46836: 6608 bnes 46840 <_Thread_Change_priority+0x58> the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 46838: 74fb moveq #-5,%d2 4683a: c481 andl %d1,%d2 4683c: 2542 0010 movel %d2,%a2@(16) _ISR_Enable( level ); 46840: 46c0 movew %d0,%sr if ( _States_Is_waiting_on_thread_queue( state ) ) { 46842: 0281 0003 bee0 andil #245472,%d1 46848: 6700 00d2 beqw 4691c <_Thread_Change_priority+0x134> _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 4684c: 2d4a 000c movel %a2,%fp@(12) 46850: 2d6a 0044 0008 movel %a2@(68),%fp@(8) if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Context_Switch_necessary = true; _ISR_Enable( level ); } 46856: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 4685c: 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 ); 4685e: 4ef9 0004 73f4 jmp 473f4 <_Thread_queue_Requeue> } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { 46864: 4a82 tstl %d2 46866: 6650 bnes 468b8 <_Thread_Change_priority+0xd0> RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 46868: 226a 008e moveal %a2@(142),%a1 4686c: 322a 0094 movew %a2@(148),%d1 46870: 3411 movew %a1@,%d2 46872: 206a 008a moveal %a2@(138),%a0 46876: 8282 orl %d2,%d1 * 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 ); 46878: 42aa 0010 clrl %a2@(16) 4687c: 3281 movew %d1,%a1@ _Priority_Major_bit_map |= the_priority_map->ready_major; 4687e: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 46884: 342a 0092 movew %a2@(146),%d2 46888: 8282 orl %d2,%d1 4688a: 33c1 0005 cd44 movew %d1,5cd44 <_Priority_Major_bit_map> _Priority_Add_to_bit_map( &the_thread->Priority_map ); if ( prepend_it ) 46890: 4a04 tstb %d4 46892: 6710 beqs 468a4 <_Thread_Change_priority+0xbc> ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 46894: 2250 moveal %a0@,%a1 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 46896: 2548 0004 movel %a0,%a2@(4) before_node = after_node->next; after_node->next = the_node; 4689a: 208a movel %a2,%a0@ the_node->next = before_node; before_node->previous = the_node; 4689c: 234a 0004 movel %a2,%a1@(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; 468a0: 2489 movel %a1,%a2@ 468a2: 6014 bras 468b8 <_Thread_Change_priority+0xd0> Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 468a4: 2608 movel %a0,%d3 468a6: 5883 addql #4,%d3 468a8: 2483 movel %d3,%a2@ old_last_node = the_chain->last; 468aa: 2268 0008 moveal %a0@(8),%a1 the_chain->last = the_node; 468ae: 214a 0008 movel %a2,%a0@(8) old_last_node->next = the_node; the_node->previous = old_last_node; 468b2: 2549 0004 movel %a1,%a2@(4) Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 468b6: 228a movel %a2,%a1@ _Chain_Prepend_unprotected( the_thread->ready, &the_thread->Object.Node ); else _Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node ); } _ISR_Flash( level ); 468b8: 223c 0000 0700 movel #1792,%d1 468be: 46c0 movew %d0,%sr 468c0: 8280 orl %d0,%d1 468c2: 46c1 movew %d1,%sr RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void ) { Priority_Bit_map_control minor; Priority_Bit_map_control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 468c4: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 468ca: 4841 swap %d1 468cc: 04c1 ff1 %d1 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 468ce: 4282 clrl %d2 468d0: 41f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a0 468d6: 3401 movew %d1,%d2 468d8: 3230 2a00 movew %a0@(00000000,%d2:l:2),%d1 468dc: 4841 swap %d1 468de: 04c1 ff1 %d1 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 468e0: 4283 clrl %d3 468e2: e98a lsll #4,%d2 468e4: 3601 movew %d1,%d3 468e6: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 468ec: 2202 movel %d2,%d1 468ee: d283 addl %d3,%d1 468f0: 2401 movel %d1,%d2 468f2: e58a lsll #2,%d2 468f4: e989 lsll #4,%d1 * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 468f6: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 468fc: 93c2 subal %d2,%a1 468fe: 2231 1800 movel %a1@(00000000,%d1:l),%d1 46902: 23c1 0005 cd22 movel %d1,5cd22 <_Thread_Heir> * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Thread_Calculate_heir(); if ( !_Thread_Is_executing_also_the_heir() && 46908: b288 cmpl %a0,%d1 4690a: 670e beqs 4691a <_Thread_Change_priority+0x132> _Thread_Executing->is_preemptible ) 4690c: 4a28 0075 tstb %a0@(117) 46910: 6708 beqs 4691a <_Thread_Change_priority+0x132> _Context_Switch_necessary = true; 46912: 7201 moveq #1,%d1 46914: 13c1 0005 cd5e moveb %d1,5cd5e <_Context_Switch_necessary> _ISR_Enable( level ); 4691a: 46c0 movew %d0,%sr } 4691c: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 46922: 4e5e unlk %fp 46924: 4e75 rts ... 00046928 <_Thread_Clear_state>: void _Thread_Clear_state( Thread_Control *the_thread, States_Control state ) { 46928: 4e56 ffec linkw %fp,#-20 4692c: 206e 0008 moveal %fp@(8),%a0 46930: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ ISR_Level level; States_Control current_state; _ISR_Disable( level ); 46934: 263c 0000 0700 movel #1792,%d3 4693a: 2203 movel %d3,%d1 void _Thread_Clear_state( Thread_Control *the_thread, States_Control state ) { 4693c: 202e 000c movel %fp@(12),%d0 ISR_Level level; States_Control current_state; _ISR_Disable( level ); 46940: 40c2 movew %sr,%d2 46942: 8282 orl %d2,%d1 46944: 46c1 movew %d1,%sr current_state = the_thread->current_state; 46946: 2228 0010 movel %a0@(16),%d1 if ( current_state & state ) { 4694a: 2800 movel %d0,%d4 4694c: c881 andl %d1,%d4 4694e: 6778 beqs 469c8 <_Thread_Clear_state+0xa0> RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); 46950: 4680 notl %d0 46952: c081 andl %d1,%d0 current_state = 46954: 2140 0010 movel %d0,%a0@(16) the_thread->current_state = _States_Clear( state, current_state ); if ( _States_Is_ready( current_state ) ) { 46958: 666e bnes 469c8 <_Thread_Clear_state+0xa0> RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 4695a: 2668 008e moveal %a0@(142),%a3 4695e: 3028 0094 movew %a0@(148),%d0 46962: 3213 movew %a3@,%d1 _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node); 46964: 2268 008a moveal %a0@(138),%a1 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 46968: 2809 movel %a1,%d4 4696a: 5884 addql #4,%d4 4696c: 8081 orl %d1,%d0 4696e: 2084 movel %d4,%a0@ old_last_node = the_chain->last; 46970: 2469 0008 moveal %a1@(8),%a2 46974: 3680 movew %d0,%a3@ the_chain->last = the_node; 46976: 2348 0008 movel %a0,%a1@(8) _Priority_Major_bit_map |= the_priority_map->ready_major; 4697a: 3039 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d0 46980: 3228 0092 movew %a0@(146),%d1 old_last_node->next = the_node; the_node->previous = old_last_node; 46984: 214a 0004 movel %a2,%a0@(4) 46988: 8081 orl %d1,%d0 Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 4698a: 2488 movel %a0,%a2@ 4698c: 33c0 0005 cd44 movew %d0,5cd44 <_Priority_Major_bit_map> _ISR_Flash( level ); 46992: 2003 movel %d3,%d0 46994: 46c2 movew %d2,%sr 46996: 8082 orl %d2,%d0 46998: 46c0 movew %d0,%sr * a context switch. * Pseudo-ISR case: * Even if the thread isn't preemptible, if the new heir is * a pseudo-ISR system task, we need to do a context switch. */ if ( the_thread->current_priority < _Thread_Heir->current_priority ) { 4699a: 2028 0014 movel %a0@(20),%d0 4699e: 2279 0005 cd22 moveal 5cd22 <_Thread_Heir>,%a1 469a4: b0a9 0014 cmpl %a1@(20),%d0 469a8: 641e bccs 469c8 <_Thread_Clear_state+0xa0> _Thread_Heir = the_thread; 469aa: 23c8 0005 cd22 movel %a0,5cd22 <_Thread_Heir> if ( _Thread_Executing->is_preemptible || 469b0: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 469b6: 4a28 0075 tstb %a0@(117) 469ba: 6604 bnes 469c0 <_Thread_Clear_state+0x98> 469bc: 4a80 tstl %d0 469be: 6608 bnes 469c8 <_Thread_Clear_state+0xa0> the_thread->current_priority == 0 ) _Context_Switch_necessary = true; 469c0: 7001 moveq #1,%d0 469c2: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary> } } } _ISR_Enable( level ); 469c8: 46c2 movew %d2,%sr } 469ca: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 469ce: 4e5e unlk %fp 469d0: 4e75 rts ... 00046aa4 <_Thread_Create_idle>: * * _Thread_Create_idle */ void _Thread_Create_idle( void ) { 46aa4: 4e56 0000 linkw %fp,#0 46aa8: 2f02 movel %d2,%sp@- * This routine allocates an internal thread. */ RTEMS_INLINE_ROUTINE Thread_Control *_Thread_Internal_allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_Thread_Internal_information ); 46aaa: 4879 0005 cde2 pea 5cde2 <_Thread_Internal_information> 46ab0: 4eb9 0004 609c jsr 4609c <_Objects_Allocate> rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 46ab6: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 46abc: 5281 addql #1,%d1 /* * The entire workspace is zeroed during its initialization. Thus, all * fields not explicitly assigned were explicitly zeroed by * _Workspace_Initialization. */ _Thread_Idle = _Thread_Internal_allocate(); 46abe: 23c0 0005 ce24 movel %d0,5ce24 <_Thread_Idle> 46ac4: 23c1 0005 cc94 movel %d1,5cc94 <_Thread_Dispatch_disable_level> * that when _Thread_Initialize unnests dispatch that we do not * do anything stupid. */ _Thread_Disable_dispatch(); _Thread_Initialize( 46aca: 4282 clrl %d2 46acc: 1439 0005 b4e2 moveb 5b4e2 ,%d2 46ad2: 2f3c 4944 4c45 movel #1229212741,%sp@- 46ad8: 2239 0005 b4fc movel 5b4fc ,%d1 46ade: 42a7 clrl %sp@- 46ae0: 2039 0005 b4de movel 5b4de ,%d0 46ae6: 42a7 clrl %sp@- 46ae8: 42a7 clrl %sp@- 46aea: 4878 0001 pea 1 46aee: 2f02 movel %d2,%sp@- 46af0: 42a7 clrl %sp@- 46af2: b280 cmpl %d0,%d1 46af4: 6302 blss 46af8 <_Thread_Create_idle+0x54> 46af6: 2001 movel %d1,%d0 46af8: 2f00 movel %d0,%sp@- 46afa: 42a7 clrl %sp@- 46afc: 2f39 0005 ce24 movel 5ce24 <_Thread_Idle>,%sp@- 46b02: 4879 0005 cde2 pea 5cde2 <_Thread_Internal_information> 46b08: 4eb9 0004 6d94 jsr 46d94 <_Thread_Initialize> * MUST be done before _Thread_Start is invoked. */ _Thread_Heir = _Thread_Executing = _Thread_Idle; _Thread_Start( 46b0e: 4fef 002c lea %sp@(44),%sp 46b12: 4297 clrl %sp@ */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 46b14: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 46b1a: 5381 subql #1,%d1 46b1c: 42a7 clrl %sp@- 46b1e: 2f39 0005 b4f8 movel 5b4f8 ,%sp@- /* * WARNING!!! This is necessary to "kick" start the system and * MUST be done before _Thread_Start is invoked. */ _Thread_Heir = _Thread_Executing = _Thread_Idle; 46b24: 2039 0005 ce24 movel 5ce24 <_Thread_Idle>,%d0 _Thread_Start( 46b2a: 42a7 clrl %sp@- 46b2c: 23c1 0005 cc94 movel %d1,5cc94 <_Thread_Dispatch_disable_level> 46b32: 2f00 movel %d0,%sp@- /* * WARNING!!! This is necessary to "kick" start the system and * MUST be done before _Thread_Start is invoked. */ _Thread_Heir = 46b34: 23c0 0005 cd4e movel %d0,5cd4e <_Thread_Executing> 46b3a: 23c0 0005 cd22 movel %d0,5cd22 <_Thread_Heir> _Thread_Executing = _Thread_Idle; _Thread_Start( 46b40: 4eb9 0004 7734 jsr 47734 <_Thread_Start> Configuration.idle_task, NULL, 0 ); } 46b46: 242e fffc movel %fp@(-4),%d2 * MUST be done before _Thread_Start is invoked. */ _Thread_Heir = _Thread_Executing = _Thread_Idle; _Thread_Start( 46b4a: 4fef 0014 lea %sp@(20),%sp Configuration.idle_task, NULL, 0 ); } 46b4e: 4e5e unlk %fp 46b50: 4e75 rts ... 0004c028 <_Thread_Evaluate_mode>: * * XXX */ bool _Thread_Evaluate_mode( void ) { 4c028: 4e56 0000 linkw %fp,#0 Thread_Control *executing; executing = _Thread_Executing; 4c02c: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 if ( !_States_Is_ready( executing->current_state ) || 4c032: 4aa8 0010 tstl %a0@(16) 4c036: 660e bnes 4c046 <_Thread_Evaluate_mode+0x1e> 4c038: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 4c03e: 6710 beqs 4c050 <_Thread_Evaluate_mode+0x28> ( !_Thread_Is_heir( executing ) && executing->is_preemptible ) ) { 4c040: 4a28 0075 tstb %a0@(117) 4c044: 670a beqs 4c050 <_Thread_Evaluate_mode+0x28> _Context_Switch_necessary = true; 4c046: 7001 moveq #1,%d0 4c048: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary> return true; 4c04e: 6002 bras 4c052 <_Thread_Evaluate_mode+0x2a> 4c050: 4200 clrb %d0 } return false; } 4c052: 4e5e unlk %fp 4c054: 4e75 rts ... 0004a84c <_Thread_Ready>: */ void _Thread_Ready( Thread_Control *the_thread ) { 4a84c: 4e56 ffec linkw %fp,#-20 4a850: 206e 0008 moveal %fp@(8),%a0 4a854: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ ISR_Level level; Thread_Control *heir; _ISR_Disable( level ); 4a858: 243c 0000 0700 movel #1792,%d2 4a85e: 2002 movel %d2,%d0 4a860: 40c1 movew %sr,%d1 4a862: 8081 orl %d1,%d0 4a864: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 4a866: 2668 008e moveal %a0@(142),%a3 4a86a: 3028 0094 movew %a0@(148),%d0 4a86e: 3613 movew %a3@,%d3 the_thread->current_state = STATES_READY; _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node ); 4a870: 2268 008a moveal %a0@(138),%a1 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 4a874: 2809 movel %a1,%d4 4a876: 5884 addql #4,%d4 4a878: 8083 orl %d3,%d0 4a87a: 2084 movel %d4,%a0@ old_last_node = the_chain->last; 4a87c: 2469 0008 moveal %a1@(8),%a2 4a880: 3680 movew %d0,%a3@ the_chain->last = the_node; 4a882: 2348 0008 movel %a0,%a1@(8) _Priority_Major_bit_map |= the_priority_map->ready_major; 4a886: 3039 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d0 4a88c: 3628 0092 movew %a0@(146),%d3 old_last_node->next = the_node; the_node->previous = old_last_node; 4a890: 214a 0004 movel %a2,%a0@(4) 4a894: 8083 orl %d3,%d0 Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 4a896: 2488 movel %a0,%a2@ 4a898: 33c0 0005 cd44 movew %d0,5cd44 <_Priority_Major_bit_map> ISR_Level level; Thread_Control *heir; _ISR_Disable( level ); the_thread->current_state = STATES_READY; 4a89e: 42a8 0010 clrl %a0@(16) _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node ); _ISR_Flash( level ); 4a8a2: 2002 movel %d2,%d0 4a8a4: 46c1 movew %d1,%sr 4a8a6: 8081 orl %d1,%d0 4a8a8: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void ) { Priority_Bit_map_control minor; Priority_Bit_map_control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4a8aa: 3039 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d0 4a8b0: 4840 swap %d0 4a8b2: 04c0 ff1 %d0 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4a8b4: 4282 clrl %d2 4a8b6: 41f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a0 4a8bc: 3400 movew %d0,%d2 4a8be: 3030 2a00 movew %a0@(00000000,%d2:l:2),%d0 4a8c2: 4840 swap %d0 4a8c4: 04c0 ff1 %d0 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 4a8c6: 4283 clrl %d3 4a8c8: e98a lsll #4,%d2 4a8ca: 3600 movew %d0,%d3 4a8cc: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 4a8d2: 2002 movel %d2,%d0 4a8d4: d083 addl %d3,%d0 4a8d6: 2400 movel %d0,%d2 4a8d8: e58a lsll #2,%d2 4a8da: e988 lsll #4,%d0 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 4a8dc: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 4a8e2: 93c2 subal %d2,%a1 4a8e4: 2031 0800 movel %a1@(00000000,%d0:l),%d0 4a8e8: 23c0 0005 cd22 movel %d0,5cd22 <_Thread_Heir> _Thread_Calculate_heir(); heir = _Thread_Heir; if ( !_Thread_Is_executing( heir ) && _Thread_Executing->is_preemptible ) 4a8ee: b1c0 cmpal %d0,%a0 4a8f0: 670e beqs 4a900 <_Thread_Ready+0xb4> 4a8f2: 4a28 0075 tstb %a0@(117) 4a8f6: 6708 beqs 4a900 <_Thread_Ready+0xb4> _Context_Switch_necessary = true; 4a8f8: 7001 moveq #1,%d0 4a8fa: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary> _ISR_Enable( level ); 4a900: 46c1 movew %d1,%sr } 4a902: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 4a906: 4e5e unlk %fp 4a908: 4e75 rts ... 00047c04 <_Thread_Restart>: Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { if ( !_States_Is_dormant( the_thread->current_state ) ) { 47c04: 7001 moveq #1,%d0 bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { 47c06: 4e56 0000 linkw %fp,#0 47c0a: 2f0a movel %a2,%sp@- 47c0c: 246e 0008 moveal %fp@(8),%a2 if ( !_States_Is_dormant( the_thread->current_state ) ) { 47c10: c0aa 0010 andl %a2@(16),%d0 47c14: 4a00 tstb %d0 47c16: 6704 beqs 47c1c <_Thread_Restart+0x18> 47c18: 4200 clrb %d0 47c1a: 6064 bras 47c80 <_Thread_Restart+0x7c> _Thread_Set_transient( the_thread ); 47c1c: 2f0a movel %a2,%sp@- 47c1e: 4eb9 0004 7de0 jsr 47de0 <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); 47c24: 2f2e 0010 movel %fp@(16),%sp@- 47c28: 2f2e 000c movel %fp@(12),%sp@- 47c2c: 2f0a movel %a2,%sp@- 47c2e: 4eb9 0004 b144 jsr 4b144 <_Thread_Reset> _Thread_Load_environment( the_thread ); 47c34: 2f0a movel %a2,%sp@- 47c36: 4eb9 0004 ade0 jsr 4ade0 <_Thread_Load_environment> _Thread_Ready( the_thread ); 47c3c: 2f0a movel %a2,%sp@- 47c3e: 4eb9 0004 b084 jsr 4b084 <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); 47c44: 2f0a movel %a2,%sp@- 47c46: 4eb9 0004 83c8 jsr 483c8 <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) 47c4c: 4fef 001c lea %sp@(28),%sp 47c50: b5f9 0005 d826 cmpal 5d826 <_Thread_Executing>,%a2 47c56: 6626 bnes 47c7e <_Thread_Restart+0x7a> */ RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void ) { #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( _Thread_Executing->fp_context != NULL ) 47c58: 4aaa 0102 tstl %a2@(258) 47c5c: 670c beqs 47c6a <_Thread_Restart+0x66> _Context_Restore_fp( &_Thread_Executing->fp_context ); 47c5e: 486a 0102 pea %a2@(258) 47c62: 4eb9 0004 88b8 jsr 488b8 <_CPU_Context_restore_fp> 47c68: 588f addql #4,%sp #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); 47c6a: 2079 0005 d826 moveal 5d826 <_Thread_Executing>,%a0 47c70: 41e8 00ce lea %a0@(206),%a0 47c74: 2f08 movel %a0,%sp@- 47c76: 4eb9 0004 8776 jsr 48776 <_CPU_Context_Restart_self> 47c7c: 588f addql #4,%sp <== NOT EXECUTED 47c7e: 7001 moveq #1,%d0 return true; } return false; } 47c80: 246e fffc moveal %fp@(-4),%a2 47c84: 4e5e unlk %fp 47c86: 4e75 rts 0004abe4 <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { 4abe4: 4e56 ffec linkw %fp,#-20 4abe8: 206e 0008 moveal %fp@(8),%a0 4abec: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ ISR_Level level; States_Control current_state; _ISR_Disable( level ); 4abf0: 243c 0000 0700 movel #1792,%d2 4abf6: 2002 movel %d2,%d0 4abf8: 40c1 movew %sr,%d1 4abfa: 8081 orl %d1,%d0 4abfc: 46c0 movew %d0,%sr _ISR_Enable( level ); return; } #endif current_state = the_thread->current_state; 4abfe: 2028 0010 movel %a0@(16),%d0 if ( current_state & STATES_SUSPENDED ) { 4ac02: 0800 0001 btst #1,%d0 4ac06: 6778 beqs 4ac80 <_Thread_Resume+0x9c> 4ac08: 76fd moveq #-3,%d3 4ac0a: c083 andl %d3,%d0 current_state = 4ac0c: 2140 0010 movel %d0,%a0@(16) the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); if ( _States_Is_ready( current_state ) ) { 4ac10: 666e bnes 4ac80 <_Thread_Resume+0x9c> RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 4ac12: 2668 008e moveal %a0@(142),%a3 4ac16: 3028 0094 movew %a0@(148),%d0 4ac1a: 3613 movew %a3@,%d3 _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node); 4ac1c: 2268 008a moveal %a0@(138),%a1 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 4ac20: 2809 movel %a1,%d4 4ac22: 5884 addql #4,%d4 4ac24: 8083 orl %d3,%d0 4ac26: 2084 movel %d4,%a0@ old_last_node = the_chain->last; 4ac28: 2469 0008 moveal %a1@(8),%a2 4ac2c: 3680 movew %d0,%a3@ the_chain->last = the_node; 4ac2e: 2348 0008 movel %a0,%a1@(8) _Priority_Major_bit_map |= the_priority_map->ready_major; 4ac32: 3039 0006 1e6c movew 61e6c <_Priority_Major_bit_map>,%d0 4ac38: 3628 0092 movew %a0@(146),%d3 old_last_node->next = the_node; the_node->previous = old_last_node; 4ac3c: 214a 0004 movel %a2,%a0@(4) 4ac40: 8083 orl %d3,%d0 Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 4ac42: 2488 movel %a0,%a2@ 4ac44: 33c0 0006 1e6c movew %d0,61e6c <_Priority_Major_bit_map> _ISR_Flash( level ); 4ac4a: 2002 movel %d2,%d0 4ac4c: 46c1 movew %d1,%sr 4ac4e: 8081 orl %d1,%d0 4ac50: 46c0 movew %d0,%sr if ( the_thread->current_priority < _Thread_Heir->current_priority ) { 4ac52: 2028 0014 movel %a0@(20),%d0 4ac56: 2279 0006 1e4a moveal 61e4a <_Thread_Heir>,%a1 4ac5c: b0a9 0014 cmpl %a1@(20),%d0 4ac60: 641e bccs 4ac80 <_Thread_Resume+0x9c> _Thread_Heir = the_thread; 4ac62: 23c8 0006 1e4a movel %a0,61e4a <_Thread_Heir> if ( _Thread_Executing->is_preemptible || 4ac68: 2079 0006 1e76 moveal 61e76 <_Thread_Executing>,%a0 4ac6e: 4a28 0075 tstb %a0@(117) 4ac72: 6604 bnes 4ac78 <_Thread_Resume+0x94> 4ac74: 4a80 tstl %d0 4ac76: 6608 bnes 4ac80 <_Thread_Resume+0x9c> the_thread->current_priority == 0 ) _Context_Switch_necessary = true; 4ac78: 7001 moveq #1,%d0 4ac7a: 13c0 0006 1e86 moveb %d0,61e86 <_Context_Switch_necessary> } } } _ISR_Enable( level ); 4ac80: 46c1 movew %d1,%sr } 4ac82: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 4ac86: 4e5e unlk %fp 4ac88: 4e75 rts ... 00047500 <_Thread_Set_state>: { ISR_Level level; Chain_Control *ready; ready = the_thread->ready; _ISR_Disable( level ); 47500: 223c 0000 0700 movel #1792,%d1 void _Thread_Set_state( Thread_Control *the_thread, States_Control state ) { 47506: 4e56 fff4 linkw %fp,#-12 4750a: 206e 0008 moveal %fp@(8),%a0 4750e: 48d7 040c moveml %d2-%d3/%a2,%sp@ 47512: 242e 000c movel %fp@(12),%d2 ISR_Level level; Chain_Control *ready; ready = the_thread->ready; 47516: 2268 008a moveal %a0@(138),%a1 _ISR_Disable( level ); 4751a: 40c0 movew %sr,%d0 4751c: 8280 orl %d0,%d1 4751e: 46c1 movew %d1,%sr if ( !_States_Is_ready( the_thread->current_state ) ) { 47520: 2228 0010 movel %a0@(16),%d1 47524: 670c beqs 47532 <_Thread_Set_state+0x32> the_thread->current_state = 47526: 8481 orl %d1,%d2 47528: 2142 0010 movel %d2,%a0@(16) _States_Set( state, the_thread->current_state ); _ISR_Enable( level ); 4752c: 46c0 movew %d0,%sr return; 4752e: 6000 00ae braw 475de <_Thread_Set_state+0xde> } the_thread->current_state = state; if ( _Chain_Has_only_one_node( ready ) ) { 47532: 2229 0008 movel %a1@(8),%d1 _States_Set( state, the_thread->current_state ); _ISR_Enable( level ); return; } the_thread->current_state = state; 47536: 2142 0010 movel %d2,%a0@(16) if ( _Chain_Has_only_one_node( ready ) ) { 4753a: b291 cmpl %a1@,%d1 4753c: 6632 bnes 47570 <_Thread_Set_state+0x70> */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 4753e: 2209 movel %a1,%d1 47540: 5881 addql #4,%d1 RTEMS_INLINE_ROUTINE void _Priority_Remove_from_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; 47542: 2468 008e moveal %a0@(142),%a2 47546: 2281 movel %d1,%a1@ 47548: 3412 movew %a2@,%d2 4754a: 3228 0098 movew %a0@(152),%d1 the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 4754e: 2349 0008 movel %a1,%a1@(8) 47552: c282 andl %d2,%d1 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 47554: 42a9 0004 clrl %a1@(4) 47558: 3481 movew %d1,%a2@ _Chain_Initialize_empty( ready ); _Priority_Remove_from_bit_map( &the_thread->Priority_map ); 4755a: 6620 bnes 4757c <_Thread_Set_state+0x7c> if ( *the_priority_map->minor == 0 ) _Priority_Major_bit_map &= the_priority_map->block_major; 4755c: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 47562: 3428 0096 movew %a0@(150),%d2 47566: c282 andl %d2,%d1 47568: 33c1 0005 cd44 movew %d1,5cd44 <_Priority_Major_bit_map> 4756e: 600c bras 4757c <_Thread_Set_state+0x7c> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 47570: 2250 moveal %a0@,%a1 previous = the_node->previous; 47572: 2468 0004 moveal %a0@(4),%a2 next->previous = previous; previous->next = next; 47576: 2489 movel %a1,%a2@ Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 47578: 234a 0004 movel %a2,%a1@(4) } else _Chain_Extract_unprotected( &the_thread->Object.Node ); _ISR_Flash( level ); 4757c: 223c 0000 0700 movel #1792,%d1 47582: 46c0 movew %d0,%sr 47584: 8280 orl %d0,%d1 47586: 46c1 movew %d1,%sr if ( _Thread_Is_heir( the_thread ) ) 47588: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 4758e: 663c bnes 475cc <_Thread_Set_state+0xcc> RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void ) { Priority_Bit_map_control minor; Priority_Bit_map_control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 47590: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 47596: 4841 swap %d1 47598: 04c1 ff1 %d1 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4759a: 4282 clrl %d2 4759c: 43f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a1 475a2: 3401 movew %d1,%d2 475a4: 3231 2a00 movew %a1@(00000000,%d2:l:2),%d1 475a8: 4841 swap %d1 475aa: 04c1 ff1 %d1 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 475ac: 4283 clrl %d3 475ae: e98a lsll #4,%d2 475b0: 3601 movew %d1,%d3 475b2: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 475b8: 2202 movel %d2,%d1 475ba: d283 addl %d3,%d1 475bc: 2401 movel %d1,%d2 475be: e58a lsll #2,%d2 475c0: e989 lsll #4,%d1 475c2: 93c2 subal %d2,%a1 475c4: d3c1 addal %d1,%a1 475c6: 23d1 0005 cd22 movel %a1@,5cd22 <_Thread_Heir> _Thread_Calculate_heir(); if ( _Thread_Is_executing( the_thread ) ) 475cc: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 475d2: 6608 bnes 475dc <_Thread_Set_state+0xdc> _Context_Switch_necessary = true; 475d4: 7201 moveq #1,%d1 475d6: 13c1 0005 cd5e moveb %d1,5cd5e <_Context_Switch_necessary> _ISR_Enable( level ); 475dc: 46c0 movew %d0,%sr } 475de: 4cd7 040c moveml %sp@,%d2-%d3/%a2 475e2: 4e5e unlk %fp 475e4: 4e75 rts ... 00047664 <_Thread_Stack_Allocate>: size_t _Thread_Stack_Allocate( Thread_Control *the_thread, size_t stack_size ) { 47664: 4e56 0000 linkw %fp,#0 47668: 2039 0005 b4de movel 5b4de ,%d0 4766e: 2f02 movel %d2,%sp@- 47670: 242e 000c movel %fp@(12),%d2 47674: b082 cmpl %d2,%d0 47676: 6302 blss 4767a <_Thread_Stack_Allocate+0x16> 47678: 2400 movel %d0,%d2 * Call ONLY the CPU table stack allocate hook, _or_ the * the RTEMS workspace allocate. This is so the stack free * routine can call the correct deallocation routine. */ if ( Configuration.stack_allocate_hook ) { 4767a: 2079 0005 b504 moveal 5b504 ,%a0 47680: 4a88 tstl %a0 47682: 6706 beqs 4768a <_Thread_Stack_Allocate+0x26> stack_addr = (*Configuration.stack_allocate_hook)( the_stack_size ); 47684: 2f02 movel %d2,%sp@- 47686: 4e90 jsr %a0@ 47688: 6008 bras 47692 <_Thread_Stack_Allocate+0x2e> * get and keep the stack adjust factor, the stack alignment, and * the context initialization sequence in sync. */ the_stack_size = _Stack_Adjust_size( the_stack_size ); stack_addr = _Workspace_Allocate( the_stack_size ); 4768a: 2f02 movel %d2,%sp@- 4768c: 4eb9 0004 7e90 jsr 47e90 <_Workspace_Allocate> } if ( !stack_addr ) 47692: 4a80 tstl %d0 47694: 56c1 sne %d1 the_stack_size = 0; the_thread->Start.stack = stack_addr; 47696: 206e 0008 moveal %fp@(8),%a0 * get and keep the stack adjust factor, the stack alignment, and * the context initialization sequence in sync. */ the_stack_size = _Stack_Adjust_size( the_stack_size ); stack_addr = _Workspace_Allocate( the_stack_size ); 4769a: 588f addql #4,%sp } if ( !stack_addr ) the_stack_size = 0; the_thread->Start.stack = stack_addr; 4769c: 2140 00ca movel %d0,%a0@(202) the_stack_size = _Stack_Adjust_size( the_stack_size ); stack_addr = _Workspace_Allocate( the_stack_size ); } if ( !stack_addr ) 476a0: 1001 moveb %d1,%d0 476a2: 49c0 extbl %d0 the_stack_size = 0; the_thread->Start.stack = stack_addr; return the_stack_size; } 476a4: c082 andl %d2,%d0 476a6: 242e fffc movel %fp@(-4),%d2 476aa: 4e5e unlk %fp 476ac: 4e75 rts ... 00047784 <_Thread_Suspend>: { ISR_Level level; Chain_Control *ready; ready = the_thread->ready; _ISR_Disable( level ); 47784: 223c 0000 0700 movel #1792,%d1 */ void _Thread_Suspend( Thread_Control *the_thread ) { 4778a: 4e56 fff4 linkw %fp,#-12 4778e: 206e 0008 moveal %fp@(8),%a0 47792: 48d7 040c moveml %d2-%d3/%a2,%sp@ ISR_Level level; Chain_Control *ready; ready = the_thread->ready; 47796: 2268 008a moveal %a0@(138),%a1 _ISR_Disable( level ); 4779a: 40c0 movew %sr,%d0 4779c: 8280 orl %d0,%d1 4779e: 46c1 movew %d1,%sr #if defined(RTEMS_ITRON_API) the_thread->suspend_count++; #endif if ( !_States_Is_ready( the_thread->current_state ) ) { 477a0: 2228 0010 movel %a0@(16),%d1 477a4: 670e beqs 477b4 <_Thread_Suspend+0x30> the_thread->current_state = 477a6: 7402 moveq #2,%d2 477a8: 8481 orl %d1,%d2 477aa: 2142 0010 movel %d2,%a0@(16) _States_Set( STATES_SUSPENDED, the_thread->current_state ); _ISR_Enable( level ); 477ae: 46c0 movew %d0,%sr return; 477b0: 6000 00b0 braw 47862 <_Thread_Suspend+0xde> } the_thread->current_state = STATES_SUSPENDED; 477b4: 7202 moveq #2,%d1 if ( _Chain_Has_only_one_node( ready ) ) { 477b6: 2429 0008 movel %a1@(8),%d2 _States_Set( STATES_SUSPENDED, the_thread->current_state ); _ISR_Enable( level ); return; } the_thread->current_state = STATES_SUSPENDED; 477ba: 2141 0010 movel %d1,%a0@(16) if ( _Chain_Has_only_one_node( ready ) ) { 477be: b491 cmpl %a1@,%d2 477c0: 6632 bnes 477f4 <_Thread_Suspend+0x70> */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 477c2: 2209 movel %a1,%d1 477c4: 5881 addql #4,%d1 RTEMS_INLINE_ROUTINE void _Priority_Remove_from_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; 477c6: 2468 008e moveal %a0@(142),%a2 477ca: 2281 movel %d1,%a1@ 477cc: 3412 movew %a2@,%d2 477ce: 3228 0098 movew %a0@(152),%d1 the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 477d2: 2349 0008 movel %a1,%a1@(8) 477d6: c282 andl %d2,%d1 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 477d8: 42a9 0004 clrl %a1@(4) 477dc: 3481 movew %d1,%a2@ _Chain_Initialize_empty( ready ); _Priority_Remove_from_bit_map( &the_thread->Priority_map ); 477de: 6620 bnes 47800 <_Thread_Suspend+0x7c> if ( *the_priority_map->minor == 0 ) _Priority_Major_bit_map &= the_priority_map->block_major; 477e0: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 477e6: 3428 0096 movew %a0@(150),%d2 477ea: c282 andl %d2,%d1 477ec: 33c1 0005 cd44 movew %d1,5cd44 <_Priority_Major_bit_map> 477f2: 600c bras 47800 <_Thread_Suspend+0x7c> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 477f4: 2250 moveal %a0@,%a1 previous = the_node->previous; 477f6: 2468 0004 moveal %a0@(4),%a2 next->previous = previous; previous->next = next; 477fa: 2489 movel %a1,%a2@ Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 477fc: 234a 0004 movel %a2,%a1@(4) } else _Chain_Extract_unprotected( &the_thread->Object.Node ); _ISR_Flash( level ); 47800: 223c 0000 0700 movel #1792,%d1 47806: 46c0 movew %d0,%sr 47808: 8280 orl %d0,%d1 4780a: 46c1 movew %d1,%sr if ( _Thread_Is_heir( the_thread ) ) 4780c: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 47812: 663c bnes 47850 <_Thread_Suspend+0xcc> RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void ) { Priority_Bit_map_control minor; Priority_Bit_map_control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 47814: 3239 0005 cd44 movew 5cd44 <_Priority_Major_bit_map>,%d1 4781a: 4841 swap %d1 4781c: 04c1 ff1 %d1 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4781e: 4282 clrl %d2 47820: 43f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a1 47826: 3401 movew %d1,%d2 47828: 3231 2a00 movew %a1@(00000000,%d2:l:2),%d1 4782c: 4841 swap %d1 4782e: 04c1 ff1 %d1 47830: 4283 clrl %d3 47832: e98a lsll #4,%d2 47834: 3601 movew %d1,%d3 47836: 2279 0005 cc40 moveal 5cc40 <_Thread_Ready_chain>,%a1 4783c: 2202 movel %d2,%d1 4783e: d283 addl %d3,%d1 47840: 2401 movel %d1,%d2 47842: e58a lsll #2,%d2 47844: e989 lsll #4,%d1 47846: 93c2 subal %d2,%a1 47848: d3c1 addal %d1,%a1 4784a: 23d1 0005 cd22 movel %a1@,5cd22 <_Thread_Heir> _Thread_Calculate_heir(); if ( _Thread_Is_executing( the_thread ) ) 47850: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 47856: 6608 bnes 47860 <_Thread_Suspend+0xdc> _Context_Switch_necessary = true; 47858: 7401 moveq #1,%d2 4785a: 13c2 0005 cd5e moveb %d2,5cd5e <_Context_Switch_necessary> _ISR_Enable( level ); 47860: 46c0 movew %d0,%sr } 47862: 4cd7 040c moveml %sp@,%d2-%d3/%a2 47866: 4e5e unlk %fp 47868: 4e75 rts ... 000478dc <_Thread_Yield_processor>: * ready chain * select heir */ void _Thread_Yield_processor( void ) { 478dc: 4e56 fff4 linkw %fp,#-12 ISR_Level level; Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; 478e0: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 * ready chain * select heir */ void _Thread_Yield_processor( void ) { 478e6: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; ready = executing->ready; _ISR_Disable( level ); 478ea: 243c 0000 0700 movel #1792,%d2 478f0: 2002 movel %d2,%d0 ISR_Level level; Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; ready = executing->ready; 478f2: 2268 008a moveal %a0@(138),%a1 _ISR_Disable( level ); 478f6: 40c1 movew %sr,%d1 478f8: 8081 orl %d1,%d0 478fa: 46c0 movew %d0,%sr if ( !_Chain_Has_only_one_node( ready ) ) { 478fc: 2029 0008 movel %a1@(8),%d0 47900: b091 cmpl %a1@,%d0 47902: 6738 beqs 4793c <_Thread_Yield_processor+0x60> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 47904: 2450 moveal %a0@,%a2 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 47906: 2009 movel %a1,%d0 47908: 5880 addql #4,%d0 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4790a: 2668 0004 moveal %a0@(4),%a3 next->previous = previous; previous->next = next; 4790e: 268a movel %a2,%a3@ Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 47910: 254b 0004 movel %a3,%a2@(4) Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 47914: 2080 movel %d0,%a0@ old_last_node = the_chain->last; 47916: 2469 0008 moveal %a1@(8),%a2 the_chain->last = the_node; 4791a: 2348 0008 movel %a0,%a1@(8) old_last_node->next = the_node; the_node->previous = old_last_node; 4791e: 214a 0004 movel %a2,%a0@(4) Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 47922: 2488 movel %a0,%a2@ _Chain_Extract_unprotected( &executing->Object.Node ); _Chain_Append_unprotected( ready, &executing->Object.Node ); _ISR_Flash( level ); 47924: 2002 movel %d2,%d0 47926: 46c1 movew %d1,%sr 47928: 8081 orl %d1,%d0 4792a: 46c0 movew %d0,%sr if ( _Thread_Is_heir( executing ) ) 4792c: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 47932: 6610 bnes 47944 <_Thread_Yield_processor+0x68> _Thread_Heir = (Thread_Control *) ready->first; 47934: 23d1 0005 cd22 movel %a1@,5cd22 <_Thread_Heir> 4793a: 6008 bras 47944 <_Thread_Yield_processor+0x68> _Context_Switch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) 4793c: b1f9 0005 cd22 cmpal 5cd22 <_Thread_Heir>,%a0 47942: 6708 beqs 4794c <_Thread_Yield_processor+0x70> _Context_Switch_necessary = true; 47944: 7001 moveq #1,%d0 47946: 13c0 0005 cd5e moveb %d0,5cd5e <_Context_Switch_necessary> _ISR_Enable( level ); 4794c: 46c1 movew %d1,%sr } 4794e: 4cd7 0c04 moveml %sp@,%d2/%a2-%a3 47952: 4e5e unlk %fp 47954: 4e75 rts ... 00046798 <_Thread_blocking_operation_Cancel>: /* * If the sync state is timed out, this is very likely not needed. * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { 46798: 7202 moveq #2,%d1 Thread_blocking_operation_States sync_state __attribute__((unused)), #endif Thread_Control *the_thread, ISR_Level level ) { 4679a: 4e56 0000 linkw %fp,#0 4679e: 202e 0010 movel %fp@(16),%d0 467a2: 2f0a movel %a2,%sp@- 467a4: 246e 000c moveal %fp@(12),%a2 #endif /* * The thread is not waiting on anything after this completes. */ the_thread->Wait.queue = NULL; 467a8: 42aa 0044 clrl %a2@(68) /* * If the sync state is timed out, this is very likely not needed. * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { 467ac: b2aa 0050 cmpl %a2@(80),%d1 467b0: 6618 bnes 467ca <_Thread_blocking_operation_Cancel+0x32> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 467b2: 123c 0003 moveb #3,%d1 467b6: 2541 0050 movel %d1,%a2@(80) _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 467ba: 46c0 movew %d0,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 467bc: 486a 0048 pea %a2@(72) 467c0: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 467c6: 588f addql #4,%sp 467c8: 6002 bras 467cc <_Thread_blocking_operation_Cancel+0x34> } else _ISR_Enable( level ); 467ca: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 467cc: 2d4a 0008 movel %a2,%fp@(8) #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 467d0: 246e fffc moveal %fp@(-4),%a2 467d4: 203c 1003 fff8 movel #268697592,%d0 467da: 2d40 000c movel %d0,%fp@(12) 467de: 4e5e unlk %fp 467e0: 4ef9 0004 6928 jmp 46928 <_Thread_Clear_state> ... 0004702c <_Thread_queue_Dequeue>: Thread_Control *(*dequeue_p)( Thread_queue_Control * ); Thread_Control *the_thread; ISR_Level level; Thread_blocking_operation_States sync_state; if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) 4702c: 41f9 0004 7088 lea 47088 <_Thread_queue_Dequeue_priority>,%a0 47032: 7001 moveq #1,%d0 */ Thread_Control *_Thread_queue_Dequeue( Thread_queue_Control *the_thread_queue ) { 47034: 4e56 fff4 linkw %fp,#-12 47038: 48d7 040c moveml %d2-%d3/%a2,%sp@ 4703c: 246e 0008 moveal %fp@(8),%a2 Thread_Control *(*dequeue_p)( Thread_queue_Control * ); Thread_Control *the_thread; ISR_Level level; Thread_blocking_operation_States sync_state; if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) 47040: b0aa 0034 cmpl %a2@(52),%d0 47044: 6706 beqs 4704c <_Thread_queue_Dequeue+0x20> 47046: 41f9 0004 a62c lea 4a62c <_Thread_queue_Dequeue_fifo>,%a0 dequeue_p = _Thread_queue_Dequeue_priority; else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */ dequeue_p = _Thread_queue_Dequeue_fifo; the_thread = (*dequeue_p)( the_thread_queue ); 4704c: 2f0a movel %a2,%sp@- 4704e: 4e90 jsr %a0@ _ISR_Disable( level ); 47050: 223c 0000 0700 movel #1792,%d1 47056: 40c2 movew %sr,%d2 47058: 8282 orl %d2,%d1 4705a: 46c1 movew %d1,%sr if ( !the_thread ) { 4705c: 588f addql #4,%sp 4705e: 4a80 tstl %d0 47060: 6618 bnes 4707a <_Thread_queue_Dequeue+0x4e> sync_state = the_thread_queue->sync_state; 47062: 222a 0030 movel %a2@(48),%d1 47066: 7601 moveq #1,%d3 47068: 5381 subql #1,%d1 4706a: b681 cmpl %d1,%d3 4706c: 650c bcss 4707a <_Thread_queue_Dequeue+0x4e> if ( (sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ) { the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 4706e: 7203 moveq #3,%d1 the_thread = _Thread_Executing; 47070: 2039 0005 cd4e movel 5cd4e <_Thread_Executing>,%d0 _ISR_Disable( level ); if ( !the_thread ) { sync_state = the_thread_queue->sync_state; if ( (sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) ) { the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 47076: 2541 0030 movel %d1,%a2@(48) the_thread = _Thread_Executing; } } _ISR_Enable( level ); 4707a: 46c2 movew %d2,%sr return the_thread; } 4707c: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 47082: 4e5e unlk %fp 47084: 4e75 rts ... 0004a62c <_Thread_queue_Dequeue_fifo>: ) { ISR_Level level; Thread_Control *the_thread; _ISR_Disable( level ); 4a62c: 223c 0000 0700 movel #1792,%d1 */ Thread_Control *_Thread_queue_Dequeue_fifo( Thread_queue_Control *the_thread_queue ) { 4a632: 4e56 fff4 linkw %fp,#-12 4a636: 206e 0008 moveal %fp@(8),%a0 4a63a: 48d7 1c00 moveml %a2-%a4,%sp@ ISR_Level level; Thread_Control *the_thread; _ISR_Disable( level ); 4a63e: 40c0 movew %sr,%d0 4a640: 8280 orl %d0,%d1 4a642: 46c1 movew %d1,%sr */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 4a644: 2248 moveal %a0,%a1 4a646: 2459 moveal %a1@+,%a2 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4a648: b3ca cmpal %a2,%a1 4a64a: 674e beqs 4a69a <_Thread_queue_Dequeue_fifo+0x6e> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 4a64c: 2252 moveal %a2@,%a1 if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) { the_thread = (Thread_Control *) 4a64e: 264a moveal %a2,%a3 4a650: 49f9 0004 6928 lea 46928 <_Thread_Clear_state>,%a4 _Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4a656: 7202 moveq #2,%d1 the_chain->first = new_first; 4a658: 2089 movel %a1,%a0@ new_first->previous = _Chain_Head(the_chain); 4a65a: 2348 0004 movel %a0,%a1@(4) if ( !_Chain_Is_empty( &the_thread_queue->Queues.Fifo ) ) { the_thread = (Thread_Control *) _Chain_Get_first_unprotected( &the_thread_queue->Queues.Fifo ); the_thread->Wait.queue = NULL; 4a65e: 42aa 0044 clrl %a2@(68) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4a662: b2aa 0050 cmpl %a2@(80),%d1 4a666: 6710 beqs 4a678 <_Thread_queue_Dequeue_fifo+0x4c> _ISR_Enable( level ); 4a668: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 4a66a: 2f3c 1003 fff8 movel #268697592,%sp@- 4a670: 2f0a movel %a2,%sp@- 4a672: 4e94 jsr %a4@ 4a674: 508f addql #8,%sp 4a676: 6026 bras 4a69e <_Thread_queue_Dequeue_fifo+0x72> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 4a678: 7203 moveq #3,%d1 4a67a: 2541 0050 movel %d1,%a2@(80) _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 4a67e: 46c0 movew %d0,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 4a680: 486a 0048 pea %a2@(72) 4a684: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 4a68a: 2f3c 1003 fff8 movel #268697592,%sp@- 4a690: 2f0a movel %a2,%sp@- 4a692: 4e94 jsr %a4@ 4a694: 4fef 000c lea %sp@(12),%sp 4a698: 6004 bras 4a69e <_Thread_queue_Dequeue_fifo+0x72> #endif return the_thread; } _ISR_Enable( level ); 4a69a: 46c0 movew %d0,%sr 4a69c: 97cb subal %a3,%a3 return NULL; } 4a69e: 200b movel %a3,%d0 4a6a0: 4cee 1c00 fff4 moveml %fp@(-12),%a2-%a4 4a6a6: 4e5e unlk %fp 4a6a8: 4e75 rts ... 00047088 <_Thread_queue_Dequeue_priority>: Chain_Node *new_second_node; Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); 47088: 203c 0000 0700 movel #1792,%d0 */ Thread_Control *_Thread_queue_Dequeue_priority( Thread_queue_Control *the_thread_queue ) { 4708e: 4e56 ffec linkw %fp,#-20 47092: 226e 0008 moveal %fp@(8),%a1 47096: 48d7 3c04 moveml %d2/%a2-%a5,%sp@ Chain_Node *new_second_node; Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); 4709a: 40c1 movew %sr,%d1 4709c: 8081 orl %d1,%d0 4709e: 46c0 movew %d0,%sr 470a0: 4280 clrl %d0 470a2: 2049 moveal %a1,%a0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 470a4: 2408 movel %a0,%d2 470a6: 5882 addql #4,%d2 470a8: b490 cmpl %a0@,%d2 470aa: 6728 beqs 470d4 <_Thread_queue_Dequeue_priority+0x4c> 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 *) 470ac: 2400 movel %d0,%d2 470ae: e588 lsll #2,%d0 470b0: e98a lsll #4,%d2 470b2: 9480 subl %d0,%d2 470b4: 2471 2800 moveal %a1@(00000000,%d2:l),%a2 470b8: 200a movel %a2,%d0 470ba: 0680 0000 003c addil #60,%d0 _ISR_Enable( level ); return NULL; dequeue: the_thread->Wait.queue = NULL; new_first_node = the_thread->Wait.Block2n.first; 470c0: 206a 0038 moveal %a2@(56),%a0 new_first_thread = (Thread_Control *) new_first_node; next_node = the_thread->Object.Node.next; 470c4: 2652 moveal %a2@,%a3 previous_node = the_thread->Object.Node.previous; 470c6: 226a 0004 moveal %a2@(4),%a1 */ _ISR_Enable( level ); return NULL; dequeue: the_thread->Wait.queue = NULL; 470ca: 42aa 0044 clrl %a2@(68) 470ce: b088 cmpl %a0,%d0 470d0: 6614 bnes 470e6 <_Thread_queue_Dequeue_priority+0x5e> 470d2: 6046 bras 4711a <_Thread_queue_Dequeue_priority+0x92> Chain_Node *previous_node; _ISR_Disable( level ); for( index=0 ; index < TASK_QUEUE_DATA_NUMBER_OF_PRIORITY_HEADERS ; index++ ) { 470d4: 5280 addql #1,%d0 470d6: 41e8 000c lea %a0@(12),%a0 Chain_Node *last_node; Chain_Node *next_node; Chain_Node *previous_node; _ISR_Disable( level ); for( index=0 ; 470da: 7404 moveq #4,%d2 470dc: b480 cmpl %d0,%d2 470de: 66c4 bnes 470a4 <_Thread_queue_Dequeue_priority+0x1c> } /* * We did not find a thread to unblock. */ _ISR_Enable( level ); 470e0: 46c1 movew %d1,%sr 470e2: 95ca subal %a2,%a2 return NULL; 470e4: 6078 bras 4715e <_Thread_queue_Dequeue_priority+0xd6> 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 ) ) { last_node = the_thread->Wait.Block2n.last; 470e6: 286a 0040 moveal %a2@(64),%a4 new_second_node = new_first_node->next; 470ea: 2a50 moveal %a0@,%a5 previous_node->next = new_first_node; next_node->previous = new_first_node; 470ec: 2748 0004 movel %a0,%a3@(4) if ( !_Chain_Is_empty( &the_thread->Wait.Block2n ) ) { last_node = the_thread->Wait.Block2n.last; new_second_node = new_first_node->next; previous_node->next = new_first_node; 470f0: 2288 movel %a0,%a1@ next_node->previous = new_first_node; new_first_node->next = next_node; new_first_node->previous = previous_node; 470f2: 2149 0004 movel %a1,%a0@(4) last_node = the_thread->Wait.Block2n.last; new_second_node = new_first_node->next; previous_node->next = new_first_node; next_node->previous = new_first_node; new_first_node->next = next_node; 470f6: 208b movel %a3,%a0@ new_first_node->previous = previous_node; if ( !_Chain_Has_only_one_node( &the_thread->Wait.Block2n ) ) { 470f8: 226a 0040 moveal %a2@(64),%a1 470fc: b3ea 0038 cmpal %a2@(56),%a1 47100: 671e beqs 47120 <_Thread_queue_Dequeue_priority+0x98> /* > two threads on 2-n */ new_second_node->previous = 47102: 43e8 0038 lea %a0@(56),%a1 47106: 2b49 0004 movel %a1,%a5@(4) _Chain_Head( &new_first_thread->Wait.Block2n ); new_first_thread->Wait.Block2n.first = new_second_node; 4710a: 214d 0038 movel %a5,%a0@(56) new_first_thread->Wait.Block2n.last = last_node; 4710e: 214c 0040 movel %a4,%a0@(64) last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n ); 47112: 41e8 003c lea %a0@(60),%a0 47116: 2888 movel %a0,%a4@ 47118: 6006 bras 47120 <_Thread_queue_Dequeue_priority+0x98> } } else { previous_node->next = next_node; next_node->previous = previous_node; 4711a: 2749 0004 movel %a1,%a3@(4) new_first_thread->Wait.Block2n.last = last_node; last_node->next = _Chain_Tail( &new_first_thread->Wait.Block2n ); } } else { previous_node->next = next_node; 4711e: 228b movel %a3,%a1@ 47120: 47f9 0004 6928 lea 46928 <_Thread_Clear_state>,%a3 next_node->previous = previous_node; } if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 47126: 7002 moveq #2,%d0 47128: b0aa 0050 cmpl %a2@(80),%d0 4712c: 6710 beqs 4713e <_Thread_queue_Dequeue_priority+0xb6> _ISR_Enable( level ); 4712e: 46c1 movew %d1,%sr RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 47130: 2f3c 1003 fff8 movel #268697592,%sp@- 47136: 2f0a movel %a2,%sp@- 47138: 4e93 jsr %a3@ 4713a: 508f addql #8,%sp 4713c: 6020 bras 4715e <_Thread_queue_Dequeue_priority+0xd6> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 4713e: 7403 moveq #3,%d2 47140: 2542 0050 movel %d2,%a2@(80) _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 47144: 46c1 movew %d1,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 47146: 486a 0048 pea %a2@(72) 4714a: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 47150: 2f3c 1003 fff8 movel #268697592,%sp@- 47156: 2f0a movel %a2,%sp@- 47158: 4e93 jsr %a3@ 4715a: 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 ); } 4715e: 200a movel %a2,%d0 47160: 4cee 3c04 ffec moveml %fp@(-20),%d2/%a2-%a5 47166: 4e5e unlk %fp 47168: 4e75 rts ... 00047204 <_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 ) { 47204: 4e56 ffe4 linkw %fp,#-28 47208: 206e 000c moveal %fp@(12),%a0 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 4720c: 43e8 003c lea %a0@(60),%a1 Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; 47210: 2028 0014 movel %a0@(20),%d0 Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 47214: 48d7 0c7c moveml %d2-%d6/%a2-%a3,%sp@ _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; 47218: 2400 movel %d0,%d2 4721a: ec8a lsrl #6,%d2 4721c: 2202 movel %d2,%d1 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); 4721e: 283c 0000 0700 movel #1792,%d4 _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; 47224: e989 lsll #4,%d1 47226: e58a lsll #2,%d2 Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 47228: 246e 0008 moveal %fp@(8),%a2 _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; 4722c: 9282 subl %d2,%d1 4722e: 47f2 1800 lea %a2@(00000000,%d1:l),%a3 47232: 2149 0038 movel %a1,%a0@(56) the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 47236: 43e8 0038 lea %a0@(56),%a1 block_state = the_thread_queue->state; 4723a: 2a2a 0038 movel %a2@(56),%d5 4723e: 2149 0040 movel %a1,%a0@(64) RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 47242: 42a8 003c clrl %a0@(60) if ( _Thread_queue_Is_reverse_search( priority ) ) 47246: 0800 0005 btst #5,%d0 4724a: 6660 bnes 472ac <_Thread_queue_Enqueue_priority+0xa8> */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 4724c: 2c0b movel %a3,%d6 4724e: 5886 addql #4,%d6 goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); 47250: 2404 movel %d4,%d2 47252: 40c1 movew %sr,%d1 47254: 8481 orl %d1,%d2 47256: 46c2 movew %d2,%sr search_thread = (Thread_Control *) header->first; 47258: 2253 moveal %a3@,%a1 4725a: 76ff moveq #-1,%d3 while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 4725c: 601e bras 4727c <_Thread_queue_Enqueue_priority+0x78> search_priority = search_thread->current_priority; 4725e: 2629 0014 movel %a1@(20),%d3 if ( priority <= search_priority ) 47262: b680 cmpl %d0,%d3 47264: 641a bccs 47280 <_Thread_queue_Enqueue_priority+0x7c> break; search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); 47266: 2404 movel %d4,%d2 47268: 46c1 movew %d1,%sr 4726a: 8481 orl %d1,%d2 4726c: 46c2 movew %d2,%sr if ( !_States_Are_set( search_thread->current_state, block_state) ) { 4726e: 2405 movel %d5,%d2 47270: c4a9 0010 andl %a1@(16),%d2 47274: 6604 bnes 4727a <_Thread_queue_Enqueue_priority+0x76> _ISR_Enable( level ); 47276: 46c1 movew %d1,%sr <== NOT EXECUTED goto restart_forward_search; 47278: 60d6 bras 47250 <_Thread_queue_Enqueue_priority+0x4c><== NOT EXECUTED } search_thread = (Thread_Control *)search_thread->Object.Node.next; 4727a: 2251 moveal %a1@,%a1 restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->first; while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 4727c: bc89 cmpl %a1,%d6 4727e: 66de bnes 4725e <_Thread_queue_Enqueue_priority+0x5a> 47280: 2401 movel %d1,%d2 } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 47282: 7801 moveq #1,%d4 47284: b8aa 0030 cmpl %a2@(48),%d4 47288: 6600 00a4 bnew 4732e <_Thread_queue_Enqueue_priority+0x12a> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 4728c: 42aa 0030 clrl %a2@(48) if ( priority == search_priority ) 47290: b680 cmpl %d0,%d3 47292: 677e beqs 47312 <_Thread_queue_Enqueue_priority+0x10e> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; 47294: 2669 0004 moveal %a1@(4),%a3 the_node = (Chain_Node *) the_thread; the_node->next = search_node; 47298: 2089 movel %a1,%a0@ the_node->previous = previous_node; 4729a: 214b 0004 movel %a3,%a0@(4) previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 4729e: 214a 0044 movel %a2,%a0@(68) previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; the_node->previous = previous_node; previous_node->next = the_node; 472a2: 2688 movel %a0,%a3@ search_node->previous = the_node; 472a4: 2348 0004 movel %a0,%a1@(4) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 472a8: 46c1 movew %d1,%sr 472aa: 6062 bras 4730e <_Thread_queue_Enqueue_priority+0x10a> return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 472ac: 4283 clrl %d3 472ae: 1639 0005 b4e2 moveb 5b4e2 ,%d3 _ISR_Disable( level ); 472b4: 2404 movel %d4,%d2 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 472b6: 5283 addql #1,%d3 _ISR_Disable( level ); 472b8: 40c1 movew %sr,%d1 472ba: 8481 orl %d1,%d2 472bc: 46c2 movew %d2,%sr search_thread = (Thread_Control *) header->last; 472be: 226b 0008 moveal %a3@(8),%a1 while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 472c2: 6020 bras 472e4 <_Thread_queue_Enqueue_priority+0xe0> search_priority = search_thread->current_priority; 472c4: 2629 0014 movel %a1@(20),%d3 if ( priority >= search_priority ) 472c8: b680 cmpl %d0,%d3 472ca: 631c blss 472e8 <_Thread_queue_Enqueue_priority+0xe4> break; search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); 472cc: 2404 movel %d4,%d2 472ce: 46c1 movew %d1,%sr 472d0: 8481 orl %d1,%d2 472d2: 46c2 movew %d2,%sr if ( !_States_Are_set( search_thread->current_state, block_state) ) { 472d4: 2405 movel %d5,%d2 472d6: c4a9 0010 andl %a1@(16),%d2 472da: 6604 bnes 472e0 <_Thread_queue_Enqueue_priority+0xdc> _ISR_Enable( level ); 472dc: 46c1 movew %d1,%sr goto restart_reverse_search; 472de: 60cc bras 472ac <_Thread_queue_Enqueue_priority+0xa8> } search_thread = (Thread_Control *) 472e0: 2269 0004 moveal %a1@(4),%a1 restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->last; while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 472e4: b7c9 cmpal %a1,%a3 472e6: 66dc bnes 472c4 <_Thread_queue_Enqueue_priority+0xc0> 472e8: 2401 movel %d1,%d2 } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != 472ea: 7801 moveq #1,%d4 472ec: b8aa 0030 cmpl %a2@(48),%d4 472f0: 663c bnes 4732e <_Thread_queue_Enqueue_priority+0x12a> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 472f2: 42aa 0030 clrl %a2@(48) if ( priority == search_priority ) 472f6: b680 cmpl %d0,%d3 472f8: 6718 beqs 47312 <_Thread_queue_Enqueue_priority+0x10e> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; 472fa: 2651 moveal %a1@,%a3 the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; 472fc: 2149 0004 movel %a1,%a0@(4) search_node = (Chain_Node *) search_thread; next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; 47300: 208b movel %a3,%a0@ the_node->previous = search_node; search_node->next = the_node; next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 47302: 214a 0044 movel %a2,%a0@(68) next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; search_node->next = the_node; 47306: 2288 movel %a0,%a1@ next_node->previous = the_node; 47308: 2748 0004 movel %a0,%a3@(4) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 4730c: 46c1 movew %d1,%sr 4730e: 7001 moveq #1,%d0 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 47310: 6026 bras 47338 <_Thread_queue_Enqueue_priority+0x134> 47312: 43e9 003c lea %a1@(60),%a1 equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; 47316: 2669 0004 moveal %a1@(4),%a3 the_node = (Chain_Node *) the_thread; the_node->next = search_node; 4731a: 2089 movel %a1,%a0@ the_node->previous = previous_node; 4731c: 214b 0004 movel %a3,%a0@(4) previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 47320: 214a 0044 movel %a2,%a0@(68) previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; the_node->previous = previous_node; previous_node->next = the_node; 47324: 2688 movel %a0,%a3@ search_node->previous = the_node; 47326: 2348 0004 movel %a0,%a1@(4) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 4732a: 46c2 movew %d2,%sr 4732c: 60e0 bras 4730e <_Thread_queue_Enqueue_priority+0x10a> * For example, the blocking thread could have been given * the mutex by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ *level_p = level; 4732e: 206e 0010 moveal %fp@(16),%a0 return the_thread_queue->sync_state; 47332: 202a 0030 movel %a2@(48),%d0 * For example, the blocking thread could have been given * the mutex by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ *level_p = level; 47336: 2082 movel %d2,%a0@ return the_thread_queue->sync_state; } 47338: 4cd7 0c7c moveml %sp@,%d2-%d6/%a2-%a3 4733c: 4e5e unlk %fp 4733e: 4e75 rts 0004c100 <_Thread_queue_Extract_fifo>: Thread_Control *the_thread ) { ISR_Level level; _ISR_Disable( level ); 4c100: 223c 0000 0700 movel #1792,%d1 void _Thread_queue_Extract_fifo( Thread_queue_Control *the_thread_queue __attribute__((unused)), Thread_Control *the_thread ) { 4c106: 4e56 0000 linkw %fp,#0 4c10a: 2f0a movel %a2,%sp@- 4c10c: 246e 000c moveal %fp@(12),%a2 ISR_Level level; _ISR_Disable( level ); 4c110: 40c0 movew %sr,%d0 4c112: 8280 orl %d0,%d1 4c114: 46c1 movew %d1,%sr if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 4c116: 222a 0010 movel %a2@(16),%d1 4c11a: 0281 0003 bee0 andil #245472,%d1 4c120: 660a bnes 4c12c <_Thread_queue_Extract_fifo+0x2c> _ISR_Enable( level ); 4c122: 46c0 movew %d0,%sr #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 4c124: 246e fffc moveal %fp@(-4),%a2 4c128: 4e5e unlk %fp 4c12a: 4e75 rts ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4c12c: 2052 moveal %a2@,%a0 _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4c12e: 7202 moveq #2,%d1 previous = the_node->previous; 4c130: 226a 0004 moveal %a2@(4),%a1 return; } _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; 4c134: 42aa 0044 clrl %a2@(68) next->previous = previous; previous->next = next; 4c138: 2288 movel %a0,%a1@ Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 4c13a: 2149 0004 movel %a1,%a0@(4) if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4c13e: b2aa 0050 cmpl %a2@(80),%d1 4c142: 6704 beqs 4c148 <_Thread_queue_Extract_fifo+0x48> _ISR_Enable( level ); 4c144: 46c0 movew %d0,%sr 4c146: 6014 bras 4c15c <_Thread_queue_Extract_fifo+0x5c> 4c148: 7203 moveq #3,%d1 4c14a: 2541 0050 movel %d1,%a2@(80) } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 4c14e: 46c0 movew %d0,%sr (void) _Watchdog_Remove( &the_thread->Timer ); 4c150: 486a 0048 pea %a2@(72) 4c154: 4eb9 0004 7d64 jsr 47d64 <_Watchdog_Remove> 4c15a: 588f addql #4,%sp RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 4c15c: 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 } 4c160: 246e fffc moveal %fp@(-4),%a2 4c164: 203c 1003 fff8 movel #268697592,%d0 4c16a: 2d40 000c movel %d0,%fp@(12) 4c16e: 4e5e unlk %fp 4c170: 4ef9 0004 6928 jmp 46928 <_Thread_Clear_state> ... 00047368 <_Thread_queue_Flush>: #else Thread_queue_Flush_callout remote_extract_callout __attribute__((unused)), #endif uint32_t status ) { 47368: 4e56 fff4 linkw %fp,#-12 4736c: 48d7 040c moveml %d2-%d3/%a2,%sp@ 47370: 262e 0008 movel %fp@(8),%d3 Thread_Control *the_thread; while ( (the_thread = _Thread_queue_Dequeue( the_thread_queue )) ) { 47374: 45f9 0004 702c lea 4702c <_Thread_queue_Dequeue>,%a2 #else Thread_queue_Flush_callout remote_extract_callout __attribute__((unused)), #endif uint32_t status ) { 4737a: 242e 0010 movel %fp@(16),%d2 Thread_Control *the_thread; while ( (the_thread = _Thread_queue_Dequeue( the_thread_queue )) ) { 4737e: 6006 bras 47386 <_Thread_queue_Flush+0x1e> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) ( *remote_extract_callout )( the_thread ); else #endif the_thread->Wait.return_code = status; 47380: 2040 moveal %d0,%a0 47382: 2142 0034 movel %d2,%a0@(52) uint32_t status ) { Thread_Control *the_thread; while ( (the_thread = _Thread_queue_Dequeue( the_thread_queue )) ) { 47386: 2f03 movel %d3,%sp@- 47388: 4e92 jsr %a2@ 4738a: 588f addql #4,%sp 4738c: 4a80 tstl %d0 4738e: 66f0 bnes 47380 <_Thread_queue_Flush+0x18> ( *remote_extract_callout )( the_thread ); else #endif the_thread->Wait.return_code = status; } } 47390: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 47396: 4e5e unlk %fp 47398: 4e75 rts ... 0004a804 <_Thread_queue_Process_timeout>: #include void _Thread_queue_Process_timeout( Thread_Control *the_thread ) { 4a804: 4e56 0000 linkw %fp,#0 4a808: 206e 0008 moveal %fp@(8),%a0 Thread_queue_Control *the_thread_queue = the_thread->Wait.queue; 4a80c: 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 && 4a810: 2029 0030 movel %a1@(48),%d0 4a814: 671c beqs 4a832 <_Thread_queue_Process_timeout+0x2e> 4a816: b1f9 0005 cd4e cmpal 5cd4e <_Thread_Executing>,%a0 4a81c: 6614 bnes 4a832 <_Thread_queue_Process_timeout+0x2e> _Thread_Is_executing( the_thread ) ) { if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { 4a81e: 7203 moveq #3,%d1 4a820: b280 cmpl %d0,%d1 4a822: 6722 beqs 4a846 <_Thread_queue_Process_timeout+0x42> the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 4a824: 7002 moveq #2,%d0 */ 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; 4a826: 2169 003c 0034 movel %a1@(60),%a0@(52) the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 4a82c: 2340 0030 movel %d0,%a1@(48) 4a830: 6014 bras 4a846 <_Thread_queue_Process_timeout+0x42> } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; 4a832: 2169 003c 0034 movel %a1@(60),%a0@(52) _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); 4a838: 2f08 movel %a0,%sp@- 4a83a: 2f28 0044 movel %a0@(68),%sp@- 4a83e: 4eb9 0004 a700 jsr 4a700 <_Thread_queue_Extract> 4a844: 508f addql #8,%sp } } 4a846: 4e5e unlk %fp 4a848: 4e75 rts ... 00047458 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 47458: 4e56 fffc linkw %fp,#-4 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 4745c: 486e fffc pea %fp@(-4) 47460: 2f2e 0008 movel %fp@(8),%sp@- 47464: 4eb9 0004 6d08 jsr 46d08 <_Thread_Get> switch ( location ) { 4746a: 508f addql #8,%sp 4746c: 4aae fffc tstl %fp@(-4) 47470: 6618 bnes 4748a <_Thread_queue_Timeout+0x32> #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 47472: 2f00 movel %d0,%sp@- 47474: 4eb9 0004 a804 jsr 4a804 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4747a: 588f addql #4,%sp 4747c: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 47482: 5380 subql #1,%d0 47484: 23c0 0005 cc94 movel %d0,5cc94 <_Thread_Dispatch_disable_level> _Thread_Unnest_dispatch(); break; } } 4748a: 4e5e unlk %fp 4748c: 4e75 rts ... 00049ca8 <_Timer_Manager_initialization>: * * Output parameters: NONE */ void _Timer_Manager_initialization(void) { 49ca8: 4e56 0000 linkw %fp,#0 _Objects_Initialize_information( 49cac: 4878 0004 pea 4 49cb0: 42a7 clrl %sp@- 49cb2: 4878 003c pea 3c 49cb6: 2f39 0005 b4b6 movel 5b4b6 ,%sp@- 49cbc: 4878 0002 pea 2 49cc0: 4878 0002 pea 2 49cc4: 4879 0005 d684 pea 5d684 <_Timer_Information> 49cca: 4eb9 0004 6548 jsr 46548 <_Objects_Initialize_information> /* * Initialize the pointer to the default timer server control block to NULL * indicating that task-based timer support is not initialized. */ _Timer_server = NULL; 49cd0: 4fef 001c lea %sp@(28),%sp } 49cd4: 4e5e unlk %fp /* * Initialize the pointer to the default timer server control block to NULL * indicating that task-based timer support is not initialized. */ _Timer_server = NULL; 49cd6: 42b9 0005 d6be clrl 5d6be <_Timer_server> } 49cdc: 4e75 rts ... 00051644 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 51644: 4e56 ffb4 linkw %fp,#-76 51648: 200e movel %fp,%d0 5164a: 0680 ffff fff4 addil #-12,%d0 51650: 48d7 3cfc moveml %d2-%d7/%a2-%a5,%sp@ 51654: 246e 0008 moveal %fp@(8),%a2 51658: 240e movel %fp,%d2 5165a: 2a0e movel %fp,%d5 5165c: 260e movel %fp,%d3 5165e: 0682 ffff ffe8 addil #-24,%d2 51664: 5185 subql #8,%d5 51666: 0683 ffff ffec addil #-20,%d3 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 5166c: 41ea 0008 lea %a2@(8),%a0 static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 51670: 4bea 0040 lea %a2@(64),%a5 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 51674: 2e0a movel %a2,%d7 /* * This path is for normal forward movement and cases where the * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 51676: 280a movel %a2,%d4 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 51678: 0687 0000 0030 addil #48,%d7 /* * This path is for normal forward movement and cases where the * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 5167e: 0684 0000 0068 addil #104,%d4 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 51684: 49f9 0005 51f4 lea 551f4 <_Watchdog_Adjust_to_chain>,%a4 ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 5168a: 47f9 0005 5284 lea 55284 <_Watchdog_Insert>,%a3 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 51690: 2d48 ffe4 movel %a0,%fp@(-28) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 51694: 2d45 fff4 movel %d5,%fp@(-12) the_chain->permanent_null = NULL; 51698: 42ae fff8 clrl %fp@(-8) the_chain->last = _Chain_Head(the_chain); 5169c: 2d40 fffc movel %d0,%fp@(-4) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 516a0: 2d43 ffe8 movel %d3,%fp@(-24) the_chain->permanent_null = NULL; 516a4: 42ae ffec clrl %fp@(-20) the_chain->last = _Chain_Head(the_chain); 516a8: 2d42 fff0 movel %d2,%fp@(-16) 516ac: 2d4d ffe0 movel %a5,%fp@(-32) { /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; 516b0: 41ee fff4 lea %fp@(-12),%a0 * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 516b4: 3a7c 0700 moveaw #1792,%a5 { /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; 516b8: 2548 0078 movel %a0,%a2@(120) static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 516bc: 2039 0007 552c movel 7552c <_Watchdog_Ticks_since_boot>,%d0 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 516c2: 222a 003c movel %a2@(60),%d1 watchdogs->last_snapshot = snapshot; 516c6: 2540 003c movel %d0,%a2@(60) _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 516ca: 486e ffe8 pea %fp@(-24) 516ce: 9081 subl %d1,%d0 516d0: 2f00 movel %d0,%sp@- 516d2: 2f07 movel %d7,%sp@- 516d4: 4e94 jsr %a4@ static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 516d6: 2039 0007 547a movel 7547a <_TOD_Now>,%d0 /* * Process the seconds chain. Start by checking that the Time * of Day (TOD) has not been set backwards. If it has then * we want to adjust the watchdogs->Chain to indicate this. */ if ( snapshot > last_snapshot ) { 516dc: 4fef 000c lea %sp@(12),%sp Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 516e0: 222a 0074 movel %a2@(116),%d1 /* * Process the seconds chain. Start by checking that the Time * of Day (TOD) has not been set backwards. If it has then * we want to adjust the watchdogs->Chain to indicate this. */ if ( snapshot > last_snapshot ) { 516e4: b280 cmpl %d0,%d1 516e6: 6414 bccs 516fc <_Timer_server_Body+0xb8> /* * This path is for normal forward movement and cases where the * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 516e8: 486e ffe8 pea %fp@(-24) 516ec: 2c00 movel %d0,%d6 516ee: 9c81 subl %d1,%d6 516f0: 2f06 movel %d6,%sp@- 516f2: 2d40 ffdc movel %d0,%fp@(-36) 516f6: 2f04 movel %d4,%sp@- 516f8: 4e94 jsr %a4@ 516fa: 6018 bras 51714 <_Timer_server_Body+0xd0> } else if ( snapshot < last_snapshot ) { 516fc: b280 cmpl %d0,%d1 516fe: 631c blss 5171c <_Timer_server_Body+0xd8> /* * The current TOD is before the last TOD which indicates that * TOD has been set backwards. */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); 51700: 9280 subl %d0,%d1 51702: 2f01 movel %d1,%sp@- 51704: 4878 0001 pea 1 51708: 2d40 ffdc movel %d0,%fp@(-36) 5170c: 2f04 movel %d4,%sp@- 5170e: 4eb9 0005 5174 jsr 55174 <_Watchdog_Adjust> 51714: 202e ffdc movel %fp@(-36),%d0 51718: 4fef 000c lea %sp@(12),%sp } watchdogs->last_snapshot = snapshot; 5171c: 2540 0074 movel %d0,%a2@(116) } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 51720: 202a 0078 movel %a2@(120),%d0 51724: 2f00 movel %d0,%sp@- 51726: 4eb9 0005 2014 jsr 52014 <_Chain_Get> if ( timer == NULL ) { 5172c: 588f addql #4,%sp } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 5172e: 2040 moveal %d0,%a0 if ( timer == NULL ) { 51730: 4a80 tstl %d0 51732: 6724 beqs 51758 <_Timer_server_Body+0x114> static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 51734: 2028 0038 movel %a0@(56),%d0 <== NOT EXECUTED 51738: 7201 moveq #1,%d1 <== NOT EXECUTED 5173a: b280 cmpl %d0,%d1 <== NOT EXECUTED 5173c: 6608 bnes 51746 <_Timer_server_Body+0x102> <== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 5173e: 4868 0010 pea %a0@(16) <== NOT EXECUTED 51742: 2f07 movel %d7,%sp@- <== NOT EXECUTED 51744: 600c bras 51752 <_Timer_server_Body+0x10e> <== NOT EXECUTED } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 51746: 7c03 moveq #3,%d6 <== NOT EXECUTED 51748: bc80 cmpl %d0,%d6 <== NOT EXECUTED 5174a: 66d4 bnes 51720 <_Timer_server_Body+0xdc> <== NOT EXECUTED _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 5174c: 4868 0010 pea %a0@(16) <== NOT EXECUTED 51750: 2f04 movel %d4,%sp@- <== NOT EXECUTED 51752: 4e93 jsr %a3@ <== NOT EXECUTED 51754: 508f addql #8,%sp <== NOT EXECUTED 51756: 60c8 bras 51720 <_Timer_server_Body+0xdc> <== 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 ); 51758: 200d movel %a5,%d0 5175a: 40c1 movew %sr,%d1 5175c: 8081 orl %d1,%d0 5175e: 46c0 movew %d0,%sr if ( _Chain_Is_empty( insert_chain ) ) { 51760: baae fff4 cmpl %fp@(-12),%d5 51764: 6612 bnes 51778 <_Timer_server_Body+0x134> ts->insert_chain = NULL; 51766: 42aa 0078 clrl %a2@(120) _ISR_Enable( level ); 5176a: 46c1 movew %d1,%sr /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 5176c: 3a7c 0700 moveaw #1792,%a5 _Chain_Initialize_empty( &fire_chain ); while ( true ) { _Timer_server_Get_watchdogs_that_fire_now( ts, &insert_chain, &fire_chain ); if ( !_Chain_Is_empty( &fire_chain ) ) { 51770: b6ae ffe8 cmpl %fp@(-24),%d3 51774: 6608 bnes 5177e <_Timer_server_Body+0x13a> 51776: 6042 bras 517ba <_Timer_server_Body+0x176> ts->insert_chain = NULL; _ISR_Enable( level ); break; } else { _ISR_Enable( level ); 51778: 46c1 movew %d1,%sr <== NOT EXECUTED 5177a: 6000 ff40 braw 516bc <_Timer_server_Body+0x78> <== NOT EXECUTED /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 5177e: 220d movel %a5,%d1 51780: 40c0 movew %sr,%d0 51782: 8280 orl %d0,%d1 51784: 46c1 movew %d1,%sr */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 51786: 206e ffe8 moveal %fp@(-24),%a0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 5178a: b688 cmpl %a0,%d3 5178c: 6726 beqs 517b4 <_Timer_server_Body+0x170> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 5178e: 2250 moveal %a0@,%a1 the_chain->first = new_first; 51790: 2d49 ffe8 movel %a1,%fp@(-24) new_first->previous = _Chain_Head(the_chain); 51794: 2342 0004 movel %d2,%a1@(4) watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { 51798: 4a88 tstl %a0 5179a: 6718 beqs 517b4 <_Timer_server_Body+0x170> watchdog->state = WATCHDOG_INACTIVE; 5179c: 42a8 0008 clrl %a0@(8) _ISR_Enable( level ); 517a0: 46c0 movew %d0,%sr /* * The timer server may block here and wait for resources or time. * The system watchdogs are inactive and will remain inactive since * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); 517a2: 2f28 0024 movel %a0@(36),%sp@- 517a6: 2f28 0020 movel %a0@(32),%sp@- 517aa: 2068 001c moveal %a0@(28),%a0 517ae: 4e90 jsr %a0@ } 517b0: 508f addql #8,%sp 517b2: 60ca bras 5177e <_Timer_server_Body+0x13a> watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 517b4: 46c0 movew %d0,%sr 517b6: 6000 fef8 braw 516b0 <_Timer_server_Body+0x6c> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 517ba: 4200 clrb %d0 517bc: 1540 007c moveb %d0,%a2@(124) 517c0: 2039 0007 53e8 movel 753e8 <_Thread_Dispatch_disable_level>,%d0 517c6: 5280 addql #1,%d0 517c8: 23c0 0007 53e8 movel %d0,753e8 <_Thread_Dispatch_disable_level> /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 517ce: 4878 0008 pea 8 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 517d2: 4bf9 0005 53a0 lea 553a0 <_Watchdog_Remove>,%a5 /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 517d8: 2f12 movel %a2@,%sp@- 517da: 4eb9 0005 498c jsr 5498c <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); 517e0: 2f0a movel %a2,%sp@- 517e2: 4eba fd9c jsr %pc@(51580 <_Timer_server_Reset_interval_system_watchdog>) _Timer_server_Reset_tod_system_watchdog( ts ); 517e6: 2f0a movel %a2,%sp@- 517e8: 4eba fdf6 jsr %pc@(515e0 <_Timer_server_Reset_tod_system_watchdog>) _Thread_Enable_dispatch(); 517ec: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> ts->active = true; 517f2: 7201 moveq #1,%d1 517f4: 1541 007c moveb %d1,%a2@(124) static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 517f8: 2f2e ffe4 movel %fp@(-28),%sp@- 517fc: 4e95 jsr %a5@ static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 517fe: 2f2e ffe0 movel %fp@(-32),%sp@- 51802: 4e95 jsr %a5@ 51804: 4fef 0018 lea %sp@(24),%sp 51808: 6000 fea6 braw 516b0 <_Timer_server_Body+0x6c> 0005180c <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 5180c: 4e56 fff0 linkw %fp,#-16 51810: 206e 000c moveal %fp@(12),%a0 51814: 48d7 041c moveml %d2-%d4/%a2,%sp@ 51818: 246e 0008 moveal %fp@(8),%a2 if ( ts->insert_chain == NULL ) { 5181c: 202a 0078 movel %a2@(120),%d0 51820: 6600 00f8 bnew 5191a <_Timer_server_Schedule_operation_method+0x10e> 51824: 2039 0007 53e8 movel 753e8 <_Thread_Dispatch_disable_level>,%d0 5182a: 5280 addql #1,%d0 5182c: 23c0 0007 53e8 movel %d0,753e8 <_Thread_Dispatch_disable_level> * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 51832: 2028 0038 movel %a0@(56),%d0 51836: 7201 moveq #1,%d1 51838: b280 cmpl %d0,%d1 5183a: 6660 bnes 5189c <_Timer_server_Schedule_operation_method+0x90> /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 5183c: 203c 0000 0700 movel #1792,%d0 51842: 40c3 movew %sr,%d3 51844: 8083 orl %d3,%d0 51846: 46c0 movew %d0,%sr snapshot = _Watchdog_Ticks_since_boot; 51848: 2039 0007 552c movel 7552c <_Watchdog_Ticks_since_boot>,%d0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 5184e: 220a movel %a2,%d1 51850: 0681 0000 0034 addil #52,%d1 last_snapshot = ts->Interval_watchdogs.last_snapshot; 51856: 242a 003c movel %a2@(60),%d2 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 5185a: 226a 0030 moveal %a2@(48),%a1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 5185e: b289 cmpl %a1,%d1 51860: 6716 beqs 51878 <_Timer_server_Schedule_operation_method+0x6c> first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; 51862: 2800 movel %d0,%d4 51864: 9882 subl %d2,%d4 delta_interval = first_watchdog->delta_interval; 51866: 2229 0010 movel %a1@(16),%d1 if (delta_interval > delta) { 5186a: b881 cmpl %d1,%d4 5186c: 6504 bcss 51872 <_Timer_server_Schedule_operation_method+0x66> 5186e: 4281 clrl %d1 51870: 6002 bras 51874 <_Timer_server_Schedule_operation_method+0x68> delta_interval -= delta; 51872: 9284 subl %d4,%d1 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 51874: 2341 0010 movel %d1,%a1@(16) } ts->Interval_watchdogs.last_snapshot = snapshot; 51878: 2540 003c movel %d0,%a2@(60) _ISR_Enable( level ); 5187c: 46c3 movew %d3,%sr _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 5187e: 4868 0010 pea %a0@(16) 51882: 486a 0030 pea %a2@(48) 51886: 4eb9 0005 5284 jsr 55284 <_Watchdog_Insert> if ( !ts->active ) { 5188c: 508f addql #8,%sp 5188e: 102a 007c moveb %a2@(124),%d0 51892: 6678 bnes 5190c <_Timer_server_Schedule_operation_method+0x100> _Timer_server_Reset_interval_system_watchdog( ts ); 51894: 2f0a movel %a2,%sp@- 51896: 4eba fce8 jsr %pc@(51580 <_Timer_server_Reset_interval_system_watchdog>) 5189a: 606e bras 5190a <_Timer_server_Schedule_operation_method+0xfe> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 5189c: 7203 moveq #3,%d1 5189e: b280 cmpl %d0,%d1 518a0: 666a bnes 5190c <_Timer_server_Schedule_operation_method+0x100> /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 518a2: 203c 0000 0700 movel #1792,%d0 518a8: 40c3 movew %sr,%d3 518aa: 8083 orl %d3,%d0 518ac: 46c0 movew %d0,%sr 518ae: 200a movel %a2,%d0 518b0: 0680 0000 006c addil #108,%d0 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 518b6: 2239 0007 547a movel 7547a <_TOD_Now>,%d1 last_snapshot = ts->TOD_watchdogs.last_snapshot; 518bc: 242a 0074 movel %a2@(116),%d2 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 518c0: 226a 0068 moveal %a2@(104),%a1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 518c4: b089 cmpl %a1,%d0 518c6: 6720 beqs 518e8 <_Timer_server_Schedule_operation_method+0xdc> if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 518c8: 2029 0010 movel %a1@(16),%d0 if ( snapshot > last_snapshot ) { 518cc: b481 cmpl %d1,%d2 518ce: 6410 bccs 518e0 <_Timer_server_Schedule_operation_method+0xd4> /* * We advanced in time. */ delta = snapshot - last_snapshot; 518d0: 2801 movel %d1,%d4 518d2: 9882 subl %d2,%d4 if (delta_interval > delta) { 518d4: b880 cmpl %d0,%d4 518d6: 6504 bcss 518dc <_Timer_server_Schedule_operation_method+0xd0> 518d8: 4280 clrl %d0 <== NOT EXECUTED 518da: 6008 bras 518e4 <_Timer_server_Schedule_operation_method+0xd8><== NOT EXECUTED delta_interval -= delta; 518dc: 9084 subl %d4,%d0 518de: 6004 bras 518e4 <_Timer_server_Schedule_operation_method+0xd8> } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 518e0: d082 addl %d2,%d0 delta_interval += delta; 518e2: 9081 subl %d1,%d0 } first_watchdog->delta_interval = delta_interval; 518e4: 2340 0010 movel %d0,%a1@(16) } ts->TOD_watchdogs.last_snapshot = snapshot; 518e8: 2541 0074 movel %d1,%a2@(116) _ISR_Enable( level ); 518ec: 46c3 movew %d3,%sr _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 518ee: 4868 0010 pea %a0@(16) 518f2: 486a 0068 pea %a2@(104) 518f6: 4eb9 0005 5284 jsr 55284 <_Watchdog_Insert> if ( !ts->active ) { 518fc: 508f addql #8,%sp 518fe: 102a 007c moveb %a2@(124),%d0 51902: 6608 bnes 5190c <_Timer_server_Schedule_operation_method+0x100> _Timer_server_Reset_tod_system_watchdog( ts ); 51904: 2f0a movel %a2,%sp@- 51906: 4eba fcd8 jsr %pc@(515e0 <_Timer_server_Reset_tod_system_watchdog>) 5190a: 588f addql #4,%sp * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); } } 5190c: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 51912: 4e5e unlk %fp if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 51914: 4ef9 0005 4012 jmp 54012 <_Thread_Enable_dispatch> * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); 5191a: 202a 0078 movel %a2@(120),%d0 <== NOT EXECUTED 5191e: 2d48 000c movel %a0,%fp@(12) <== NOT EXECUTED } } 51922: 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 ); 51928: 2d40 0008 movel %d0,%fp@(8) <== NOT EXECUTED } } 5192c: 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 ); 5192e: 4ef9 0005 1fdc jmp 51fdc <_Chain_Append> <== NOT EXECUTED 00047958 <_Timespec_Add_to>: uint32_t _Timespec_Add_to( struct timespec *time, const struct timespec *add ) { 47958: 4e56 0000 linkw %fp,#0 4795c: 206e 0008 moveal %fp@(8),%a0 47960: 2f0a movel %a2,%sp@- 47962: 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; 47966: 226a 0004 moveal %a2@(4),%a1 4796a: d3e8 0004 addal %a0@(4),%a1 4796e: 2209 movel %a1,%d1 uint32_t _Timespec_Add_to( struct timespec *time, const struct timespec *add ) { uint32_t seconds = add->tv_sec; 47970: 2012 movel %a2@,%d0 /* Add the basics */ time->tv_sec += add->tv_sec; 47972: d190 addl %d0,%a0@ time->tv_nsec += add->tv_nsec; 47974: 2149 0004 movel %a1,%a0@(4) /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 47978: 600a bras 47984 <_Timespec_Add_to+0x2c> time->tv_nsec -= TOD_NANOSECONDS_PER_SECOND; time->tv_sec++; 4797a: 5290 addql #1,%a0@ seconds++; 4797c: 5280 addql #1,%d0 4797e: 0681 c465 3600 addil #-1000000000,%d1 /* 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 ) { 47984: 0c81 3b9a c9ff cmpil #999999999,%d1 4798a: 62ee bhis 4797a <_Timespec_Add_to+0x22> time->tv_sec++; seconds++; } return seconds; } 4798c: 245f moveal %sp@+,%a2 4798e: 4e5e unlk %fp /* 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 ) { 47990: 2141 0004 movel %d1,%a0@(4) time->tv_sec++; seconds++; } return seconds; } 47994: 4e75 rts ... 0004a980 <_Timespec_To_ticks>: */ uint32_t _Timespec_To_ticks( const struct timespec *time ) { 4a980: 4e56 fff4 linkw %fp,#-12 4a984: 48d7 040c moveml %d2-%d3/%a2,%sp@ 4a988: 246e 0008 moveal %fp@(8),%a2 uint32_t ticks; if ( (time->tv_sec == 0) && (time->tv_nsec == 0) ) 4a98c: 2412 movel %a2@,%d2 4a98e: 660a bnes 4a99a <_Timespec_To_ticks+0x1a> 4a990: 4aaa 0004 tstl %a2@(4) 4a994: 6604 bnes 4a99a <_Timespec_To_ticks+0x1a> 4a996: 4280 clrl %d0 4a998: 602a bras 4a9c4 <_Timespec_To_ticks+0x44> return 0; ticks = time->tv_sec * TOD_TICKS_PER_SECOND; 4a99a: 4eb9 0004 c010 jsr 4c010 ticks += time->tv_nsec / rtems_configuration_get_nanoseconds_per_tick(); 4a9a0: 2239 0005 b4f0 movel 5b4f0 ,%d1 4a9a6: 263c 0000 03e8 movel #1000,%d3 4a9ac: 4c03 1800 mulsl %d3,%d1 uint32_t ticks; if ( (time->tv_sec == 0) && (time->tv_nsec == 0) ) return 0; ticks = time->tv_sec * TOD_TICKS_PER_SECOND; 4a9b0: 4c02 0800 mulsl %d2,%d0 ticks += time->tv_nsec / rtems_configuration_get_nanoseconds_per_tick(); 4a9b4: 262a 0004 movel %a2@(4),%d3 4a9b8: 4c41 3003 remul %d1,%d3,%d3 4a9bc: d083 addl %d3,%d0 if (ticks) 4a9be: 6604 bnes 4a9c4 <_Timespec_To_ticks+0x44> 4a9c0: 103c 0001 moveb #1,%d0 return ticks; return 1; } 4a9c4: 4cee 040c fff4 moveml %fp@(-12),%d2-%d3/%a2 4a9ca: 4e5e unlk %fp 4a9cc: 4e75 rts ... 0004a9d0 <_User_extensions_Add_set>: #include void _User_extensions_Add_set( User_extensions_Control *the_extension ) { 4a9d0: 4e56 0000 linkw %fp,#0 4a9d4: 2f0b movel %a3,%sp@- _Chain_Append( &_User_extensions_List, &the_extension->Node ); 4a9d6: 47f9 0004 58d0 lea 458d0 <_Chain_Append>,%a3 #include void _User_extensions_Add_set( User_extensions_Control *the_extension ) { 4a9dc: 2f0a movel %a2,%sp@- 4a9de: 246e 0008 moveal %fp@(8),%a2 _Chain_Append( &_User_extensions_List, &the_extension->Node ); 4a9e2: 2f0a movel %a2,%sp@- 4a9e4: 4879 0005 ce28 pea 5ce28 <_User_extensions_List> 4a9ea: 4e93 jsr %a3@ /* * If a switch handler is present, append it to the switch chain. */ if ( the_extension->Callouts.thread_switch != NULL ) { 4a9ec: 202a 0024 movel %a2@(36),%d0 4a9f0: 508f addql #8,%sp 4a9f2: 6712 beqs 4aa06 <_User_extensions_Add_set+0x36> the_extension->Switch.thread_switch = the_extension->Callouts.thread_switch; _Chain_Append( 4a9f4: 486a 0008 pea %a2@(8) 4a9f8: 4879 0005 cc98 pea 5cc98 <_User_extensions_Switches_list> /* * If a switch handler is present, append it to the switch chain. */ if ( the_extension->Callouts.thread_switch != NULL ) { the_extension->Switch.thread_switch = 4a9fe: 2540 0010 movel %d0,%a2@(16) the_extension->Callouts.thread_switch; _Chain_Append( 4aa02: 4e93 jsr %a3@ 4aa04: 508f addql #8,%sp &_User_extensions_Switches_list, &the_extension->Switch.Node ); } } 4aa06: 246e fff8 moveal %fp@(-8),%a2 4aa0a: 266e fffc moveal %fp@(-4),%a3 4aa0e: 4e5e unlk %fp 4aa10: 4e75 rts ... 00047b02 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 47b02: 4e56 fff0 linkw %fp,#-16 47b06: 48d7 041c moveml %d2-%d4/%a2,%sp@ 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 ); 47b0a: 4282 clrl %d2 47b0c: 142e 000f moveb %fp@(15),%d2 void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 47b10: 282e 0008 movel %fp@(8),%d4 47b14: 262e 0010 movel %fp@(16),%d3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.last ; 47b18: 2479 0005 ce30 moveal 5ce30 <_User_extensions_List+0x8>,%a2 47b1e: 6018 bras 47b38 <_User_extensions_Fatal+0x36> !_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 ) 47b20: 206a 0030 moveal %a2@(48),%a0 47b24: 4a88 tstl %a0 47b26: 670c beqs 47b34 <_User_extensions_Fatal+0x32> (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 47b28: 2f03 movel %d3,%sp@- 47b2a: 2f02 movel %d2,%sp@- 47b2c: 2f04 movel %d4,%sp@- 47b2e: 4e90 jsr %a0@ 47b30: 4fef 000c lea %sp@(12),%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.last ; !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 47b34: 246a 0004 moveal %a2@(4),%a2 { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.last ; !_Chain_Is_head( &_User_extensions_List, the_node ) ; 47b38: b5fc 0005 ce28 cmpal #380456,%a2 47b3e: 66e0 bnes 47b20 <_User_extensions_Fatal+0x1e> the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 47b40: 4cee 041c fff0 moveml %fp@(-16),%d2-%d4/%a2 47b46: 4e5e unlk %fp 47b48: 4e75 rts ... 000479e0 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 479e0: 4e56 ffe4 linkw %fp,#-28 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 479e4: 203c 0005 ce2c movel #380460,%d0 479ea: 23c0 0005 ce28 movel %d0,5ce28 <_User_extensions_List> the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 479f0: 203c 0005 ce28 movel #380456,%d0 479f6: 23c0 0005 ce30 movel %d0,5ce30 <_User_extensions_List+0x8> */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 479fc: 203c 0005 cc9c movel #380060,%d0 47a02: 23c0 0005 cc98 movel %d0,5cc98 <_User_extensions_Switches_list> the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 47a08: 203c 0005 cc98 movel #380056,%d0 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 47a0e: 42b9 0005 ce2c clrl 5ce2c <_User_extensions_List+0x4> 47a14: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%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; 47a18: 2a39 0005 b51a movel 5b51a ,%d5 initial_extensions = Configuration.User_extension_table; 47a1e: 2639 0005 b51e movel 5b51e ,%d3 47a24: 42b9 0005 cc9c clrl 5cc9c <_User_extensions_Switches_list+0x4> the_chain->last = _Chain_Head(the_chain); 47a2a: 23c0 0005 cca0 movel %d0,5cca0 <_User_extensions_Switches_list+0x8> _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 47a30: 4a83 tstl %d3 47a32: 6750 beqs 47a84 <_User_extensions_Handler_initialization+0xa4> extension = (User_extensions_Control *) 47a34: 7834 moveq #52,%d4 47a36: 4c05 4800 mulsl %d5,%d4 _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 47a3a: 4282 clrl %d2 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; 47a3c: 49f9 0004 d23c lea 4d23c ,%a4 _User_extensions_Add_set( extension ); 47a42: 47f9 0004 a9d0 lea 4a9d0 <_User_extensions_Add_set>,%a3 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) 47a48: 2f04 movel %d4,%sp@- 47a4a: 4eb9 0004 7e5c jsr 47e5c <_Workspace_Allocate_or_fatal_error> 47a50: 2440 moveal %d0,%a2 _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 47a52: 2f04 movel %d4,%sp@- 47a54: 42a7 clrl %sp@- 47a56: 2f00 movel %d0,%sp@- 47a58: 4eb9 0004 d2ac jsr 4d2ac 47a5e: 601c bras 47a7c <_User_extensions_Handler_initialization+0x9c> RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; 47a60: 4878 0020 pea 20 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 47a64: 5282 addql #1,%d2 47a66: 2f03 movel %d3,%sp@- 47a68: 486a 0014 pea %a2@(20) 47a6c: 0683 0000 0020 addil #32,%d3 47a72: 4e94 jsr %a4@ _User_extensions_Add_set( extension ); 47a74: 2f0a movel %a2,%sp@- _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; 47a76: 45ea 0034 lea %a2@(52),%a2 47a7a: 4e93 jsr %a3@ extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 47a7c: 4fef 0010 lea %sp@(16),%sp 47a80: ba82 cmpl %d2,%d5 47a82: 62dc bhis 47a60 <_User_extensions_Handler_initialization+0x80> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; } } } 47a84: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 47a8a: 4e5e unlk %fp 47a8c: 4e75 rts ... 000483c8 <_User_extensions_Thread_restart>: #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { 483c8: 4e56 0000 linkw %fp,#0 483cc: 2f0a movel %a2,%sp@- Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.first ; 483ce: 2479 0005 d900 moveal 5d900 <_User_extensions_List>,%a2 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { 483d4: 2f02 movel %d2,%sp@- 483d6: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.first ; 483da: 6016 bras 483f2 <_User_extensions_Thread_restart+0x2a> !_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 ) 483dc: 206a 001c moveal %a2@(28),%a0 483e0: 4a88 tstl %a0 483e2: 670c beqs 483f0 <_User_extensions_Thread_restart+0x28> (*the_extension->Callouts.thread_restart)( 483e4: 2f02 movel %d2,%sp@- 483e6: 2f39 0005 d826 movel 5d826 <_Thread_Executing>,%sp@- 483ec: 4e90 jsr %a0@ 483ee: 508f addql #8,%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.first ; !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 483f0: 2452 moveal %a2@,%a2 483f2: b5fc 0005 d904 cmpal #383236,%a2 483f8: 66e2 bnes 483dc <_User_extensions_Thread_restart+0x14> (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } 483fa: 242e fff8 movel %fp@(-8),%d2 483fe: 246e fffc moveal %fp@(-4),%a2 48402: 4e5e unlk %fp 48404: 4e75 rts ... 00047bd0 <_User_extensions_Thread_start>: #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { 47bd0: 4e56 0000 linkw %fp,#0 47bd4: 2f0a movel %a2,%sp@- Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.first ; 47bd6: 2479 0005 ce28 moveal 5ce28 <_User_extensions_List>,%a2 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { 47bdc: 2f02 movel %d2,%sp@- 47bde: 242e 0008 movel %fp@(8),%d2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.first ; 47be2: 6016 bras 47bfa <_User_extensions_Thread_start+0x2a> !_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 ) 47be4: 206a 0018 moveal %a2@(24),%a0 47be8: 4a88 tstl %a0 47bea: 670c beqs 47bf8 <_User_extensions_Thread_start+0x28> (*the_extension->Callouts.thread_start)( 47bec: 2f02 movel %d2,%sp@- 47bee: 2f39 0005 cd4e movel 5cd4e <_Thread_Executing>,%sp@- 47bf4: 4e90 jsr %a0@ 47bf6: 508f addql #8,%sp Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _User_extensions_List.first ; !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 47bf8: 2452 moveal %a2@,%a2 47bfa: b5fc 0005 ce2c cmpal #380460,%a2 47c00: 66e2 bnes 47be4 <_User_extensions_Thread_start+0x14> (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } 47c02: 242e fff8 movel %fp@(-8),%d2 47c06: 246e fffc moveal %fp@(-4),%a2 47c0a: 4e5e unlk %fp 47c0c: 4e75 rts ... 00047d18 <_Watchdog_Handler_initialization>: */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 47d18: 43f9 0005 cd6c lea 5cd6c <_Watchdog_Ticks_chain>,%a1 47d1e: 41f9 0005 cd60 lea 5cd60 <_Watchdog_Seconds_chain>,%a0 * * Output parameters: NONE */ void _Watchdog_Handler_initialization( void ) { 47d24: 4e56 0000 linkw %fp,#0 _Watchdog_Sync_level = 0; _Watchdog_Ticks_since_boot = 0; _Chain_Initialize_empty( &_Watchdog_Ticks_chain ); _Chain_Initialize_empty( &_Watchdog_Seconds_chain ); } 47d28: 4e5e unlk %fp * Output parameters: NONE */ void _Watchdog_Handler_initialization( void ) { _Watchdog_Sync_count = 0; 47d2a: 42b9 0005 cdd4 clrl 5cdd4 <_Watchdog_Sync_count> _Watchdog_Sync_level = 0; 47d30: 42b9 0005 cd4a clrl 5cd4a <_Watchdog_Sync_level> the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 47d36: 23c9 0005 cd74 movel %a1,5cd74 <_Watchdog_Ticks_chain+0x8> 47d3c: 23c8 0005 cd68 movel %a0,5cd68 <_Watchdog_Seconds_chain+0x8> _Watchdog_Ticks_since_boot = 0; 47d42: 42b9 0005 cdd8 clrl 5cdd8 <_Watchdog_Ticks_since_boot> */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 47d48: 22bc 0005 cd70 movel #380272,%a1@ the_chain->permanent_null = NULL; 47d4e: 42b9 0005 cd70 clrl 5cd70 <_Watchdog_Ticks_chain+0x4> */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 47d54: 20bc 0005 cd64 movel #380260,%a0@ the_chain->permanent_null = NULL; 47d5a: 42b9 0005 cd64 clrl 5cd64 <_Watchdog_Seconds_chain+0x4> _Chain_Initialize_empty( &_Watchdog_Ticks_chain ); _Chain_Initialize_empty( &_Watchdog_Seconds_chain ); } 47d60: 4e75 rts ... 00047c48 <_Watchdog_Insert>: Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; _ISR_Disable( level ); 47c48: 327c 0700 moveaw #1792,%a1 47c4c: 2009 movel %a1,%d0 void _Watchdog_Insert( Chain_Control *header, Watchdog_Control *the_watchdog ) { 47c4e: 4e56 ffec linkw %fp,#-20 47c52: 206e 000c moveal %fp@(12),%a0 47c56: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 47c5a: 266e 0008 moveal %fp@(8),%a3 Watchdog_Control *after; uint32_t insert_isr_nest_level; Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; 47c5e: 2439 0005 cd2e movel 5cd2e <_ISR_Nest_level>,%d2 _ISR_Disable( level ); 47c64: 40c1 movew %sr,%d1 47c66: 8081 orl %d1,%d0 47c68: 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 ) { 47c6a: 4aa8 0008 tstl %a0@(8) 47c6e: 6706 beqs 47c76 <_Watchdog_Insert+0x2e> _ISR_Enable( level ); 47c70: 46c1 movew %d1,%sr return; 47c72: 6000 009a braw 47d0e <_Watchdog_Insert+0xc6> } the_watchdog->state = WATCHDOG_BEING_INSERTED; _Watchdog_Sync_count++; 47c76: 2039 0005 cdd4 movel 5cdd4 <_Watchdog_Sync_count>,%d0 47c7c: 5280 addql #1,%d0 * used around this flash point allowed interrupts to execute * which violated the design assumptions. The critical section * mechanism used here WAS redesigned to address this. */ _ISR_Flash( level ); 47c7e: 2449 moveal %a1,%a2 _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; _Watchdog_Sync_count++; 47c80: 23c0 0005 cdd4 movel %d0,5cdd4 <_Watchdog_Sync_count> if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; 47c86: 7001 moveq #1,%d0 47c88: 2140 0008 movel %d0,%a0@(8) _Watchdog_Sync_count++; restart: delta_interval = the_watchdog->initial; 47c8c: 2028 000c movel %a0@(12),%d0 * cache *header!! * * Till Straumann, 7/2003 (gcc-3.2.2 -O4 on powerpc) * */ for ( after = (Watchdog_Control *) ((volatile Chain_Control *)header)->first ; 47c90: 2253 moveal %a3@,%a1 ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) 47c92: 4a80 tstl %d0 47c94: 673c beqs 47cd2 <_Watchdog_Insert+0x8a> 47c96: 4a91 tstl %a1@ 47c98: 6738 beqs 47cd2 <_Watchdog_Insert+0x8a> break; if ( delta_interval < after->delta_interval ) { 47c9a: 2629 0010 movel %a1@(16),%d3 47c9e: b680 cmpl %d0,%d3 47ca0: 6308 blss 47caa <_Watchdog_Insert+0x62> after->delta_interval -= delta_interval; 47ca2: 9680 subl %d0,%d3 47ca4: 2343 0010 movel %d3,%a1@(16) break; 47ca8: 6028 bras 47cd2 <_Watchdog_Insert+0x8a> * used around this flash point allowed interrupts to execute * which violated the design assumptions. The critical section * mechanism used here WAS redesigned to address this. */ _ISR_Flash( level ); 47caa: 280a movel %a2,%d4 47cac: 46c1 movew %d1,%sr 47cae: 8881 orl %d1,%d4 47cb0: 46c4 movew %d4,%sr if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; 47cb2: 9083 subl %d3,%d0 * mechanism used here WAS redesigned to address this. */ _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { 47cb4: 7601 moveq #1,%d3 47cb6: b6a8 0008 cmpl %a0@(8),%d3 47cba: 663c bnes 47cf8 <_Watchdog_Insert+0xb0> goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { 47cbc: 2639 0005 cd4a movel 5cd4a <_Watchdog_Sync_level>,%d3 47cc2: b483 cmpl %d3,%d2 47cc4: 6408 bccs 47cce <_Watchdog_Insert+0x86> _Watchdog_Sync_level = insert_isr_nest_level; 47cc6: 23c2 0005 cd4a movel %d2,5cd4a <_Watchdog_Sync_level> goto restart; 47ccc: 60be bras 47c8c <_Watchdog_Insert+0x44> RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_Next( Watchdog_Control *the_watchdog ) { return ( (Watchdog_Control *) the_watchdog->Node.next ); 47cce: 2251 moveal %a1@,%a1 } } 47cd0: 60c0 bras 47c92 <_Watchdog_Insert+0x4a> _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); 47cd2: 2269 0004 moveal %a1@(4),%a1 the_watchdog->start_time = _Watchdog_Ticks_since_boot; 47cd6: 2639 0005 cdd8 movel 5cdd8 <_Watchdog_Ticks_since_boot>,%d3 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 47cdc: 2451 moveal %a1@,%a2 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 47cde: 2149 0004 movel %a1,%a0@(4) before_node = after_node->next; after_node->next = the_node; 47ce2: 2288 movel %a0,%a1@ } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; 47ce4: 2140 0010 movel %d0,%a0@(16) RTEMS_INLINE_ROUTINE void _Watchdog_Activate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_ACTIVE; 47ce8: 7002 moveq #2,%d0 _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); the_watchdog->start_time = _Watchdog_Ticks_since_boot; 47cea: 2143 0014 movel %d3,%a0@(20) the_node->next = before_node; before_node->previous = the_node; 47cee: 2548 0004 movel %a0,%a2@(4) 47cf2: 2140 0008 movel %d0,%a0@(8) Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; 47cf6: 208a movel %a2,%a0@ exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; 47cf8: 23c2 0005 cd4a movel %d2,5cd4a <_Watchdog_Sync_level> _Watchdog_Sync_count--; 47cfe: 2039 0005 cdd4 movel 5cdd4 <_Watchdog_Sync_count>,%d0 47d04: 5380 subql #1,%d0 47d06: 23c0 0005 cdd4 movel %d0,5cdd4 <_Watchdog_Sync_count> _ISR_Enable( level ); 47d0c: 46c1 movew %d1,%sr } 47d0e: 4cd7 0c1c moveml %sp@,%d2-%d4/%a2-%a3 47d12: 4e5e unlk %fp 47d14: 4e75 rts ... 00047de0 <_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 ); 47de0: 203c 0000 0700 movel #1792,%d0 */ void _Watchdog_Tickle( Chain_Control *header ) { 47de6: 4e56 ffe8 linkw %fp,#-24 47dea: 48d7 3c0c moveml %d2-%d3/%a2-%a5,%sp@ 47dee: 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 ); 47df2: 40c2 movew %sr,%d2 47df4: 8082 orl %d2,%d0 47df6: 46c0 movew %d0,%sr */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 47df8: 264c moveal %a4,%a3 47dfa: 245b moveal %a3@+,%a2 if ( _Chain_Is_empty( header ) ) 47dfc: b7ca cmpal %a2,%a3 47dfe: 674e beqs 47e4e <_Watchdog_Tickle+0x6e> * 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) { 47e00: 202a 0010 movel %a2@(16),%d0 47e04: 6708 beqs 47e0e <_Watchdog_Tickle+0x2e> the_watchdog->delta_interval--; 47e06: 5380 subql #1,%d0 47e08: 2540 0010 movel %d0,%a2@(16) if ( the_watchdog->delta_interval != 0 ) 47e0c: 6640 bnes 47e4e <_Watchdog_Tickle+0x6e> goto leave; } do { watchdog_state = _Watchdog_Remove( the_watchdog ); 47e0e: 4bf9 0004 7d64 lea 47d64 <_Watchdog_Remove>,%a5 case WATCHDOG_REMOVE_IT: break; } _ISR_Disable( level ); 47e14: 263c 0000 0700 movel #1792,%d3 if ( the_watchdog->delta_interval != 0 ) goto leave; } do { watchdog_state = _Watchdog_Remove( the_watchdog ); 47e1a: 2f0a movel %a2,%sp@- 47e1c: 4e95 jsr %a5@ _ISR_Enable( level ); 47e1e: 46c2 movew %d2,%sr switch( watchdog_state ) { 47e20: 7202 moveq #2,%d1 47e22: 588f addql #4,%sp 47e24: b280 cmpl %d0,%d1 47e26: 6610 bnes 47e38 <_Watchdog_Tickle+0x58> case WATCHDOG_ACTIVE: (*the_watchdog->routine)( 47e28: 2f2a 0024 movel %a2@(36),%sp@- 47e2c: 2f2a 0020 movel %a2@(32),%sp@- 47e30: 206a 001c moveal %a2@(28),%a0 47e34: 4e90 jsr %a0@ 47e36: 508f addql #8,%sp case WATCHDOG_REMOVE_IT: break; } _ISR_Disable( level ); 47e38: 2003 movel %d3,%d0 47e3a: 40c2 movew %sr,%d2 47e3c: 8082 orl %d2,%d0 47e3e: 46c0 movew %d0,%sr RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) header->first ); 47e40: 2014 movel %a4@,%d0 47e42: 2440 moveal %d0,%a2 the_watchdog = _Watchdog_First( header ); } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); 47e44: b7c0 cmpal %d0,%a3 47e46: 6706 beqs 47e4e <_Watchdog_Tickle+0x6e> 47e48: 4aaa 0010 tstl %a2@(16) 47e4c: 67cc beqs 47e1a <_Watchdog_Tickle+0x3a> leave: _ISR_Enable(level); 47e4e: 46c2 movew %d2,%sr } 47e50: 4cee 3c0c ffe8 moveml %fp@(-24),%d2-%d3/%a2-%a5 47e56: 4e5e unlk %fp 47e58: 4e75 rts ... 0005a41c <_execve>: int _execve( const char *path __attribute__((unused)), char *const argv[] __attribute__((unused)), char *const envp[] __attribute__((unused)) ) { 5a41c: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 5a420: 4eb9 0004 d430 jsr 4d430 <__errno> 5a426: 7258 moveq #88,%d1 5a428: 2040 moveal %d0,%a0 } 5a42a: 70ff moveq #-1,%d0 5a42c: 4e5e unlk %fp const char *path __attribute__((unused)), char *const argv[] __attribute__((unused)), char *const envp[] __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 5a42e: 2081 movel %d1,%a0@ } 5a430: 4e75 rts ... 00044e40 : int aio_cancel( int filedes __attribute__((unused)), struct aiocb *aiocbp __attribute__((unused)) ) { 44e40: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44e44: 4eb9 0004 d430 jsr 4d430 <__errno> 44e4a: 7258 moveq #88,%d1 44e4c: 2040 moveal %d0,%a0 } 44e4e: 70ff moveq #-1,%d0 44e50: 4e5e unlk %fp int aio_cancel( int filedes __attribute__((unused)), struct aiocb *aiocbp __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44e52: 2081 movel %d1,%a0@ } 44e54: 4e75 rts ... 00044e58 : #include int aio_error( const struct aiocb *aiocbp __attribute__((unused)) ) { 44e58: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44e5c: 4eb9 0004 d430 jsr 4d430 <__errno> 44e62: 7258 moveq #88,%d1 44e64: 2040 moveal %d0,%a0 } 44e66: 70ff moveq #-1,%d0 44e68: 4e5e unlk %fp int aio_error( const struct aiocb *aiocbp __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44e6a: 2081 movel %d1,%a0@ } 44e6c: 4e75 rts ... 00044e70 : int aio_fsync( int op __attribute__((unused)), struct aiocb *aiocbp __attribute__((unused)) ) { 44e70: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44e74: 4eb9 0004 d430 jsr 4d430 <__errno> 44e7a: 7258 moveq #88,%d1 44e7c: 2040 moveal %d0,%a0 } 44e7e: 70ff moveq #-1,%d0 44e80: 4e5e unlk %fp int aio_fsync( int op __attribute__((unused)), struct aiocb *aiocbp __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44e82: 2081 movel %d1,%a0@ } 44e84: 4e75 rts ... 00044e88 : #include int aio_read( struct aiocb *aiocbp __attribute__((unused)) ) { 44e88: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44e8c: 4eb9 0004 d430 jsr 4d430 <__errno> 44e92: 7258 moveq #88,%d1 44e94: 2040 moveal %d0,%a0 } 44e96: 70ff moveq #-1,%d0 44e98: 4e5e unlk %fp int aio_read( struct aiocb *aiocbp __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44e9a: 2081 movel %d1,%a0@ } 44e9c: 4e75 rts ... 00044ea0 : #include int aio_return( const struct aiocb *aiocbp __attribute__((unused)) ) { 44ea0: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44ea4: 4eb9 0004 d430 jsr 4d430 <__errno> 44eaa: 7258 moveq #88,%d1 44eac: 2040 moveal %d0,%a0 } 44eae: 70ff moveq #-1,%d0 44eb0: 4e5e unlk %fp int aio_return( const struct aiocb *aiocbp __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44eb2: 2081 movel %d1,%a0@ } 44eb4: 4e75 rts ... 00044eb8 : int aio_suspend( const struct aiocb * const list[] __attribute__((unused)), int nent __attribute__((unused)), const struct timespec *timeout __attribute__((unused)) ) { 44eb8: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44ebc: 4eb9 0004 d430 jsr 4d430 <__errno> 44ec2: 7258 moveq #88,%d1 44ec4: 2040 moveal %d0,%a0 } 44ec6: 70ff moveq #-1,%d0 44ec8: 4e5e unlk %fp const struct aiocb * const list[] __attribute__((unused)), int nent __attribute__((unused)), const struct timespec *timeout __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44eca: 2081 movel %d1,%a0@ } 44ecc: 4e75 rts ... 00044ed0 : #include int aio_write( struct aiocb *aiocbp __attribute__((unused)) ) { 44ed0: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44ed4: 4eb9 0004 d430 jsr 4d430 <__errno> 44eda: 7258 moveq #88,%d1 44edc: 2040 moveal %d0,%a0 } 44ede: 70ff moveq #-1,%d0 44ee0: 4e5e unlk %fp int aio_write( struct aiocb *aiocbp __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44ee2: 2081 movel %d1,%a0@ } 44ee4: 4e75 rts ... 00044ee8 : int clock_getcpuclockid( pid_t pid, clockid_t *clock_id ) { 44ee8: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44eec: 4eb9 0004 d430 jsr 4d430 <__errno> 44ef2: 7258 moveq #88,%d1 44ef4: 2040 moveal %d0,%a0 } 44ef6: 70ff moveq #-1,%d0 44ef8: 4e5e unlk %fp int clock_getcpuclockid( pid_t pid, clockid_t *clock_id ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44efa: 2081 movel %d1,%a0@ } 44efc: 4e75 rts ... 00044f00 : int clock_getenable_attr( clockid_t clock_id, int *attr ) { 44f00: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44f04: 4eb9 0004 d430 jsr 4d430 <__errno> 44f0a: 7258 moveq #88,%d1 44f0c: 2040 moveal %d0,%a0 } 44f0e: 70ff moveq #-1,%d0 44f10: 4e5e unlk %fp int clock_getenable_attr( clockid_t clock_id, int *attr ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44f12: 2081 movel %d1,%a0@ } 44f14: 4e75 rts ... 00044f18 : int clock_setenable_attr( clockid_t clock_id, int attr ) { 44f18: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44f1c: 4eb9 0004 d430 jsr 4d430 <__errno> 44f22: 7258 moveq #88,%d1 44f24: 2040 moveal %d0,%a0 } 44f26: 70ff moveq #-1,%d0 44f28: 4e5e unlk %fp int clock_setenable_attr( clockid_t clock_id, int attr ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44f2a: 2081 movel %d1,%a0@ } 44f2c: 4e75 rts ... 00044f30 : int filedes __attribute__((unused)), void *dev_data_ptr __attribute__((unused)), size_t nbyte __attribute__((unused)), int *dev_info_ptr __attribute__((unused)) ) { 44f30: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44f34: 4eb9 0004 d430 jsr 4d430 <__errno> 44f3a: 7258 moveq #88,%d1 44f3c: 2040 moveal %d0,%a0 } 44f3e: 70ff moveq #-1,%d0 44f40: 4e5e unlk %fp void *dev_data_ptr __attribute__((unused)), size_t nbyte __attribute__((unused)), int *dev_info_ptr __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44f42: 2081 movel %d1,%a0@ } 44f44: 4e75 rts ... 00044f48 : #include #include int fork( void ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44f48: 4e56 0000 linkw %fp,#0 44f4c: 4eb9 0004 d430 jsr 4d430 <__errno> 44f52: 7258 moveq #88,%d1 44f54: 2040 moveal %d0,%a0 } 44f56: 70ff moveq #-1,%d0 44f58: 4e5e unlk %fp #include #include int fork( void ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44f5a: 2081 movel %d1,%a0@ } 44f5c: 4e75 rts ... 00044bc0 : int getitimer( int which, struct itimerval *value ) { 44bc0: 4e56 0000 linkw %fp,#0 if ( !value ) 44bc4: 4aae 000c tstl %fp@(12) 44bc8: 660e bnes 44bd8 rtems_set_errno_and_return_minus_one( EFAULT ); 44bca: 4eb9 0004 d024 jsr 4d024 <__errno> 44bd0: 2040 moveal %d0,%a0 44bd2: 700e moveq #14,%d0 44bd4: 2080 movel %d0,%a0@ 44bd6: 6020 bras 44bf8 44bd8: 41f9 0004 d024 lea 4d024 <__errno>,%a0 switch ( which ) { 44bde: 7002 moveq #2,%d0 44be0: b0ae 0008 cmpl %fp@(8),%d0 44be4: 650a bcss 44bf0 case ITIMER_REAL: case ITIMER_VIRTUAL: case ITIMER_PROF: rtems_set_errno_and_return_minus_one( ENOSYS ); 44be6: 4e90 jsr %a0@ 44be8: 7258 moveq #88,%d1 44bea: 2040 moveal %d0,%a0 44bec: 2081 movel %d1,%a0@ 44bee: 6008 bras 44bf8 default: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 44bf0: 4e90 jsr %a0@ 44bf2: 2040 moveal %d0,%a0 44bf4: 7016 moveq #22,%d0 44bf6: 2080 movel %d0,%a0@ } 44bf8: 70ff moveq #-1,%d0 44bfa: 4e5e unlk %fp 44bfc: 4e75 rts ... 00044f60 : int mode __attribute__((unused)), struct aiocb * const list[] __attribute__((unused)), int nent __attribute__((unused)), struct sigevent *sig __attribute__((unused)) ) { 44f60: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44f64: 4eb9 0004 d430 jsr 4d430 <__errno> 44f6a: 7258 moveq #88,%d1 44f6c: 2040 moveal %d0,%a0 } 44f6e: 70ff moveq #-1,%d0 44f70: 4e5e unlk %fp struct aiocb * const list[] __attribute__((unused)), int nent __attribute__((unused)), struct sigevent *sig __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44f72: 2081 movel %d1,%a0@ } 44f74: 4e75 rts ... 00044f78 : const void *addr __attribute__((unused)), size_t len __attribute__((unused)), int prot __attribute__((unused)) ) { return 0; } 44f78: 4280 clrl %d0 int mprotect( const void *addr __attribute__((unused)), size_t len __attribute__((unused)), int prot __attribute__((unused)) ) { 44f7a: 4e56 0000 linkw %fp,#0 return 0; } 44f7e: 4e5e unlk %fp 44f80: 4e75 rts ... 000490bc : */ int mq_close( mqd_t mqdes ) { 490bc: 4e56 fffc linkw %fp,#-4 490c0: 2f0a movel %a2,%sp@- RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd *_POSIX_Message_queue_Get_fd ( mqd_t id, Objects_Locations *location ) { return (POSIX_Message_queue_Control_fd *) _Objects_Get( 490c2: 486e fffc pea %fp@(-4) 490c6: 2f2e 0008 movel %fp@(8),%sp@- 490ca: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 490d0: 4eb9 0004 c188 jsr 4c188 <_Objects_Get> POSIX_Message_queue_Control *the_mq; POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); if ( location == OBJECTS_LOCAL ) { 490d6: 4fef 000c lea %sp@(12),%sp 490da: 2440 moveal %d0,%a2 490dc: 4aae fffc tstl %fp@(-4) 490e0: 663a bnes 4911c * First update the actual message queue to reflect this descriptor * being disassociated. This may result in the queue being really * deleted. */ the_mq = the_mq_fd->Queue; 490e2: 206a 0010 moveal %a2@(16),%a0 the_mq->open_count -= 1; 490e6: 53a8 0016 subql #1,%a0@(22) _POSIX_Message_queue_Delete( the_mq ); 490ea: 2f08 movel %a0,%sp@- 490ec: 4eb9 0004 9134 jsr 49134 <_POSIX_Message_queue_Delete> /* * Now close this file descriptor. */ _Objects_Close( 490f2: 2f0a movel %a2,%sp@- 490f4: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 490fa: 4eb9 0004 bdbc jsr 4bdbc <_Objects_Close> RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free_fd ( POSIX_Message_queue_Control_fd *the_mq_fd ) { _Objects_Free( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); 49100: 2f0a movel %a2,%sp@- 49102: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 49108: 4eb9 0004 c030 jsr 4c030 <_Objects_Free> &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 4910e: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> return 0; 49114: 4fef 0014 lea %sp@(20),%sp _Objects_Close( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 49118: 4280 clrl %d0 return 0; 4911a: 600e bras 4912a /* * OBJECTS_REMOTE: * OBJECTS_ERROR: */ rtems_set_errno_and_return_minus_one( EBADF ); 4911c: 4eb9 0005 2858 jsr 52858 <__errno> 49122: 7209 moveq #9,%d1 49124: 2040 moveal %d0,%a0 49126: 70ff moveq #-1,%d0 49128: 2081 movel %d1,%a0@ } 4912a: 246e fff8 moveal %fp@(-8),%a2 4912e: 4e5e unlk %fp 49130: 4e75 rts ... 00049184 : int mq_getattr( mqd_t mqdes, struct mq_attr *mqstat ) { 49184: 4e56 fffc linkw %fp,#-4 49188: 2f0a movel %a2,%sp@- 4918a: 246e 000c moveal %fp@(12),%a2 POSIX_Message_queue_Control *the_mq; POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; CORE_message_queue_Attributes *the_mq_attr; if ( !mqstat ) 4918e: 4a8a tstl %a2 49190: 6610 bnes 491a2 rtems_set_errno_and_return_minus_one( EINVAL ); 49192: 4eb9 0005 2858 jsr 52858 <__errno> 49198: 72ff moveq #-1,%d1 4919a: 2040 moveal %d0,%a0 4919c: 7016 moveq #22,%d0 4919e: 2080 movel %d0,%a0@ 491a0: 6052 bras 491f4 RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd *_POSIX_Message_queue_Get_fd ( mqd_t id, Objects_Locations *location ) { return (POSIX_Message_queue_Control_fd *) _Objects_Get( 491a2: 486e fffc pea %fp@(-4) 491a6: 2f2e 0008 movel %fp@(8),%sp@- 491aa: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 491b0: 4eb9 0004 c188 jsr 4c188 <_Objects_Get> the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 491b6: 4fef 000c lea %sp@(12),%sp 491ba: 4aae fffc tstl %fp@(-4) 491be: 6626 bnes 491e6 * Return the old values. */ the_mq_attr = &the_mq->Message_queue.Attributes; mqstat->mq_flags = the_mq_fd->oflag; 491c0: 2240 moveal %d0,%a1 491c2: 24a9 0014 movel %a1@(20),%a2@ the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: the_mq = the_mq_fd->Queue; 491c6: 2069 0010 moveal %a1@(16),%a0 */ the_mq_attr = &the_mq->Message_queue.Attributes; mqstat->mq_flags = the_mq_fd->oflag; mqstat->mq_msgsize = the_mq->Message_queue.maximum_message_size; 491ca: 2568 0066 0008 movel %a0@(102),%a2@(8) mqstat->mq_maxmsg = the_mq->Message_queue.maximum_pending_messages; 491d0: 2568 005e 0004 movel %a0@(94),%a2@(4) mqstat->mq_curmsgs = the_mq->Message_queue.number_of_pending_messages; 491d6: 2568 0062 000c movel %a0@(98),%a2@(12) _Thread_Enable_dispatch(); 491dc: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> 491e2: 4281 clrl %d1 return 0; 491e4: 600e bras 491f4 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 491e6: 4eb9 0005 2858 jsr 52858 <__errno> 491ec: 72ff moveq #-1,%d1 491ee: 2040 moveal %d0,%a0 491f0: 7009 moveq #9,%d0 491f2: 2080 movel %d0,%a0@ } 491f4: 246e fff8 moveal %fp@(-8),%a2 491f8: 2001 movel %d1,%d0 491fa: 4e5e unlk %fp 491fc: 4e75 rts ... 000492e0 : int oflag, ... /* mode_t mode, */ /* struct mq_attr attr */ ) { 492e0: 4e56 ffdc linkw %fp,#-36 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 492e4: 2039 0006 4bb0 movel 64bb0 <_Thread_Dispatch_disable_level>,%d0 492ea: 5280 addql #1,%d0 492ec: 48d7 0c3c moveml %d2-%d5/%a2-%a3,%sp@ 492f0: 23c0 0006 4bb0 movel %d0,64bb0 <_Thread_Dispatch_disable_level> 492f6: 262e 0008 movel %fp@(8),%d3 492fa: 242e 000c movel %fp@(12),%d2 POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 492fe: 2a02 movel %d2,%d5 49300: 0285 0000 0200 andil #512,%d5 49306: 6604 bnes 4930c 49308: 4284 clrl %d4 4930a: 6004 bras 49310 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); 4930c: 282e 0014 movel %fp@(20),%d4 */ RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) 49310: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 49316: 4eb9 0004 bd3c jsr 4bd3c <_Objects_Allocate> va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { 4931c: 588f addql #4,%sp 4931e: 2440 moveal %d0,%a2 49320: 4a80 tstl %d0 49322: 6618 bnes 4933c _Thread_Enable_dispatch(); 49324: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( ENFILE ); 4932a: 7417 moveq #23,%d2 4932c: 4eb9 0005 2858 jsr 52858 <__errno> 49332: 72ff moveq #-1,%d1 49334: 2040 moveal %d0,%a0 49336: 2082 movel %d2,%a0@ 49338: 6000 0120 braw 4945a } the_mq_fd->oflag = oflag; 4933c: 2542 0014 movel %d2,%a2@(20) status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); 49340: 486e fffc pea %fp@(-4) 49344: 2f03 movel %d3,%sp@- 49346: 4eb9 0004 f524 jsr 4f524 <_POSIX_Message_queue_Name_to_id> * If the name to id translation worked, then the message queue exists * and we can just return a pointer to the id. Otherwise we may * need to check to see if this is a "message queue does not exist" * or some other miscellaneous error on the name. */ if ( status ) { 4934c: 508f addql #8,%sp _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENFILE ); } the_mq_fd->oflag = oflag; status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); 4934e: 2640 moveal %d0,%a3 * If the name to id translation worked, then the message queue exists * and we can just return a pointer to the id. Otherwise we may * need to check to see if this is a "message queue does not exist" * or some other miscellaneous error on the name. */ if ( status ) { 49350: 4a80 tstl %d0 49352: 6732 beqs 49386 /* * Unless provided a valid name that did not already exist * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { 49354: 7002 moveq #2,%d0 49356: b08b cmpl %a3,%d0 49358: 6606 bnes 49360 4935a: 4a85 tstl %d5 4935c: 6600 00a4 bnew 49402 RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free_fd ( POSIX_Message_queue_Control_fd *the_mq_fd ) { _Objects_Free( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); 49360: 2f0a movel %a2,%sp@- 49362: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 49368: 4eb9 0004 c030 jsr 4c030 <_Objects_Free> _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 4936e: 4eb9 0004 c9da jsr 4c9da <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); 49374: 4eb9 0005 2858 jsr 52858 <__errno> 4937a: 508f addql #8,%sp 4937c: 72ff moveq #-1,%d1 4937e: 2040 moveal %d0,%a0 49380: 208b movel %a3,%a0@ 49382: 6000 00d6 braw 4945a 49386: 47f9 0004 c9da lea 4c9da <_Thread_Enable_dispatch>,%a3 } else { /* name -> ID translation succeeded */ /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 4938c: 0282 0000 0a00 andil #2560,%d2 49392: 0c82 0000 0a00 cmpil #2560,%d2 49398: 6624 bnes 493be 4939a: 2f0a movel %a2,%sp@- 4939c: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 493a2: 4eb9 0004 c030 jsr 4c030 <_Objects_Free> _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 493a8: 4e93 jsr %a3@ rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t ); 493aa: 4eb9 0005 2858 jsr 52858 <__errno> 493b0: 508f addql #8,%sp 493b2: 72ff moveq #-1,%d1 493b4: 2040 moveal %d0,%a0 493b6: 7011 moveq #17,%d0 493b8: 2080 movel %d0,%a0@ 493ba: 6000 009e braw 4945a RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control *_POSIX_Message_queue_Get ( Objects_Id id, Objects_Locations *location ) { return (POSIX_Message_queue_Control *) 493be: 486e fff4 pea %fp@(-12) 493c2: 2f2e fffc movel %fp@(-4),%sp@- 493c6: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 493cc: 4eb9 0004 c188 jsr 4c188 <_Objects_Get> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 493d2: 4281 clrl %d1 /* * In this case we need to do an ID->pointer conversion to * check the mode. */ the_mq = _POSIX_Message_queue_Get( the_mq_id, &location ); the_mq->open_count += 1; 493d4: 2040 moveal %d0,%a0 493d6: 52a8 0016 addql #1,%a0@(22) 493da: 2079 0006 5004 moveal 65004 <_POSIX_Message_queue_Information_fds+0x18>,%a0 493e0: 322a 000a movew %a2@(10),%d1 /* * In this case we need to do an ID->pointer conversion to * check the mode. */ the_mq = _POSIX_Message_queue_Get( the_mq_id, &location ); 493e4: 2d40 fff8 movel %d0,%fp@(-8) 493e8: 218a 1c00 movel %a2,%a0@(00000000,%d1:l:4) the_mq->open_count += 1; the_mq_fd->Queue = the_mq; 493ec: 2540 0010 movel %d0,%a2@(16) the_object ); #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) /* ASSERT: information->is_string */ the_object->name.name_p = name; 493f0: 42aa 000c clrl %a2@(12) _Objects_Open_string( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 493f4: 4e93 jsr %a3@ _Thread_Enable_dispatch(); 493f6: 4e93 jsr %a3@ return (mqd_t)the_mq_fd->Object.id; 493f8: 222a 0008 movel %a2@(8),%d1 493fc: 4fef 000c lea %sp@(12),%sp 49400: 6058 bras 4945a /* * At this point, the message queue does not exist and everything has been * checked. We should go ahead and create a message queue. */ status = _POSIX_Message_queue_Create_support( 49402: 486e fff8 pea %fp@(-8) 49406: 47f9 0004 c9da lea 4c9da <_Thread_Enable_dispatch>,%a3 4940c: 2f04 movel %d4,%sp@- 4940e: 4878 0001 pea 1 49412: 2f03 movel %d3,%sp@- 49414: 4eb9 0004 f3b0 jsr 4f3b0 <_POSIX_Message_queue_Create_support> ); /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { 4941a: 4fef 0010 lea %sp@(16),%sp 4941e: 72ff moveq #-1,%d1 49420: b280 cmpl %d0,%d1 49422: 6616 bnes 4943a RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free_fd ( POSIX_Message_queue_Control_fd *the_mq_fd ) { _Objects_Free( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); 49424: 2f0a movel %a2,%sp@- 49426: 4879 0006 4fec pea 64fec <_POSIX_Message_queue_Information_fds> 4942c: 4eb9 0004 c030 jsr 4c030 <_Objects_Free> _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 49432: 4e93 jsr %a3@ return (mqd_t) -1; 49434: 508f addql #8,%sp /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 49436: 72ff moveq #-1,%d1 return (mqd_t) -1; 49438: 6020 bras 4945a #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4943a: 4280 clrl %d0 4943c: 2079 0006 5004 moveal 65004 <_POSIX_Message_queue_Information_fds+0x18>,%a0 49442: 302a 000a movew %a2@(10),%d0 } the_mq_fd->Queue = the_mq; 49446: 256e fff8 0010 movel %fp@(-8),%a2@(16) 4944c: 218a 0c00 movel %a2,%a0@(00000000,%d0:l:4) the_object ); #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) /* ASSERT: information->is_string */ the_object->name.name_p = name; 49450: 42aa 000c clrl %a2@(12) &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 49454: 4e93 jsr %a3@ return (mqd_t) the_mq_fd->Object.id; 49456: 222a 0008 movel %a2@(8),%d1 } 4945a: 2001 movel %d1,%d0 4945c: 4cee 0c3c ffdc moveml %fp@(-36),%d2-%d5/%a2-%a3 49462: 4e5e unlk %fp 49464: 4e75 rts ... 000497d0 : */ int mq_unlink( const char *name ) { 497d0: 4e56 fff0 linkw %fp,#-16 497d4: 2039 0006 4bb0 movel 64bb0 <_Thread_Dispatch_disable_level>,%d0 497da: 5280 addql #1,%d0 497dc: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 497e0: 23c0 0006 4bb0 movel %d0,64bb0 <_Thread_Dispatch_disable_level> register POSIX_Message_queue_Control *the_mq; Objects_Id the_mq_id; _Thread_Disable_dispatch(); status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); 497e6: 486e fffc pea %fp@(-4) 497ea: 45f9 0004 c9da lea 4c9da <_Thread_Enable_dispatch>,%a2 497f0: 2f2e 0008 movel %fp@(8),%sp@- 497f4: 4eb9 0004 f524 jsr 4f524 <_POSIX_Message_queue_Name_to_id> if ( status != 0 ) { 497fa: 508f addql #8,%sp register POSIX_Message_queue_Control *the_mq; Objects_Id the_mq_id; _Thread_Disable_dispatch(); status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); 497fc: 2400 movel %d0,%d2 if ( status != 0 ) { 497fe: 6710 beqs 49810 _Thread_Enable_dispatch(); 49800: 4e92 jsr %a2@ rtems_set_errno_and_return_minus_one( status ); 49802: 4eb9 0005 2858 jsr 52858 <__errno> 49808: 2040 moveal %d0,%a0 4980a: 70ff moveq #-1,%d0 4980c: 2082 movel %d2,%a0@ 4980e: 6034 bras 49844 } the_mq = (POSIX_Message_queue_Control *) _Objects_Get_local_object( 49810: 4280 clrl %d0 49812: 2079 0006 4e96 moveal 64e96 <_POSIX_Message_queue_Information+0x18>,%a0 49818: 302e fffe movew %fp@(-2),%d0 4981c: 2670 0c00 moveal %a0@(00000000,%d0:l:4),%a3 &_POSIX_Message_queue_Information, _Objects_Get_index( the_mq_id ) ); the_mq->linked = false; 49820: 4200 clrb %d0 49822: 1740 0015 moveb %d0,%a3@(21) RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Namespace_remove ( POSIX_Message_queue_Control *the_mq ) { _Objects_Namespace_remove( 49826: 2f0b movel %a3,%sp@- 49828: 4879 0006 4e7e pea 64e7e <_POSIX_Message_queue_Information> 4982e: 4eb9 0004 c2e0 jsr 4c2e0 <_Objects_Namespace_remove> _POSIX_Message_queue_Namespace_remove( the_mq ); _POSIX_Message_queue_Delete( the_mq ); 49834: 2f0b movel %a3,%sp@- 49836: 4eb9 0004 9134 jsr 49134 <_POSIX_Message_queue_Delete> _Thread_Enable_dispatch(); 4983c: 4e92 jsr %a2@ return 0; 4983e: 4fef 000c lea %sp@(12),%sp the_mq->linked = false; _POSIX_Message_queue_Namespace_remove( the_mq ); _POSIX_Message_queue_Delete( the_mq ); _Thread_Enable_dispatch(); 49842: 4280 clrl %d0 return 0; } 49844: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 4984a: 4e5e unlk %fp 4984c: 4e75 rts ... 00062240 : int nanosleep( const struct timespec *rqtp, struct timespec *rmtp ) { 62240: 4e56 fff4 linkw %fp,#-12 62244: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 62248: 266e 0008 moveal %fp@(8),%a3 6224c: 246e 000c moveal %fp@(12),%a2 Watchdog_Interval ticks; if ( !_Timespec_Is_valid( rqtp ) ) 62250: 2f0b movel %a3,%sp@- 62252: 4eb9 0006 2390 jsr 62390 <_Timespec_Is_valid> 62258: 588f addql #4,%sp 6225a: 4a00 tstb %d0 6225c: 670a beqs 62268 * Return EINVAL if the delay interval is negative. * * NOTE: This behavior is beyond the POSIX specification. * FSU and GNU/Linux pthreads shares this behavior. */ if ( rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 ) 6225e: 4a93 tstl %a3@ 62260: 6d06 blts 62268 62262: 4aab 0004 tstl %a3@(4) 62266: 6c12 bges 6227a rtems_set_errno_and_return_minus_one( EINVAL ); 62268: 4eb9 0005 3ac4 jsr 53ac4 <__errno> 6226e: 7416 moveq #22,%d2 62270: 72ff moveq #-1,%d1 62272: 2040 moveal %d0,%a0 62274: 2082 movel %d2,%a0@ 62276: 6000 00ce braw 62346 ticks = _Timespec_To_ticks( rqtp ); 6227a: 2f0b movel %a3,%sp@- 6227c: 47f9 0004 a71e lea 4a71e <_Thread_Enable_dispatch>,%a3 62282: 4eb9 0005 0ce8 jsr 50ce8 <_Timespec_To_ticks> * A nanosleep for zero time is implemented as a yield. * This behavior is also beyond the POSIX specification but is * consistent with the RTEMS API and yields desirable behavior. */ if ( !ticks ) { 62288: 588f addql #4,%sp * FSU and GNU/Linux pthreads shares this behavior. */ if ( rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 ) rtems_set_errno_and_return_minus_one( EINVAL ); ticks = _Timespec_To_ticks( rqtp ); 6228a: 2400 movel %d0,%d2 * A nanosleep for zero time is implemented as a yield. * This behavior is also beyond the POSIX specification but is * consistent with the RTEMS API and yields desirable behavior. */ if ( !ticks ) { 6228c: 6628 bnes 622b6 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 6228e: 2039 0006 84ec movel 684ec <_Thread_Dispatch_disable_level>,%d0 62294: 5280 addql #1,%d0 62296: 23c0 0006 84ec movel %d0,684ec <_Thread_Dispatch_disable_level> _Thread_Disable_dispatch(); _Thread_Yield_processor(); 6229c: 4eb9 0004 b348 jsr 4b348 <_Thread_Yield_processor> _Thread_Enable_dispatch(); 622a2: 4e93 jsr %a3@ if ( rmtp ) { 622a4: 4a8a tstl %a2 622a6: 6700 009c beqw 62344 rmtp->tv_sec = 0; rmtp->tv_nsec = 0; 622aa: 42aa 0004 clrl %a2@(4) 622ae: 4281 clrl %d1 if ( !ticks ) { _Thread_Disable_dispatch(); _Thread_Yield_processor(); _Thread_Enable_dispatch(); if ( rmtp ) { rmtp->tv_sec = 0; 622b0: 4292 clrl %a2@ 622b2: 6000 0092 braw 62346 622b6: 2039 0006 84ec movel 684ec <_Thread_Dispatch_disable_level>,%d0 622bc: 5280 addql #1,%d0 622be: 23c0 0006 84ec movel %d0,684ec <_Thread_Dispatch_disable_level> /* * Block for the desired amount of time */ _Thread_Disable_dispatch(); _Thread_Set_state( 622c4: 2f3c 1000 0008 movel #268435464,%sp@- 622ca: 2f39 0006 85a6 movel 685a6 <_Thread_Executing>,%sp@- 622d0: 4eb9 0004 af6c jsr 4af6c <_Thread_Set_state> STATES_DELAYING | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Watchdog_Initialize( &_Thread_Executing->Timer, _Thread_Delay_ended, _Thread_Executing->Object.id, 622d6: 2079 0006 85a6 moveal 685a6 <_Thread_Executing>,%a0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 622dc: 203c 0004 a590 movel #304528,%d0 622e2: 2140 0064 movel %d0,%a0@(100) _Thread_Disable_dispatch(); _Thread_Set_state( _Thread_Executing, STATES_DELAYING | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Watchdog_Initialize( 622e6: 2028 0008 movel %a0@(8),%d0 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 622ea: 42a8 0050 clrl %a0@(80) the_watchdog->routine = routine; the_watchdog->id = id; 622ee: 2140 0068 movel %d0,%a0@(104) the_watchdog->user_data = user_data; 622f2: 42a8 006c clrl %a0@(108) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 622f6: 2142 0054 movel %d2,%a0@(84) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 622fa: 4868 0048 pea %a0@(72) 622fe: 4879 0006 85c4 pea 685c4 <_Watchdog_Ticks_chain> 62304: 4eb9 0004 b72c jsr 4b72c <_Watchdog_Insert> _Thread_Delay_ended, _Thread_Executing->Object.id, NULL ); _Watchdog_Insert_ticks( &_Thread_Executing->Timer, ticks ); _Thread_Enable_dispatch(); 6230a: 4e93 jsr %a3@ /* calculate time remaining */ if ( rmtp ) { 6230c: 4fef 0010 lea %sp@(16),%sp 62310: 4a8a tstl %a2 62312: 6730 beqs 62344 ticks -= _Thread_Executing->Timer.stop_time - _Thread_Executing->Timer.start_time; 62314: 2079 0006 85a6 moveal 685a6 <_Thread_Executing>,%a0 _Thread_Enable_dispatch(); /* calculate time remaining */ if ( rmtp ) { ticks -= 6231a: 2028 005c movel %a0@(92),%d0 6231e: 90a8 0060 subl %a0@(96),%d0 62322: d480 addl %d0,%d2 _Thread_Executing->Timer.stop_time - _Thread_Executing->Timer.start_time; _Timespec_From_ticks( ticks, rmtp ); 62324: 2f0a movel %a2,%sp@- 62326: 2f02 movel %d2,%sp@- 62328: 4eb9 0006 2354 jsr 62354 <_Timespec_From_ticks> */ #if defined(RTEMS_POSIX_API) /* * If there is time remaining, then we were interrupted by a signal. */ if ( ticks ) 6232e: 508f addql #8,%sp 62330: 4a82 tstl %d2 62332: 6710 beqs 62344 rtems_set_errno_and_return_minus_one( EINTR ); 62334: 4eb9 0005 3ac4 jsr 53ac4 <__errno> 6233a: 72ff moveq #-1,%d1 6233c: 2040 moveal %d0,%a0 6233e: 7004 moveq #4,%d0 62340: 2080 movel %d0,%a0@ 62342: 6002 bras 62346 62344: 4281 clrl %d1 #endif } return 0; } 62346: 2001 movel %d1,%d0 62348: 4cee 0c04 fff4 moveml %fp@(-12),%d2/%a2-%a3 6234e: 4e5e unlk %fp 62350: 4e75 rts ... 00046818 : /* * 3.4.2 Suspend Process Execution, P1003.1b-1993, p. 81 */ int pause( void ) { 46818: 4e56 fffc linkw %fp,#-4 4681c: 2f02 movel %d2,%sp@- sigset_t all_signals; int status; (void) sigfillset( &all_signals ); 4681e: 240e movel %fp,%d2 46820: 5982 subql #4,%d2 46822: 2f02 movel %d2,%sp@- 46824: 4eb9 0004 729c jsr 4729c status = sigtimedwait( &all_signals, NULL, NULL ); 4682a: 42a7 clrl %sp@- 4682c: 42a7 clrl %sp@- 4682e: 2f02 movel %d2,%sp@- 46830: 4eb9 0004 7414 jsr 47414 return status; } 46836: 242e fff8 movel %fp@(-8),%d2 4683a: 4e5e unlk %fp 4683c: 4e75 rts ... 00044f84 : int pthread_atfork( void (*prepare)(void) __attribute__((unused)), void (*parent)(void) __attribute__((unused)), void (*child)(void) __attribute__((unused)) ) { 44f84: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44f88: 4eb9 0004 d430 jsr 4d430 <__errno> 44f8e: 7258 moveq #88,%d1 44f90: 2040 moveal %d0,%a0 } 44f92: 70ff moveq #-1,%d0 44f94: 4e5e unlk %fp void (*prepare)(void) __attribute__((unused)), void (*parent)(void) __attribute__((unused)), void (*child)(void) __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44f96: 2081 movel %d1,%a0@ } 44f98: 4e75 rts ... 000494bc : int pthread_attr_getcputime( pthread_attr_t *attr, int *clock_allowed ) { 494bc: 4e56 0000 linkw %fp,#0 494c0: 206e 0008 moveal %fp@(8),%a0 494c4: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !clock_allowed ) 494c8: 4a88 tstl %a0 494ca: 6710 beqs 494dc 494cc: 4a90 tstl %a0@ 494ce: 670c beqs 494dc 494d0: 4a89 tstl %a1 494d2: 6708 beqs 494dc return EINVAL; *clock_allowed = attr->cputime_clock_allowed; 494d4: 22a8 0034 movel %a0@(52),%a1@ 494d8: 4280 clrl %d0 return 0; 494da: 6002 bras 494de 494dc: 7016 moveq #22,%d0 } 494de: 4e5e unlk %fp 494e0: 4e75 rts ... 00048f74 : int pthread_attr_getdetachstate( const pthread_attr_t *attr, int *detachstate ) { 48f74: 4e56 0000 linkw %fp,#0 48f78: 206e 0008 moveal %fp@(8),%a0 48f7c: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !detachstate ) 48f80: 4a88 tstl %a0 48f82: 6710 beqs 48f94 48f84: 4a90 tstl %a0@ 48f86: 670c beqs 48f94 48f88: 4a89 tstl %a1 48f8a: 6708 beqs 48f94 return EINVAL; *detachstate = attr->detachstate; 48f8c: 22a8 0038 movel %a0@(56),%a1@ 48f90: 4280 clrl %d0 return 0; 48f92: 6002 bras 48f96 48f94: 7016 moveq #22,%d0 } 48f96: 4e5e unlk %fp 48f98: 4e75 rts ... 00048f9c : int pthread_attr_getinheritsched( const pthread_attr_t *attr, int *inheritsched ) { 48f9c: 4e56 0000 linkw %fp,#0 48fa0: 206e 0008 moveal %fp@(8),%a0 48fa4: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !inheritsched ) 48fa8: 4a88 tstl %a0 48faa: 6710 beqs 48fbc 48fac: 4a90 tstl %a0@ 48fae: 670c beqs 48fbc 48fb0: 4a89 tstl %a1 48fb2: 6708 beqs 48fbc return EINVAL; *inheritsched = attr->inheritsched; 48fb4: 22a8 0010 movel %a0@(16),%a1@ 48fb8: 4280 clrl %d0 return 0; 48fba: 6002 bras 48fbe 48fbc: 7016 moveq #22,%d0 } 48fbe: 4e5e unlk %fp 48fc0: 4e75 rts ... 00048fc4 : int pthread_attr_getschedparam( const pthread_attr_t *attr, struct sched_param *param ) { 48fc4: 4e56 0000 linkw %fp,#0 48fc8: 206e 0008 moveal %fp@(8),%a0 48fcc: 202e 000c movel %fp@(12),%d0 if ( !attr || !attr->is_initialized || !param ) 48fd0: 4a88 tstl %a0 48fd2: 6720 beqs 48ff4 48fd4: 4a90 tstl %a0@ 48fd6: 671c beqs 48ff4 48fd8: 4a80 tstl %d0 48fda: 6718 beqs 48ff4 return EINVAL; *param = attr->schedparam; 48fdc: 4878 001c pea 1c 48fe0: 4868 0018 pea %a0@(24) 48fe4: 2f00 movel %d0,%sp@- 48fe6: 4eb9 0005 2120 jsr 52120 return 0; 48fec: 4fef 000c lea %sp@(12),%sp ) { if ( !attr || !attr->is_initialized || !param ) return EINVAL; *param = attr->schedparam; 48ff0: 4280 clrl %d0 return 0; 48ff2: 6002 bras 48ff6 48ff4: 7016 moveq #22,%d0 } 48ff6: 4e5e unlk %fp 48ff8: 4e75 rts ... 00048ffc : int pthread_attr_getschedpolicy( const pthread_attr_t *attr, int *policy ) { 48ffc: 4e56 0000 linkw %fp,#0 49000: 206e 0008 moveal %fp@(8),%a0 49004: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !policy ) 49008: 4a88 tstl %a0 4900a: 6710 beqs 4901c 4900c: 4a90 tstl %a0@ 4900e: 670c beqs 4901c 49010: 4a89 tstl %a1 49012: 6708 beqs 4901c return EINVAL; *policy = attr->schedpolicy; 49014: 22a8 0014 movel %a0@(20),%a1@ 49018: 4280 clrl %d0 return 0; 4901a: 6002 bras 4901e 4901c: 7016 moveq #22,%d0 } 4901e: 4e5e unlk %fp 49020: 4e75 rts ... 00049024 : int pthread_attr_getscope( const pthread_attr_t *attr, int *contentionscope ) { 49024: 4e56 0000 linkw %fp,#0 49028: 206e 0008 moveal %fp@(8),%a0 4902c: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !contentionscope ) 49030: 4a88 tstl %a0 49032: 6710 beqs 49044 49034: 4a90 tstl %a0@ 49036: 670c beqs 49044 49038: 4a89 tstl %a1 4903a: 6708 beqs 49044 return EINVAL; *contentionscope = attr->contentionscope; 4903c: 22a8 000c movel %a0@(12),%a1@ 49040: 4280 clrl %d0 return 0; 49042: 6002 bras 49046 49044: 7016 moveq #22,%d0 } 49046: 4e5e unlk %fp 49048: 4e75 rts ... 0004904c : int pthread_attr_getstackaddr( const pthread_attr_t *attr, void **stackaddr ) { 4904c: 4e56 0000 linkw %fp,#0 49050: 206e 0008 moveal %fp@(8),%a0 49054: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !stackaddr ) 49058: 4a88 tstl %a0 4905a: 6710 beqs 4906c 4905c: 4a90 tstl %a0@ 4905e: 670c beqs 4906c 49060: 4a89 tstl %a1 49062: 6708 beqs 4906c return EINVAL; *stackaddr = attr->stackaddr; 49064: 22a8 0004 movel %a0@(4),%a1@ 49068: 4280 clrl %d0 return 0; 4906a: 6002 bras 4906e 4906c: 7016 moveq #22,%d0 } 4906e: 4e5e unlk %fp 49070: 4e75 rts ... 00049074 : int pthread_attr_getstacksize( const pthread_attr_t *attr, size_t *stacksize ) { 49074: 4e56 0000 linkw %fp,#0 49078: 206e 0008 moveal %fp@(8),%a0 4907c: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !stacksize ) 49080: 4a88 tstl %a0 49082: 6710 beqs 49094 49084: 4a90 tstl %a0@ 49086: 670c beqs 49094 49088: 4a89 tstl %a1 4908a: 6708 beqs 49094 return EINVAL; *stacksize = attr->stacksize; 4908c: 22a8 0008 movel %a0@(8),%a1@ 49090: 4280 clrl %d0 return 0; 49092: 6002 bras 49096 49094: 7016 moveq #22,%d0 } 49096: 4e5e unlk %fp 49098: 4e75 rts ... 0004a98c : int pthread_attr_setinheritsched( pthread_attr_t *attr, int inheritsched ) { 4a98c: 4e56 0000 linkw %fp,#0 4a990: 206e 0008 moveal %fp@(8),%a0 4a994: 222e 000c movel %fp@(12),%d1 4a998: 2f02 movel %d2,%sp@- if ( !attr || !attr->is_initialized ) 4a99a: 4a88 tstl %a0 4a99c: 671c beqs 4a9ba 4a99e: 4a90 tstl %a0@ 4a9a0: 6718 beqs 4a9ba return EINVAL; switch ( inheritsched ) { 4a9a2: 2241 moveal %d1,%a1 4a9a4: 5389 subql #1,%a1 4a9a6: 203c 0000 0086 movel #134,%d0 4a9ac: 7401 moveq #1,%d2 4a9ae: b489 cmpl %a1,%d2 4a9b0: 650a bcss 4a9bc case PTHREAD_INHERIT_SCHED: case PTHREAD_EXPLICIT_SCHED: attr->inheritsched = inheritsched; 4a9b2: 2141 0010 movel %d1,%a0@(16) 4a9b6: 4200 clrb %d0 return 0; 4a9b8: 6002 bras 4a9bc 4a9ba: 7016 moveq #22,%d0 default: return ENOTSUP; } } 4a9bc: 241f movel %sp@+,%d2 4a9be: 4e5e unlk %fp 4a9c0: 4e75 rts ... 00049128 : int pthread_attr_setschedparam( pthread_attr_t *attr, const struct sched_param *param ) { 49128: 4e56 0000 linkw %fp,#0 4912c: 206e 0008 moveal %fp@(8),%a0 49130: 202e 000c movel %fp@(12),%d0 if ( !attr || !attr->is_initialized || !param ) 49134: 4a88 tstl %a0 49136: 6720 beqs 49158 49138: 4a90 tstl %a0@ 4913a: 671c beqs 49158 4913c: 4a80 tstl %d0 4913e: 6718 beqs 49158 return EINVAL; attr->schedparam = *param; 49140: 4878 001c pea 1c 49144: 2f00 movel %d0,%sp@- 49146: 4868 0018 pea %a0@(24) 4914a: 4eb9 0005 2120 jsr 52120 return 0; 49150: 4fef 000c lea %sp@(12),%sp ) { if ( !attr || !attr->is_initialized || !param ) return EINVAL; attr->schedparam = *param; 49154: 4280 clrl %d0 return 0; 49156: 6002 bras 4915a 49158: 7016 moveq #22,%d0 } 4915a: 4e5e unlk %fp 4915c: 4e75 rts ... 000452b4 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 452b4: 4e56 ffe0 linkw %fp,#-32 452b8: 206e 000c moveal %fp@(12),%a0 452bc: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 452c0: 266e 0008 moveal %fp@(8),%a3 452c4: 246e 0010 moveal %fp@(16),%a2 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 452c8: 4a8b tstl %a3 452ca: 6700 008e beqw 4535a return EINVAL; if ( count == 0 ) 452ce: 4a8a tstl %a2 452d0: 6700 0088 beqw 4535a return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 452d4: 4a88 tstl %a0 452d6: 6614 bnes 452ec the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 452d8: 240e movel %fp,%d2 452da: 0682 ffff fff0 addil #-16,%d2 452e0: 2f02 movel %d2,%sp@- 452e2: 4eb9 0004 51f8 jsr 451f8 452e8: 588f addql #4,%sp 452ea: 2042 moveal %d2,%a0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 452ec: 4a90 tstl %a0@ 452ee: 676a beqs 4535a return EINVAL; switch ( the_attr->process_shared ) { 452f0: 4aa8 0004 tstl %a0@(4) 452f4: 6664 bnes 4535a rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 452f6: 2039 0005 e158 movel 5e158 <_Thread_Dispatch_disable_level>,%d0 452fc: 5280 addql #1,%d0 /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; the_attributes.maximum_count = count; 452fe: 2d4a fffc movel %a2,%fp@(-4) 45302: 23c0 0005 e158 movel %d0,5e158 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 45308: 42ae fff8 clrl %fp@(-8) * This function allocates a barrier control block from * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) 4530c: 4879 0005 e49a pea 5e49a <_POSIX_Barrier_Information> 45312: 45f9 0004 7ca2 lea 47ca2 <_Thread_Enable_dispatch>,%a2 45318: 4eb9 0004 70cc jsr 470cc <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 4531e: 588f addql #4,%sp 45320: 2840 moveal %d0,%a4 45322: 4a80 tstl %d0 45324: 6606 bnes 4532c _Thread_Enable_dispatch(); 45326: 4e92 jsr %a2@ 45328: 700b moveq #11,%d0 return EAGAIN; 4532a: 6030 bras 4535c } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 4532c: 486e fff8 pea %fp@(-8) 45330: 486c 0010 pea %a4@(16) 45334: 4eb9 0004 6868 jsr 46868 <_CORE_barrier_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4533a: 202c 0008 movel %a4@(8),%d0 4533e: 4281 clrl %d1 45340: 2079 0005 e4b2 moveal 5e4b2 <_POSIX_Barrier_Information+0x18>,%a0 45346: 3200 movew %d0,%d1 45348: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4) _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 4534c: 42ac 000c clrl %a4@(12) ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 45350: 2680 movel %d0,%a3@ _Thread_Enable_dispatch(); 45352: 4e92 jsr %a2@ return 0; 45354: 508f addql #8,%sp /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; _Thread_Enable_dispatch(); 45356: 4280 clrl %d0 return 0; 45358: 6002 bras 4535c 4535a: 7016 moveq #22,%d0 } 4535c: 4cee 1c04 ffe0 moveml %fp@(-32),%d2/%a2-%a4 45362: 4e5e unlk %fp 45364: 4e75 rts ... 00045368 : */ int pthread_barrier_wait( pthread_barrier_t *barrier ) { 45368: 4e56 fffc linkw %fp,#-4 4536c: 206e 0008 moveal %fp@(8),%a0 POSIX_Barrier_Control *the_barrier = NULL; Objects_Locations location; if ( !barrier ) 45370: 4a88 tstl %a0 45372: 6750 beqs 453c4 RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Get ( pthread_barrier_t *barrier, Objects_Locations *location ) { return (POSIX_Barrier_Control *) _Objects_Get( 45374: 486e fffc pea %fp@(-4) 45378: 2f10 movel %a0@,%sp@- 4537a: 4879 0005 e49a pea 5e49a <_POSIX_Barrier_Information> 45380: 4eb9 0004 7518 jsr 47518 <_Objects_Get> return EINVAL; the_barrier = _POSIX_Barrier_Get( barrier, &location ); switch ( location ) { 45386: 4fef 000c lea %sp@(12),%sp 4538a: 4aae fffc tstl %fp@(-4) 4538e: 6634 bnes 453c4 case OBJECTS_LOCAL: _CORE_barrier_Wait( 45390: 42a7 clrl %sp@- 45392: 2040 moveal %d0,%a0 45394: 42a7 clrl %sp@- 45396: 4878 0001 pea 1 4539a: 2f28 0008 movel %a0@(8),%sp@- 4539e: 4868 0010 pea %a0@(16) 453a2: 4eb9 0004 68a4 jsr 468a4 <_CORE_barrier_Wait> the_barrier->Object.id, true, 0, NULL ); _Thread_Enable_dispatch(); 453a8: 4eb9 0004 7ca2 jsr 47ca2 <_Thread_Enable_dispatch> return _POSIX_Barrier_Translate_core_barrier_return_code( 453ae: 2079 0005 e212 moveal 5e212 <_Thread_Executing>,%a0 453b4: 2f28 0034 movel %a0@(52),%sp@- 453b8: 4eb9 0004 a76c jsr 4a76c <_POSIX_Barrier_Translate_core_barrier_return_code> 453be: 4fef 0018 lea %sp@(24),%sp 453c2: 6002 bras 453c6 453c4: 7016 moveq #22,%d0 case OBJECTS_ERROR: break; } return EINVAL; } 453c6: 4e5e unlk %fp 453c8: 4e75 rts ... 000451d4 : int pthread_barrierattr_getpshared( const pthread_barrierattr_t *attr, int *pshared ) { 451d4: 4e56 0000 linkw %fp,#0 451d8: 206e 0008 moveal %fp@(8),%a0 if ( !attr ) 451dc: 4a88 tstl %a0 451de: 6710 beqs 451f0 return EINVAL; if ( !attr->is_initialized ) 451e0: 4a90 tstl %a0@ 451e2: 670c beqs 451f0 return EINVAL; *pshared = attr->process_shared; 451e4: 226e 000c moveal %fp@(12),%a1 451e8: 4280 clrl %d0 451ea: 22a8 0004 movel %a0@(4),%a1@ return 0; 451ee: 6002 bras 451f2 451f0: 7016 moveq #22,%d0 } 451f2: 4e5e unlk %fp 451f4: 4e75 rts ... 000451f8 : */ int pthread_barrierattr_init( pthread_barrierattr_t *attr ) { 451f8: 4e56 0000 linkw %fp,#0 451fc: 206e 0008 moveal %fp@(8),%a0 if ( !attr ) 45200: 4a88 tstl %a0 45202: 6604 bnes 45208 45204: 7016 moveq #22,%d0 45206: 600a bras 45212 return EINVAL; attr->is_initialized = true; 45208: 7201 moveq #1,%d1 attr->process_shared = PTHREAD_PROCESS_PRIVATE; 4520a: 4280 clrl %d0 4520c: 42a8 0004 clrl %a0@(4) ) { if ( !attr ) return EINVAL; attr->is_initialized = true; 45210: 2081 movel %d1,%a0@ attr->process_shared = PTHREAD_PROCESS_PRIVATE; return 0; } 45212: 4e5e unlk %fp 45214: 4e75 rts ... 00044a80 : */ int pthread_cancel( pthread_t thread ) { 44a80: 4e56 fffc linkw %fp,#-4 /* * Don't even think about deleting a resource from an ISR. */ if ( _ISR_Is_in_progress() ) 44a84: 2039 0005 d3c2 movel 5d3c2 <_ISR_Nest_level>,%d0 44a8a: 6704 beqs 44a90 44a8c: 7047 moveq #71,%d0 44a8e: 603a bras 44aca RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Get ( pthread_t id, Objects_Locations *location ) { return (Thread_Control *) 44a90: 486e fffc pea %fp@(-4) 44a94: 2f2e 0008 movel %fp@(8),%sp@- 44a98: 4879 0005 d50e pea 5d50e <_POSIX_Threads_Information> 44a9e: 4eb9 0004 6884 jsr 46884 <_Objects_Get> return EPROTO; the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 44aa4: 4fef 000c lea %sp@(12),%sp 44aa8: 4aae fffc tstl %fp@(-4) 44aac: 6704 beqs 44ab2 44aae: 7016 moveq #22,%d0 44ab0: 6018 bras 44aca case OBJECTS_LOCAL: thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; thread_support->cancelation_requested = 1; 44ab2: 2240 moveal %d0,%a1 44ab4: 7201 moveq #1,%d1 44ab6: 2069 010e moveal %a1@(270),%a0 44aba: 2141 00dc movel %d1,%a0@(220) /* This enables dispatch implicitly */ _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( the_thread ); 44abe: 2f00 movel %d0,%sp@- 44ac0: 4eb9 0004 97fc jsr 497fc <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch> return 0; 44ac6: 588f addql #4,%sp thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; thread_support->cancelation_requested = 1; /* This enables dispatch implicitly */ _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( the_thread ); 44ac8: 4280 clrl %d0 case OBJECTS_ERROR: break; } return EINVAL; } 44aca: 4e5e unlk %fp 44acc: 4e75 rts ... 00044cf8 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 44cf8: 4e56 0000 linkw %fp,#0 44cfc: 2f03 movel %d3,%sp@- 44cfe: 262e 000c movel %fp@(12),%d3 44d02: 2f02 movel %d2,%sp@- 44d04: 242e 0008 movel %fp@(8),%d2 /* * The POSIX standard does not address what to do when the routine * is NULL. It also does not address what happens when we cannot * allocate memory or anything else bad happens. */ if ( !routine ) 44d08: 6754 beqs 44d5e rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 44d0a: 2039 0005 dbd0 movel 5dbd0 <_Thread_Dispatch_disable_level>,%d0 44d10: 5280 addql #1,%d0 44d12: 23c0 0005 dbd0 movel %d0,5dbd0 <_Thread_Dispatch_disable_level> return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 44d18: 4878 0010 pea 10 44d1c: 4eb9 0004 896c jsr 4896c <_Workspace_Allocate> if ( handler ) { 44d22: 588f addql #4,%sp 44d24: 4a80 tstl %d0 44d26: 6726 beqs 44d4e thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; 44d28: 2079 0005 dc8a moveal 5dc8a <_Thread_Executing>,%a0 44d2e: 2228 010e movel %a0@(270),%d1 handler->routine = routine; 44d32: 2040 moveal %d0,%a0 handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); if ( handler ) { thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; 44d34: 0681 0000 00e0 addil #224,%d1 handler->routine = routine; 44d3a: 2142 0008 movel %d2,%a0@(8) handler->arg = arg; 44d3e: 2143 000c movel %d3,%a0@(12) _Chain_Append( handler_stack, &handler->Node ); 44d42: 2f00 movel %d0,%sp@- 44d44: 2f01 movel %d1,%sp@- 44d46: 4eb9 0004 6388 jsr 46388 <_Chain_Append> 44d4c: 508f addql #8,%sp } _Thread_Enable_dispatch(); } 44d4e: 242e fff8 movel %fp@(-8),%d2 44d52: 262e fffc movel %fp@(-4),%d3 44d56: 4e5e unlk %fp handler->routine = routine; handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); } _Thread_Enable_dispatch(); 44d58: 4ef9 0004 772a jmp 4772a <_Thread_Enable_dispatch> } 44d5e: 242e fff8 movel %fp@(-8),%d2 44d62: 262e fffc movel %fp@(-4),%d3 44d66: 4e5e unlk %fp 44d68: 4e75 rts ... 00045964 : */ int pthread_cond_broadcast( pthread_cond_t *cond ) { 45964: 4e56 0000 linkw %fp,#0 return _POSIX_Condition_variables_Signal_support( cond, true ); 45968: 4878 0001 pea 1 4596c: 2f2e 0008 movel %fp@(8),%sp@- 45970: 4eb9 0004 5af8 jsr 45af8 <_POSIX_Condition_variables_Signal_support> } 45976: 4e5e unlk %fp 45978: 4e75 rts ... 00045a40 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 45a40: 4e56 fff4 linkw %fp,#-12 45a44: 202e 000c movel %fp@(12),%d0 45a48: 48d7 1c00 moveml %a2-%a4,%sp@ POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; 45a4c: 45f9 0005 c89c lea 5c89c <_POSIX_Condition_variables_Default_attributes>,%a2 45a52: 4a80 tstl %d0 45a54: 6702 beqs 45a58 45a56: 2440 moveal %d0,%a2 /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 45a58: 7001 moveq #1,%d0 45a5a: b0aa 0004 cmpl %a2@(4),%d0 45a5e: 6776 beqs 45ad6 return EINVAL; if ( !the_attr->is_initialized ) 45a60: 4a92 tstl %a2@ 45a62: 6772 beqs 45ad6 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 45a64: 2039 0005 f1c4 movel 5f1c4 <_Thread_Dispatch_disable_level>,%d0 45a6a: 5280 addql #1,%d0 45a6c: 23c0 0005 f1c4 movel %d0,5f1c4 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) 45a72: 4879 0005 f592 pea 5f592 <_POSIX_Condition_variables_Information> 45a78: 47f9 0004 89a6 lea 489a6 <_Thread_Enable_dispatch>,%a3 45a7e: 4eb9 0004 7dd0 jsr 47dd0 <_Objects_Allocate> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 45a84: 588f addql #4,%sp 45a86: 2840 moveal %d0,%a4 45a88: 4a80 tstl %d0 45a8a: 6606 bnes 45a92 _Thread_Enable_dispatch(); 45a8c: 4e93 jsr %a3@ 45a8e: 700c moveq #12,%d0 return ENOMEM; 45a90: 6046 bras 45ad8 } the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; 45a92: 42ac 0014 clrl %a4@(20) if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 45a96: 296a 0004 0010 movel %a2@(4),%a4@(16) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; /* XXX some more initialization might need to go here */ _Thread_queue_Initialize( 45a9c: 4878 0074 pea 74 45aa0: 4878 0800 pea 800 45aa4: 42a7 clrl %sp@- 45aa6: 486c 0018 pea %a4@(24) 45aaa: 4eb9 0004 90b8 jsr 490b8 <_Thread_queue_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 45ab0: 202c 0008 movel %a4@(8),%d0 45ab4: 4281 clrl %d1 45ab6: 2079 0005 f5aa moveal 5f5aa <_POSIX_Condition_variables_Information+0x18>,%a0 45abc: 3200 movew %d0,%d1 45abe: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4) _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 45ac2: 42ac 000c clrl %a4@(12) &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 45ac6: 206e 0008 moveal %fp@(8),%a0 45aca: 2080 movel %d0,%a0@ _Thread_Enable_dispatch(); 45acc: 4e93 jsr %a3@ return 0; 45ace: 4fef 0010 lea %sp@(16),%sp 0 ); *cond = the_cond->Object.id; _Thread_Enable_dispatch(); 45ad2: 4280 clrl %d0 return 0; 45ad4: 6002 bras 45ad8 45ad6: 7016 moveq #22,%d0 } 45ad8: 4cee 1c00 fff4 moveml %fp@(-12),%a2-%a4 45ade: 4e5e unlk %fp 45ae0: 4e75 rts ... 00045b58 : int pthread_cond_timedwait( pthread_cond_t *cond, pthread_mutex_t *mutex, const struct timespec *abstime ) { 45b58: 4e56 fffc linkw %fp,#-4 * So we check the abstime provided, and hold on to whether it * is valid or not. If it isn't correct and in the future, * then we do a polling operation and convert the UNSATISFIED * status into the appropriate error. */ switch ( _POSIX_Absolute_timeout_to_ticks(abstime, &ticks) ) { 45b5c: 486e fffc pea %fp@(-4) 45b60: 2f2e 0010 movel %fp@(16),%sp@- 45b64: 4eb9 0004 5fc4 jsr 45fc4 <_POSIX_Absolute_timeout_to_ticks> 45b6a: 508f addql #8,%sp 45b6c: 4a80 tstl %d0 45b6e: 6728 beqs 45b98 45b70: 7202 moveq #2,%d1 45b72: b280 cmpl %d0,%d1 45b74: 55c0 scs %d0 45b76: 5280 addql #1,%d0 default: /* only to silence warnings */ already_timedout = false; break; } return _POSIX_Condition_variables_Wait_support( 45b78: 0280 0000 00ff andil #255,%d0 45b7e: 2f00 movel %d0,%sp@- 45b80: 2f2e fffc movel %fp@(-4),%sp@- 45b84: 2f2e 000c movel %fp@(12),%sp@- 45b88: 2f2e 0008 movel %fp@(8),%sp@- 45b8c: 4eb9 0004 5bbc jsr 45bbc <_POSIX_Condition_variables_Wait_support> 45b92: 4fef 0010 lea %sp@(16),%sp 45b96: 6002 bras 45b9a * So we check the abstime provided, and hold on to whether it * is valid or not. If it isn't correct and in the future, * then we do a polling operation and convert the UNSATISFIED * status into the appropriate error. */ switch ( _POSIX_Absolute_timeout_to_ticks(abstime, &ticks) ) { 45b98: 7016 moveq #22,%d0 cond, mutex, ticks, already_timedout ); } 45b9a: 4e5e unlk %fp 45b9c: 4e75 rts ... 00045ba0 : int pthread_cond_wait( pthread_cond_t *cond, pthread_mutex_t *mutex ) { 45ba0: 4e56 0000 linkw %fp,#0 return _POSIX_Condition_variables_Wait_support( 45ba4: 42a7 clrl %sp@- 45ba6: 42a7 clrl %sp@- 45ba8: 2f2e 000c movel %fp@(12),%sp@- 45bac: 2f2e 0008 movel %fp@(8),%sp@- 45bb0: 4eb9 0004 5bbc jsr 45bbc <_POSIX_Condition_variables_Wait_support> cond, mutex, THREAD_QUEUE_WAIT_FOREVER, false ); } 45bb6: 4e5e unlk %fp 45bb8: 4e75 rts ... 000458f4 : int pthread_condattr_getpshared( const pthread_condattr_t *attr, int *pshared ) { 458f4: 4e56 0000 linkw %fp,#0 458f8: 206e 0008 moveal %fp@(8),%a0 if ( !attr ) 458fc: 4a88 tstl %a0 458fe: 6604 bnes 45904 45900: 7016 moveq #22,%d0 45902: 600a bras 4590e return EINVAL; *pshared = attr->process_shared; 45904: 226e 000c moveal %fp@(12),%a1 45908: 4280 clrl %d0 4590a: 22a8 0004 movel %a0@(4),%a1@ return 0; } 4590e: 4e5e unlk %fp 45910: 4e75 rts ... 00045228 : int pthread_equal( pthread_t t1, pthread_t t2 ) { 45228: 4e56 0000 linkw %fp,#0 4522c: 202e 000c movel %fp@(12),%d0 45230: b0ae 0008 cmpl %fp@(8),%d0 45234: 57c0 seq %d0 break; } return status; #endif } 45236: 4e5e unlk %fp int pthread_equal( pthread_t t1, pthread_t t2 ) { 45238: 49c0 extbl %d0 break; } return status; #endif } 4523a: 4480 negl %d0 4523c: 4e75 rts ... 0004ba2c : } void pthread_exit( void *value_ptr ) { 4ba2c: 4e56 0000 linkw %fp,#0 _POSIX_Thread_Exit( _Thread_Executing, value_ptr ); 4ba30: 2f2e 0008 movel %fp@(8),%sp@- 4ba34: 2f39 0005 cd4e movel 5cd4e <_Thread_Executing>,%sp@- 4ba3a: 4eb9 0004 b9bc jsr 4b9bc <_POSIX_Thread_Exit> 4ba40: 508f addql #8,%sp <== NOT EXECUTED } 4ba42: 4e5e unlk %fp <== NOT EXECUTED 4ba44: 4e75 rts <== NOT EXECUTED ... 00044f9c : int pthread_getcpuclockid( pthread_t pid, clockid_t *clock_id ) { 44f9c: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 44fa0: 4eb9 0004 d430 jsr 4d430 <__errno> 44fa6: 7258 moveq #88,%d1 44fa8: 2040 moveal %d0,%a0 } 44faa: 70ff moveq #-1,%d0 44fac: 4e5e unlk %fp int pthread_getcpuclockid( pthread_t pid, clockid_t *clock_id ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 44fae: 2081 movel %d1,%a0@ } 44fb0: 4e75 rts ... 000495ec : int pthread_join( pthread_t thread, void **value_ptr ) { 495ec: 4e56 fff8 linkw %fp,#-8 495f0: 2f0b movel %a3,%sp@- 495f2: 2f0a movel %a2,%sp@- 495f4: 486e fffc pea %fp@(-4) 495f8: 2f2e 0008 movel %fp@(8),%sp@- 495fc: 4879 0006 49a6 pea 649a6 <_POSIX_Threads_Information> 49602: 246e 000c moveal %fp@(12),%a2 49606: 4eb9 0004 b65c jsr 4b65c <_Objects_Get> POSIX_API_Control *api; Objects_Locations location; void *return_pointer; the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 4960c: 4fef 000c lea %sp@(12),%sp 49610: 4aae fffc tstl %fp@(-4) 49614: 6704 beqs 4961a 49616: 7003 moveq #3,%d0 49618: 605c bras 49676 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4961a: 2240 moveal %d0,%a1 4961c: 2069 010e moveal %a1@(270),%a0 if ( api->detachstate == PTHREAD_CREATE_DETACHED ) { 49620: 4aa8 003c tstl %a0@(60) 49624: 660a bnes 49630 _Thread_Enable_dispatch(); 49626: 4eb9 0004 bde6 jsr 4bde6 <_Thread_Enable_dispatch> 4962c: 7016 moveq #22,%d0 return EINVAL; 4962e: 6046 bras 49676 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 49630: 2279 0006 487a moveal 6487a <_Thread_Executing>,%a1 49636: 47f9 0004 bde6 lea 4bde6 <_Thread_Enable_dispatch>,%a3 } if ( _Thread_Is_executing( the_thread ) ) { 4963c: b3c0 cmpal %d0,%a1 4963e: 6606 bnes 49646 _Thread_Enable_dispatch(); 49640: 4e93 jsr %a3@ 49642: 702d moveq #45,%d0 return EDEADLK; 49644: 6030 bras 49676 /* * Put ourself on the threads join list */ _Thread_Executing->Wait.return_argument = &return_pointer; 49646: 200e movel %fp,%d0 49648: 5180 subql #8,%d0 4964a: 2340 0028 movel %d0,%a1@(40) 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; 4964e: 7001 moveq #1,%d0 49650: 2140 0070 movel %d0,%a0@(112) _Thread_queue_Enter_critical_section( &api->Join_List ); _Thread_queue_Enqueue( &api->Join_List, WATCHDOG_NO_TIMEOUT ); 49654: 4879 0004 c55c pea 4c55c <_Thread_queue_Timeout> 4965a: 42a7 clrl %sp@- 4965c: 4868 0040 pea %a0@(64) 49660: 4eb9 0004 c270 jsr 4c270 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); 49666: 4e93 jsr %a3@ if ( value_ptr ) 49668: 4fef 000c lea %sp@(12),%sp 4966c: 4a8a tstl %a2 4966e: 6704 beqs 49674 *value_ptr = return_pointer; 49670: 24ae fff8 movel %fp@(-8),%a2@ 49674: 4280 clrl %d0 case OBJECTS_ERROR: break; } return ESRCH; } 49676: 246e fff0 moveal %fp@(-16),%a2 4967a: 266e fff4 moveal %fp@(-12),%a3 4967e: 4e5e unlk %fp 49680: 4e75 rts ... 00044fc0 : */ int pthread_key_delete( pthread_key_t key ) { 44fc0: 4e56 ffec linkw %fp,#-20 44fc4: 48d7 0c0c moveml %d2-%d3/%a2-%a3,%sp@ RTEMS_INLINE_ROUTINE POSIX_Keys_Control *_POSIX_Keys_Get ( pthread_key_t id, Objects_Locations *location ) { return (POSIX_Keys_Control *) 44fc8: 486e fffc pea %fp@(-4) 44fcc: 2f2e 0008 movel %fp@(8),%sp@- 44fd0: 4879 0005 ed18 pea 5ed18 <_POSIX_Keys_Information> 44fd6: 4eb9 0004 729c jsr 4729c <_Objects_Get> register POSIX_Keys_Control *the_key; Objects_Locations location; uint32_t the_api; the_key = _POSIX_Keys_Get( key, &location ); switch ( location ) { 44fdc: 4fef 000c lea %sp@(12),%sp 44fe0: 2400 movel %d0,%d2 44fe2: 4aae fffc tstl %fp@(-4) 44fe6: 6704 beqs 44fec 44fe8: 7016 moveq #22,%d0 44fea: 604c bras 45038 case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Keys_Information, &the_key->Object ); 44fec: 2f00 movel %d0,%sp@- 44fee: 4879 0005 ed18 pea 5ed18 <_POSIX_Keys_Information> 44ff4: 2440 moveal %d0,%a2 44ff6: 45ea 0018 lea %a2@(24),%a2 44ffa: 7601 moveq #1,%d3 for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) if ( the_key->Values[ the_api ] ) _Workspace_Free( the_key->Values[ the_api ] ); 44ffc: 47f9 0004 8d04 lea 48d04 <_Workspace_Free>,%a3 the_key = _POSIX_Keys_Get( key, &location ); switch ( location ) { case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Keys_Information, &the_key->Object ); 45002: 4eb9 0004 6ed0 jsr 46ed0 <_Objects_Close> 45008: 508f addql #8,%sp for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) if ( the_key->Values[ the_api ] ) 4500a: 2012 movel %a2@,%d0 switch ( location ) { case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Keys_Information, &the_key->Object ); for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) 4500c: 5283 addql #1,%d3 4500e: 588a addql #4,%a2 if ( the_key->Values[ the_api ] ) 45010: 4a80 tstl %d0 45012: 6706 beqs 4501a _Workspace_Free( the_key->Values[ the_api ] ); 45014: 2f00 movel %d0,%sp@- 45016: 4e93 jsr %a3@ 45018: 588f addql #4,%sp switch ( location ) { case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Keys_Information, &the_key->Object ); for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) 4501a: 7005 moveq #5,%d0 4501c: b083 cmpl %d3,%d0 4501e: 66ea bnes 4500a */ RTEMS_INLINE_ROUTINE void _POSIX_Keys_Free ( POSIX_Keys_Control *the_key ) { _Objects_Free( &_POSIX_Keys_Information, &the_key->Object ); 45020: 2f02 movel %d2,%sp@- 45022: 4879 0005 ed18 pea 5ed18 <_POSIX_Keys_Information> 45028: 4eb9 0004 7144 jsr 47144 <_Objects_Free> * NOTE: The destructor is not called and it is the responsibility * of the application to free the memory. */ _POSIX_Keys_Free( the_key ); _Thread_Enable_dispatch(); 4502e: 4eb9 0004 7a26 jsr 47a26 <_Thread_Enable_dispatch> return 0; 45034: 508f addql #8,%sp * NOTE: The destructor is not called and it is the responsibility * of the application to free the memory. */ _POSIX_Keys_Free( the_key ); _Thread_Enable_dispatch(); 45036: 4280 clrl %d0 case OBJECTS_ERROR: break; } return EINVAL; } 45038: 4cee 0c0c ffec moveml %fp@(-20),%d2-%d3/%a2-%a3 4503e: 4e5e unlk %fp 45040: 4e75 rts ... 0004699c : */ int pthread_mutex_destroy( pthread_mutex_t *mutex ) { 4699c: 4e56 fffc linkw %fp,#-4 469a0: 2f0b movel %a3,%sp@- 469a2: 2f0a movel %a2,%sp@- register POSIX_Mutex_Control *the_mutex; Objects_Locations location; the_mutex = _POSIX_Mutex_Get( mutex, &location ); 469a4: 486e fffc pea %fp@(-4) 469a8: 2f2e 0008 movel %fp@(8),%sp@- 469ac: 4eb9 0004 6a6a jsr 46a6a <_POSIX_Mutex_Get> switch ( location ) { 469b2: 508f addql #8,%sp ) { register POSIX_Mutex_Control *the_mutex; Objects_Locations location; the_mutex = _POSIX_Mutex_Get( mutex, &location ); 469b4: 2440 moveal %d0,%a2 switch ( location ) { 469b6: 4aae fffc tstl %fp@(-4) 469ba: 6704 beqs 469c0 469bc: 7016 moveq #22,%d0 469be: 6046 bras 46a06 469c0: 47f9 0004 99be lea 499be <_Thread_Enable_dispatch>,%a3 /* * XXX: There is an error for the mutex being locked * or being in use by a condition variable. */ if ( _CORE_mutex_Is_locked( &the_mutex->Mutex ) ) { 469c6: 4aaa 0062 tstl %a2@(98) 469ca: 6606 bnes 469d2 _Thread_Enable_dispatch(); 469cc: 4e93 jsr %a3@ 469ce: 7010 moveq #16,%d0 return EBUSY; 469d0: 6034 bras 46a06 } _Objects_Close( &_POSIX_Mutex_Information, &the_mutex->Object ); 469d2: 2f00 movel %d0,%sp@- 469d4: 4879 0006 1a9c pea 61a9c <_POSIX_Mutex_Information> 469da: 4eb9 0004 8e68 jsr 48e68 <_Objects_Close> _CORE_mutex_Flush( &the_mutex->Mutex, NULL, EINVAL ); 469e0: 4878 0016 pea 16 469e4: 42a7 clrl %sp@- 469e6: 486a 0014 pea %a2@(20) 469ea: 4eb9 0004 8580 jsr 48580 <_CORE_mutex_Flush> RTEMS_INLINE_ROUTINE void _POSIX_Mutex_Free ( POSIX_Mutex_Control *the_mutex ) { _Objects_Free( &_POSIX_Mutex_Information, &the_mutex->Object ); 469f0: 2f0a movel %a2,%sp@- 469f2: 4879 0006 1a9c pea 61a9c <_POSIX_Mutex_Information> 469f8: 4eb9 0004 90dc jsr 490dc <_Objects_Free> _POSIX_Mutex_Free( the_mutex ); _Thread_Enable_dispatch(); 469fe: 4e93 jsr %a3@ return 0; 46a00: 4fef 001c lea %sp@(28),%sp _Objects_Close( &_POSIX_Mutex_Information, &the_mutex->Object ); _CORE_mutex_Flush( &the_mutex->Mutex, NULL, EINVAL ); _POSIX_Mutex_Free( the_mutex ); _Thread_Enable_dispatch(); 46a04: 4280 clrl %d0 case OBJECTS_ERROR: break; } return EINVAL; } 46a06: 246e fff4 moveal %fp@(-12),%a2 46a0a: 266e fff8 moveal %fp@(-8),%a3 46a0e: 4e5e unlk %fp 46a10: 4e75 rts ... 00046d78 : */ int pthread_mutex_trylock( pthread_mutex_t *mutex ) { 46d78: 4e56 0000 linkw %fp,#0 return _POSIX_Mutex_Lock_support( mutex, false, THREAD_QUEUE_WAIT_FOREVER ); 46d7c: 42a7 clrl %sp@- 46d7e: 42a7 clrl %sp@- 46d80: 2f2e 0008 movel %fp@(8),%sp@- 46d84: 4eb9 0004 6c38 jsr 46c38 <_POSIX_Mutex_Lock_support> } 46d8a: 4e5e unlk %fp 46d8c: 4e75 rts ... 00046d90 : */ int pthread_mutex_unlock( pthread_mutex_t *mutex ) { 46d90: 4e56 fffc linkw %fp,#-4 46d94: 2f02 movel %d2,%sp@- register POSIX_Mutex_Control *the_mutex; Objects_Locations location; CORE_mutex_Status status; the_mutex = _POSIX_Mutex_Get( mutex, &location ); 46d96: 486e fffc pea %fp@(-4) 46d9a: 2f2e 0008 movel %fp@(8),%sp@- 46d9e: 4eb9 0004 6a6a jsr 46a6a <_POSIX_Mutex_Get> switch ( location ) { 46da4: 508f addql #8,%sp 46da6: 4aae fffc tstl %fp@(-4) 46daa: 6704 beqs 46db0 46dac: 7016 moveq #22,%d0 46dae: 6026 bras 46dd6 case OBJECTS_LOCAL: status = _CORE_mutex_Surrender( 46db0: 2040 moveal %d0,%a0 46db2: 42a7 clrl %sp@- 46db4: 2f28 0008 movel %a0@(8),%sp@- 46db8: 4868 0014 pea %a0@(20) 46dbc: 4eb9 0004 8740 jsr 48740 <_CORE_mutex_Surrender> 46dc2: 2400 movel %d0,%d2 &the_mutex->Mutex, the_mutex->Object.id, NULL ); _Thread_Enable_dispatch(); 46dc4: 4eb9 0004 99be jsr 499be <_Thread_Enable_dispatch> return _POSIX_Mutex_Translate_core_mutex_return_code( status ); 46dca: 2f02 movel %d2,%sp@- 46dcc: 4eb9 0004 6d60 jsr 46d60 <_POSIX_Mutex_Translate_core_mutex_return_code> 46dd2: 4fef 0010 lea %sp@(16),%sp case OBJECTS_ERROR: break; } return EINVAL; } 46dd6: 242e fff8 movel %fp@(-8),%d2 46dda: 4e5e unlk %fp 46ddc: 4e75 rts ... 0004686c : int pthread_mutexattr_getprioceiling( const pthread_mutexattr_t *attr, int *prioceiling ) { 4686c: 4e56 0000 linkw %fp,#0 46870: 206e 0008 moveal %fp@(8),%a0 46874: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !prioceiling ) 46878: 4a88 tstl %a0 4687a: 6710 beqs 4688c 4687c: 4a90 tstl %a0@ 4687e: 670c beqs 4688c 46880: 4a89 tstl %a1 46882: 6708 beqs 4688c return EINVAL; *prioceiling = attr->prio_ceiling; 46884: 22a8 0008 movel %a0@(8),%a1@ 46888: 4280 clrl %d0 return 0; 4688a: 6002 bras 4688e 4688c: 7016 moveq #22,%d0 } 4688e: 4e5e unlk %fp 46890: 4e75 rts ... 00046894 : int pthread_mutexattr_getprotocol( const pthread_mutexattr_t *attr, int *protocol ) { 46894: 4e56 0000 linkw %fp,#0 46898: 206e 0008 moveal %fp@(8),%a0 4689c: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !protocol ) 468a0: 4a88 tstl %a0 468a2: 6710 beqs 468b4 468a4: 4a90 tstl %a0@ 468a6: 670c beqs 468b4 468a8: 4a89 tstl %a1 468aa: 6708 beqs 468b4 return EINVAL; *protocol = attr->protocol; 468ac: 22a8 000c movel %a0@(12),%a1@ 468b0: 4280 clrl %d0 return 0; 468b2: 6002 bras 468b6 468b4: 7016 moveq #22,%d0 } 468b6: 4e5e unlk %fp 468b8: 4e75 rts ... 000468bc : int pthread_mutexattr_getpshared( const pthread_mutexattr_t *attr, int *pshared ) { 468bc: 4e56 0000 linkw %fp,#0 468c0: 206e 0008 moveal %fp@(8),%a0 468c4: 226e 000c moveal %fp@(12),%a1 if ( !attr || !attr->is_initialized || !pshared ) 468c8: 4a88 tstl %a0 468ca: 6710 beqs 468dc 468cc: 4a90 tstl %a0@ 468ce: 670c beqs 468dc 468d0: 4a89 tstl %a1 468d2: 6708 beqs 468dc return EINVAL; *pshared = attr->process_shared; 468d4: 22a8 0004 movel %a0@(4),%a1@ 468d8: 4280 clrl %d0 return 0; 468da: 6002 bras 468de 468dc: 7016 moveq #22,%d0 } 468de: 4e5e unlk %fp 468e0: 4e75 rts ... 00044b58 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 44b58: 4e56 0000 linkw %fp,#0 44b5c: 206e 0008 moveal %fp@(8),%a0 44b60: 226e 000c moveal %fp@(12),%a1 if ( !attr ) 44b64: 4a88 tstl %a0 44b66: 6710 beqs 44b78 return EINVAL; if ( !attr->is_initialized ) 44b68: 4a90 tstl %a0@ 44b6a: 670c beqs 44b78 return EINVAL; if ( !type ) 44b6c: 4a89 tstl %a1 44b6e: 6708 beqs 44b78 return EINVAL; *type = attr->type; 44b70: 22a8 0010 movel %a0@(16),%a1@ 44b74: 4280 clrl %d0 return 0; 44b76: 6002 bras 44b7a 44b78: 7016 moveq #22,%d0 } 44b7a: 4e5e unlk %fp 44b7c: 4e75 rts ... 00045b74 : */ int pthread_rwlock_destroy( pthread_rwlock_t *rwlock ) { 45b74: 4e56 fffc linkw %fp,#-4 45b78: 206e 0008 moveal %fp@(8),%a0 45b7c: 2f0b movel %a3,%sp@- 45b7e: 2f0a movel %a2,%sp@- POSIX_RWLock_Control *the_rwlock = NULL; Objects_Locations location; if ( !rwlock ) 45b80: 4a88 tstl %a0 45b82: 6760 beqs 45be4 RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Get ( pthread_rwlock_t *RWLock, Objects_Locations *location ) { return (POSIX_RWLock_Control *) _Objects_Get( 45b84: 486e fffc pea %fp@(-4) 45b88: 2f10 movel %a0@,%sp@- 45b8a: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45b90: 4eb9 0004 83dc jsr 483dc <_Objects_Get> return EINVAL; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 45b96: 4fef 000c lea %sp@(12),%sp 45b9a: 2440 moveal %d0,%a2 45b9c: 4aae fffc tstl %fp@(-4) 45ba0: 6642 bnes 45be4 case OBJECTS_LOCAL: /* * If there is at least one thread waiting, then do not delete it. */ if ( _Thread_queue_First( &the_rwlock->RWLock.Wait_queue ) != NULL ) { 45ba2: 486a 0010 pea %a2@(16) 45ba6: 47f9 0004 8b66 lea 48b66 <_Thread_Enable_dispatch>,%a3 45bac: 4eb9 0004 92f0 jsr 492f0 <_Thread_queue_First> 45bb2: 588f addql #4,%sp 45bb4: 4a80 tstl %d0 45bb6: 6706 beqs 45bbe _Thread_Enable_dispatch(); 45bb8: 4e93 jsr %a3@ 45bba: 7010 moveq #16,%d0 return EBUSY; 45bbc: 6028 bras 45be6 /* * POSIX doesn't require behavior when it is locked. */ _Objects_Close( &_POSIX_RWLock_Information, &the_rwlock->Object ); 45bbe: 2f0a movel %a2,%sp@- 45bc0: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45bc6: 4eb9 0004 8010 jsr 48010 <_Objects_Close> */ RTEMS_INLINE_ROUTINE void _POSIX_RWLock_Free ( POSIX_RWLock_Control *the_RWLock ) { _Objects_Free( &_POSIX_RWLock_Information, &the_RWLock->Object ); 45bcc: 2f0a movel %a2,%sp@- 45bce: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45bd4: 4eb9 0004 8284 jsr 48284 <_Objects_Free> _POSIX_RWLock_Free( the_rwlock ); _Thread_Enable_dispatch(); 45bda: 4e93 jsr %a3@ return 0; 45bdc: 4fef 0010 lea %sp@(16),%sp _Objects_Close( &_POSIX_RWLock_Information, &the_rwlock->Object ); _POSIX_RWLock_Free( the_rwlock ); _Thread_Enable_dispatch(); 45be0: 4280 clrl %d0 return 0; 45be2: 6002 bras 45be6 45be4: 7016 moveq #22,%d0 case OBJECTS_ERROR: break; } return EINVAL; } 45be6: 246e fff4 moveal %fp@(-12),%a2 45bea: 266e fff8 moveal %fp@(-8),%a3 45bee: 4e5e unlk %fp 45bf0: 4e75 rts ... 00045c8c : */ int pthread_rwlock_rdlock( pthread_rwlock_t *rwlock ) { 45c8c: 4e56 fffc linkw %fp,#-4 45c90: 2f0a movel %a2,%sp@- 45c92: 246e 0008 moveal %fp@(8),%a2 POSIX_RWLock_Control *the_rwlock; Objects_Locations location; if ( !rwlock ) 45c96: 4a8a tstl %a2 45c98: 674e beqs 45ce8 RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Get ( pthread_rwlock_t *RWLock, Objects_Locations *location ) { return (POSIX_RWLock_Control *) _Objects_Get( 45c9a: 486e fffc pea %fp@(-4) 45c9e: 2f12 movel %a2@,%sp@- 45ca0: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45ca6: 4eb9 0004 83dc jsr 483dc <_Objects_Get> return EINVAL; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 45cac: 4fef 000c lea %sp@(12),%sp 45cb0: 4aae fffc tstl %fp@(-4) 45cb4: 6632 bnes 45ce8 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 45cb6: 42a7 clrl %sp@- 45cb8: 2040 moveal %d0,%a0 45cba: 42a7 clrl %sp@- 45cbc: 4878 0001 pea 1 45cc0: 2f12 movel %a2@,%sp@- 45cc2: 4868 0010 pea %a0@(16) 45cc6: 4eb9 0004 77f8 jsr 477f8 <_CORE_RWLock_Obtain_for_reading> true, /* we are willing to wait forever */ 0, NULL ); _Thread_Enable_dispatch(); 45ccc: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch> return _POSIX_RWLock_Translate_core_RWLock_return_code( 45cd2: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45cd8: 2f28 0034 movel %a0@(52),%sp@- 45cdc: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45ce2: 4fef 0018 lea %sp@(24),%sp 45ce6: 6002 bras 45cea 45ce8: 7016 moveq #22,%d0 case OBJECTS_ERROR: break; } return EINVAL; } 45cea: 246e fff8 moveal %fp@(-8),%a2 45cee: 4e5e unlk %fp 45cf0: 4e75 rts ... 00045cf4 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 45cf4: 4e56 ffec linkw %fp,#-20 45cf8: 48d7 040c moveml %d2-%d3/%a2,%sp@ 45cfc: 246e 0008 moveal %fp@(8),%a2 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 45d00: 4a8a tstl %a2 45d02: 6700 008e beqw 45d92 * * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); 45d06: 486e fff8 pea %fp@(-8) 45d0a: 2f2e 000c movel %fp@(12),%sp@- 45d0e: 4eb9 0004 b7d4 jsr 4b7d4 <_POSIX_Absolute_timeout_to_ticks> 45d14: 486e fffc pea %fp@(-4) 45d18: 2400 movel %d0,%d2 45d1a: 2f12 movel %a2@,%sp@- 45d1c: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45d22: 4eb9 0004 83dc jsr 483dc <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 45d28: 4fef 0014 lea %sp@(20),%sp 45d2c: 4aae fffc tstl %fp@(-4) 45d30: 6660 bnes 45d92 int _EXFUN(pthread_rwlock_init, (pthread_rwlock_t *__rwlock, _CONST pthread_rwlockattr_t *__attr)); int _EXFUN(pthread_rwlock_destroy, (pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_rdlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_tryrdlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_timedrdlock, 45d32: 7203 moveq #3,%d1 45d34: b282 cmpl %d2,%d1 45d36: 57c3 seq %d3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 45d38: 42a7 clrl %sp@- 45d3a: 2f2e fff8 movel %fp@(-8),%sp@- 45d3e: 4483 negl %d3 45d40: 4281 clrl %d1 45d42: 1203 moveb %d3,%d1 45d44: 2040 moveal %d0,%a0 45d46: 2f01 movel %d1,%sp@- 45d48: 2f12 movel %a2@,%sp@- 45d4a: 4868 0010 pea %a0@(16) 45d4e: 4eb9 0004 77f8 jsr 477f8 <_CORE_RWLock_Obtain_for_reading> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 45d54: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch> if ( !do_wait ) { 45d5a: 4fef 0014 lea %sp@(20),%sp 45d5e: 4a03 tstb %d3 45d60: 661c bnes 45d7e if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 45d62: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45d68: 7002 moveq #2,%d0 45d6a: b0a8 0034 cmpl %a0@(52),%d0 45d6e: 660e bnes 45d7e switch (status) { 45d70: 4a82 tstl %d2 45d72: 671e beqs 45d92 45d74: b082 cmpl %d2,%d0 45d76: 6506 bcss 45d7e 45d78: 103c 0074 moveb #116,%d0 45d7c: 6016 bras 45d94 break; } } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 45d7e: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45d84: 2f28 0034 movel %a0@(52),%sp@- 45d88: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45d8e: 588f addql #4,%sp 45d90: 6002 bras 45d94 45d92: 7016 moveq #22,%d0 case OBJECTS_ERROR: break; } return EINVAL; } 45d94: 4cee 040c ffec moveml %fp@(-20),%d2-%d3/%a2 45d9a: 4e5e unlk %fp 45d9c: 4e75 rts ... 00045da0 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 45da0: 4e56 ffec linkw %fp,#-20 45da4: 48d7 040c moveml %d2-%d3/%a2,%sp@ 45da8: 246e 0008 moveal %fp@(8),%a2 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 45dac: 4a8a tstl %a2 45dae: 6700 008e beqw 45e3e * * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); 45db2: 486e fff8 pea %fp@(-8) 45db6: 2f2e 000c movel %fp@(12),%sp@- 45dba: 4eb9 0004 b7d4 jsr 4b7d4 <_POSIX_Absolute_timeout_to_ticks> 45dc0: 486e fffc pea %fp@(-4) 45dc4: 2400 movel %d0,%d2 45dc6: 2f12 movel %a2@,%sp@- 45dc8: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45dce: 4eb9 0004 83dc jsr 483dc <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 45dd4: 4fef 0014 lea %sp@(20),%sp 45dd8: 4aae fffc tstl %fp@(-4) 45ddc: 6660 bnes 45e3e (pthread_rwlock_t *__rwlock, _CONST struct timespec *__abstime)); int _EXFUN(pthread_rwlock_unlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_wrlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_trywrlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_timedwrlock, 45dde: 7203 moveq #3,%d1 45de0: b282 cmpl %d2,%d1 45de2: 57c3 seq %d3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 45de4: 42a7 clrl %sp@- 45de6: 2f2e fff8 movel %fp@(-8),%sp@- 45dea: 4483 negl %d3 45dec: 4281 clrl %d1 45dee: 1203 moveb %d3,%d1 45df0: 2040 moveal %d0,%a0 45df2: 2f01 movel %d1,%sp@- 45df4: 2f12 movel %a2@,%sp@- 45df6: 4868 0010 pea %a0@(16) 45dfa: 4eb9 0004 78a8 jsr 478a8 <_CORE_RWLock_Obtain_for_writing> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 45e00: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch> if ( !do_wait && 45e06: 4fef 0014 lea %sp@(20),%sp 45e0a: 4a03 tstb %d3 45e0c: 661c bnes 45e2a (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 45e0e: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45e14: 7002 moveq #2,%d0 45e16: b0a8 0034 cmpl %a0@(52),%d0 45e1a: 660e bnes 45e2a switch (status) { 45e1c: 4a82 tstl %d2 45e1e: 671e beqs 45e3e 45e20: b082 cmpl %d2,%d0 45e22: 6506 bcss 45e2a 45e24: 103c 0074 moveb #116,%d0 45e28: 6016 bras 45e40 case POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE: break; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 45e2a: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45e30: 2f28 0034 movel %a0@(52),%sp@- 45e34: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45e3a: 588f addql #4,%sp 45e3c: 6002 bras 45e40 45e3e: 7016 moveq #22,%d0 case OBJECTS_ERROR: break; } return EINVAL; } 45e40: 4cee 040c ffec moveml %fp@(-20),%d2-%d3/%a2 45e46: 4e5e unlk %fp 45e48: 4e75 rts ... 00045f80 : */ int pthread_rwlock_wrlock( pthread_rwlock_t *rwlock ) { 45f80: 4e56 fffc linkw %fp,#-4 45f84: 2f0a movel %a2,%sp@- 45f86: 246e 0008 moveal %fp@(8),%a2 POSIX_RWLock_Control *the_rwlock; Objects_Locations location; if ( !rwlock ) 45f8a: 4a8a tstl %a2 45f8c: 674e beqs 45fdc 45f8e: 486e fffc pea %fp@(-4) 45f92: 2f12 movel %a2@,%sp@- 45f94: 4879 0005 f7e4 pea 5f7e4 <_POSIX_RWLock_Information> 45f9a: 4eb9 0004 83dc jsr 483dc <_Objects_Get> return EINVAL; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 45fa0: 4fef 000c lea %sp@(12),%sp 45fa4: 4aae fffc tstl %fp@(-4) 45fa8: 6632 bnes 45fdc case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 45faa: 42a7 clrl %sp@- 45fac: 2040 moveal %d0,%a0 45fae: 42a7 clrl %sp@- 45fb0: 4878 0001 pea 1 45fb4: 2f12 movel %a2@,%sp@- 45fb6: 4868 0010 pea %a0@(16) 45fba: 4eb9 0004 78a8 jsr 478a8 <_CORE_RWLock_Obtain_for_writing> true, /* do not timeout -- wait forever */ 0, NULL ); _Thread_Enable_dispatch(); 45fc0: 4eb9 0004 8b66 jsr 48b66 <_Thread_Enable_dispatch> return _POSIX_RWLock_Translate_core_RWLock_return_code( 45fc6: 2079 0005 f6f2 moveal 5f6f2 <_Thread_Executing>,%a0 45fcc: 2f28 0034 movel %a0@(52),%sp@- 45fd0: 4eb9 0004 5e4c jsr 45e4c <_POSIX_RWLock_Translate_core_RWLock_return_code> 45fd6: 4fef 0018 lea %sp@(24),%sp 45fda: 6002 bras 45fde 45fdc: 7016 moveq #22,%d0 case OBJECTS_ERROR: break; } return EINVAL; } 45fde: 246e fff8 moveal %fp@(-8),%a2 45fe2: 4e5e unlk %fp 45fe4: 4e75 rts ... 000464dc : int pthread_rwlockattr_getpshared( const pthread_rwlockattr_t *attr, int *pshared ) { 464dc: 4e56 0000 linkw %fp,#0 464e0: 206e 0008 moveal %fp@(8),%a0 if ( !attr ) 464e4: 4a88 tstl %a0 464e6: 6710 beqs 464f8 return EINVAL; if ( !attr->is_initialized ) 464e8: 4a90 tstl %a0@ 464ea: 670c beqs 464f8 return EINVAL; *pshared = attr->process_shared; 464ec: 226e 000c moveal %fp@(12),%a1 464f0: 4280 clrl %d0 464f2: 22a8 0004 movel %a0@(4),%a1@ return 0; 464f6: 6002 bras 464fa 464f8: 7016 moveq #22,%d0 } 464fa: 4e5e unlk %fp 464fc: 4e75 rts ... 00046500 : */ int pthread_rwlockattr_init( pthread_rwlockattr_t *attr ) { 46500: 4e56 0000 linkw %fp,#0 46504: 206e 0008 moveal %fp@(8),%a0 if ( !attr ) 46508: 4a88 tstl %a0 4650a: 6604 bnes 46510 4650c: 7016 moveq #22,%d0 4650e: 600a bras 4651a return EINVAL; attr->is_initialized = true; 46510: 7201 moveq #1,%d1 attr->process_shared = PTHREAD_PROCESS_PRIVATE; 46512: 4280 clrl %d0 46514: 42a8 0004 clrl %a0@(4) ) { if ( !attr ) return EINVAL; attr->is_initialized = true; 46518: 2081 movel %d1,%a0@ attr->process_shared = PTHREAD_PROCESS_PRIVATE; return 0; } 4651a: 4e5e unlk %fp 4651c: 4e75 rts ... 0004c9c0 : #include #include pthread_t pthread_self( void ) { 4c9c0: 4e56 0000 linkw %fp,#0 4c9c4: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 return _Thread_Executing->Object.id; } 4c9ca: 4e5e unlk %fp 4c9cc: 2028 0008 movel %a0@(8),%d0 4c9d0: 4e75 rts ... 00044b70 : int pthread_setcancelstate( int state, int *oldstate ) { 44b70: 4e56 0000 linkw %fp,#0 44b74: 202e 0008 movel %fp@(8),%d0 44b78: 226e 000c moveal %fp@(12),%a1 * Don't even think about deleting a resource from an ISR. * Besides this request is supposed to be for _Thread_Executing * and the ISR context is not a thread. */ if ( _ISR_Is_in_progress() ) 44b7c: 2239 0005 d3c2 movel 5d3c2 <_ISR_Nest_level>,%d1 44b82: 6704 beqs 44b88 44b84: 7047 moveq #71,%d0 44b86: 603e bras 44bc6 return EPROTO; if ( !oldstate ) 44b88: 4a89 tstl %a1 44b8a: 6738 beqs 44bc4 return EINVAL; if ( state != PTHREAD_CANCEL_ENABLE && state != PTHREAD_CANCEL_DISABLE ) 44b8c: 7201 moveq #1,%d1 44b8e: b280 cmpl %d0,%d1 44b90: 6532 bcss 44bc4 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 44b92: 2239 0005 d328 movel 5d328 <_Thread_Dispatch_disable_level>,%d1 44b98: 5281 addql #1,%d1 return EINVAL; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 44b9a: 2079 0005 d3e2 moveal 5d3e2 <_Thread_Executing>,%a0 44ba0: 23c1 0005 d328 movel %d1,5d328 <_Thread_Dispatch_disable_level> 44ba6: 2068 010e moveal %a0@(270),%a0 _Thread_Disable_dispatch(); *oldstate = thread_support->cancelability_state; 44baa: 22a8 00d4 movel %a0@(212),%a1@ thread_support->cancelability_state = state; 44bae: 2140 00d4 movel %d0,%a0@(212) _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing); 44bb2: 2f39 0005 d3e2 movel 5d3e2 <_Thread_Executing>,%sp@- 44bb8: 4eb9 0004 97fc jsr 497fc <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch> /* * _Thread_Enable_dispatch is invoked by above call. */ return 0; 44bbe: 588f addql #4,%sp _Thread_Disable_dispatch(); *oldstate = thread_support->cancelability_state; thread_support->cancelability_state = state; _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing); 44bc0: 4280 clrl %d0 /* * _Thread_Enable_dispatch is invoked by above call. */ return 0; 44bc2: 6002 bras 44bc6 44bc4: 7016 moveq #22,%d0 } 44bc6: 4e5e unlk %fp 44bc8: 4e75 rts ... 00044bcc : int pthread_setcanceltype( int type, int *oldtype ) { 44bcc: 4e56 0000 linkw %fp,#0 44bd0: 202e 0008 movel %fp@(8),%d0 44bd4: 226e 000c moveal %fp@(12),%a1 * Don't even think about deleting a resource from an ISR. * Besides this request is supposed to be for _Thread_Executing * and the ISR context is not a thread. */ if ( _ISR_Is_in_progress() ) 44bd8: 2239 0005 d3c2 movel 5d3c2 <_ISR_Nest_level>,%d1 44bde: 6704 beqs 44be4 44be0: 7047 moveq #71,%d0 44be2: 603e bras 44c22 return EPROTO; if ( !oldtype ) 44be4: 4a89 tstl %a1 44be6: 6738 beqs 44c20 return EINVAL; if ( type != PTHREAD_CANCEL_DEFERRED && type != PTHREAD_CANCEL_ASYNCHRONOUS ) 44be8: 7201 moveq #1,%d1 44bea: b280 cmpl %d0,%d1 44bec: 6532 bcss 44c20 44bee: 2239 0005 d328 movel 5d328 <_Thread_Dispatch_disable_level>,%d1 44bf4: 5281 addql #1,%d1 return EINVAL; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 44bf6: 2079 0005 d3e2 moveal 5d3e2 <_Thread_Executing>,%a0 44bfc: 23c1 0005 d328 movel %d1,5d328 <_Thread_Dispatch_disable_level> 44c02: 2068 010e moveal %a0@(270),%a0 _Thread_Disable_dispatch(); *oldtype = thread_support->cancelability_type; 44c06: 22a8 00d8 movel %a0@(216),%a1@ thread_support->cancelability_type = type; 44c0a: 2140 00d8 movel %d0,%a0@(216) _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing); 44c0e: 2f39 0005 d3e2 movel 5d3e2 <_Thread_Executing>,%sp@- 44c14: 4eb9 0004 97fc jsr 497fc <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch> /* * _Thread_Enable_dispatch is invoked by above call. */ return 0; 44c1a: 588f addql #4,%sp _Thread_Disable_dispatch(); *oldtype = thread_support->cancelability_type; thread_support->cancelability_type = type; _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch(_Thread_Executing); 44c1c: 4280 clrl %d0 /* * _Thread_Enable_dispatch is invoked by above call. */ return 0; 44c1e: 6002 bras 44c22 44c20: 7016 moveq #22,%d0 } 44c22: 4e5e unlk %fp 44c24: 4e75 rts ... 0004abf4 : int pthread_sigmask( int how, const sigset_t *set, sigset_t *oset ) { 4abf4: 4e56 0000 linkw %fp,#0 4abf8: 202e 0008 movel %fp@(8),%d0 4abfc: 2f0b movel %a3,%sp@- 4abfe: 226e 000c moveal %fp@(12),%a1 4ac02: 2f0a movel %a2,%sp@- 4ac04: 246e 0010 moveal %fp@(16),%a2 POSIX_API_Control *api; if ( !set && !oset ) 4ac08: 4a89 tstl %a1 4ac0a: 6604 bnes 4ac10 4ac0c: 4a8a tstl %a2 4ac0e: 6742 beqs 4ac52 rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 4ac10: 2679 0005 e94e moveal 5e94e <_Thread_Executing>,%a3 4ac16: 206b 010e moveal %a3@(270),%a0 if ( oset ) 4ac1a: 4a8a tstl %a2 4ac1c: 6704 beqs 4ac22 *oset = api->signals_blocked; 4ac1e: 24a8 00cc movel %a0@(204),%a2@ if ( !set ) 4ac22: 4a89 tstl %a1 4ac24: 675c beqs 4ac82 return 0; switch ( how ) { 4ac26: 7201 moveq #1,%d1 4ac28: b280 cmpl %d0,%d1 4ac2a: 670e beqs 4ac3a 4ac2c: 123c 0002 moveb #2,%d1 4ac30: b280 cmpl %d0,%d1 4ac32: 670e beqs 4ac42 4ac34: 4a80 tstl %d0 4ac36: 6714 beqs 4ac4c 4ac38: 6018 bras 4ac52 case SIG_BLOCK: api->signals_blocked |= *set; 4ac3a: 2011 movel %a1@,%d0 4ac3c: 81a8 00cc orl %d0,%a0@(204) break; 4ac40: 6020 bras 4ac62 case SIG_UNBLOCK: api->signals_blocked &= ~*set; 4ac42: 2011 movel %a1@,%d0 4ac44: 4680 notl %d0 4ac46: c1a8 00cc andl %d0,%a0@(204) break; 4ac4a: 6016 bras 4ac62 case SIG_SETMASK: api->signals_blocked = *set; 4ac4c: 2151 00cc movel %a1@,%a0@(204) break; 4ac50: 6010 bras 4ac62 default: rtems_set_errno_and_return_minus_one( EINVAL ); 4ac52: 4eb9 0004 d714 jsr 4d714 <__errno> 4ac58: 72ff moveq #-1,%d1 4ac5a: 2040 moveal %d0,%a0 4ac5c: 7016 moveq #22,%d0 4ac5e: 2080 movel %d0,%a0@ 4ac60: 6022 bras 4ac84 /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending) ) { 4ac62: 2039 0005 ef36 movel 5ef36 <_POSIX_signals_Pending>,%d0 /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & 4ac68: 2228 00cc movel %a0@(204),%d1 4ac6c: 4681 notl %d1 (api->signals_pending | _POSIX_signals_Pending) ) { 4ac6e: 80a8 00d0 orl %a0@(208),%d0 /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & 4ac72: c081 andl %d1,%d0 4ac74: 670c beqs 4ac82 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Executing->do_post_task_switch_extension = true; 4ac76: 7001 moveq #1,%d0 4ac78: 1740 0074 moveb %d0,%a3@(116) _Thread_Dispatch(); 4ac7c: 4eb9 0004 79ac jsr 479ac <_Thread_Dispatch> 4ac82: 4281 clrl %d1 } return 0; } 4ac84: 246e fff8 moveal %fp@(-8),%a2 4ac88: 2001 movel %d1,%d0 4ac8a: 266e fffc moveal %fp@(-4),%a3 4ac8e: 4e5e unlk %fp 4ac90: 4e75 rts ... 0004509c : int pthread_spin_init( pthread_spinlock_t *spinlock, int pshared ) { 4509c: 4e56 fff0 linkw %fp,#-16 450a0: 48d7 1c00 moveml %a2-%a4,%sp@ 450a4: 266e 0008 moveal %fp@(8),%a3 POSIX_Spinlock_Control *the_spinlock; CORE_spinlock_Attributes attributes; if ( !spinlock ) 450a8: 4a8b tstl %a3 450aa: 6762 beqs 4510e return EINVAL; switch ( pshared ) { 450ac: 4aae 000c tstl %fp@(12) 450b0: 665c bnes 4510e rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 450b2: 2039 0005 dc74 movel 5dc74 <_Thread_Dispatch_disable_level>,%d0 450b8: 5280 addql #1,%d0 450ba: 23c0 0005 dc74 movel %d0,5dc74 <_Thread_Dispatch_disable_level> * This function allocates a spinlock control block from * the inactive chain of free spinlock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Spinlock_Control *_POSIX_Spinlock_Allocate( void ) { return (POSIX_Spinlock_Control *) 450c0: 4879 0005 de94 pea 5de94 <_POSIX_Spinlock_Information> 450c6: 45f9 0004 768e lea 4768e <_Thread_Enable_dispatch>,%a2 450cc: 4eb9 0004 6ab8 jsr 46ab8 <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_spinlock = _POSIX_Spinlock_Allocate(); if ( !the_spinlock ) { 450d2: 588f addql #4,%sp 450d4: 2840 moveal %d0,%a4 450d6: 4a80 tstl %d0 450d8: 6606 bnes 450e0 _Thread_Enable_dispatch(); 450da: 4e92 jsr %a2@ 450dc: 700b moveq #11,%d0 return EAGAIN; 450de: 6030 bras 45110 } _CORE_spinlock_Initialize( &the_spinlock->Spinlock, &attributes ); 450e0: 486e fffc pea %fp@(-4) 450e4: 486c 0010 pea %a4@(16) 450e8: 4eb9 0004 6558 jsr 46558 <_CORE_spinlock_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 450ee: 202c 0008 movel %a4@(8),%d0 450f2: 4281 clrl %d1 450f4: 2079 0005 deac moveal 5deac <_POSIX_Spinlock_Information+0x18>,%a0 450fa: 3200 movew %d0,%d1 450fc: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4) _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 45100: 42ac 000c clrl %a4@(12) _Objects_Open_u32( &_POSIX_Spinlock_Information, &the_spinlock->Object, 0 ); *spinlock = the_spinlock->Object.id; 45104: 2680 movel %d0,%a3@ _Thread_Enable_dispatch(); 45106: 4e92 jsr %a2@ return 0; 45108: 508f addql #8,%sp _Objects_Open_u32( &_POSIX_Spinlock_Information, &the_spinlock->Object, 0 ); *spinlock = the_spinlock->Object.id; _Thread_Enable_dispatch(); 4510a: 4280 clrl %d0 return 0; 4510c: 6002 bras 45110 4510e: 7016 moveq #22,%d0 } 45110: 4cee 1c00 fff0 moveml %fp@(-16),%a2-%a4 45116: 4e5e unlk %fp 45118: 4e75 rts ... 00045190 : */ int pthread_spin_trylock( pthread_spinlock_t *spinlock ) { 45190: 4e56 fffc linkw %fp,#-4 45194: 206e 0008 moveal %fp@(8),%a0 45198: 2f02 movel %d2,%sp@- POSIX_Spinlock_Control *the_spinlock = NULL; Objects_Locations location; CORE_spinlock_Status status; if ( !spinlock ) 4519a: 4a88 tstl %a0 4519c: 6742 beqs 451e0 4519e: 486e fffc pea %fp@(-4) 451a2: 2f10 movel %a0@,%sp@- 451a4: 4879 0005 de94 pea 5de94 <_POSIX_Spinlock_Information> 451aa: 4eb9 0004 6f04 jsr 46f04 <_Objects_Get> return EINVAL; the_spinlock = _POSIX_Spinlock_Get( spinlock, &location ); switch ( location ) { 451b0: 4fef 000c lea %sp@(12),%sp 451b4: 4aae fffc tstl %fp@(-4) 451b8: 6626 bnes 451e0 case OBJECTS_LOCAL: status = _CORE_spinlock_Wait( &the_spinlock->Spinlock, false, 0 ); 451ba: 42a7 clrl %sp@- 451bc: 2040 moveal %d0,%a0 451be: 42a7 clrl %sp@- 451c0: 4868 0010 pea %a0@(16) 451c4: 4eb9 0004 65c8 jsr 465c8 <_CORE_spinlock_Wait> 451ca: 2400 movel %d0,%d2 _Thread_Enable_dispatch(); 451cc: 4eb9 0004 768e jsr 4768e <_Thread_Enable_dispatch> return _POSIX_Spinlock_Translate_core_spinlock_return_code( status ); 451d2: 2f02 movel %d2,%sp@- 451d4: 4eb9 0004 5178 jsr 45178 <_POSIX_Spinlock_Translate_core_spinlock_return_code> 451da: 4fef 0010 lea %sp@(16),%sp 451de: 6002 bras 451e2 451e0: 7016 moveq #22,%d0 case OBJECTS_ERROR: break; } return EINVAL; } 451e2: 242e fff8 movel %fp@(-8),%d2 451e6: 4e5e unlk %fp 451e8: 4e75 rts ... 00045420 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 45420: 4e56 0000 linkw %fp,#0 * Don't even think about deleting a resource from an ISR. * Besides this request is supposed to be for _Thread_Executing * and the ISR context is not a thread. */ if ( _ISR_Is_in_progress() ) 45424: 2039 0005 dc6a movel 5dc6a <_ISR_Nest_level>,%d0 * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 4542a: 2f02 movel %d2,%sp@- * Don't even think about deleting a resource from an ISR. * Besides this request is supposed to be for _Thread_Executing * and the ISR context is not a thread. */ if ( _ISR_Is_in_progress() ) 4542c: 4a80 tstl %d0 4542e: 6646 bnes 45476 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 45430: 2079 0005 dc8a moveal 5dc8a <_Thread_Executing>,%a0 45436: 2039 0005 dbd0 movel 5dbd0 <_Thread_Dispatch_disable_level>,%d0 4543c: 5280 addql #1,%d0 4543e: 2068 010e moveal %a0@(270),%a0 45442: 23c0 0005 dbd0 movel %d0,5dbd0 <_Thread_Dispatch_disable_level> _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 45448: 4aa8 00d4 tstl %a0@(212) 4544c: 6704 beqs 45452 4544e: 4202 clrb %d2 <== NOT EXECUTED 45450: 6008 bras 4545a <== NOT EXECUTED /* Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ int _EXFUN(pthread_setcancelstate, (int __state, int *__oldstate)); int _EXFUN(pthread_setcanceltype, (int __type, int *__oldtype)); void _EXFUN(pthread_testcancel, (void)); 45452: 4aa8 00dc tstl %a0@(220) 45456: 56c2 sne %d2 45458: 4482 negl %d2 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 4545a: 4eb9 0004 772a jsr 4772a <_Thread_Enable_dispatch> if ( cancel ) 45460: 4a02 tstb %d2 45462: 6712 beqs 45476 _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 45464: 4878 ffff pea ffffffff 45468: 2f39 0005 dc8a movel 5dc8a <_Thread_Executing>,%sp@- 4546e: 4eb9 0004 a594 jsr 4a594 <_POSIX_Thread_Exit> 45474: 508f addql #8,%sp <== NOT EXECUTED } 45476: 242e fffc movel %fp@(-4),%d2 4547a: 4e5e unlk %fp 4547c: 4e75 rts ... 0004ba48 : rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { 4ba48: 4e56 ffe4 linkw %fp,#-28 4ba4c: 202e 0010 movel %fp@(16),%d0 4ba50: 48d7 1c0c moveml %d2-%d3/%a2-%a4,%sp@ 4ba54: 242e 0008 movel %fp@(8),%d2 4ba58: 262e 000c movel %fp@(12),%d3 4ba5c: 266e 0014 moveal %fp@(20),%a3 Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) 4ba60: 4a82 tstl %d2 4ba62: 6606 bnes 4ba6a 4ba64: 7003 moveq #3,%d0 4ba66: 6000 0088 braw 4baf0 return RTEMS_INVALID_NAME; if ( !id ) 4ba6a: 4a8b tstl %a3 4ba6c: 6604 bnes 4ba72 4ba6e: 7009 moveq #9,%d0 4ba70: 607e bras 4baf0 return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { 4ba72: 0803 0004 btst #4,%d3 4ba76: 6710 beqs 4ba88 the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) 4ba78: 4a80 tstl %d0 4ba7a: 6606 bnes 4ba82 4ba7c: 103c 000a moveb #10,%d0 4ba80: 606e bras 4baf0 if ( !id ) return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 4ba82: 42ae fff8 clrl %fp@(-8) 4ba86: 6006 bras 4ba8e if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; 4ba88: 7201 moveq #1,%d1 4ba8a: 2d41 fff8 movel %d1,%fp@(-8) 4ba8e: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 4ba94: 5281 addql #1,%d1 the_attributes.maximum_count = maximum_waiters; 4ba96: 2d40 fffc movel %d0,%fp@(-4) 4ba9a: 23c1 0005 cc94 movel %d1,5cc94 <_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 ); 4baa0: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4baa6: 45f9 0004 6ce2 lea 46ce2 <_Thread_Enable_dispatch>,%a2 4baac: 4eb9 0004 609c jsr 4609c <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { 4bab2: 588f addql #4,%sp 4bab4: 2840 moveal %d0,%a4 4bab6: 4a80 tstl %d0 4bab8: 6606 bnes 4bac0 _Thread_Enable_dispatch(); 4baba: 4e92 jsr %a2@ 4babc: 7005 moveq #5,%d0 return RTEMS_TOO_MANY; 4babe: 6030 bras 4baf0 } the_barrier->attribute_set = attribute_set; 4bac0: 2943 0010 movel %d3,%a4@(16) _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 4bac4: 486e fff8 pea %fp@(-8) 4bac8: 486c 0014 pea %a4@(20) 4bacc: 4eb9 0004 bf0c jsr 4bf0c <_CORE_barrier_Initialize> 4bad2: 202c 0008 movel %a4@(8),%d0 4bad6: 4281 clrl %d1 4bad8: 2079 0005 d540 moveal 5d540 <_Barrier_Information+0x18>,%a0 4bade: 3200 movew %d0,%d1 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 4bae0: 2942 000c movel %d2,%a4@(12) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4bae4: 218c 1c00 movel %a4,%a0@(00000000,%d1:l:4) &_Barrier_Information, &the_barrier->Object, (Objects_Name) name ); *id = the_barrier->Object.id; 4bae8: 2680 movel %d0,%a3@ _Thread_Enable_dispatch(); 4baea: 4e92 jsr %a2@ return RTEMS_SUCCESSFUL; 4baec: 508f addql #8,%sp (Objects_Name) name ); *id = the_barrier->Object.id; _Thread_Enable_dispatch(); 4baee: 4280 clrl %d0 return RTEMS_SUCCESSFUL; } 4baf0: 4cee 1c0c ffe4 moveml %fp@(-28),%d2-%d3/%a2-%a4 4baf6: 4e5e unlk %fp 4baf8: 4e75 rts ... 0004bafc : */ rtems_status_code rtems_barrier_delete( rtems_id id ) { 4bafc: 4e56 fffc linkw %fp,#-4 4bb00: 2f0a movel %a2,%sp@- RTEMS_INLINE_ROUTINE Barrier_Control *_Barrier_Get ( Objects_Id id, Objects_Locations *location ) { return (Barrier_Control *) 4bb02: 486e fffc pea %fp@(-4) 4bb06: 2f2e 0008 movel %fp@(8),%sp@- 4bb0a: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb10: 4eb9 0004 64e8 jsr 464e8 <_Objects_Get> Barrier_Control *the_barrier; Objects_Locations location; the_barrier = _Barrier_Get( id, &location ); switch ( location ) { 4bb16: 4fef 000c lea %sp@(12),%sp 4bb1a: 2440 moveal %d0,%a2 4bb1c: 4aae fffc tstl %fp@(-4) 4bb20: 6704 beqs 4bb26 4bb22: 7004 moveq #4,%d0 4bb24: 6038 bras 4bb5e case OBJECTS_LOCAL: _CORE_barrier_Flush( 4bb26: 4878 0002 pea 2 4bb2a: 42a7 clrl %sp@- 4bb2c: 486a 0014 pea %a2@(20) 4bb30: 4eb9 0004 7368 jsr 47368 <_Thread_queue_Flush> &the_barrier->Barrier, NULL, CORE_BARRIER_WAS_DELETED ); _Objects_Close( &_Barrier_Information, &the_barrier->Object ); 4bb36: 2f0a movel %a2,%sp@- 4bb38: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb3e: 4eb9 0004 611c jsr 4611c <_Objects_Close> */ RTEMS_INLINE_ROUTINE void _Barrier_Free ( Barrier_Control *the_barrier ) { _Objects_Free( &_Barrier_Information, &the_barrier->Object ); 4bb44: 2f0a movel %a2,%sp@- 4bb46: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb4c: 4eb9 0004 6390 jsr 46390 <_Objects_Free> _Barrier_Free( the_barrier ); _Thread_Enable_dispatch(); 4bb52: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4bb58: 4fef 001c lea %sp@(28),%sp _Objects_Close( &_Barrier_Information, &the_barrier->Object ); _Barrier_Free( the_barrier ); _Thread_Enable_dispatch(); 4bb5c: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4bb5e: 246e fff8 moveal %fp@(-8),%a2 4bb62: 4e5e unlk %fp 4bb64: 4e75 rts ... 0004bb68 : rtems_status_code rtems_barrier_release( rtems_id id, uint32_t *released ) { 4bb68: 4e56 fffc linkw %fp,#-4 4bb6c: 2f0a movel %a2,%sp@- 4bb6e: 246e 000c moveal %fp@(12),%a2 4bb72: 2f02 movel %d2,%sp@- 4bb74: 242e 0008 movel %fp@(8),%d2 Barrier_Control *the_barrier; Objects_Locations location; if ( !released ) 4bb78: 4a8a tstl %a2 4bb7a: 6604 bnes 4bb80 4bb7c: 7009 moveq #9,%d0 4bb7e: 603e bras 4bbbe RTEMS_INLINE_ROUTINE Barrier_Control *_Barrier_Get ( Objects_Id id, Objects_Locations *location ) { return (Barrier_Control *) 4bb80: 486e fffc pea %fp@(-4) 4bb84: 2f02 movel %d2,%sp@- 4bb86: 4879 0005 d528 pea 5d528 <_Barrier_Information> 4bb8c: 4eb9 0004 64e8 jsr 464e8 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_barrier = _Barrier_Get( id, &location ); switch ( location ) { 4bb92: 4fef 000c lea %sp@(12),%sp 4bb96: 4aae fffc tstl %fp@(-4) 4bb9a: 6704 beqs 4bba0 4bb9c: 7004 moveq #4,%d0 4bb9e: 601e bras 4bbbe case OBJECTS_LOCAL: *released = _CORE_barrier_Release( &the_barrier->Barrier, id, NULL ); 4bba0: 42a7 clrl %sp@- 4bba2: 2040 moveal %d0,%a0 4bba4: 2f02 movel %d2,%sp@- 4bba6: 4868 0014 pea %a0@(20) 4bbaa: 4eb9 0004 bf48 jsr 4bf48 <_CORE_barrier_Release> 4bbb0: 2480 movel %d0,%a2@ _Thread_Enable_dispatch(); 4bbb2: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4bbb8: 4fef 000c lea %sp@(12),%sp the_barrier = _Barrier_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: *released = _CORE_barrier_Release( &the_barrier->Barrier, id, NULL ); _Thread_Enable_dispatch(); 4bbbc: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4bbbe: 242e fff4 movel %fp@(-12),%d2 4bbc2: 246e fff8 moveal %fp@(-8),%a2 4bbc6: 4e5e unlk %fp 4bbc8: 4e75 rts ... 00046438 : uint32_t api, uint32_t class, uint32_t node, uint32_t index ) { 46438: 7218 moveq #24,%d1 4643a: 4e56 0000 linkw %fp,#0 4643e: 202e 000c movel %fp@(12),%d0 46442: 2f02 movel %d2,%sp@- 46444: 242e 0008 movel %fp@(8),%d2 46448: e3aa lsll %d1,%d2 4644a: 123c 001b moveb #27,%d1 4644e: e3a8 lsll %d1,%d0 46450: 222e 0010 movel %fp@(16),%d1 46454: 8082 orl %d2,%d0 46456: 4841 swap %d1 46458: 4241 clrw %d1 return _Objects_Build_id( api, class, node, index ); } 4645a: 241f movel %sp@+,%d2 uint32_t api, uint32_t class, uint32_t node, uint32_t index ) { 4645c: 80ae 0014 orl %fp@(20),%d0 return _Objects_Build_id( api, class, node, index ); } 46460: 4e5e unlk %fp 46462: 8081 orl %d1,%d0 46464: 4e75 rts ... 00048920 : rtems_status_code rtems_clock_get( rtems_clock_get_options option, void *time_buffer ) { 48920: 4e56 0000 linkw %fp,#0 48924: 202e 0008 movel %fp@(8),%d0 48928: 2f0a movel %a2,%sp@- 4892a: 246e 000c moveal %fp@(12),%a2 if ( !time_buffer ) 4892e: 4a8a tstl %a2 48930: 6604 bnes 48936 48932: 7209 moveq #9,%d1 48934: 6066 bras 4899c return RTEMS_INVALID_ADDRESS; if ( option == RTEMS_CLOCK_GET_TOD ) 48936: 4a80 tstl %d0 48938: 6610 bnes 4894a return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); 4893a: 2d4a 0008 movel %a2,%fp@(8) if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); return RTEMS_INVALID_NUMBER; } 4893e: 246e fffc moveal %fp@(-4),%a2 48942: 4e5e unlk %fp { if ( !time_buffer ) return RTEMS_INVALID_ADDRESS; if ( option == RTEMS_CLOCK_GET_TOD ) return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); 48944: 4ef9 0004 89f8 jmp 489f8 if ( option == RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH ) 4894a: 7201 moveq #1,%d1 4894c: b280 cmpl %d0,%d1 4894e: 6610 bnes 48960 return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer); 48950: 2d4a 0008 movel %a2,%fp@(8) if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); return RTEMS_INVALID_NUMBER; } 48954: 246e fffc moveal %fp@(-4),%a2 48958: 4e5e unlk %fp if ( option == RTEMS_CLOCK_GET_TOD ) return rtems_clock_get_tod( (rtems_time_of_day *)time_buffer ); if ( option == RTEMS_CLOCK_GET_SECONDS_SINCE_EPOCH ) return rtems_clock_get_seconds_since_epoch((rtems_interval *)time_buffer); 4895a: 4ef9 0004 89a8 jmp 489a8 if ( option == RTEMS_CLOCK_GET_TICKS_SINCE_BOOT ) { 48960: 7202 moveq #2,%d1 48962: b280 cmpl %d0,%d1 48964: 6608 bnes 4896e rtems_interval *interval = (rtems_interval *)time_buffer; *interval = rtems_clock_get_ticks_since_boot(); 48966: 4eb9 0004 89e8 jsr 489e8 4896c: 600c bras 4897a return RTEMS_SUCCESSFUL; } if ( option == RTEMS_CLOCK_GET_TICKS_PER_SECOND ) { 4896e: 7203 moveq #3,%d1 48970: b280 cmpl %d0,%d1 48972: 660c bnes 48980 rtems_interval *interval = (rtems_interval *)time_buffer; *interval = rtems_clock_get_ticks_per_second(); 48974: 4eb9 0004 89d0 jsr 489d0 4897a: 2480 movel %d0,%a2@ 4897c: 4281 clrl %d1 return RTEMS_SUCCESSFUL; 4897e: 601c bras 4899c } if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) 48980: 7204 moveq #4,%d1 48982: b280 cmpl %d0,%d1 48984: 6706 beqs 4898c 48986: 123c 000a moveb #10,%d1 4898a: 6010 bras 4899c return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); 4898c: 2d4a 0008 movel %a2,%fp@(8) return RTEMS_INVALID_NUMBER; } 48990: 246e fffc moveal %fp@(-4),%a2 48994: 4e5e unlk %fp *interval = rtems_clock_get_ticks_per_second(); return RTEMS_SUCCESSFUL; } if ( option == RTEMS_CLOCK_GET_TIME_VALUE ) return rtems_clock_get_tod_timeval( (struct timeval *)time_buffer ); 48996: 4ef9 0004 8aac jmp 48aac return RTEMS_INVALID_NUMBER; } 4899c: 246e fffc moveal %fp@(-4),%a2 489a0: 2001 movel %d1,%d0 489a2: 4e5e unlk %fp 489a4: 4e75 rts ... 00044910 : #include #include #include rtems_interval rtems_clock_get_ticks_since_boot(void) { 44910: 4e56 0000 linkw %fp,#0 return _Watchdog_Ticks_since_boot; 44914: 2039 0005 cdd8 movel 5cdd8 <_Watchdog_Ticks_since_boot>,%d0 } 4491a: 4e5e unlk %fp 4491c: 4e75 rts ... 000456bc : #include rtems_status_code rtems_clock_get_tod( rtems_time_of_day *time_buffer ) { 456bc: 4e56 ffcc linkw %fp,#-52 456c0: 2f0a movel %a2,%sp@- 456c2: 246e 0008 moveal %fp@(8),%a2 456c6: 2f02 movel %d2,%sp@- rtems_time_of_day *tmbuf = time_buffer; struct tm time; struct timeval now; if ( !time_buffer ) 456c8: 4a8a tstl %a2 456ca: 6606 bnes 456d2 456cc: 7009 moveq #9,%d0 456ce: 6000 0092 braw 45762 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Is_set ) 456d2: 4a39 0006 6bb8 tstb 66bb8 <_TOD_Is_set> 456d8: 6606 bnes 456e0 456da: 700b moveq #11,%d0 456dc: 6000 0084 braw 45762 { ISR_Level level; struct timespec now; suseconds_t useconds; _ISR_Disable(level); 456e0: 203c 0000 0700 movel #1792,%d0 456e6: 40c2 movew %sr,%d2 456e8: 8082 orl %d2,%d0 456ea: 46c0 movew %d0,%sr _TOD_Get( &now ); 456ec: 486e fff0 pea %fp@(-16) 456f0: 4eb9 0004 6e14 jsr 46e14 <_TOD_Get> _ISR_Enable(level); 456f6: 46c2 movew %d2,%sr useconds = (suseconds_t)now.tv_nsec; useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND; time->tv_sec = now.tv_sec; time->tv_usec = useconds; 456f8: 243c 0000 03e8 movel #1000,%d2 /* Obtain the current time */ _TOD_Get_timeval( &now ); /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); 456fe: 486e ffcc pea %fp@(-52) _ISR_Disable(level); _TOD_Get( &now ); _ISR_Enable(level); useconds = (suseconds_t)now.tv_nsec; 45702: 202e fff4 movel %fp@(-12),%d0 45706: 486e fff8 pea %fp@(-8) useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND; time->tv_sec = now.tv_sec; 4570a: 2d6e fff0 fff8 movel %fp@(-16),%fp@(-8) time->tv_usec = useconds; 45710: 4c42 0800 remsl %d2,%d0,%d0 45714: 2d40 fffc movel %d0,%fp@(-4) 45718: 4eb9 0004 e608 jsr 4e608 /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; tmbuf->month = time.tm_mon + 1; 4571e: 206e ffdc moveal %fp@(-36),%a0 45722: 5288 addql #1,%a0 tmbuf->minute = time.tm_min; tmbuf->second = time.tm_sec; tmbuf->ticks = now.tv_usec / rtems_configuration_get_microseconds_per_tick(); return RTEMS_SUCCESSFUL; 45724: 4fef 000c lea %sp@(12),%sp tmbuf->month = time.tm_mon + 1; tmbuf->day = time.tm_mday; tmbuf->hour = time.tm_hour; tmbuf->minute = time.tm_min; tmbuf->second = time.tm_sec; tmbuf->ticks = now.tv_usec / 45728: 4280 clrl %d0 /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; tmbuf->month = time.tm_mon + 1; 4572a: 2548 0004 movel %a0,%a2@(4) /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; 4572e: 206e ffe0 moveal %fp@(-32),%a0 45732: 41e8 076c lea %a0@(1900),%a0 tmbuf->month = time.tm_mon + 1; tmbuf->day = time.tm_mday; 45736: 256e ffd8 0008 movel %fp@(-40),%a2@(8) tmbuf->hour = time.tm_hour; 4573c: 256e ffd4 000c movel %fp@(-44),%a2@(12) tmbuf->minute = time.tm_min; 45742: 256e ffd0 0010 movel %fp@(-48),%a2@(16) tmbuf->second = time.tm_sec; 45748: 256e ffcc 0014 movel %fp@(-52),%a2@(20) /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; 4574e: 2488 movel %a0,%a2@ tmbuf->month = time.tm_mon + 1; tmbuf->day = time.tm_mday; tmbuf->hour = time.tm_hour; tmbuf->minute = time.tm_min; tmbuf->second = time.tm_sec; tmbuf->ticks = now.tv_usec / 45750: 242e fffc movel %fp@(-4),%d2 45754: 41f9 0005 d630 lea 5d630 ,%a0 4575a: 4c50 2002 remul %a0@,%d2,%d2 4575e: 2542 0018 movel %d2,%a2@(24) rtems_configuration_get_microseconds_per_tick(); return RTEMS_SUCCESSFUL; } 45762: 242e ffc4 movel %fp@(-60),%d2 45766: 246e ffc8 moveal %fp@(-56),%a2 4576a: 4e5e unlk %fp 4576c: 4e75 rts ... 0004493c : * * NOTE: This routine only works for leap-years through 2099. */ rtems_status_code rtems_clock_tick( void ) { 4493c: 4e56 0000 linkw %fp,#0 _TOD_Tickle_ticks(); 44940: 4eb9 0004 5c8c jsr 45c8c <_TOD_Tickle_ticks> */ RTEMS_INLINE_ROUTINE void _Watchdog_Tickle_ticks( void ) { _Watchdog_Tickle( &_Watchdog_Ticks_chain ); 44946: 4879 0005 cd6c pea 5cd6c <_Watchdog_Ticks_chain> 4494c: 4eb9 0004 7de0 jsr 47de0 <_Watchdog_Tickle> _Watchdog_Tickle_ticks(); _Thread_Tickle_timeslice(); 44952: 4eb9 0004 786c jsr 4786c <_Thread_Tickle_timeslice> if ( _Thread_Is_context_switch_necessary() && 44958: 588f addql #4,%sp * otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_context_switch_necessary( void ) { return ( _Context_Switch_necessary ); 4495a: 1039 0005 cd5e moveb 5cd5e <_Context_Switch_necessary>,%d0 44960: 670e beqs 44970 * otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_dispatching_enabled( void ) { return ( _Thread_Dispatch_disable_level == 0 ); 44962: 2039 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d0 44968: 6606 bnes 44970 _Thread_Is_dispatching_enabled() ) _Thread_Dispatch(); 4496a: 4eb9 0004 6b90 jsr 46b90 <_Thread_Dispatch> return RTEMS_SUCCESSFUL; } 44970: 4280 clrl %d0 44972: 4e5e unlk %fp 44974: 4e75 rts ... 00049f70 : * rtems_debug_is_enabled */ bool rtems_debug_is_enabled( rtems_debug_control level ) { 49f70: 4e56 0000 linkw %fp,#0 49f74: 202e 0008 movel %fp@(8),%d0 return (_Debug_Level & level) ? true : false; } 49f78: 4e5e unlk %fp * rtems_debug_is_enabled */ bool rtems_debug_is_enabled( rtems_debug_control level ) { 49f7a: c0b9 0005 cd52 andl 5cd52 <_Debug_Level>,%d0 49f80: 56c0 sne %d0 return (_Debug_Level & level) ? true : false; } 49f82: 4480 negl %d0 49f84: 4e75 rts ... 00044978 : rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { 44978: 4e56 0000 linkw %fp,#0 4497c: 202e 0008 movel %fp@(8),%d0 44980: 206e 0014 moveal %fp@(20),%a0 RTEMS_API_Control *api; if ( !event_out ) 44984: 4a88 tstl %a0 44986: 6604 bnes 4498c 44988: 7009 moveq #9,%d0 4498a: 6046 bras 449d2 return RTEMS_INVALID_ADDRESS; api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; 4498c: 2279 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a1 44992: 2269 010a moveal %a1@(266),%a1 if ( _Event_sets_Is_empty( event_in ) ) { 44996: 4a80 tstl %d0 44998: 6604 bnes 4499e *event_out = api->pending_events; 4499a: 2091 movel %a1@,%a0@ return RTEMS_SUCCESSFUL; 4499c: 6034 bras 449d2 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4499e: 2239 0005 cc94 movel 5cc94 <_Thread_Dispatch_disable_level>,%d1 449a4: 5281 addql #1,%d1 449a6: 23c1 0005 cc94 movel %d1,5cc94 <_Thread_Dispatch_disable_level> } _Thread_Disable_dispatch(); _Event_Seize( event_in, option_set, ticks, event_out ); 449ac: 2f08 movel %a0,%sp@- 449ae: 2f2e 0010 movel %fp@(16),%sp@- 449b2: 2f2e 000c movel %fp@(12),%sp@- 449b6: 2f00 movel %d0,%sp@- 449b8: 4eb9 0004 49d8 jsr 449d8 <_Event_Seize> _Thread_Enable_dispatch(); 449be: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch> return( _Thread_Executing->Wait.return_code ); 449c4: 2079 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a0 449ca: 4fef 0010 lea %sp@(16),%sp 449ce: 2028 0034 movel %a0@(52),%d0 } 449d2: 4e5e unlk %fp 449d4: 4e75 rts ... 00046ff4 : #endif #include const char *rtems_get_version_string(void) { 46ff4: 4e56 0000 linkw %fp,#0 return _RTEMS_version; } 46ff8: 203c 0005 df0a movel #384778,%d0 46ffe: 4e5e unlk %fp 47000: 4e75 rts ... 000454b2 : #endif Objects_Information *_Internal_Objects[ OBJECTS_INTERNAL_CLASSES_LAST + 1 ]; void rtems_initialize_data_structures(void) { 454b2: 4e56 0000 linkw %fp,#0 454b6: 42b9 0005 ce1c clrl 5ce1c <_System_state_Current> #endif /* * Initialize any target architecture specific support as early as possible */ _CPU_Initialize(); 454bc: 4eb9 0004 7fec jsr 47fec <_CPU_Initialize> /* * Do this as early as possible to ensure no debugging output * is even attempted to be printed. */ _Debug_Manager_initialization(); 454c2: 4eb9 0004 9f3c jsr 49f3c <_Debug_Manager_initialization> _API_extensions_Initialization(); 454c8: 4eb9 0004 5740 jsr 45740 <_API_extensions_Initialization> * This routine initializes the thread dispatching subsystem. */ RTEMS_INLINE_ROUTINE void _Thread_Dispatch_initialization( void ) { _Thread_Dispatch_disable_level = 1; 454ce: 7001 moveq #1,%d0 454d0: 23c0 0005 cc94 movel %d0,5cc94 <_Thread_Dispatch_disable_level> /* * Before this is called, we are not allowed to allocate memory * from the Workspace because it is not initialized. */ _Workspace_Handler_initialization(); 454d6: 4eb9 0004 7ec4 jsr 47ec4 <_Workspace_Handler_initialization> _User_extensions_Handler_initialization(); 454dc: 4eb9 0004 79e0 jsr 479e0 <_User_extensions_Handler_initialization> _ISR_Handler_initialization(); 454e2: 4eb9 0004 6034 jsr 46034 <_ISR_Handler_initialization> /* * Initialize the internal support API and allocator Mutex */ _Objects_Information_table[OBJECTS_INTERNAL_API] = _Internal_Objects; _API_Mutex_Initialization( 1 ); 454e8: 4878 0001 pea 1 _ISR_Handler_initialization(); /* * Initialize the internal support API and allocator Mutex */ _Objects_Information_table[OBJECTS_INTERNAL_API] = _Internal_Objects; 454ec: 203c 0005 ccaa movel #380074,%d0 454f2: 23c0 0005 cc50 movel %d0,5cc50 <_Objects_Information_table+0x4> _API_Mutex_Initialization( 1 ); 454f8: 4eb9 0004 5870 jsr 45870 <_API_Mutex_Initialization> _API_Mutex_Allocate( &_RTEMS_Allocator_Mutex ); 454fe: 4879 0005 cd46 pea 5cd46 <_RTEMS_Allocator_Mutex> 45504: 4eb9 0004 57d0 jsr 457d0 <_API_Mutex_Allocate> #include #endif Objects_Information *_Internal_Objects[ OBJECTS_INTERNAL_CLASSES_LAST + 1 ]; void rtems_initialize_data_structures(void) 4550a: 508f addql #8,%sp RTEMS_INLINE_ROUTINE void _Priority_Handler_initialization( void ) { int index; _Priority_Major_bit_map = 0; 4550c: 41f9 0005 cdb4 lea 5cdb4 <_Priority_Bit_map>,%a0 45512: 4240 clrw %d0 45514: 33c0 0005 cd44 movew %d0,5cd44 <_Priority_Major_bit_map> for ( index=0 ; index <16 ; index++ ) _Priority_Bit_map[ index ] = 0; 4551a: 4258 clrw %a0@+ RTEMS_INLINE_ROUTINE void _Priority_Handler_initialization( void ) { int index; _Priority_Major_bit_map = 0; for ( index=0 ; index <16 ; index++ ) 4551c: b1fc 0005 cdd4 cmpal #380372,%a0 45522: 66f6 bnes 4551a _API_Mutex_Initialization( 1 ); _API_Mutex_Allocate( &_RTEMS_Allocator_Mutex ); _Priority_Handler_initialization(); _Watchdog_Handler_initialization(); 45524: 4eb9 0004 7d18 jsr 47d18 <_Watchdog_Handler_initialization> _TOD_Handler_initialization(); 4552a: 4eb9 0004 5c5c jsr 45c5c <_TOD_Handler_initialization> _Thread_Handler_initialization(); 45530: 4eb9 0004 6f50 jsr 46f50 <_Thread_Handler_initialization> _MPCI_Handler_initialization( RTEMS_TIMEOUT ); #endif /* MANAGERS */ _RTEMS_API_Initialize(); 45536: 4eb9 0004 56ec jsr 456ec <_RTEMS_API_Initialize> _Extension_Manager_initialization(); 4553c: 4eb9 0004 558c jsr 4558c <_Extension_Manager_initialization> _IO_Manager_initialization(); 45542: 4eb9 0004 5604 jsr 45604 <_IO_Manager_initialization> #ifdef RTEMS_POSIX_API _POSIX_API_Initialize(); 45548: 4eb9 0004 5698 jsr 45698 <_POSIX_API_Initialize> _Thread_Create_idle(); /* * Scheduling can properly occur now as long as we avoid dispatching. */ } 4554e: 4e5e unlk %fp 45550: 7001 moveq #1,%d0 45552: 23c0 0005 ce1c movel %d0,5ce1c <_System_state_Current> * _Thread_Executing and _Thread_Heir are not set. * * At this point all API extensions are in place. After the call to * _Thread_Create_idle() _Thread_Executing and _Thread_Heir will be set. */ _Thread_Create_idle(); 45558: 4ef9 0004 6aa4 jmp 46aa4 <_Thread_Create_idle> ... 00044cb8 : rtems_status_code rtems_interrupt_catch( rtems_isr_entry new_isr_handler, rtems_vector_number vector, rtems_isr_entry *old_isr_handler ) { 44cb8: 4e56 0000 linkw %fp,#0 44cbc: 222e 0008 movel %fp@(8),%d1 44cc0: 202e 000c movel %fp@(12),%d0 44cc4: 206e 0010 moveal %fp@(16),%a0 if ( !_ISR_Is_vector_number_valid( vector ) ) 44cc8: 0c80 0000 00ff cmpil #255,%d0 44cce: 6304 blss 44cd4 44cd0: 700a moveq #10,%d0 44cd2: 601e bras 44cf2 return RTEMS_INVALID_NUMBER; if ( !_ISR_Is_valid_user_handler( (void *) new_isr_handler ) ) 44cd4: 4a81 tstl %d1 44cd6: 6718 beqs 44cf0 return RTEMS_INVALID_ADDRESS; if ( !_ISR_Is_valid_user_handler( (void *) old_isr_handler ) ) 44cd8: 4a88 tstl %a0 44cda: 6714 beqs 44cf0 return RTEMS_INVALID_ADDRESS; _ISR_Install_vector( 44cdc: 2f08 movel %a0,%sp@- 44cde: 2f01 movel %d1,%sp@- 44ce0: 2f00 movel %d0,%sp@- 44ce2: 4eb9 0004 8026 jsr 48026 <_CPU_ISR_install_vector> vector, (proc_ptr)new_isr_handler, (proc_ptr *)old_isr_handler ); return RTEMS_SUCCESSFUL; 44ce8: 4fef 000c lea %sp@(12),%sp return RTEMS_INVALID_ADDRESS; if ( !_ISR_Is_valid_user_handler( (void *) old_isr_handler ) ) return RTEMS_INVALID_ADDRESS; _ISR_Install_vector( 44cec: 4280 clrl %d0 vector, (proc_ptr)new_isr_handler, (proc_ptr *)old_isr_handler ); return RTEMS_SUCCESSFUL; 44cee: 6002 bras 44cf2 44cf0: 7009 moveq #9,%d0 } 44cf2: 4e5e unlk %fp 44cf4: 4e75 rts ... 0004527c : rtems_attribute rtems_interrupt_level_attribute( uint32_t level ) { return RTEMS_INTERRUPT_LEVEL(level); } 4527c: 7007 moveq #7,%d0 uint32_t rtems_interrupt_mask = RTEMS_INTERRUPT_MASK; rtems_attribute rtems_interrupt_level_attribute( uint32_t level ) { 4527e: 4e56 0000 linkw %fp,#0 return RTEMS_INTERRUPT_LEVEL(level); } 45282: c0ae 0008 andl %fp@(8),%d0 45286: 4e5e unlk %fp 45288: 4e75 rts ... 00046d4c : 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 ) { 46d4c: 4e56 0000 linkw %fp,#0 46d50: 206e 000c moveal %fp@(12),%a0 46d54: 2f0a movel %a2,%sp@- 46d56: 226e 0010 moveal %fp@(16),%a1 46d5a: 2f02 movel %d2,%sp@- 46d5c: 242e 0008 movel %fp@(8),%d2 rtems_device_major_number major_limit = _IO_Number_of_drivers; 46d60: 2039 0006 28c6 movel 628c6 <_IO_Number_of_drivers>,%d0 if ( rtems_interrupt_is_in_progress() ) 46d66: 2239 0006 20a6 movel 620a6 <_ISR_Nest_level>,%d1 46d6c: 6706 beqs 46d74 46d6e: 7012 moveq #18,%d0 46d70: 6000 00d6 braw 46e48 return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) 46d74: 4a89 tstl %a1 46d76: 6700 00ce beqw 46e46 return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; 46d7a: 2280 movel %d0,%a1@ if ( driver_table == NULL ) 46d7c: 4a88 tstl %a0 46d7e: 6700 00c6 beqw 46e46 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 46d82: 4a90 tstl %a0@ 46d84: 6600 00ce bnew 46e54 46d88: 4aa8 0004 tstl %a0@(4) 46d8c: 6600 00c6 bnew 46e54 46d90: 6000 00b4 braw 46e46 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 46d94: 2039 0006 200c movel 6200c <_Thread_Dispatch_disable_level>,%d0 46d9a: 5280 addql #1,%d0 46d9c: 23c0 0006 200c movel %d0,6200c <_Thread_Dispatch_disable_level> if ( major >= major_limit ) return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { 46da2: 4a82 tstl %d2 46da4: 662c bnes 46dd2 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; 46da6: 2039 0006 28c6 movel 628c6 <_IO_Number_of_drivers>,%d0 46dac: 2479 0006 28ca moveal 628ca <_IO_Driver_address_table>,%a2 46db2: 6010 bras 46dc4 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 46db4: 4a92 tstl %a2@ 46db6: 6600 00a6 bnew 46e5e 46dba: 4aaa 0004 tstl %a2@(4) 46dbe: 6600 009e bnew 46e5e 46dc2: 6004 bras 46dc8 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 ) { 46dc4: b082 cmpl %d2,%d0 46dc6: 62ec bhis 46db4 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 46dc8: 2282 movel %d2,%a1@ if ( m != n ) 46dca: b082 cmpl %d2,%d0 46dcc: 6634 bnes 46e02 46dce: 6000 0098 braw 46e68 _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 46dd2: 2202 movel %d2,%d1 46dd4: 2002 movel %d2,%d0 46dd6: e789 lsll #3,%d1 46dd8: eb88 lsll #5,%d0 46dda: 2479 0006 28ca moveal 628ca <_IO_Driver_address_table>,%a2 46de0: 9081 subl %d1,%d0 46de2: d5c0 addal %d0,%a2 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 46de4: 4a92 tstl %a2@ 46de6: 660e bnes 46df6 46de8: 4aaa 0004 tstl %a2@(4) 46dec: 57c0 seq %d0 46dee: 49c0 extbl %d0 46df0: 4480 negl %d0 } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { 46df2: 4a00 tstb %d0 46df4: 660a bnes 46e00 _Thread_Enable_dispatch(); 46df6: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch> 46dfc: 700c moveq #12,%d0 return RTEMS_RESOURCE_IN_USE; 46dfe: 6048 bras 46e48 } *registered_major = major; 46e00: 2282 movel %d2,%a1@ } _IO_Driver_address_table [major] = *driver_table; 46e02: 4878 0018 pea 18 46e06: 2202 movel %d2,%d1 46e08: 2002 movel %d2,%d0 46e0a: e789 lsll #3,%d1 46e0c: eb88 lsll #5,%d0 46e0e: 2f08 movel %a0,%sp@- 46e10: 9081 subl %d1,%d0 46e12: d0b9 0006 28ca addl 628ca <_IO_Driver_address_table>,%d0 46e18: 2f00 movel %d0,%sp@- 46e1a: 4eb9 0005 1c44 jsr 51c44 _Thread_Enable_dispatch(); 46e20: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); } 46e26: 246e fffc moveal %fp@(-4),%a2 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 46e2a: 4fef 000c lea %sp@(12),%sp 46e2e: 2d42 0008 movel %d2,%fp@(8) } 46e32: 242e fff8 movel %fp@(-8),%d2 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 46e36: 42ae 0010 clrl %fp@(16) 46e3a: 42ae 000c clrl %fp@(12) } 46e3e: 4e5e unlk %fp _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 46e40: 4ef9 0004 e908 jmp 4e908 46e46: 7009 moveq #9,%d0 } 46e48: 242e fff8 movel %fp@(-8),%d2 46e4c: 246e fffc moveal %fp@(-4),%a2 46e50: 4e5e unlk %fp 46e52: 4e75 rts return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) 46e54: b082 cmpl %d2,%d0 46e56: 6200 ff3c bhiw 46d94 46e5a: 700a moveq #10,%d0 46e5c: 60ea bras 46e48 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 ) { 46e5e: 5282 addql #1,%d2 46e60: 45ea 0018 lea %a2@(24),%a2 46e64: 6000 ff5e braw 46dc4 if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); 46e68: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch> 46e6e: 7005 moveq #5,%d0 return sc; 46e70: 60d6 bras 46e48 ... 00046e74 : */ rtems_status_code rtems_io_unregister_driver( rtems_device_major_number major ) { 46e74: 4e56 0000 linkw %fp,#0 46e78: 222e 0008 movel %fp@(8),%d1 if ( rtems_interrupt_is_in_progress() ) 46e7c: 2039 0006 20a6 movel 620a6 <_ISR_Nest_level>,%d0 46e82: 6704 beqs 46e88 46e84: 7012 moveq #18,%d0 46e86: 6042 bras 46eca return RTEMS_CALLED_FROM_ISR; if ( major < _IO_Number_of_drivers ) { 46e88: b2b9 0006 28c6 cmpl 628c6 <_IO_Number_of_drivers>,%d1 46e8e: 6504 bcss 46e94 46e90: 700d moveq #13,%d0 46e92: 6036 bras 46eca 46e94: 2039 0006 200c movel 6200c <_Thread_Dispatch_disable_level>,%d0 46e9a: 5280 addql #1,%d0 46e9c: 23c0 0006 200c movel %d0,6200c <_Thread_Dispatch_disable_level> _Thread_Disable_dispatch(); memset( 46ea2: 2001 movel %d1,%d0 46ea4: 4878 0018 pea 18 46ea8: e789 lsll #3,%d1 46eaa: eb88 lsll #5,%d0 46eac: 42a7 clrl %sp@- 46eae: 9081 subl %d1,%d0 46eb0: d0b9 0006 28ca addl 628ca <_IO_Driver_address_table>,%d0 46eb6: 2f00 movel %d0,%sp@- 46eb8: 4eb9 0005 1cb4 jsr 51cb4 &_IO_Driver_address_table[major], 0, sizeof( rtems_driver_address_table ) ); _Thread_Enable_dispatch(); 46ebe: 4eb9 0004 8672 jsr 48672 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 46ec4: 4fef 000c lea %sp@(12),%sp memset( &_IO_Driver_address_table[major], 0, sizeof( rtems_driver_address_table ) ); _Thread_Enable_dispatch(); 46ec8: 4280 clrl %d0 return RTEMS_SUCCESSFUL; } return RTEMS_UNSATISFIED; } 46eca: 4e5e unlk %fp 46ecc: 4e75 rts ... 00047394 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 47394: 4e56 fff0 linkw %fp,#-16 47398: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 4739c: 286e 0008 moveal %fp@(8),%a4 uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 473a0: 4a8c tstl %a4 473a2: 6740 beqs 473e4 473a4: 45f9 0006 6b60 lea 66b60 <_Objects_Information_table+0x4>,%a2 return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { if ( !_Objects_Information_table[ api_index ] ) 473aa: 2052 moveal %a2@,%a0 473ac: 4a88 tstl %a0 473ae: 672a beqs 473da continue; information = _Objects_Information_table[ api_index ][ 1 ]; 473b0: 2668 0004 moveal %a0@(4),%a3 if ( !information ) 473b4: 4a8b tstl %a3 473b6: 6722 beqs 473da 473b8: 7401 moveq #1,%d2 473ba: 6014 bras 473d0 continue; for ( i=1 ; i <= information->maximum ; i++ ) { the_thread = (Thread_Control *)information->local_table[ i ]; 473bc: 206b 0018 moveal %a3@(24),%a0 473c0: 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++ ) { 473c4: 5282 addql #1,%d2 the_thread = (Thread_Control *)information->local_table[ i ]; if ( !the_thread ) 473c6: 4a80 tstl %d0 473c8: 6706 beqs 473d0 continue; (*routine)(the_thread); 473ca: 2f00 movel %d0,%sp@- 473cc: 4e94 jsr %a4@ 473ce: 588f addql #4,%sp information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 473d0: 4280 clrl %d0 473d2: 302b 000e movew %a3@(14),%d0 473d6: b082 cmpl %d2,%d0 473d8: 64e2 bccs 473bc 473da: 588a addql #4,%a2 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 473dc: b5fc 0006 6b70 cmpal #420720,%a2 473e2: 66c6 bnes 473aa (*routine)(the_thread); } } } 473e4: 4cee 1c04 fff0 moveml %fp@(-16),%d2/%a2-%a4 473ea: 4e5e unlk %fp 473ec: 4e75 rts ... 0004ed98 : rtems_id id, const void *buffer, size_t size, uint32_t *count ) { 4ed98: 4e56 fff0 linkw %fp,#-16 4ed9c: 48d7 001c moveml %d2-%d4,%sp@ 4eda0: 262e 0008 movel %fp@(8),%d3 4eda4: 242e 000c movel %fp@(12),%d2 4eda8: 282e 0014 movel %fp@(20),%d4 register Message_queue_Control *the_message_queue; Objects_Locations location; CORE_message_queue_Status core_status; if ( !buffer ) 4edac: 4a82 tstl %d2 4edae: 6752 beqs 4ee02 return RTEMS_INVALID_ADDRESS; if ( !count ) 4edb0: 4a84 tstl %d4 4edb2: 674e beqs 4ee02 RTEMS_INLINE_ROUTINE Message_queue_Control *_Message_queue_Get ( Objects_Id id, Objects_Locations *location ) { return (Message_queue_Control *) 4edb4: 486e fffc pea %fp@(-4) 4edb8: 2f03 movel %d3,%sp@- 4edba: 4879 0007 5c42 pea 75c42 <_Message_queue_Information> 4edc0: 4eb9 0005 378c jsr 5378c <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { 4edc6: 4fef 000c lea %sp@(12),%sp 4edca: 4aae fffc tstl %fp@(-4) 4edce: 6704 beqs 4edd4 4edd0: 7004 moveq #4,%d0 4edd2: 6030 bras 4ee04 case OBJECTS_LOCAL: core_status = _CORE_message_queue_Broadcast( 4edd4: 2f04 movel %d4,%sp@- 4edd6: 2040 moveal %d0,%a0 4edd8: 42a7 clrl %sp@- 4edda: 2f03 movel %d3,%sp@- 4eddc: 2f2e 0010 movel %fp@(16),%sp@- 4ede0: 2f02 movel %d2,%sp@- 4ede2: 4868 0014 pea %a0@(20) 4ede6: 4eb9 0005 2088 jsr 52088 <_CORE_message_queue_Broadcast> 4edec: 2400 movel %d0,%d2 NULL, #endif count ); _Thread_Enable_dispatch(); 4edee: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> return _Message_queue_Translate_core_message_queue_return_code( core_status ); 4edf4: 2f02 movel %d2,%sp@- 4edf6: 4eb9 0004 f11c jsr 4f11c <_Message_queue_Translate_core_message_queue_return_code> #endif count ); _Thread_Enable_dispatch(); return 4edfc: 4fef 001c lea %sp@(28),%sp 4ee00: 6002 bras 4ee04 4ee02: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4ee04: 4cee 001c fff0 moveml %fp@(-16),%d2-%d4 4ee0a: 4e5e unlk %fp 4ee0c: 4e75 rts ... 0004ca78 : uint32_t count, size_t max_message_size, rtems_attribute attribute_set, rtems_id *id ) { 4ca78: 4e56 ffe0 linkw %fp,#-32 4ca7c: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 4ca80: 242e 0008 movel %fp@(8),%d2 4ca84: 262e 000c movel %fp@(12),%d3 4ca88: 282e 0010 movel %fp@(16),%d4 4ca8c: 2a2e 0014 movel %fp@(20),%d5 4ca90: 286e 0018 moveal %fp@(24),%a4 CORE_message_queue_Attributes the_msgq_attributes; #if defined(RTEMS_MULTIPROCESSING) bool is_global; #endif if ( !rtems_is_name_valid( name ) ) 4ca94: 4a82 tstl %d2 4ca96: 6606 bnes 4ca9e 4ca98: 7003 moveq #3,%d0 4ca9a: 6000 00a4 braw 4cb40 return RTEMS_INVALID_NAME; if ( !id ) 4ca9e: 4a8c tstl %a4 4caa0: 6606 bnes 4caa8 4caa2: 7009 moveq #9,%d0 4caa4: 6000 009a braw 4cb40 if ( (is_global = _Attributes_Is_global( attribute_set ) ) && !_System_state_Is_multiprocessing ) return RTEMS_MP_NOT_CONFIGURED; #endif if ( count == 0 ) 4caa8: 4a83 tstl %d3 4caaa: 6606 bnes 4cab2 4caac: 700a moveq #10,%d0 4caae: 6000 0090 braw 4cb40 return RTEMS_INVALID_NUMBER; if ( max_message_size == 0 ) 4cab2: 4a84 tstl %d4 4cab4: 6606 bnes 4cabc 4cab6: 7008 moveq #8,%d0 4cab8: 6000 0086 braw 4cb40 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4cabc: 2039 0006 6248 movel 66248 <_Thread_Dispatch_disable_level>,%d0 4cac2: 5280 addql #1,%d0 4cac4: 23c0 0006 6248 movel %d0,66248 <_Thread_Dispatch_disable_level> #endif #endif _Thread_Disable_dispatch(); /* protects object pointer */ the_message_queue = _Message_queue_Allocate(); 4caca: 4eb9 0005 2158 jsr 52158 <_Message_queue_Allocate> 4cad0: 2440 moveal %d0,%a2 if ( !the_message_queue ) { 4cad2: 4a80 tstl %d0 4cad4: 660a bnes 4cae0 _Thread_Enable_dispatch(); 4cad6: 4eb9 0004 f40a jsr 4f40a <_Thread_Enable_dispatch> 4cadc: 7005 moveq #5,%d0 return RTEMS_TOO_MANY; 4cade: 6060 bras 4cb40 #endif the_message_queue->attribute_set = attribute_set; if (_Attributes_Is_priority( attribute_set ) ) the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_PRIORITY; 4cae0: 204e moveal %fp,%a0 4cae2: 47f9 0004 f40a lea 4f40a <_Thread_Enable_dispatch>,%a3 4cae8: 44c5 movew %d5,%ccr 4caea: 56c0 sne %d0 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_message_queue->attribute_set = attribute_set; 4caec: 2545 0010 movel %d5,%a2@(16) if (_Attributes_Is_priority( attribute_set ) ) the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_PRIORITY; 4caf0: 49c0 extbl %d0 4caf2: 5280 addql #1,%d0 4caf4: 2100 movel %d0,%a0@- else the_msgq_attributes.discipline = CORE_MESSAGE_QUEUE_DISCIPLINES_FIFO; if ( ! _CORE_message_queue_Initialize( 4caf6: 2f04 movel %d4,%sp@- 4caf8: 2f03 movel %d3,%sp@- 4cafa: 2f08 movel %a0,%sp@- 4cafc: 486a 0014 pea %a2@(20) 4cb00: 4eb9 0004 dc30 jsr 4dc30 <_CORE_message_queue_Initialize> 4cb06: 4fef 0010 lea %sp@(16),%sp 4cb0a: 4a00 tstb %d0 4cb0c: 6616 bnes 4cb24 */ RTEMS_INLINE_ROUTINE void _Message_queue_Free ( Message_queue_Control *the_message_queue ) { _Objects_Free( &_Message_queue_Information, &the_message_queue->Object ); 4cb0e: 2f0a movel %a2,%sp@- 4cb10: 4879 0006 6a8e pea 66a8e <_Message_queue_Information> 4cb16: 4eb9 0004 e9b8 jsr 4e9b8 <_Objects_Free> _Objects_MP_Close( &_Message_queue_Information, the_message_queue->Object.id); #endif _Message_queue_Free( the_message_queue ); _Thread_Enable_dispatch(); 4cb1c: 4e93 jsr %a3@ return RTEMS_UNSATISFIED; 4cb1e: 508f addql #8,%sp _Objects_MP_Close( &_Message_queue_Information, the_message_queue->Object.id); #endif _Message_queue_Free( the_message_queue ); _Thread_Enable_dispatch(); 4cb20: 700d moveq #13,%d0 return RTEMS_UNSATISFIED; 4cb22: 601c bras 4cb40 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4cb24: 202a 0008 movel %a2@(8),%d0 4cb28: 4281 clrl %d1 4cb2a: 2079 0006 6aa6 moveal 66aa6 <_Message_queue_Information+0x18>,%a0 4cb30: 3200 movew %d0,%d1 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 4cb32: 2542 000c movel %d2,%a2@(12) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4cb36: 218a 1c00 movel %a2,%a0@(00000000,%d1:l:4) &_Message_queue_Information, &the_message_queue->Object, (Objects_Name) name ); *id = the_message_queue->Object.id; 4cb3a: 2880 movel %d0,%a4@ name, 0 ); #endif _Thread_Enable_dispatch(); 4cb3c: 4e93 jsr %a3@ 4cb3e: 4280 clrl %d0 return RTEMS_SUCCESSFUL; } 4cb40: 4cee 1c3c ffe0 moveml %fp@(-32),%d2-%d5/%a2-%a4 4cb46: 4e5e unlk %fp 4cb48: 4e75 rts ... 0004fa24 : */ rtems_status_code rtems_message_queue_delete( rtems_id id ) { 4fa24: 4e56 fffc linkw %fp,#-4 4fa28: 2f0a movel %a2,%sp@- RTEMS_INLINE_ROUTINE Message_queue_Control *_Message_queue_Get ( Objects_Id id, Objects_Locations *location ) { return (Message_queue_Control *) 4fa2a: 486e fffc pea %fp@(-4) 4fa2e: 2f2e 0008 movel %fp@(8),%sp@- 4fa32: 4879 0006 8d8c pea 68d8c <_Message_queue_Information> 4fa38: 4eb9 0004 9e20 jsr 49e20 <_Objects_Get> register Message_queue_Control *the_message_queue; Objects_Locations location; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { 4fa3e: 4fef 000c lea %sp@(12),%sp 4fa42: 2440 moveal %d0,%a2 4fa44: 4aae fffc tstl %fp@(-4) 4fa48: 6704 beqs 4fa4e 4fa4a: 7004 moveq #4,%d0 4fa4c: 6038 bras 4fa86 case OBJECTS_LOCAL: _Objects_Close( &_Message_queue_Information, 4fa4e: 2f00 movel %d0,%sp@- 4fa50: 4879 0006 8d8c pea 68d8c <_Message_queue_Information> 4fa56: 4eb9 0004 9a54 jsr 49a54 <_Objects_Close> &the_message_queue->Object ); _CORE_message_queue_Close( 4fa5c: 4878 0005 pea 5 4fa60: 42a7 clrl %sp@- 4fa62: 486a 0014 pea %a2@(20) 4fa66: 4eb9 0005 0010 jsr 50010 <_CORE_message_queue_Close> */ RTEMS_INLINE_ROUTINE void _Message_queue_Free ( Message_queue_Control *the_message_queue ) { _Objects_Free( &_Message_queue_Information, &the_message_queue->Object ); 4fa6c: 2f0a movel %a2,%sp@- 4fa6e: 4879 0006 8d8c pea 68d8c <_Message_queue_Information> 4fa74: 4eb9 0004 9cc8 jsr 49cc8 <_Objects_Free> 0, /* Not used */ 0 ); } #endif _Thread_Enable_dispatch(); 4fa7a: 4eb9 0004 a71e jsr 4a71e <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4fa80: 4fef 001c lea %sp@(28),%sp 0, /* Not used */ 0 ); } #endif _Thread_Enable_dispatch(); 4fa84: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4fa86: 246e fff8 moveal %fp@(-8),%a2 4fa8a: 4e5e unlk %fp 4fa8c: 4e75 rts ... 0004efa4 : rtems_status_code rtems_message_queue_get_number_pending( rtems_id id, uint32_t *count ) { 4efa4: 4e56 fffc linkw %fp,#-4 4efa8: 2f0a movel %a2,%sp@- 4efaa: 246e 000c moveal %fp@(12),%a2 register Message_queue_Control *the_message_queue; Objects_Locations location; if ( !count ) 4efae: 4a8a tstl %a2 4efb0: 6604 bnes 4efb6 4efb2: 7009 moveq #9,%d0 4efb4: 6030 bras 4efe6 4efb6: 486e fffc pea %fp@(-4) 4efba: 2f2e 0008 movel %fp@(8),%sp@- 4efbe: 4879 0007 5c42 pea 75c42 <_Message_queue_Information> 4efc4: 4eb9 0005 378c jsr 5378c <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { 4efca: 4fef 000c lea %sp@(12),%sp 4efce: 4aae fffc tstl %fp@(-4) 4efd2: 6704 beqs 4efd8 4efd4: 7004 moveq #4,%d0 4efd6: 600e bras 4efe6 case OBJECTS_LOCAL: *count = the_message_queue->message_queue.number_of_pending_messages; 4efd8: 2040 moveal %d0,%a0 4efda: 24a8 005c movel %a0@(92),%a2@ _Thread_Enable_dispatch(); 4efde: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4efe4: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4efe6: 246e fff8 moveal %fp@(-8),%a2 4efea: 4e5e unlk %fp 4efec: 4e75 rts ... 0004cb4c : rtems_status_code rtems_message_queue_ident( rtems_name name, uint32_t node, rtems_id *id ) { 4cb4c: 4e56 0000 linkw %fp,#0 Objects_Name_or_id_lookup_errors status; status = _Objects_Name_to_id_u32( 4cb50: 2f2e 0010 movel %fp@(16),%sp@- 4cb54: 2f2e 000c movel %fp@(12),%sp@- 4cb58: 2f2e 0008 movel %fp@(8),%sp@- 4cb5c: 4879 0006 6a8e pea 66a8e <_Message_queue_Information> 4cb62: 4eb9 0004 ec98 jsr 4ec98 <_Objects_Name_to_id_u32> 4cb68: 41f9 0006 3880 lea 63880 <_Status_Object_name_errors_to_status>,%a0 node, id ); return _Status_Object_name_errors_to_status[ status ]; } 4cb6e: 4e5e unlk %fp 4cb70: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4cb74: 4e75 rts ... 0004cb78 : void *buffer, size_t *size, rtems_option option_set, rtems_interval timeout ) { 4cb78: 4e56 fff0 linkw %fp,#-16 4cb7c: 48d7 001c moveml %d2-%d4,%sp@ 4cb80: 242e 000c movel %fp@(12),%d2 4cb84: 262e 0010 movel %fp@(16),%d3 register Message_queue_Control *the_message_queue; Objects_Locations location; bool wait; if ( !buffer ) 4cb88: 4a82 tstl %d2 4cb8a: 6766 beqs 4cbf2 return RTEMS_INVALID_ADDRESS; if ( !size ) 4cb8c: 4a83 tstl %d3 4cb8e: 6762 beqs 4cbf2 RTEMS_INLINE_ROUTINE Message_queue_Control *_Message_queue_Get ( Objects_Id id, Objects_Locations *location ) { return (Message_queue_Control *) 4cb90: 486e fffc pea %fp@(-4) 4cb94: 2f2e 0008 movel %fp@(8),%sp@- 4cb98: 4879 0006 6a8e pea 66a8e <_Message_queue_Information> 4cb9e: 4eb9 0004 eb10 jsr 4eb10 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_message_queue = _Message_queue_Get( id, &location ); switch ( location ) { 4cba4: 4fef 000c lea %sp@(12),%sp 4cba8: 4aae fffc tstl %fp@(-4) 4cbac: 6704 beqs 4cbb2 4cbae: 7004 moveq #4,%d0 4cbb0: 6042 bras 4cbf4 if ( _Options_Is_no_wait( option_set ) ) wait = false; else wait = true; _CORE_message_queue_Seize( 4cbb2: 7201 moveq #1,%d1 4cbb4: 7801 moveq #1,%d4 4cbb6: 2040 moveal %d0,%a0 4cbb8: c2ae 0014 andl %fp@(20),%d1 4cbbc: 2f2e 0018 movel %fp@(24),%sp@- 4cbc0: b384 eorl %d1,%d4 4cbc2: 2f04 movel %d4,%sp@- 4cbc4: 2f03 movel %d3,%sp@- 4cbc6: 2f02 movel %d2,%sp@- 4cbc8: 2f28 0008 movel %a0@(8),%sp@- 4cbcc: 4868 0014 pea %a0@(20) 4cbd0: 4eb9 0004 dcec jsr 4dcec <_CORE_message_queue_Seize> buffer, size, wait, timeout ); _Thread_Enable_dispatch(); 4cbd6: 4eb9 0004 f40a jsr 4f40a <_Thread_Enable_dispatch> return _Message_queue_Translate_core_message_queue_return_code( 4cbdc: 2079 0006 6302 moveal 66302 <_Thread_Executing>,%a0 4cbe2: 2f28 0034 movel %a0@(52),%sp@- 4cbe6: 4eb9 0004 cc78 jsr 4cc78 <_Message_queue_Translate_core_message_queue_return_code> 4cbec: 4fef 001c lea %sp@(28),%sp 4cbf0: 6002 bras 4cbf4 4cbf2: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4cbf4: 4cee 001c fff0 moveml %fp@(-16),%d2-%d4 4cbfa: 4e5e unlk %fp 4cbfc: 4e75 rts ... 00046584 : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { 46584: 4e56 0000 linkw %fp,#0 46588: 2f0a movel %a2,%sp@- 4658a: 246e 0010 moveal %fp@(16),%a2 4658e: 2f02 movel %d2,%sp@- int i; /* * Validate parameters and look up information structure. */ if ( !info ) 46590: 4a8a tstl %a2 46592: 6604 bnes 46598 46594: 7009 moveq #9,%d0 46596: 6052 bras 465ea return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 46598: 2f2e 000c movel %fp@(12),%sp@- 4659c: 2f2e 0008 movel %fp@(8),%sp@- 465a0: 4eb9 0004 7e98 jsr 47e98 <_Objects_Get_information> if ( !obj_info ) 465a6: 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 ); 465a8: 2040 moveal %d0,%a0 if ( !obj_info ) 465aa: 4a80 tstl %d0 465ac: 6604 bnes 465b2 465ae: 700a moveq #10,%d0 465b0: 6038 bras 465ea return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; 465b2: 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; 465b6: 4282 clrl %d2 465b8: 7001 moveq #1,%d0 465ba: 4281 clrl %d1 /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; 465bc: 2568 000a 0004 movel %a0@(10),%a2@(4) info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; 465c2: 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; 465c6: 1568 0010 000c moveb %a0@(16),%a2@(12) info->maximum = obj_info->maximum; 465cc: 2542 0008 movel %d2,%a2@(8) for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 465d0: 600e bras 465e0 if ( !obj_info->local_table[i] ) 465d2: 2268 0018 moveal %a0@(24),%a1 465d6: 4ab1 0c00 tstl %a1@(00000000,%d0:l:4) 465da: 6602 bnes 465de unallocated++; 465dc: 5281 addql #1,%d1 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++ ) 465de: 5280 addql #1,%d0 465e0: b480 cmpl %d0,%d2 465e2: 64ee bccs 465d2 if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; 465e4: 2541 000e movel %d1,%a2@(14) 465e8: 4280 clrl %d0 return RTEMS_SUCCESSFUL; } 465ea: 242e fff8 movel %fp@(-8),%d2 465ee: 246e fffc moveal %fp@(-4),%a2 465f2: 4e5e unlk %fp 465f4: 4e75 rts ... 00046604 : #undef rtems_object_id_api_maximum int rtems_object_id_api_maximum(void) { return OBJECTS_ITRON_API; } 46604: 7004 moveq #4,%d0 #include #include #undef rtems_object_id_api_maximum int rtems_object_id_api_maximum(void) { 46606: 4e56 0000 linkw %fp,#0 return OBJECTS_ITRON_API; } 4660a: 4e5e unlk %fp 4660c: 4e75 rts ... 00046610 : #undef rtems_object_id_api_minimum int rtems_object_id_api_minimum(void) { return OBJECTS_INTERNAL_API; } 46610: 7001 moveq #1,%d0 #include #include #undef rtems_object_id_api_minimum int rtems_object_id_api_minimum(void) { 46612: 4e56 0000 linkw %fp,#0 return OBJECTS_INTERNAL_API; } 46616: 4e5e unlk %fp 46618: 4e75 rts ... 0004661c : #undef rtems_object_id_get_api int rtems_object_id_get_api( rtems_id id ) { 4661c: 4280 clrl %d0 return _Objects_Get_API( id ); } 4661e: 7207 moveq #7,%d1 #undef rtems_object_id_get_api int rtems_object_id_get_api( rtems_id id ) { 46620: 4e56 0000 linkw %fp,#0 46624: 102e 0008 moveb %fp@(8),%d0 return _Objects_Get_API( id ); } 46628: 4e5e unlk %fp 4662a: c081 andl %d1,%d0 4662c: 4e75 rts ... 00046640 : int rtems_object_id_get_index( rtems_id id ) { return _Objects_Get_index( id ); } 46640: 4280 clrl %d0 #undef rtems_object_id_get_index int rtems_object_id_get_index( rtems_id id ) { 46642: 4e56 0000 linkw %fp,#0 return _Objects_Get_index( id ); } 46646: 302e 000a movew %fp@(10),%d0 4664a: 4e5e unlk %fp 4664c: 4e75 rts ... 00046650 : int rtems_object_id_get_node( rtems_id id ) { return _Objects_Get_node( id ); } 46650: 4280 clrl %d0 #undef rtems_object_id_get_node int rtems_object_id_get_node( rtems_id id ) { 46652: 4e56 0000 linkw %fp,#0 return _Objects_Get_node( id ); } 46656: 102e 0009 moveb %fp@(9),%d0 4665a: 4e5e unlk %fp 4665c: 4e75 rts ... 0004f28c : */ rtems_status_code rtems_partition_delete( rtems_id id ) { 4f28c: 4e56 fffc linkw %fp,#-4 4f290: 2f0b movel %a3,%sp@- 4f292: 2f0a movel %a2,%sp@- RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get ( Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) 4f294: 486e fffc pea %fp@(-4) 4f298: 2f2e 0008 movel %fp@(8),%sp@- 4f29c: 4879 0007 5272 pea 75272 <_Partition_Information> 4f2a2: 4eb9 0005 378c jsr 5378c <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { 4f2a8: 4fef 000c lea %sp@(12),%sp 4f2ac: 2440 moveal %d0,%a2 4f2ae: 4aae fffc tstl %fp@(-4) 4f2b2: 6704 beqs 4f2b8 4f2b4: 7004 moveq #4,%d0 4f2b6: 6036 bras 4f2ee 4f2b8: 47f9 0005 4012 lea 54012 <_Thread_Enable_dispatch>,%a3 case OBJECTS_LOCAL: if ( the_partition->number_of_used_blocks == 0 ) { 4f2be: 4aaa 0020 tstl %a2@(32) 4f2c2: 6626 bnes 4f2ea _Objects_Close( &_Partition_Information, &the_partition->Object ); 4f2c4: 2f00 movel %d0,%sp@- 4f2c6: 4879 0007 5272 pea 75272 <_Partition_Information> 4f2cc: 4eb9 0005 3388 jsr 53388 <_Objects_Close> */ RTEMS_INLINE_ROUTINE void _Partition_Free ( Partition_Control *the_partition ) { _Objects_Free( &_Partition_Information, &the_partition->Object ); 4f2d2: 2f0a movel %a2,%sp@- 4f2d4: 4879 0007 5272 pea 75272 <_Partition_Information> 4f2da: 4eb9 0005 35fc jsr 535fc <_Objects_Free> 0 /* Not used */ ); } #endif _Thread_Enable_dispatch(); 4f2e0: 4e93 jsr %a3@ return RTEMS_SUCCESSFUL; 4f2e2: 4fef 0010 lea %sp@(16),%sp 0 /* Not used */ ); } #endif _Thread_Enable_dispatch(); 4f2e6: 4280 clrl %d0 return RTEMS_SUCCESSFUL; 4f2e8: 6004 bras 4f2ee } _Thread_Enable_dispatch(); 4f2ea: 4e93 jsr %a3@ 4f2ec: 700c moveq #12,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4f2ee: 246e fff4 moveal %fp@(-12),%a2 4f2f2: 266e fff8 moveal %fp@(-8),%a3 4f2f6: 4e5e unlk %fp 4f2f8: 4e75 rts ... 0004f364 : rtems_status_code rtems_partition_ident( rtems_name name, uint32_t node, rtems_id *id ) { 4f364: 4e56 0000 linkw %fp,#0 Objects_Name_or_id_lookup_errors status; status = _Objects_Name_to_id_u32( &_Partition_Information, name, node, id ); 4f368: 2f2e 0010 movel %fp@(16),%sp@- 4f36c: 2f2e 000c movel %fp@(12),%sp@- 4f370: 2f2e 0008 movel %fp@(8),%sp@- 4f374: 4879 0007 5272 pea 75272 <_Partition_Information> 4f37a: 4eb9 0005 39a0 jsr 539a0 <_Objects_Name_to_id_u32> 4f380: 41f9 0006 e700 lea 6e700 <_Status_Object_name_errors_to_status>,%a0 return _Status_Object_name_errors_to_status[ status ]; } 4f386: 4e5e unlk %fp 4f388: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 4f38c: 4e75 rts ... 0004f390 : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { 4f390: 4e56 fffc linkw %fp,#-4 4f394: 2f0a movel %a2,%sp@- 4f396: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get ( Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) 4f398: 486e fffc pea %fp@(-4) 4f39c: 2f2e 0008 movel %fp@(8),%sp@- 4f3a0: 4879 0007 5272 pea 75272 <_Partition_Information> 4f3a6: 242e 000c movel %fp@(12),%d2 4f3aa: 4eb9 0005 378c jsr 5378c <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { 4f3b0: 4fef 000c lea %sp@(12),%sp 4f3b4: 2440 moveal %d0,%a2 4f3b6: 4aae fffc tstl %fp@(-4) 4f3ba: 6704 beqs 4f3c0 4f3bc: 7004 moveq #4,%d0 4f3be: 603c bras 4f3fc ) { void *starting; void *ending; starting = the_partition->starting_address; 4f3c0: 202a 0010 movel %a2@(16),%d0 ending = _Addresses_Add_offset( starting, the_partition->length ); 4f3c4: 222a 0014 movel %a2@(20),%d1 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); 4f3c8: b082 cmpl %d2,%d0 4f3ca: 623c bhis 4f408 4f3cc: d280 addl %d0,%d1 4f3ce: b282 cmpl %d2,%d1 4f3d0: 6536 bcss 4f408 return ( 4f3d2: 2202 movel %d2,%d1 4f3d4: 9280 subl %d0,%d1 4f3d6: 2001 movel %d1,%d0 4f3d8: 4c6a 0001 0018 remul %a2@(24),%d1,%d0 4f3de: 4a81 tstl %d1 4f3e0: 6626 bnes 4f408 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); 4f3e2: 2f02 movel %d2,%sp@- 4f3e4: 486a 0024 pea %a2@(36) 4f3e8: 4eb9 0005 1fdc jsr 51fdc <_Chain_Append> case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; 4f3ee: 53aa 0020 subql #1,%a2@(32) _Thread_Enable_dispatch(); 4f3f2: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4f3f8: 508f addql #8,%sp case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); 4f3fa: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4f3fc: 242e fff4 movel %fp@(-12),%d2 4f400: 246e fff8 moveal %fp@(-8),%a2 4f404: 4e5e unlk %fp 4f406: 4e75 rts _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 4f408: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4f40e: 7009 moveq #9,%d0 return RTEMS_INVALID_ADDRESS; 4f410: 60ea bras 4f3fc ... 0004e8c4 : */ rtems_status_code rtems_port_delete( rtems_id id ) { 4e8c4: 4e56 fffc linkw %fp,#-4 4e8c8: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE Dual_ported_memory_Control *_Dual_ported_memory_Get ( Objects_Id id, Objects_Locations *location ) { return (Dual_ported_memory_Control *) 4e8ca: 486e fffc pea %fp@(-4) 4e8ce: 2f2e 0008 movel %fp@(8),%sp@- 4e8d2: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e8d8: 4eb9 0005 378c jsr 5378c <_Objects_Get> register Dual_ported_memory_Control *the_port; Objects_Locations location; the_port = _Dual_ported_memory_Get( id, &location ); switch ( location ) { 4e8de: 4fef 000c lea %sp@(12),%sp 4e8e2: 2400 movel %d0,%d2 4e8e4: 4aae fffc tstl %fp@(-4) 4e8e8: 6704 beqs 4e8ee 4e8ea: 7004 moveq #4,%d0 4e8ec: 6028 bras 4e916 case OBJECTS_LOCAL: _Objects_Close( &_Dual_ported_memory_Information, &the_port->Object ); 4e8ee: 2f00 movel %d0,%sp@- 4e8f0: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e8f6: 4eb9 0005 3388 jsr 53388 <_Objects_Close> */ RTEMS_INLINE_ROUTINE void _Dual_ported_memory_Free ( Dual_ported_memory_Control *the_port ) { _Objects_Free( &_Dual_ported_memory_Information, &the_port->Object ); 4e8fc: 2f02 movel %d2,%sp@- 4e8fe: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e904: 4eb9 0005 35fc jsr 535fc <_Objects_Free> _Dual_ported_memory_Free( the_port ); _Thread_Enable_dispatch(); 4e90a: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 4e910: 4fef 0010 lea %sp@(16),%sp switch ( location ) { case OBJECTS_LOCAL: _Objects_Close( &_Dual_ported_memory_Information, &the_port->Object ); _Dual_ported_memory_Free( the_port ); _Thread_Enable_dispatch(); 4e914: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4e916: 242e fff8 movel %fp@(-8),%d2 4e91a: 4e5e unlk %fp 4e91c: 4e75 rts ... 0004e920 : rtems_status_code rtems_port_external_to_internal( rtems_id id, void *external, void **internal ) { 4e920: 4e56 fffc linkw %fp,#-4 4e924: 2f0a movel %a2,%sp@- 4e926: 246e 0010 moveal %fp@(16),%a2 4e92a: 2f02 movel %d2,%sp@- 4e92c: 242e 000c movel %fp@(12),%d2 register Dual_ported_memory_Control *the_port; Objects_Locations location; uint32_t ending; if ( !internal ) 4e930: 4a8a tstl %a2 4e932: 6604 bnes 4e938 4e934: 7009 moveq #9,%d0 4e936: 6042 bras 4e97a RTEMS_INLINE_ROUTINE Dual_ported_memory_Control *_Dual_ported_memory_Get ( Objects_Id id, Objects_Locations *location ) { return (Dual_ported_memory_Control *) 4e938: 486e fffc pea %fp@(-4) 4e93c: 2f2e 0008 movel %fp@(8),%sp@- 4e940: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e946: 4eb9 0005 378c jsr 5378c <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_port = _Dual_ported_memory_Get( id, &location ); switch ( location ) { 4e94c: 4fef 000c lea %sp@(12),%sp 4e950: 2040 moveal %d0,%a0 4e952: 4aae fffc tstl %fp@(-4) 4e956: 6704 beqs 4e95c 4e958: 7004 moveq #4,%d0 4e95a: 601e bras 4e97a case OBJECTS_LOCAL: ending = _Addresses_Subtract( external, the_port->external_base ); 4e95c: 2002 movel %d2,%d0 4e95e: 90a8 0014 subl %a0@(20),%d0 if ( ending > the_port->length ) 4e962: b0a8 0018 cmpl %a0@(24),%d0 4e966: 6304 blss 4e96c *internal = external; 4e968: 2482 movel %d2,%a2@ 4e96a: 6006 bras 4e972 else *internal = _Addresses_Add_offset( the_port->internal_base, 4e96c: d0a8 0010 addl %a0@(16),%d0 4e970: 2480 movel %d0,%a2@ ending ); _Thread_Enable_dispatch(); 4e972: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4e978: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4e97a: 242e fff4 movel %fp@(-12),%d2 4e97e: 246e fff8 moveal %fp@(-8),%a2 4e982: 4e5e unlk %fp 4e984: 4e75 rts ... 0004e9b0 : rtems_status_code rtems_port_internal_to_external( rtems_id id, void *internal, void **external ) { 4e9b0: 4e56 fffc linkw %fp,#-4 4e9b4: 2f0a movel %a2,%sp@- 4e9b6: 246e 0010 moveal %fp@(16),%a2 4e9ba: 2f02 movel %d2,%sp@- 4e9bc: 242e 000c movel %fp@(12),%d2 register Dual_ported_memory_Control *the_port; Objects_Locations location; uint32_t ending; if ( !external ) 4e9c0: 4a8a tstl %a2 4e9c2: 6604 bnes 4e9c8 4e9c4: 7009 moveq #9,%d0 4e9c6: 6042 bras 4ea0a 4e9c8: 486e fffc pea %fp@(-4) 4e9cc: 2f2e 0008 movel %fp@(8),%sp@- 4e9d0: 4879 0007 5238 pea 75238 <_Dual_ported_memory_Information> 4e9d6: 4eb9 0005 378c jsr 5378c <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_port = _Dual_ported_memory_Get( id, &location ); switch ( location ) { 4e9dc: 4fef 000c lea %sp@(12),%sp 4e9e0: 2040 moveal %d0,%a0 4e9e2: 4aae fffc tstl %fp@(-4) 4e9e6: 6704 beqs 4e9ec 4e9e8: 7004 moveq #4,%d0 4e9ea: 601e bras 4ea0a case OBJECTS_LOCAL: ending = _Addresses_Subtract( internal, the_port->internal_base ); 4e9ec: 2002 movel %d2,%d0 4e9ee: 90a8 0010 subl %a0@(16),%d0 if ( ending > the_port->length ) 4e9f2: b0a8 0018 cmpl %a0@(24),%d0 4e9f6: 6304 blss 4e9fc *external = internal; 4e9f8: 2482 movel %d2,%a2@ 4e9fa: 6006 bras 4ea02 else *external = _Addresses_Add_offset( the_port->external_base, 4e9fc: d0a8 0014 addl %a0@(20),%d0 4ea00: 2480 movel %d0,%a2@ ending ); _Thread_Enable_dispatch(); 4ea02: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 4ea08: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4ea0a: 242e fff4 movel %fp@(-12),%d2 4ea0e: 246e fff8 moveal %fp@(-8),%a2 4ea12: 4e5e unlk %fp 4ea14: 4e75 rts ... 00045930 : rtems_status_code rtems_rate_monotonic_create( rtems_name name, rtems_id *id ) { 45930: 4e56 fff0 linkw %fp,#-16 45934: 48d7 1c04 moveml %d2/%a2-%a4,%sp@ 45938: 242e 0008 movel %fp@(8),%d2 4593c: 286e 000c moveal %fp@(12),%a4 Rate_monotonic_Control *the_period; if ( !rtems_is_name_valid( name ) ) 45940: 6606 bnes 45948 45942: 7003 moveq #3,%d0 45944: 6000 009e braw 459e4 return RTEMS_INVALID_NAME; if ( !id ) 45948: 4a8c tstl %a4 4594a: 6606 bnes 45952 4594c: 7009 moveq #9,%d0 4594e: 6000 0094 braw 459e4 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 45952: 2039 0005 e8d0 movel 5e8d0 <_Thread_Dispatch_disable_level>,%d0 45958: 5280 addql #1,%d0 4595a: 23c0 0005 e8d0 movel %d0,5e8d0 <_Thread_Dispatch_disable_level> * This function allocates a period control block from * the inactive chain of free period control blocks. */ RTEMS_INLINE_ROUTINE Rate_monotonic_Control *_Rate_monotonic_Allocate( void ) { return (Rate_monotonic_Control *) 45960: 4879 0005 e7cc pea 5e7cc <_Rate_monotonic_Information> 45966: 47f9 0004 82be lea 482be <_Thread_Enable_dispatch>,%a3 4596c: 4eb9 0004 7594 jsr 47594 <_Objects_Allocate> _Thread_Disable_dispatch(); /* to prevent deletion */ the_period = _Rate_monotonic_Allocate(); if ( !the_period ) { 45972: 588f addql #4,%sp 45974: 2440 moveal %d0,%a2 45976: 4a80 tstl %d0 45978: 6606 bnes 45980 _Thread_Enable_dispatch(); 4597a: 4e93 jsr %a3@ 4597c: 7005 moveq #5,%d0 return RTEMS_TOO_MANY; 4597e: 6064 bras 459e4 } the_period->owner = _Thread_Executing; 45980: 41f9 0005 e98a lea 5e98a <_Thread_Executing>,%a0 45986: 2550 0040 movel %a0@,%a2@(64) the_period->state = RATE_MONOTONIC_INACTIVE; 4598a: 42aa 0038 clrl %a2@(56) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 4598e: 42aa 0018 clrl %a2@(24) the_watchdog->routine = routine; 45992: 42aa 002c clrl %a2@(44) the_watchdog->id = id; 45996: 42aa 0030 clrl %a2@(48) the_watchdog->user_data = user_data; 4599a: 42aa 0034 clrl %a2@(52) _Watchdog_Initialize( &the_period->Timer, NULL, 0, NULL ); _Rate_monotonic_Reset_statistics( the_period ); 4599e: 4878 0038 pea 38 459a2: 42a7 clrl %sp@- 459a4: 486a 0054 pea %a2@(84) 459a8: 4eb9 0004 e964 jsr 4e964 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 459ae: 202a 0008 movel %a2@(8),%d0 459b2: 4281 clrl %d1 459b4: 2079 0005 e7e4 moveal 5e7e4 <_Rate_monotonic_Information+0x18>,%a0 459ba: 3200 movew %d0,%d1 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 459bc: 2542 000c movel %d2,%a2@(12) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 459c0: 218a 1c00 movel %a2,%a0@(00000000,%d1:l:4) 459c4: 223c 7fff ffff movel #2147483647,%d1 459ca: 2541 005c movel %d1,%a2@(92) 459ce: 2541 0060 movel %d1,%a2@(96) 459d2: 2541 0074 movel %d1,%a2@(116) 459d6: 2541 0078 movel %d1,%a2@(120) &_Rate_monotonic_Information, &the_period->Object, (Objects_Name) name ); *id = the_period->Object.id; 459da: 2880 movel %d0,%a4@ _Thread_Enable_dispatch(); 459dc: 4e93 jsr %a3@ return RTEMS_SUCCESSFUL; 459de: 4fef 000c lea %sp@(12),%sp &the_period->Object, (Objects_Name) name ); *id = the_period->Object.id; _Thread_Enable_dispatch(); 459e2: 4280 clrl %d0 return RTEMS_SUCCESSFUL; } 459e4: 4cee 1c04 fff0 moveml %fp@(-16),%d2/%a2-%a4 459ea: 4e5e unlk %fp 459ec: 4e75 rts ... 000713e4 : rtems_status_code rtems_rate_monotonic_get_statistics( rtems_id id, rtems_rate_monotonic_period_statistics *statistics ) { 713e4: 4e56 fffc linkw %fp,#-4 713e8: 2f0a movel %a2,%sp@- 713ea: 246e 000c moveal %fp@(12),%a2 Objects_Locations location; Rate_monotonic_Control *the_period; rtems_rate_monotonic_period_statistics *dst; Rate_monotonic_Statistics *src; if ( !statistics ) 713ee: 4a8a tstl %a2 713f0: 6606 bnes 713f8 713f2: 7009 moveq #9,%d0 713f4: 6000 0098 braw 7148e 713f8: 486e fffc pea %fp@(-4) 713fc: 2f2e 0008 movel %fp@(8),%sp@- 71400: 4879 0009 c72c pea 9c72c <_Rate_monotonic_Information> 71406: 4eb9 0004 a898 jsr 4a898 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 7140c: 4fef 000c lea %sp@(12),%sp 71410: 2040 moveal %d0,%a0 71412: 4aae fffc tstl %fp@(-4) 71416: 6704 beqs 7141c 71418: 7004 moveq #4,%d0 7141a: 6072 bras 7148e case OBJECTS_LOCAL: dst = statistics; src = &the_period->Statistics; dst->count = src->count; 7141c: 24a8 0054 movel %a0@(84),%a2@ dst->missed_count = src->missed_count; 71420: 2568 0058 0004 movel %a0@(88),%a2@(4) #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( &src->min_cpu_time, &dst->min_cpu_time ); 71426: 2028 005c movel %a0@(92),%d0 7142a: 2228 0060 movel %a0@(96),%d1 7142e: 2540 0008 movel %d0,%a2@(8) 71432: 2541 000c movel %d1,%a2@(12) _Timestamp_To_timespec( &src->max_cpu_time, &dst->max_cpu_time ); 71436: 2028 0064 movel %a0@(100),%d0 7143a: 2228 0068 movel %a0@(104),%d1 7143e: 2540 0010 movel %d0,%a2@(16) 71442: 2541 0014 movel %d1,%a2@(20) _Timestamp_To_timespec( &src->total_cpu_time, &dst->total_cpu_time ); 71446: 2028 006c movel %a0@(108),%d0 7144a: 2228 0070 movel %a0@(112),%d1 7144e: 2540 0018 movel %d0,%a2@(24) 71452: 2541 001c movel %d1,%a2@(28) _Timestamp_To_timespec( &src->min_wall_time, &dst->min_wall_time ); 71456: 2028 0074 movel %a0@(116),%d0 7145a: 2228 0078 movel %a0@(120),%d1 7145e: 2540 0020 movel %d0,%a2@(32) 71462: 2541 0024 movel %d1,%a2@(36) _Timestamp_To_timespec( &src->max_wall_time, &dst->max_wall_time ); 71466: 2028 007c movel %a0@(124),%d0 7146a: 2228 0080 movel %a0@(128),%d1 7146e: 2540 0028 movel %d0,%a2@(40) 71472: 2541 002c movel %d1,%a2@(44) _Timestamp_To_timespec( &src->total_wall_time, &dst->total_wall_time ); 71476: 2028 0084 movel %a0@(132),%d0 7147a: 2228 0088 movel %a0@(136),%d1 7147e: 2540 0030 movel %d0,%a2@(48) 71482: 2541 0034 movel %d1,%a2@(52) dst->min_wall_time = src->min_wall_time; dst->max_wall_time = src->max_wall_time; dst->total_wall_time = src->total_wall_time; #endif _Thread_Enable_dispatch(); 71486: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 7148c: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 7148e: 246e fff8 moveal %fp@(-8),%a2 71492: 4e5e unlk %fp 71494: 4e75 rts ... 00071498 : rtems_status_code rtems_rate_monotonic_get_status( rtems_id id, rtems_rate_monotonic_period_status *status ) { 71498: 4e56 ffec linkw %fp,#-20 7149c: 2f0a movel %a2,%sp@- 7149e: 246e 000c moveal %fp@(12),%a2 Objects_Locations location; Rate_monotonic_Period_time_t since_last_period; Rate_monotonic_Control *the_period; bool valid_status; if ( !status ) 714a2: 4a8a tstl %a2 714a4: 6606 bnes 714ac 714a6: 7009 moveq #9,%d0 714a8: 6000 0094 braw 7153e 714ac: 486e fffc pea %fp@(-4) 714b0: 2f2e 0008 movel %fp@(8),%sp@- 714b4: 4879 0009 c72c pea 9c72c <_Rate_monotonic_Information> 714ba: 4eb9 0004 a898 jsr 4a898 <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 714c0: 4fef 000c lea %sp@(12),%sp 714c4: 2040 moveal %d0,%a0 714c6: 4aae fffc tstl %fp@(-4) 714ca: 6704 beqs 714d0 714cc: 7004 moveq #4,%d0 714ce: 606e bras 7153e case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; 714d0: 2268 0040 moveal %a0@(64),%a1 status->state = the_period->state; 714d4: 2028 0038 movel %a0@(56),%d0 the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; 714d8: 24a9 0008 movel %a1@(8),%a2@ status->state = the_period->state; 714dc: 2540 0004 movel %d0,%a2@(4) /* * If the period is inactive, there is no information. */ if ( status->state == RATE_MONOTONIC_INACTIVE ) { 714e0: 6612 bnes 714f4 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timespec_Set_to_zero( &status->since_last_period ); _Timespec_Set_to_zero( &status->executed_since_last_period ); 714e2: 42aa 0014 clrl %a2@(20) /* * If the period is inactive, there is no information. */ if ( status->state == RATE_MONOTONIC_INACTIVE ) { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timespec_Set_to_zero( &status->since_last_period ); 714e6: 42aa 0008 clrl %a2@(8) 714ea: 42aa 000c clrl %a2@(12) _Timespec_Set_to_zero( &status->executed_since_last_period ); 714ee: 42aa 0010 clrl %a2@(16) 714f2: 6042 bras 71536 /* * Grab the current status. */ valid_status = _Rate_monotonic_Get_status( 714f4: 486e fff4 pea %fp@(-12) 714f8: 486e ffec pea %fp@(-20) 714fc: 2f08 movel %a0,%sp@- 714fe: 4eb9 0007 15c0 jsr 715c0 <_Rate_monotonic_Get_status> the_period, &since_last_period, &executed ); if (!valid_status) { 71504: 4fef 000c lea %sp@(12),%sp 71508: 4a00 tstb %d0 7150a: 660a bnes 71516 _Thread_Enable_dispatch(); 7150c: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 71512: 700b moveq #11,%d0 return RTEMS_NOT_DEFINED; 71514: 6028 bras 7153e #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( &since_last_period, &status->since_last_period ); _Timestamp_To_timespec( 71516: 202e fff4 movel %fp@(-12),%d0 7151a: 222e fff8 movel %fp@(-8),%d1 7151e: 2540 0010 movel %d0,%a2@(16) 71522: 2541 0014 movel %d1,%a2@(20) _Thread_Enable_dispatch(); return RTEMS_NOT_DEFINED; } #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( 71526: 202e ffec movel %fp@(-20),%d0 7152a: 222e fff0 movel %fp@(-16),%d1 7152e: 2540 0008 movel %d0,%a2@(8) 71532: 2541 000c movel %d1,%a2@(12) status->since_last_period = since_last_period; status->executed_since_last_period = executed; #endif } _Thread_Enable_dispatch(); 71536: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 7153c: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 7153e: 246e ffe8 moveal %fp@(-24),%a2 71542: 4e5e unlk %fp 71544: 4e75 rts ... 0007175c : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 7175c: 4e56 ffec linkw %fp,#-20 71760: 48d7 041c moveml %d2-%d4/%a2,%sp@ 71764: 486e fffc pea %fp@(-4) 71768: 262e 0008 movel %fp@(8),%d3 7176c: 2f03 movel %d3,%sp@- 7176e: 4879 0009 c72c pea 9c72c <_Rate_monotonic_Information> 71774: 242e 000c movel %fp@(12),%d2 71778: 4eb9 0004 a898 jsr 4a898 <_Objects_Get> rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 7177e: 4fef 000c lea %sp@(12),%sp 71782: 2440 moveal %d0,%a2 71784: 4aae fffc tstl %fp@(-4) 71788: 6600 0138 bnew 718c2 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 7178c: 2039 0009 bd42 movel 9bd42 <_Thread_Executing>,%d0 71792: b0aa 0040 cmpl %a2@(64),%d0 71796: 670c beqs 717a4 _Thread_Enable_dispatch(); 71798: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 7179e: 7817 moveq #23,%d4 return RTEMS_NOT_OWNER_OF_RESOURCE; 717a0: 6000 0122 braw 718c4 } if ( length == RTEMS_PERIOD_STATUS ) { 717a4: 4a82 tstl %d2 717a6: 6622 bnes 717ca switch ( the_period->state ) { 717a8: 202a 0038 movel %a2@(56),%d0 717ac: 7204 moveq #4,%d1 717ae: b280 cmpl %d0,%d1 717b0: 6404 bccs 717b6 717b2: 4284 clrl %d4 <== NOT EXECUTED 717b4: 600a bras 717c0 <== NOT EXECUTED 717b6: 41f9 0009 5cb8 lea 95cb8 ,%a0 717bc: 2830 0c00 movel %a0@(00000000,%d0:l:4),%d4 case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); 717c0: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> return( return_value ); 717c6: 6000 00fc braw 718c4 } _ISR_Disable( level ); 717ca: 203c 0000 0700 movel #1792,%d0 717d0: 40c4 movew %sr,%d4 717d2: 8084 orl %d4,%d0 717d4: 46c0 movew %d0,%sr switch ( the_period->state ) { 717d6: 202a 0038 movel %a2@(56),%d0 717da: 7202 moveq #2,%d1 717dc: b280 cmpl %d0,%d1 717de: 6740 beqs 71820 717e0: 123c 0004 moveb #4,%d1 717e4: b280 cmpl %d0,%d1 717e6: 6700 00a4 beqw 7188c 717ea: 4a80 tstl %d0 717ec: 6600 00d4 bnew 718c2 case RATE_MONOTONIC_INACTIVE: { _ISR_Enable( level ); 717f0: 46c4 movew %d4,%sr /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 717f2: 2f0a movel %a2,%sp@- ); the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 717f4: 4284 clrl %d4 _ISR_Enable( level ); /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 717f6: 4eb9 0007 1548 jsr 71548 <_Rate_monotonic_Initiate_statistics> Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 717fc: 203c 0007 18d0 movel #465104,%d0 the_period->state = RATE_MONOTONIC_ACTIVE; 71802: 7202 moveq #2,%d1 71804: 2540 002c movel %d0,%a2@(44) the_watchdog->id = id; 71808: 2543 0030 movel %d3,%a2@(48) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 7180c: 2542 001c movel %d2,%a2@(28) 71810: 2541 0038 movel %d1,%a2@(56) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 71814: 42aa 0018 clrl %a2@(24) the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 71818: 42aa 0034 clrl %a2@(52) 7181c: 6000 0084 braw 718a2 case RATE_MONOTONIC_ACTIVE: /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 71820: 2f0a movel %a2,%sp@- 71822: 4eb9 0007 1668 jsr 71668 <_Rate_monotonic_Update_statistics> * This tells the _Rate_monotonic_Timeout that this task is * in the process of blocking on the period and that we * may be changing the length of the next period. */ the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; the_period->next_length = length; 71828: 2542 003c movel %d2,%a2@(60) /* * This tells the _Rate_monotonic_Timeout that this task is * in the process of blocking on the period and that we * may be changing the length of the next period. */ the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; 7182c: 7401 moveq #1,%d2 7182e: 2542 0038 movel %d2,%a2@(56) the_period->next_length = length; _ISR_Enable( level ); 71832: 46c4 movew %d4,%sr _Thread_Executing->Wait.id = the_period->Object.id; 71834: 2079 0009 bd42 moveal 9bd42 <_Thread_Executing>,%a0 7183a: 216a 0008 0020 movel %a2@(8),%a0@(32) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 71840: 4878 4000 pea 4000 71844: 2f08 movel %a0,%sp@- 71846: 4eb9 0004 b970 jsr 4b970 <_Thread_Set_state> /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 7184c: 203c 0000 0700 movel #1792,%d0 71852: 40c1 movew %sr,%d1 71854: 8081 orl %d1,%d0 71856: 46c0 movew %d0,%sr local_state = the_period->state; the_period->state = RATE_MONOTONIC_ACTIVE; 71858: 143c 0002 moveb #2,%d2 /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; 7185c: 202a 0038 movel %a2@(56),%d0 the_period->state = RATE_MONOTONIC_ACTIVE; 71860: 2542 0038 movel %d2,%a2@(56) _ISR_Enable( level ); 71864: 46c1 movew %d1,%sr /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) 71866: 7203 moveq #3,%d1 71868: 4fef 000c lea %sp@(12),%sp 7186c: b280 cmpl %d0,%d1 7186e: 6612 bnes 71882 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 71870: 4878 4000 pea 4000 71874: 2f39 0009 bd42 movel 9bd42 <_Thread_Executing>,%sp@- 7187a: 4eb9 0004 ad98 jsr 4ad98 <_Thread_Clear_state> 71880: 508f addql #8,%sp _Thread_Enable_dispatch(); 71882: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 71888: 4284 clrl %d4 return RTEMS_SUCCESSFUL; 7188a: 6038 bras 718c4 case RATE_MONOTONIC_EXPIRED: /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 7188c: 2f0a movel %a2,%sp@- 7188e: 4eb9 0007 1668 jsr 71668 <_Rate_monotonic_Update_statistics> _ISR_Enable( level ); 71894: 46c4 movew %d4,%sr the_period->state = RATE_MONOTONIC_ACTIVE; 71896: 7002 moveq #2,%d0 the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 71898: 7806 moveq #6,%d4 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 7189a: 2542 001c movel %d2,%a2@(28) */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; 7189e: 2540 0038 movel %d0,%a2@(56) the_period->next_length = length; 718a2: 2542 003c movel %d2,%a2@(60) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 718a6: 486a 0010 pea %a2@(16) 718aa: 4879 0009 bd60 pea 9bd60 <_Watchdog_Ticks_chain> 718b0: 4eb9 0004 c0b8 jsr 4c0b8 <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 718b6: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; 718bc: 4fef 000c lea %sp@(12),%sp 718c0: 6002 bras 718c4 718c2: 7804 moveq #4,%d4 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 718c4: 2004 movel %d4,%d0 718c6: 4cee 041c ffec moveml %fp@(-20),%d2-%d4/%a2 718cc: 4e5e unlk %fp 718ce: 4e75 rts 00062dd6 : void rtems_rate_monotonic_report_statistics( void ) { 62dd6: 4e56 0000 linkw %fp,#0 rtems_rate_monotonic_report_statistics_with_plugin( NULL, printk_plugin ); 62dda: 4879 0004 681c pea 4681c 62de0: 42a7 clrl %sp@- 62de2: 4eb9 0006 2c60 jsr 62c60 62de8: 508f addql #8,%sp } 62dea: 4e5e unlk %fp 62dec: 4e75 rts ... 0004fc78 : */ rtems_status_code rtems_region_delete( rtems_id id ) { 4fc78: 4e56 fffc linkw %fp,#-4 4fc7c: 2f0a movel %a2,%sp@- 4fc7e: 2f02 movel %d2,%sp@- Objects_Locations location; rtems_status_code return_status; Region_Control *the_region; _RTEMS_Lock_allocator(); 4fc80: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fc86: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> RTEMS_INLINE_ROUTINE Region_Control *_Region_Get ( Objects_Id id, Objects_Locations *location ) { return (Region_Control *) 4fc8c: 486e fffc pea %fp@(-4) 4fc90: 2f2e 0008 movel %fp@(8),%sp@- 4fc94: 4879 0007 52e6 pea 752e6 <_Region_Information> 4fc9a: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 4fca0: 4fef 0010 lea %sp@(16),%sp 4fca4: 2440 moveal %d0,%a2 4fca6: 4aae fffc tstl %fp@(-4) 4fcaa: 6704 beqs 4fcb0 4fcac: 7404 moveq #4,%d2 4fcae: 602c bras 4fcdc case OBJECTS_LOCAL: _Region_Debug_Walk( the_region, 5 ); if ( the_region->number_of_used_blocks != 0 ) 4fcb0: 4aaa 0064 tstl %a2@(100) 4fcb4: 6704 beqs 4fcba 4fcb6: 740c moveq #12,%d2 4fcb8: 6022 bras 4fcdc return_status = RTEMS_RESOURCE_IN_USE; else { _Objects_Close( &_Region_Information, &the_region->Object ); 4fcba: 2f00 movel %d0,%sp@- 4fcbc: 4879 0007 52e6 pea 752e6 <_Region_Information> */ RTEMS_INLINE_ROUTINE void _Region_Free ( Region_Control *the_region ) { _Objects_Free( &_Region_Information, &the_region->Object ); 4fcc2: 4282 clrl %d2 4fcc4: 4eb9 0005 3388 jsr 53388 <_Objects_Close> 4fcca: 2f0a movel %a2,%sp@- 4fccc: 4879 0007 52e6 pea 752e6 <_Region_Information> 4fcd2: 4eb9 0005 35fc jsr 535fc <_Objects_Free> 4fcd8: 4fef 0010 lea %sp@(16),%sp default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 4fcdc: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fce2: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> return return_status; } 4fce8: 246e fff8 moveal %fp@(-8),%a2 4fcec: 2002 movel %d2,%d0 4fcee: 242e fff4 movel %fp@(-12),%d2 4fcf2: 4e5e unlk %fp 4fcf4: 4e75 rts ... 0004fe0c : rtems_status_code rtems_region_get_information( rtems_id id, Heap_Information_block *the_info ) { 4fe0c: 4e56 fffc linkw %fp,#-4 4fe10: 2f02 movel %d2,%sp@- 4fe12: 242e 000c movel %fp@(12),%d2 Objects_Locations location; rtems_status_code return_status; register Region_Control *the_region; if ( !the_info ) 4fe16: 6606 bnes 4fe1e 4fe18: 143c 0009 moveb #9,%d2 4fe1c: 604e bras 4fe6c return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); 4fe1e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fe24: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 4fe2a: 486e fffc pea %fp@(-4) 4fe2e: 2f2e 0008 movel %fp@(8),%sp@- 4fe32: 4879 0007 52e6 pea 752e6 <_Region_Information> 4fe38: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 4fe3e: 4fef 0010 lea %sp@(16),%sp 4fe42: 4aae fffc tstl %fp@(-4) 4fe46: 6704 beqs 4fe4c 4fe48: 7404 moveq #4,%d2 4fe4a: 6012 bras 4fe5e case OBJECTS_LOCAL: _Heap_Get_information( &the_region->Memory, the_info ); 4fe4c: 2f02 movel %d2,%sp@- 4fe4e: 2040 moveal %d0,%a0 4fe50: 4868 0068 pea %a0@(104) 4fe54: 4282 clrl %d2 4fe56: 4eb9 0005 2db8 jsr 52db8 <_Heap_Get_information> return_status = RTEMS_SUCCESSFUL; break; 4fe5c: 508f addql #8,%sp default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 4fe5e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fe64: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> return return_status; 4fe6a: 588f addql #4,%sp } 4fe6c: 2002 movel %d2,%d0 4fe6e: 242e fff8 movel %fp@(-8),%d2 4fe72: 4e5e unlk %fp 4fe74: 4e75 rts ... 0004ff88 : rtems_status_code rtems_region_get_segment_size( rtems_id id, void *segment, uintptr_t *size ) { 4ff88: 4e56 fffc linkw %fp,#-4 4ff8c: 2f03 movel %d3,%sp@- 4ff8e: 262e 0010 movel %fp@(16),%d3 4ff92: 2f02 movel %d2,%sp@- 4ff94: 242e 000c movel %fp@(12),%d2 Objects_Locations location; rtems_status_code return_status = RTEMS_SUCCESSFUL; register Region_Control *the_region; if ( !segment ) 4ff98: 6766 beqs 50000 return RTEMS_INVALID_ADDRESS; if ( !size ) 4ff9a: 4a83 tstl %d3 4ff9c: 6762 beqs 50000 return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); 4ff9e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4ffa4: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 4ffaa: 486e fffc pea %fp@(-4) 4ffae: 2f2e 0008 movel %fp@(8),%sp@- 4ffb2: 4879 0007 52e6 pea 752e6 <_Region_Information> 4ffb8: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 4ffbe: 222e fffc movel %fp@(-4),%d1 4ffc2: 4fef 0010 lea %sp@(16),%sp 4ffc6: 670a beqs 4ffd2 4ffc8: 7001 moveq #1,%d0 4ffca: b081 cmpl %d1,%d0 4ffcc: 6620 bnes 4ffee 4ffce: 7404 moveq #4,%d2 4ffd0: 601e bras 4fff0 case OBJECTS_LOCAL: if ( !_Heap_Size_of_alloc_area( &the_region->Memory, segment, size ) ) 4ffd2: 2f03 movel %d3,%sp@- 4ffd4: 2040 moveal %d0,%a0 4ffd6: 2f02 movel %d2,%sp@- 4ffd8: 4868 0068 pea %a0@(104) 4ffdc: 4eb9 0005 31d4 jsr 531d4 <_Heap_Size_of_alloc_area> 4ffe2: 4fef 000c lea %sp@(12),%sp 4ffe6: 4a00 tstb %d0 4ffe8: 6604 bnes 4ffee 4ffea: 7409 moveq #9,%d2 <== NOT EXECUTED 4ffec: 6002 bras 4fff0 <== NOT EXECUTED 4ffee: 4282 clrl %d2 case OBJECTS_ERROR: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 4fff0: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 4fff6: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> return return_status; 4fffc: 588f addql #4,%sp 4fffe: 6002 bras 50002 50000: 7409 moveq #9,%d2 } 50002: 2002 movel %d2,%d0 50004: 242e fff4 movel %fp@(-12),%d2 50008: 262e fff8 movel %fp@(-8),%d3 5000c: 4e5e unlk %fp 5000e: 4e75 rts 0005003c : rtems_id id, void *segment, uintptr_t size, uintptr_t *old_size ) { 5003c: 4e56 ffe8 linkw %fp,#-24 50040: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 50044: 266e 0014 moveal %fp@(20),%a3 uintptr_t osize; rtems_status_code return_status; Heap_Resize_status status; register Region_Control *the_region; if ( !old_size ) 50048: 4a8b tstl %a3 5004a: 6700 008e beqw 500da return RTEMS_INVALID_ADDRESS; _RTEMS_Lock_allocator(); 5004e: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 50054: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 5005a: 486e fff8 pea %fp@(-8) 5005e: 2f2e 0008 movel %fp@(8),%sp@- 50062: 4879 0007 52e6 pea 752e6 <_Region_Information> 50068: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 5006e: 4fef 0010 lea %sp@(16),%sp 50072: 2440 moveal %d0,%a2 50074: 4aae fff8 tstl %fp@(-8) 50078: 664e bnes 500c8 case OBJECTS_LOCAL: _Region_Debug_Walk( the_region, 7 ); status = _Heap_Resize_block( 5007a: 486e fffc pea %fp@(-4) 5007e: 486e fff4 pea %fp@(-12) 50082: 2f2e 0010 movel %fp@(16),%sp@- 50086: 2f2e 000c movel %fp@(12),%sp@- 5008a: 486a 0068 pea %a2@(104) 5008e: 4eb9 0005 30fc jsr 530fc <_Heap_Resize_block> segment, (uint32_t) size, &osize, &avail_size ); *old_size = (uint32_t) osize; 50094: 26ae fff4 movel %fp@(-12),%a3@ case OBJECTS_LOCAL: _Region_Debug_Walk( the_region, 7 ); status = _Heap_Resize_block( 50098: 2400 movel %d0,%d2 ); *old_size = (uint32_t) osize; _Region_Debug_Walk( the_region, 8 ); if ( status == HEAP_RESIZE_SUCCESSFUL ) 5009a: 4fef 0014 lea %sp@(20),%sp 5009e: 660e bnes 500ae _Region_Process_queue( the_region ); /* unlocks allocator */ 500a0: 2f0a movel %a2,%sp@- 500a2: 4eb9 0005 72f8 jsr 572f8 <_Region_Process_queue> 500a8: 588f addql #4,%sp 500aa: 4280 clrl %d0 500ac: 602e bras 500dc else _RTEMS_Unlock_allocator(); 500ae: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 500b4: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> if (status == HEAP_RESIZE_SUCCESSFUL) return RTEMS_SUCCESSFUL; if (status == HEAP_RESIZE_UNSATISFIED) 500ba: 588f addql #4,%sp 500bc: 7001 moveq #1,%d0 500be: b082 cmpl %d2,%d0 500c0: 6618 bnes 500da 500c2: 103c 000d moveb #13,%d0 500c6: 6014 bras 500dc default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 500c8: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 500ce: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> return return_status; 500d4: 588f addql #4,%sp default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 500d6: 7004 moveq #4,%d0 return return_status; 500d8: 6002 bras 500dc 500da: 7009 moveq #9,%d0 } 500dc: 4cee 0c04 ffe8 moveml %fp@(-24),%d2/%a2-%a3 500e2: 4e5e unlk %fp 500e4: 4e75 rts ... 000500e8 : rtems_status_code rtems_region_return_segment( rtems_id id, void *segment ) { 500e8: 4e56 fffc linkw %fp,#-4 500ec: 2f0a movel %a2,%sp@- 500ee: 2f02 movel %d2,%sp@- uint32_t size; #endif int status; register Region_Control *the_region; _RTEMS_Lock_allocator(); 500f0: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 500f6: 4eb9 0005 1f48 jsr 51f48 <_API_Mutex_Lock> 500fc: 486e fffc pea %fp@(-4) 50100: 2f2e 0008 movel %fp@(8),%sp@- 50104: 4879 0007 52e6 pea 752e6 <_Region_Information> 5010a: 4eb9 0005 3754 jsr 53754 <_Objects_Get_no_protection> the_region = _Region_Get( id, &location ); switch ( location ) { 50110: 4fef 0010 lea %sp@(16),%sp 50114: 2440 moveal %d0,%a2 50116: 4aae fffc tstl %fp@(-4) 5011a: 6704 beqs 50120 5011c: 7404 moveq #4,%d2 5011e: 6026 bras 50146 RTEMS_INLINE_ROUTINE bool _Region_Free_segment ( Region_Control *the_region, void *the_segment ) { return _Heap_Free( &the_region->Memory, the_segment ); 50120: 2f2e 000c movel %fp@(12),%sp@- 50124: 486a 0068 pea %a2@(104) 50128: 4eb9 0005 2c04 jsr 52c04 <_Heap_Free> #endif status = _Region_Free_segment( the_region, segment ); _Region_Debug_Walk( the_region, 4 ); if ( !status ) 5012e: 508f addql #8,%sp 50130: 4a00 tstb %d0 50132: 6710 beqs 50144 return_status = RTEMS_INVALID_ADDRESS; else { the_region->number_of_used_blocks -= 1; 50134: 53aa 0064 subql #1,%a2@(100) _Region_Process_queue(the_region); /* unlocks allocator */ 50138: 4282 clrl %d2 5013a: 2f0a movel %a2,%sp@- 5013c: 4eb9 0005 72f8 jsr 572f8 <_Region_Process_queue> 50142: 600e bras 50152 return RTEMS_SUCCESSFUL; 50144: 7409 moveq #9,%d2 default: return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); 50146: 2f39 0007 549a movel 7549a <_RTEMS_Allocator_Mutex>,%sp@- 5014c: 4eb9 0005 1fa8 jsr 51fa8 <_API_Mutex_Unlock> return return_status; } 50152: 2002 movel %d2,%d0 return_status = RTEMS_INVALID_ID; break; } _RTEMS_Unlock_allocator(); return return_status; 50154: 588f addql #4,%sp } 50156: 242e fff4 movel %fp@(-12),%d2 5015a: 246e fff8 moveal %fp@(-8),%a2 5015e: 4e5e unlk %fp 50160: 4e75 rts ... 00050440 : rtems_status_code rtems_semaphore_ident( rtems_name name, uint32_t node, rtems_id *id ) { 50440: 4e56 0000 linkw %fp,#0 Objects_Name_or_id_lookup_errors status; status = _Objects_Name_to_id_u32( &_Semaphore_Information, name, node, id ); 50444: 2f2e 0010 movel %fp@(16),%sp@- 50448: 2f2e 000c movel %fp@(12),%sp@- 5044c: 2f2e 0008 movel %fp@(8),%sp@- 50450: 4879 0007 5320 pea 75320 <_Semaphore_Information> 50456: 4eb9 0005 39a0 jsr 539a0 <_Objects_Name_to_id_u32> 5045c: 41f9 0006 e700 lea 6e700 <_Status_Object_name_errors_to_status>,%a0 return _Status_Object_name_errors_to_status[ status ]; } 50462: 4e5e unlk %fp 50464: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 50468: 4e75 rts ... 00045560 : void rtems_shutdown_executive( uint32_t result ) { if ( !_System_state_Is_shutdown( _System_state_Get() ) ) { 45560: 7004 moveq #4,%d0 */ void rtems_shutdown_executive( uint32_t result ) { 45562: 4e56 0000 linkw %fp,#0 if ( !_System_state_Is_shutdown( _System_state_Get() ) ) { 45566: b0b9 0005 ce1c cmpl 5ce1c <_System_state_Current>,%d0 4556c: 6718 beqs 45586 4556e: 23c0 0005 ce1c movel %d0,5ce1c <_System_state_Current> * 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 ); 45574: 203c 0005 cc60 movel #380000,%d0 4557a: 2d40 0008 movel %d0,%fp@(8) _System_state_Set( SYSTEM_STATE_SHUTDOWN ); _Thread_Stop_multitasking(); } } 4557e: 4e5e unlk %fp 45580: 4ef9 0004 7f3e jmp 47f3e <_CPU_Context_Restart_self> 45586: 4e5e unlk %fp 45588: 4e75 rts ... 00045e34 : rtems_status_code rtems_signal_catch( rtems_asr_entry asr_handler, rtems_mode mode_set ) { 45e34: 4e56 0000 linkw %fp,#0 45e38: 2239 0005 e05c movel 5e05c <_Thread_Dispatch_disable_level>,%d1 45e3e: 5281 addql #1,%d1 RTEMS_API_Control *api; ASR_Information *asr; /* XXX normalize mode */ executing = _Thread_Executing; api = (RTEMS_API_Control*)executing->API_Extensions[ THREAD_API_RTEMS ]; 45e40: 2079 0005 e116 moveal 5e116 <_Thread_Executing>,%a0 rtems_status_code rtems_signal_catch( rtems_asr_entry asr_handler, rtems_mode mode_set ) { 45e46: 202e 0008 movel %fp@(8),%d0 RTEMS_API_Control *api; ASR_Information *asr; /* XXX normalize mode */ executing = _Thread_Executing; api = (RTEMS_API_Control*)executing->API_Extensions[ THREAD_API_RTEMS ]; 45e4a: 2068 010a moveal %a0@(266),%a0 45e4e: 23c1 0005 e05c movel %d1,5e05c <_Thread_Dispatch_disable_level> asr = &api->Signal; _Thread_Disable_dispatch(); /* cannot reschedule while */ /* the thread is inconsistent */ if ( !_ASR_Is_null_handler( asr_handler ) ) { 45e54: 4a80 tstl %d0 45e56: 670c beqs 45e64 asr->mode_set = mode_set; asr->handler = asr_handler; 45e58: 2140 000a movel %d0,%a0@(10) _Thread_Disable_dispatch(); /* cannot reschedule while */ /* the thread is inconsistent */ if ( !_ASR_Is_null_handler( asr_handler ) ) { asr->mode_set = mode_set; 45e5c: 216e 000c 000e movel %fp@(12),%a0@(14) 45e62: 601a bras 45e7e information->is_enabled = false; information->handler = NULL; information->mode_set = RTEMS_DEFAULT_MODES; information->signals_posted = 0; information->signals_pending = 0; information->nest_level = 0; 45e64: 42a8 001a clrl %a0@(26) */ RTEMS_INLINE_ROUTINE void _ASR_Initialize ( ASR_Information *information ) { information->is_enabled = false; 45e68: 4200 clrb %d0 information->handler = NULL; 45e6a: 42a8 000a clrl %a0@(10) */ RTEMS_INLINE_ROUTINE void _ASR_Initialize ( ASR_Information *information ) { information->is_enabled = false; 45e6e: 1140 0008 moveb %d0,%a0@(8) information->handler = NULL; information->mode_set = RTEMS_DEFAULT_MODES; 45e72: 42a8 000e clrl %a0@(14) information->signals_posted = 0; 45e76: 42a8 0012 clrl %a0@(18) information->signals_pending = 0; 45e7a: 42a8 0016 clrl %a0@(22) asr->handler = asr_handler; } else _ASR_Initialize( asr ); _Thread_Enable_dispatch(); 45e7e: 4eb9 0004 7cd2 jsr 47cd2 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; } 45e84: 4280 clrl %d0 45e86: 4e5e unlk %fp 45e88: 4e75 rts ... 00050620 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 50620: 4e56 fffc linkw %fp,#-4 50624: 2f03 movel %d3,%sp@- 50626: 2f02 movel %d2,%sp@- 50628: 242e 000c movel %fp@(12),%d2 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 5062c: 6606 bnes 50634 5062e: 700a moveq #10,%d0 50630: 6000 0084 braw 506b6 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 50634: 486e fffc pea %fp@(-4) 50638: 2f2e 0008 movel %fp@(8),%sp@- 5063c: 4eb9 0005 4068 jsr 54068 <_Thread_Get> switch ( location ) { 50642: 508f addql #8,%sp 50644: 4aae fffc tstl %fp@(-4) 50648: 6704 beqs 5064e 5064a: 7004 moveq #4,%d0 5064c: 6068 bras 506b6 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 5064e: 2240 moveal %d0,%a1 50650: 2069 010a moveal %a1@(266),%a0 asr = &api->Signal; 50654: 4aa8 000a tstl %a0@(10) 50658: 6754 beqs 506ae if ( ! _ASR_Is_null_handler( asr->handler ) ) { if ( asr->is_enabled ) { 5065a: 4a28 0008 tstb %a0@(8) 5065e: 6732 beqs 50692 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 50660: 223c 0000 0700 movel #1792,%d1 50666: 40c3 movew %sr,%d3 50668: 8283 orl %d3,%d1 5066a: 46c1 movew %d1,%sr *signal_set |= signals; 5066c: 85a8 0012 orl %d2,%a0@(18) _ISR_Enable( _level ); 50670: 46c3 movew %d3,%sr _ASR_Post_signals( signal_set, &asr->signals_posted ); the_thread->do_post_task_switch_extension = true; if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 50672: 2239 0007 5482 movel 75482 <_ISR_Nest_level>,%d1 if ( ! _ASR_Is_null_handler( asr->handler ) ) { if ( asr->is_enabled ) { _ASR_Post_signals( signal_set, &asr->signals_posted ); the_thread->do_post_task_switch_extension = true; 50678: 7401 moveq #1,%d2 5067a: 1342 0074 moveb %d2,%a1@(116) if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 5067e: 4a81 tstl %d1 50680: 6722 beqs 506a4 50682: b0b9 0007 54a2 cmpl 754a2 <_Thread_Executing>,%d0 50688: 661a bnes 506a4 _ISR_Signals_to_thread_executing = true; 5068a: 13c2 0007 5530 moveb %d2,75530 <_ISR_Signals_to_thread_executing> 50690: 6012 bras 506a4 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 50692: 203c 0000 0700 movel #1792,%d0 50698: 40c1 movew %sr,%d1 5069a: 8081 orl %d1,%d0 5069c: 46c0 movew %d0,%sr *signal_set |= signals; 5069e: 85a8 0016 orl %d2,%a0@(22) _ISR_Enable( _level ); 506a2: 46c1 movew %d1,%sr } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 506a4: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 506aa: 4280 clrl %d0 return RTEMS_SUCCESSFUL; 506ac: 6008 bras 506b6 } _Thread_Enable_dispatch(); 506ae: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> 506b4: 700b moveq #11,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 506b6: 242e fff4 movel %fp@(-12),%d2 506ba: 262e fff8 movel %fp@(-8),%d3 506be: 4e5e unlk %fp 506c0: 4e75 rts ... 00045208 : */ rtems_status_code rtems_task_delete( rtems_id id ) { 45208: 4e56 fff0 linkw %fp,#-16 4520c: 48d7 1c00 moveml %a2-%a4,%sp@ register Thread_Control *the_thread; Objects_Locations location; Objects_Information *the_information; _RTEMS_Lock_allocator(); 45210: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 45216: 47f9 0004 589c lea 4589c <_API_Mutex_Unlock>,%a3 4521c: 4eb9 0004 583c jsr 4583c <_API_Mutex_Lock> the_thread = _Thread_Get( id, &location ); 45222: 486e fffc pea %fp@(-4) 45226: 2f2e 0008 movel %fp@(8),%sp@- 4522a: 4eb9 0004 6d08 jsr 46d08 <_Thread_Get> switch ( location ) { 45230: 4fef 000c lea %sp@(12),%sp Objects_Locations location; Objects_Information *the_information; _RTEMS_Lock_allocator(); the_thread = _Thread_Get( id, &location ); 45234: 2440 moveal %d0,%a2 switch ( location ) { 45236: 4aae fffc tstl %fp@(-4) 4523a: 663c bnes 45278 case OBJECTS_LOCAL: the_information = _Objects_Get_information_id( the_thread->Object.id ); 4523c: 2f2a 0008 movel %a2@(8),%sp@- 45240: 49f9 0004 6414 lea 46414 <_Objects_Get_information_id>,%a4 45246: 4e94 jsr %a4@ 0 /* Not used */ ); } #endif _Thread_Close( the_information, the_thread ); 45248: 2f0a movel %a2,%sp@- 4524a: 2f00 movel %d0,%sp@- 4524c: 4eb9 0004 69d4 jsr 469d4 <_Thread_Close> 45252: 2f2a 0008 movel %a2@(8),%sp@- 45256: 4e94 jsr %a4@ 45258: 2f0a movel %a2,%sp@- 4525a: 2f00 movel %d0,%sp@- 4525c: 4eb9 0004 6390 jsr 46390 <_Objects_Free> _RTEMS_tasks_Free( the_thread ); _RTEMS_Unlock_allocator(); 45262: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 45268: 4e93 jsr %a3@ _Thread_Enable_dispatch(); 4526a: 4eb9 0004 6ce2 jsr 46ce2 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 45270: 4fef 001c lea %sp@(28),%sp _Thread_Close( the_information, the_thread ); _RTEMS_tasks_Free( the_thread ); _RTEMS_Unlock_allocator(); _Thread_Enable_dispatch(); 45274: 4280 clrl %d0 return RTEMS_SUCCESSFUL; 45276: 600c bras 45284 case OBJECTS_ERROR: break; } _RTEMS_Unlock_allocator(); 45278: 2f39 0005 cd46 movel 5cd46 <_RTEMS_Allocator_Mutex>,%sp@- 4527e: 4e93 jsr %a3@ return RTEMS_INVALID_ID; 45280: 588f addql #4,%sp case OBJECTS_ERROR: break; } _RTEMS_Unlock_allocator(); 45282: 7004 moveq #4,%d0 return RTEMS_INVALID_ID; } 45284: 4cee 1c00 fff0 moveml %fp@(-16),%a2-%a4 4528a: 4e5e unlk %fp 4528c: 4e75 rts ... 00046988 : rtems_status_code rtems_task_get_note( rtems_id id, uint32_t notepad, uint32_t *note ) { 46988: 4e56 fffc linkw %fp,#-4 4698c: 202e 0008 movel %fp@(8),%d0 46990: 2f0a movel %a2,%sp@- 46992: 246e 0010 moveal %fp@(16),%a2 46996: 2f02 movel %d2,%sp@- 46998: 242e 000c movel %fp@(12),%d2 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) 4699c: 4a39 0005 db44 tstb 5db44 469a2: 6604 bnes 469a8 469a4: 7016 moveq #22,%d0 469a6: 605e bras 46a06 return RTEMS_NOT_CONFIGURED; if ( !note ) 469a8: 4a8a tstl %a2 469aa: 6604 bnes 469b0 469ac: 7009 moveq #9,%d0 469ae: 6056 bras 46a06 /* * NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would * be checking an unsigned number for being negative. */ if ( notepad > RTEMS_NOTEPAD_LAST ) 469b0: 720f moveq #15,%d1 469b2: b282 cmpl %d2,%d1 469b4: 6404 bccs 469ba 469b6: 700a moveq #10,%d0 469b8: 604c bras 46a06 /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || 469ba: 4a80 tstl %d0 469bc: 670c beqs 469ca _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { 469be: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 469c4: b0a8 0008 cmpl %a0@(8),%d0 469c8: 6612 bnes 469dc api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; *note = api->Notepads[ notepad ]; 469ca: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 469d0: 4280 clrl %d0 469d2: 2068 010a moveal %a0@(266),%a0 469d6: 24b0 2c1e movel %a0@(0000001e,%d2:l:4),%a2@ return RTEMS_SUCCESSFUL; 469da: 602a bras 46a06 } the_thread = _Thread_Get( id, &location ); 469dc: 486e fffc pea %fp@(-4) 469e0: 2f00 movel %d0,%sp@- 469e2: 4eb9 0004 86c8 jsr 486c8 <_Thread_Get> switch ( location ) { 469e8: 508f addql #8,%sp 469ea: 4aae fffc tstl %fp@(-4) 469ee: 6704 beqs 469f4 469f0: 7004 moveq #4,%d0 469f2: 6012 bras 46a06 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; *note = api->Notepads[ notepad ]; 469f4: 2240 moveal %d0,%a1 469f6: 2069 010a moveal %a1@(266),%a0 469fa: 24b0 2c1e movel %a0@(0000001e,%d2:l:4),%a2@ _Thread_Enable_dispatch(); 469fe: 4eb9 0004 86a2 jsr 486a2 <_Thread_Enable_dispatch> 46a04: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 46a06: 242e fff4 movel %fp@(-12),%d2 46a0a: 246e fff8 moveal %fp@(-8),%a2 46a0e: 4e5e unlk %fp 46a10: 4e75 rts ... 00045290 : rtems_status_code rtems_task_ident( rtems_name name, uint32_t node, rtems_id *id ) { 45290: 4e56 0000 linkw %fp,#0 45294: 202e 0008 movel %fp@(8),%d0 45298: 206e 0010 moveal %fp@(16),%a0 Objects_Name_or_id_lookup_errors status; if ( !id ) 4529c: 4a88 tstl %a0 4529e: 6604 bnes 452a4 452a0: 7009 moveq #9,%d0 452a2: 6032 bras 452d6 return RTEMS_INVALID_ADDRESS; if ( name == OBJECTS_ID_OF_SELF ) { 452a4: 4a80 tstl %d0 452a6: 660c bnes 452b4 *id = _Thread_Executing->Object.id; 452a8: 2279 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a1 452ae: 20a9 0008 movel %a1@(8),%a0@ return RTEMS_SUCCESSFUL; 452b2: 6022 bras 452d6 } status = _Objects_Name_to_id_u32( &_RTEMS_tasks_Information, name, node, id ); 452b4: 2f08 movel %a0,%sp@- 452b6: 2f2e 000c movel %fp@(12),%sp@- 452ba: 2f00 movel %d0,%sp@- 452bc: 4879 0005 cc06 pea 5cc06 <_RTEMS_tasks_Information> 452c2: 4eb9 0004 6670 jsr 46670 <_Objects_Name_to_id_u32> return _Status_Object_name_errors_to_status[ status ]; 452c8: 4fef 0010 lea %sp@(16),%sp 452cc: 41f9 0005 a40c lea 5a40c <_Status_Object_name_errors_to_status>,%a0 452d2: 2030 0c00 movel %a0@(00000000,%d0:l:4),%d0 } 452d6: 4e5e unlk %fp 452d8: 4e75 rts ... 0004bc30 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4bc30: 4e56 ffe4 linkw %fp,#-28 4bc34: 48d7 1c3c moveml %d2-%d5/%a2-%a4,%sp@ 4bc38: 262e 0008 movel %fp@(8),%d3 4bc3c: 282e 000c movel %fp@(12),%d4 4bc40: 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 ) 4bc44: 4a8c tstl %a4 4bc46: 6606 bnes 4bc4e 4bc48: 7009 moveq #9,%d0 4bc4a: 6000 00fc braw 4bd48 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4bc4e: 2479 0005 cd4e moveal 5cd4e <_Thread_Executing>,%a2 api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4bc54: 4a2a 0075 tstb %a2@(117) 4bc58: 57c0 seq %d0 4bc5a: 243c 0000 0100 movel #256,%d2 4bc60: 49c0 extbl %d0 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 4bc62: 266a 010a moveal %a2@(266),%a3 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4bc66: c480 andl %d0,%d2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4bc68: 4aaa 007a tstl %a2@(122) 4bc6c: 6704 beqs 4bc72 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4bc6e: 08c2 0009 bset #9,%d2 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 4bc72: 4a2b 0008 tstb %a3@(8) 4bc76: 57c0 seq %d0 4bc78: 2a3c 0000 0400 movel #1024,%d5 4bc7e: 49c0 extbl %d0 4bc80: ca80 andl %d0,%d5 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; old_mode |= _ISR_Get_level(); 4bc82: 4eb9 0004 7ff4 jsr 47ff4 <_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; 4bc88: 8085 orl %d5,%d0 old_mode |= _ISR_Get_level(); *previous_mode_set = old_mode; 4bc8a: 8082 orl %d2,%d0 4bc8c: 2880 movel %d0,%a4@ /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4bc8e: 0804 0008 btst #8,%d4 4bc92: 670e beqs 4bca2 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4bc94: 2003 movel %d3,%d0 4bc96: 7201 moveq #1,%d1 4bc98: e088 lsrl #8,%d0 4bc9a: b380 eorl %d1,%d0 4bc9c: c081 andl %d1,%d0 4bc9e: 1540 0075 moveb %d0,%a2@(117) if ( mask & RTEMS_TIMESLICE_MASK ) { 4bca2: 0804 0009 btst #9,%d4 4bca6: 671c beqs 4bcc4 if ( _Modes_Is_timeslice(mode_set) ) { 4bca8: 0803 0009 btst #9,%d3 4bcac: 6712 beqs 4bcc0 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4bcae: 41f9 0005 cc44 lea 5cc44 <_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; 4bcb4: 7001 moveq #1,%d0 executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4bcb6: 2550 0076 movel %a0@,%a2@(118) 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; 4bcba: 2540 007a movel %d0,%a2@(122) 4bcbe: 6004 bras 4bcc4 executing->cpu_time_budget = _Thread_Ticks_per_timeslice; } else executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4bcc0: 42aa 007a clrl %a2@(122) /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4bcc4: 7007 moveq #7,%d0 4bcc6: c084 andl %d4,%d0 4bcc8: 6712 beqs 4bcdc */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); 4bcca: 40c0 movew %sr,%d0 4bccc: 7207 moveq #7,%d1 4bcce: c283 andl %d3,%d1 4bcd0: 0280 0000 f8ff andil #63743,%d0 4bcd6: e189 lsll #8,%d1 4bcd8: 8081 orl %d1,%d0 4bcda: 46c0 movew %d0,%sr */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 4bcdc: 0804 000a btst #10,%d4 4bce0: 6744 beqs 4bd26 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 4bce2: 700a moveq #10,%d0 4bce4: e0ab lsrl %d0,%d3 4bce6: 7201 moveq #1,%d1 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 4bce8: 4280 clrl %d0 4bcea: 102b 0008 moveb %a3@(8),%d0 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 4bcee: b383 eorl %d1,%d3 4bcf0: c681 andl %d1,%d3 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 4bcf2: b083 cmpl %d3,%d0 4bcf4: 6730 beqs 4bd26 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4bcf6: 203c 0000 0700 movel #1792,%d0 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 ) { asr->is_enabled = is_asr_enabled; 4bcfc: 1743 0008 moveb %d3,%a3@(8) 4bd00: 40c1 movew %sr,%d1 4bd02: 8081 orl %d1,%d0 4bd04: 46c0 movew %d0,%sr _signals = information->signals_pending; 4bd06: 202b 0016 movel %a3@(22),%d0 information->signals_pending = information->signals_posted; 4bd0a: 276b 0012 0016 movel %a3@(18),%a3@(22) information->signals_posted = _signals; 4bd10: 2740 0012 movel %d0,%a3@(18) _ISR_Enable( _level ); 4bd14: 46c1 movew %d1,%sr if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 4bd16: 4aab 0012 tstl %a3@(18) 4bd1a: 670a beqs 4bd26 if ( is_asr_enabled != asr->is_enabled ) { asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { needs_asr_dispatching = true; executing->do_post_task_switch_extension = true; 4bd1c: 7001 moveq #1,%d0 4bd1e: 7401 moveq #1,%d2 4bd20: 1540 0074 moveb %d0,%a2@(116) 4bd24: 6002 bras 4bd28 4bd26: 4202 clrb %d2 } } } if ( _System_state_Is_up( _System_state_Get() ) ) 4bd28: 7203 moveq #3,%d1 4bd2a: b2b9 0005 ce1c cmpl 5ce1c <_System_state_Current>,%d1 4bd30: 6614 bnes 4bd46 if ( _Thread_Evaluate_mode() || needs_asr_dispatching ) 4bd32: 4eb9 0004 c028 jsr 4c028 <_Thread_Evaluate_mode> 4bd38: 4a00 tstb %d0 4bd3a: 6604 bnes 4bd40 4bd3c: 4a02 tstb %d2 4bd3e: 6706 beqs 4bd46 _Thread_Dispatch(); 4bd40: 4eb9 0004 6b90 jsr 46b90 <_Thread_Dispatch> 4bd46: 4280 clrl %d0 return RTEMS_SUCCESSFUL; } 4bd48: 4cee 1c3c ffe4 moveml %fp@(-28),%d2-%d5/%a2-%a4 4bd4e: 4e5e unlk %fp 4bd50: 4e75 rts ... 0004e684 : #include #include rtems_id rtems_task_self(void) { 4e684: 4e56 0000 linkw %fp,#0 4e688: 2079 0006 20c6 moveal 620c6 <_Thread_Executing>,%a0 return _Thread_Executing->Object.id; } 4e68e: 4e5e unlk %fp 4e690: 2028 0008 movel %a0@(8),%d0 4e694: 4e75 rts ... 00046af4 : rtems_status_code rtems_task_set_note( rtems_id id, uint32_t notepad, uint32_t note ) { 46af4: 4e56 fffc linkw %fp,#-4 46af8: 202e 0008 movel %fp@(8),%d0 46afc: 2f03 movel %d3,%sp@- 46afe: 262e 0010 movel %fp@(16),%d3 46b02: 2f02 movel %d2,%sp@- 46b04: 242e 000c movel %fp@(12),%d2 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; if ( !rtems_configuration_get_notepads_enabled() ) 46b08: 4a39 0005 db44 tstb 5db44 46b0e: 6604 bnes 46b14 46b10: 7016 moveq #22,%d0 46b12: 6056 bras 46b6a /* * NOTE: There is no check for < RTEMS_NOTEPAD_FIRST because that would * be checking an unsigned number for being negative. */ if ( notepad > RTEMS_NOTEPAD_LAST ) 46b14: 720f moveq #15,%d1 46b16: b282 cmpl %d2,%d1 46b18: 6404 bccs 46b1e 46b1a: 700a moveq #10,%d0 46b1c: 604c bras 46b6a /* * Optimize the most likely case to avoid the Thread_Dispatch. */ if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) || 46b1e: 4a80 tstl %d0 46b20: 670c beqs 46b2e _Objects_Are_ids_equal( id, _Thread_Executing->Object.id ) ) { 46b22: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 46b28: b0a8 0008 cmpl %a0@(8),%d0 46b2c: 6612 bnes 46b40 api = _Thread_Executing->API_Extensions[ THREAD_API_RTEMS ]; api->Notepads[ notepad ] = note; 46b2e: 2079 0005 f64e moveal 5f64e <_Thread_Executing>,%a0 46b34: 4280 clrl %d0 46b36: 2068 010a moveal %a0@(266),%a0 46b3a: 2183 2c1e movel %d3,%a0@(0000001e,%d2:l:4) return RTEMS_SUCCESSFUL; 46b3e: 602a bras 46b6a } the_thread = _Thread_Get( id, &location ); 46b40: 486e fffc pea %fp@(-4) 46b44: 2f00 movel %d0,%sp@- 46b46: 4eb9 0004 86c8 jsr 486c8 <_Thread_Get> switch ( location ) { 46b4c: 508f addql #8,%sp 46b4e: 4aae fffc tstl %fp@(-4) 46b52: 6704 beqs 46b58 46b54: 7004 moveq #4,%d0 46b56: 6012 bras 46b6a case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; api->Notepads[ notepad ] = note; 46b58: 2240 moveal %d0,%a1 46b5a: 2069 010a moveal %a1@(266),%a0 46b5e: 2183 2c1e movel %d3,%a0@(0000001e,%d2:l:4) _Thread_Enable_dispatch(); 46b62: 4eb9 0004 86a2 jsr 486a2 <_Thread_Enable_dispatch> 46b68: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 46b6a: 242e fff4 movel %fp@(-12),%d2 46b6e: 262e fff8 movel %fp@(-8),%d3 46b72: 4e5e unlk %fp 46b74: 4e75 rts ... 000493f8 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 493f8: 4e56 fffc linkw %fp,#-4 493fc: 2f0a movel %a2,%sp@- 493fe: 246e 0010 moveal %fp@(16),%a2 49402: 2f02 movel %d2,%sp@- 49404: 242e 000c movel %fp@(12),%d2 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 49408: 6710 beqs 4941a 4940a: 4280 clrl %d0 4940c: 1039 0006 0b42 moveb 60b42 ,%d0 49412: b082 cmpl %d2,%d0 49414: 6404 bccs 4941a 49416: 7013 moveq #19,%d0 49418: 6054 bras 4946e !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4941a: 4a8a tstl %a2 4941c: 6604 bnes 49422 4941e: 7009 moveq #9,%d0 49420: 604c bras 4946e return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 49422: 486e fffc pea %fp@(-4) 49426: 2f2e 0008 movel %fp@(8),%sp@- 4942a: 4eb9 0004 b104 jsr 4b104 <_Thread_Get> switch ( location ) { 49430: 508f addql #8,%sp return RTEMS_INVALID_PRIORITY; if ( !old_priority ) return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 49432: 2040 moveal %d0,%a0 switch ( location ) { 49434: 4aae fffc tstl %fp@(-4) 49438: 6704 beqs 4943e 4943a: 7004 moveq #4,%d0 4943c: 6030 bras 4946e case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4943e: 24a8 0014 movel %a0@(20),%a2@ if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 49442: 4a82 tstl %d2 49444: 6720 beqs 49466 the_thread->real_priority = new_priority; 49446: 2142 0018 movel %d2,%a0@(24) if ( the_thread->resource_count == 0 || 4944a: 4aa8 001c tstl %a0@(28) 4944e: 6706 beqs 49456 the_thread->current_priority > new_priority ) 49450: b4a8 0014 cmpl %a0@(20),%d2 49454: 6410 bccs 49466 _Thread_Change_priority( the_thread, new_priority, false ); 49456: 42a7 clrl %sp@- 49458: 2f02 movel %d2,%sp@- 4945a: 2f08 movel %a0,%sp@- 4945c: 4eb9 0004 abb4 jsr 4abb4 <_Thread_Change_priority> 49462: 4fef 000c lea %sp@(12),%sp } _Thread_Enable_dispatch(); 49466: 4eb9 0004 b0ae jsr 4b0ae <_Thread_Enable_dispatch> 4946c: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4946e: 242e fff4 movel %fp@(-12),%d2 49472: 246e fff8 moveal %fp@(-8),%a2 49476: 4e5e unlk %fp 49478: 4e75 rts ... 00063308 : rtems_status_code rtems_task_variable_add( rtems_id tid, void **ptr, void (*dtor)(void *) ) { 63308: 4e56 fff0 linkw %fp,#-16 6330c: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 63310: 246e 000c moveal %fp@(12),%a2 63314: 242e 0010 movel %fp@(16),%d2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *new; if ( !ptr ) 63318: 4a8a tstl %a2 6331a: 6604 bnes 63320 6331c: 7009 moveq #9,%d0 6331e: 6070 bras 63390 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); 63320: 486e fffc pea %fp@(-4) 63324: 2f2e 0008 movel %fp@(8),%sp@- 63328: 4eb9 0004 b178 jsr 4b178 <_Thread_Get> switch (location) { 6332e: 508f addql #8,%sp rtems_task_variable_t *tvp, *new; if ( !ptr ) return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); 63330: 2640 moveal %d0,%a3 switch (location) { 63332: 4aae fffc tstl %fp@(-4) 63336: 6704 beqs 6333c 63338: 7004 moveq #4,%d0 6333a: 6054 bras 63390 case OBJECTS_LOCAL: /* * Figure out if the variable is already in this task's list. */ tvp = the_thread->task_variables; 6333c: 206b 011a moveal %a3@(282),%a0 while (tvp) { 63340: 6014 bras 63356 if (tvp->ptr == ptr) { 63342: b5e8 0004 cmpal %a0@(4),%a2 63346: 660c bnes 63354 tvp->dtor = dtor; 63348: 2142 0010 movel %d2,%a0@(16) _Thread_Enable_dispatch(); 6334c: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 63352: 603a bras 6338e return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; 63354: 2050 moveal %a0@,%a0 case OBJECTS_LOCAL: /* * Figure out if the variable is already in this task's list. */ tvp = the_thread->task_variables; while (tvp) { 63356: 4a88 tstl %a0 63358: 66e8 bnes 63342 } /* * Now allocate memory for this task variable. */ new = (rtems_task_variable_t *) 6335a: 4878 0014 pea 14 6335e: 4eb9 0004 c300 jsr 4c300 <_Workspace_Allocate> _Workspace_Allocate(sizeof(rtems_task_variable_t)); if (new == NULL) { 63364: 588f addql #4,%sp 63366: 43f9 0004 b152 lea 4b152 <_Thread_Enable_dispatch>,%a1 } /* * Now allocate memory for this task variable. */ new = (rtems_task_variable_t *) 6336c: 2040 moveal %d0,%a0 _Workspace_Allocate(sizeof(rtems_task_variable_t)); if (new == NULL) { 6336e: 4a80 tstl %d0 63370: 6606 bnes 63378 _Thread_Enable_dispatch(); 63372: 4e91 jsr %a1@ 63374: 701a moveq #26,%d0 return RTEMS_NO_MEMORY; 63376: 6018 bras 63390 } new->gval = *ptr; new->ptr = ptr; new->dtor = dtor; new->next = (struct rtems_task_variable_tt *)the_thread->task_variables; 63378: 20ab 011a movel %a3@(282),%a0@ _Workspace_Allocate(sizeof(rtems_task_variable_t)); if (new == NULL) { _Thread_Enable_dispatch(); return RTEMS_NO_MEMORY; } new->gval = *ptr; 6337c: 2152 0008 movel %a2@,%a0@(8) new->ptr = ptr; new->dtor = dtor; new->next = (struct rtems_task_variable_tt *)the_thread->task_variables; the_thread->task_variables = new; 63380: 2740 011a movel %d0,%a3@(282) if (new == NULL) { _Thread_Enable_dispatch(); return RTEMS_NO_MEMORY; } new->gval = *ptr; new->ptr = ptr; 63384: 214a 0004 movel %a2,%a0@(4) new->dtor = dtor; 63388: 2142 0010 movel %d2,%a0@(16) new->next = (struct rtems_task_variable_tt *)the_thread->task_variables; the_thread->task_variables = new; _Thread_Enable_dispatch(); 6338c: 4e91 jsr %a1@ 6338e: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 63390: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 63396: 4e5e unlk %fp 63398: 4e75 rts ... 0006339c : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { 6339c: 4e56 fffc linkw %fp,#-4 633a0: 2f02 movel %d2,%sp@- 633a2: 242e 000c movel %fp@(12),%d2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) 633a6: 675c beqs 63404 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); 633a8: 486e fffc pea %fp@(-4) 633ac: 2f2e 0008 movel %fp@(8),%sp@- 633b0: 4eb9 0004 b178 jsr 4b178 <_Thread_Get> switch (location) { 633b6: 508f addql #8,%sp 633b8: 4aae fffc tstl %fp@(-4) 633bc: 6704 beqs 633c2 633be: 7004 moveq #4,%d0 633c0: 6044 bras 63406 case OBJECTS_LOCAL: tvp = the_thread->task_variables; 633c2: 2240 moveal %d0,%a1 633c4: 2069 011a moveal %a1@(282),%a0 633c8: 93c9 subal %a1,%a1 while (tvp) { 633ca: 602e bras 633fa if (tvp->ptr == ptr) { 633cc: b4a8 0004 cmpl %a0@(4),%d2 633d0: 6624 bnes 633f6 if (prev) 633d2: 4a89 tstl %a1 633d4: 6704 beqs 633da prev->next = tvp->next; 633d6: 2290 movel %a0@,%a1@ 633d8: 6006 bras 633e0 else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 633da: 2240 moveal %d0,%a1 633dc: 2350 011a movel %a0@,%a1@(282) _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); 633e0: 2f08 movel %a0,%sp@- 633e2: 2f00 movel %d0,%sp@- 633e4: 4eb9 0006 3478 jsr 63478 <_RTEMS_Tasks_Invoke_task_variable_dtor> _Thread_Enable_dispatch(); 633ea: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 633f0: 508f addql #8,%sp prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); _Thread_Enable_dispatch(); 633f2: 4280 clrl %d0 return RTEMS_SUCCESSFUL; 633f4: 6010 bras 63406 } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; 633f6: 2248 moveal %a0,%a1 633f8: 2050 moveal %a0@,%a0 the_thread = _Thread_Get (tid, &location); switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { 633fa: 4a88 tstl %a0 633fc: 66ce bnes 633cc return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 633fe: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 63404: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 63406: 242e fff8 movel %fp@(-8),%d2 6340a: 4e5e unlk %fp 6340c: 4e75 rts ... 00063410 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { 63410: 4e56 fffc linkw %fp,#-4 63414: 2f0a movel %a2,%sp@- 63416: 246e 0010 moveal %fp@(16),%a2 6341a: 2f02 movel %d2,%sp@- 6341c: 242e 000c movel %fp@(12),%d2 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) 63420: 6746 beqs 63468 return RTEMS_INVALID_ADDRESS; if ( !result ) 63422: 4a8a tstl %a2 63424: 6742 beqs 63468 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); 63426: 486e fffc pea %fp@(-4) 6342a: 2f2e 0008 movel %fp@(8),%sp@- 6342e: 4eb9 0004 b178 jsr 4b178 <_Thread_Get> switch (location) { 63434: 508f addql #8,%sp 63436: 4aae fffc tstl %fp@(-4) 6343a: 6704 beqs 63440 6343c: 7004 moveq #4,%d0 6343e: 602a bras 6346a case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; 63440: 2240 moveal %d0,%a1 63442: 2069 011a moveal %a1@(282),%a0 while (tvp) { 63446: 6016 bras 6345e if (tvp->ptr == ptr) { 63448: b4a8 0004 cmpl %a0@(4),%d2 6344c: 660e bnes 6345c /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; 6344e: 24a8 000c movel %a0@(12),%a2@ _Thread_Enable_dispatch(); 63452: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> 63458: 4280 clrl %d0 return RTEMS_SUCCESSFUL; 6345a: 600e bras 6346a } tvp = (rtems_task_variable_t *)tvp->next; 6345c: 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) { 6345e: 4a88 tstl %a0 63460: 66e6 bnes 63448 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 63462: 4eb9 0004 b152 jsr 4b152 <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; 63468: 7009 moveq #9,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 6346a: 242e fff4 movel %fp@(-12),%d2 6346e: 246e fff8 moveal %fp@(-8),%a2 63472: 4e5e unlk %fp 63474: 4e75 rts ... 00051270 : rtems_id id, rtems_interval ticks, rtems_timer_service_routine_entry routine, void *user_data ) { 51270: 4e56 ffe4 linkw %fp,#-28 51274: 48d7 1c1c moveml %d2-%d4/%a2-%a4,%sp@ 51278: 262e 0008 movel %fp@(8),%d3 5127c: 242e 000c movel %fp@(12),%d2 51280: 282e 0010 movel %fp@(16),%d4 Timer_Control *the_timer; Objects_Locations location; ISR_Level level; Timer_server_Control *timer_server = _Timer_server; 51284: 2679 0007 5cb6 moveal 75cb6 <_Timer_server>,%a3 if ( !timer_server ) 5128a: 4a8b tstl %a3 5128c: 6606 bnes 51294 5128e: 700e moveq #14,%d0 51290: 6000 008e braw 51320 return RTEMS_INCORRECT_STATE; if ( !routine ) 51294: 4a84 tstl %d4 51296: 6606 bnes 5129e 51298: 7009 moveq #9,%d0 5129a: 6000 0084 braw 51320 return RTEMS_INVALID_ADDRESS; if ( ticks == 0 ) 5129e: 4a82 tstl %d2 512a0: 6604 bnes 512a6 512a2: 700a moveq #10,%d0 512a4: 607a bras 51320 512a6: 486e fffc pea %fp@(-4) 512aa: 2f03 movel %d3,%sp@- 512ac: 4879 0007 5c7c pea 75c7c <_Timer_Information> 512b2: 4eb9 0005 378c jsr 5378c <_Objects_Get> return RTEMS_INVALID_NUMBER; the_timer = _Timer_Get( id, &location ); switch ( location ) { 512b8: 4fef 000c lea %sp@(12),%sp 512bc: 2440 moveal %d0,%a2 512be: 4aae fffc tstl %fp@(-4) 512c2: 6704 beqs 512c8 512c4: 7004 moveq #4,%d0 512c6: 6058 bras 51320 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 512c8: 486a 0010 pea %a2@(16) 512cc: 4eb9 0005 53a0 jsr 553a0 <_Watchdog_Remove> _ISR_Disable( level ); 512d2: 203c 0000 0700 movel #1792,%d0 512d8: 40c1 movew %sr,%d1 512da: 8081 orl %d1,%d0 512dc: 46c0 movew %d0,%sr 512de: 49f9 0005 4012 lea 54012 <_Thread_Enable_dispatch>,%a4 /* * 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 ) { 512e4: 588f addql #4,%sp 512e6: 4aaa 0018 tstl %a2@(24) 512ea: 6706 beqs 512f2 _ISR_Enable( level ); 512ec: 46c1 movew %d1,%sr _Thread_Enable_dispatch(); 512ee: 4e94 jsr %a4@ 512f0: 602c bras 5131e /* * 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; 512f2: 7001 moveq #1,%d0 ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 512f4: 256e 0014 0034 movel %fp@(20),%a2@(52) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 512fa: 2544 002c movel %d4,%a2@(44) the_watchdog->id = id; 512fe: 2543 0030 movel %d3,%a2@(48) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = ticks; 51302: 2542 001c movel %d2,%a2@(28) /* * 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; 51306: 2540 0038 movel %d0,%a2@(56) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 5130a: 42aa 0018 clrl %a2@(24) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = ticks; _ISR_Enable( level ); 5130e: 46c1 movew %d1,%sr (*timer_server->schedule_operation)( timer_server, the_timer ); 51310: 2f0a movel %a2,%sp@- 51312: 2f0b movel %a3,%sp@- 51314: 206b 0004 moveal %a3@(4),%a0 51318: 4e90 jsr %a0@ _Thread_Enable_dispatch(); 5131a: 4e94 jsr %a4@ return RTEMS_SUCCESSFUL; 5131c: 508f addql #8,%sp the_timer->Ticker.initial = ticks; _ISR_Enable( level ); (*timer_server->schedule_operation)( timer_server, the_timer ); _Thread_Enable_dispatch(); 5131e: 4280 clrl %d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 51320: 4cee 1c1c ffe4 moveml %fp@(-28),%d2-%d4/%a2-%a4 51326: 4e5e unlk %fp 51328: 4e75 rts ... 0005132c : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 5132c: 4e56 ffe8 linkw %fp,#-24 51330: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 51334: 282e 0008 movel %fp@(8),%d4 51338: 262e 000c movel %fp@(12),%d3 5133c: 242e 0010 movel %fp@(16),%d2 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; 51340: 2679 0007 5cb6 moveal 75cb6 <_Timer_server>,%a3 if ( !timer_server ) 51346: 4a8b tstl %a3 51348: 6606 bnes 51350 5134a: 700e moveq #14,%d0 5134c: 6000 00a4 braw 513f2 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 51350: 4a39 0007 53fc tstb 753fc <_TOD_Is_set> 51356: 6606 bnes 5135e 51358: 700b moveq #11,%d0 <== NOT EXECUTED 5135a: 6000 0096 braw 513f2 <== NOT EXECUTED return RTEMS_NOT_DEFINED; if ( !routine ) 5135e: 4a82 tstl %d2 51360: 6606 bnes 51368 51362: 7009 moveq #9,%d0 51364: 6000 008c braw 513f2 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 51368: 2f03 movel %d3,%sp@- 5136a: 4eb9 0004 e7a8 jsr 4e7a8 <_TOD_Validate> 51370: 588f addql #4,%sp 51372: 4a00 tstb %d0 51374: 677a beqs 513f0 return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 51376: 2f03 movel %d3,%sp@- 51378: 4eb9 0004 e708 jsr 4e708 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) 5137e: 588f addql #4,%sp return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 51380: 2600 movel %d0,%d3 if ( seconds <= _TOD_Seconds_since_epoch() ) 51382: b0b9 0007 547a cmpl 7547a <_TOD_Now>,%d0 51388: 6366 blss 513f0 5138a: 486e fffc pea %fp@(-4) 5138e: 2f04 movel %d4,%sp@- 51390: 4879 0007 5c7c pea 75c7c <_Timer_Information> 51396: 4eb9 0005 378c jsr 5378c <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 5139c: 4fef 000c lea %sp@(12),%sp 513a0: 2440 moveal %d0,%a2 513a2: 4aae fffc tstl %fp@(-4) 513a6: 6704 beqs 513ac 513a8: 7004 moveq #4,%d0 513aa: 6046 bras 513f2 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 513ac: 486a 0010 pea %a2@(16) 513b0: 4eb9 0005 53a0 jsr 553a0 <_Watchdog_Remove> the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 513b6: 256e 0014 0034 movel %fp@(20),%a2@(52) the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 513bc: 7003 moveq #3,%d0 void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; 513be: 2544 0030 movel %d4,%a2@(48) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 513c2: 96b9 0007 547a subl 7547a <_TOD_Now>,%d3 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 513c8: 2540 0038 movel %d0,%a2@(56) _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 513cc: 2543 001c movel %d3,%a2@(28) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 513d0: 2542 002c movel %d2,%a2@(44) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 513d4: 42aa 0018 clrl %a2@(24) (*timer_server->schedule_operation)( timer_server, the_timer ); 513d8: 2f0a movel %a2,%sp@- 513da: 2f0b movel %a3,%sp@- 513dc: 206b 0004 moveal %a3@(4),%a0 513e0: 4e90 jsr %a0@ _Thread_Enable_dispatch(); 513e2: 4eb9 0005 4012 jsr 54012 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 513e8: 4fef 000c lea %sp@(12),%sp _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); (*timer_server->schedule_operation)( timer_server, the_timer ); _Thread_Enable_dispatch(); 513ec: 4280 clrl %d0 return RTEMS_SUCCESSFUL; 513ee: 6002 bras 513f2 513f0: 7014 moveq #20,%d0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 513f2: 4cee 0c1c ffe8 moveml %fp@(-24),%d2-%d4/%a2-%a3 513f8: 4e5e unlk %fp 513fa: 4e75 rts 00045a3c : #include /* for memset */ bool rtems_workspace_get_information( Heap_Information_block *the_info ) { 45a3c: 4e56 0000 linkw %fp,#0 45a40: 202e 0008 movel %fp@(8),%d0 if ( !the_info ) 45a44: 6710 beqs 45a56 return false; return _Protected_heap_Get_information( &_Workspace_Area, the_info ); 45a46: 2f00 movel %d0,%sp@- 45a48: 4879 0005 eac2 pea 5eac2 <_Workspace_Area> 45a4e: 4eb9 0004 6dd0 jsr 46dd0 <_Protected_heap_Get_information> 45a54: 508f addql #8,%sp } 45a56: 4e5e unlk %fp 45a58: 4e75 rts ... 00045040 : int sched_getparam( pid_t pid __attribute__((unused)), struct sched_param *param __attribute__((unused)) ) { 45040: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 45044: 4eb9 0004 d430 jsr 4d430 <__errno> 4504a: 7258 moveq #88,%d1 4504c: 2040 moveal %d0,%a0 } 4504e: 70ff moveq #-1,%d0 45050: 4e5e unlk %fp int sched_getparam( pid_t pid __attribute__((unused)), struct sched_param *param __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 45052: 2081 movel %d1,%a0@ } 45054: 4e75 rts ... 00045058 : #include int sched_getscheduler( pid_t pid __attribute__((unused)) ) { 45058: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 4505c: 4eb9 0004 d430 jsr 4d430 <__errno> 45062: 7258 moveq #88,%d1 45064: 2040 moveal %d0,%a0 } 45066: 70ff moveq #-1,%d0 45068: 4e5e unlk %fp int sched_getscheduler( pid_t pid __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 4506a: 2081 movel %d1,%a0@ } 4506c: 4e75 rts ... 00045714 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 45714: 4e56 0000 linkw %fp,#0 45718: 2f03 movel %d3,%sp@- 4571a: 262e 0008 movel %fp@(8),%d3 4571e: 2f02 movel %d2,%sp@- 45720: 242e 000c movel %fp@(12),%d2 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 45724: 4a83 tstl %d3 45726: 671a beqs 45742 45728: 4eb9 0004 2994 jsr 42994 4572e: b083 cmpl %d3,%d0 45730: 6710 beqs 45742 rtems_set_errno_and_return_minus_one( ESRCH ); 45732: 4eb9 0004 d5a0 jsr 4d5a0 <__errno> 45738: 7403 moveq #3,%d2 4573a: 72ff moveq #-1,%d1 4573c: 2040 moveal %d0,%a0 4573e: 2082 movel %d2,%a0@ 45740: 6026 bras 45768 if ( !interval ) 45742: 4a82 tstl %d2 45744: 6610 bnes 45756 rtems_set_errno_and_return_minus_one( EINVAL ); 45746: 4eb9 0004 d5a0 jsr 4d5a0 <__errno> 4574c: 72ff moveq #-1,%d1 4574e: 2040 moveal %d0,%a0 45750: 7016 moveq #22,%d0 45752: 2080 movel %d0,%a0@ 45754: 6012 bras 45768 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 45756: 2f02 movel %d2,%sp@- 45758: 2f39 0005 dc54 movel 5dc54 <_Thread_Ticks_per_timeslice>,%sp@- 4575e: 4eb9 0004 8850 jsr 48850 <_Timespec_From_ticks> return 0; 45764: 508f addql #8,%sp rtems_set_errno_and_return_minus_one( ESRCH ); if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 45766: 4281 clrl %d1 return 0; } 45768: 242e fff8 movel %fp@(-8),%d2 4576c: 2001 movel %d1,%d0 4576e: 262e fffc movel %fp@(-4),%d3 45772: 4e5e unlk %fp 45774: 4e75 rts ... 00045070 : int sched_setparam( pid_t pid __attribute__((unused)), const struct sched_param *param __attribute__((unused)) ) { 45070: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 45074: 4eb9 0004 d430 jsr 4d430 <__errno> 4507a: 7258 moveq #88,%d1 4507c: 2040 moveal %d0,%a0 } 4507e: 70ff moveq #-1,%d0 45080: 4e5e unlk %fp int sched_setparam( pid_t pid __attribute__((unused)), const struct sched_param *param __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 45082: 2081 movel %d1,%a0@ } 45084: 4e75 rts ... 00045088 : int sched_setscheduler( pid_t pid __attribute__((unused)), int policy __attribute__((unused)), const struct sched_param *param __attribute__((unused)) ) { 45088: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 4508c: 4eb9 0004 d430 jsr 4d430 <__errno> 45092: 7258 moveq #88,%d1 45094: 2040 moveal %d0,%a0 } 45096: 70ff moveq #-1,%d0 45098: 4e5e unlk %fp pid_t pid __attribute__((unused)), int policy __attribute__((unused)), const struct sched_param *param __attribute__((unused)) ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 4509a: 2081 movel %d1,%a0@ } 4509c: 4e75 rts ... 00047c50 : int sem_getvalue( sem_t *sem, int *sval ) { 47c50: 4e56 fffc linkw %fp,#-4 47c54: 206e 0008 moveal %fp@(8),%a0 47c58: 486e fffc pea %fp@(-4) 47c5c: 2f10 movel %a0@,%sp@- 47c5e: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 47c64: 4eb9 0004 9aa0 jsr 49aa0 <_Objects_Get> register POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _POSIX_Semaphore_Get( sem, &location ); switch ( location ) { 47c6a: 4fef 000c lea %sp@(12),%sp 47c6e: 4aae fffc tstl %fp@(-4) 47c72: 6614 bnes 47c88 case OBJECTS_LOCAL: *sval = _CORE_semaphore_Get_count( &the_semaphore->Semaphore ); 47c74: 206e 000c moveal %fp@(12),%a0 47c78: 2240 moveal %d0,%a1 47c7a: 20a9 0062 movel %a1@(98),%a0@ _Thread_Enable_dispatch(); 47c7e: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch> 47c84: 4280 clrl %d0 return 0; 47c86: 600e bras 47c96 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 47c88: 4eb9 0005 07a0 jsr 507a0 <__errno> 47c8e: 7216 moveq #22,%d1 47c90: 2040 moveal %d0,%a0 47c92: 70ff moveq #-1,%d0 47c94: 2081 movel %d1,%a0@ } 47c96: 4e5e unlk %fp 47c98: 4e75 rts ... 00047dd0 : */ int sem_post( sem_t *sem ) { 47dd0: 4e56 fffc linkw %fp,#-4 47dd4: 206e 0008 moveal %fp@(8),%a0 47dd8: 486e fffc pea %fp@(-4) 47ddc: 2f10 movel %a0@,%sp@- 47dde: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 47de4: 4eb9 0004 9aa0 jsr 49aa0 <_Objects_Get> register POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; the_semaphore = _POSIX_Semaphore_Get( sem, &location ); switch ( location ) { 47dea: 4fef 000c lea %sp@(12),%sp 47dee: 4aae fffc tstl %fp@(-4) 47df2: 6620 bnes 47e14 case OBJECTS_LOCAL: _CORE_semaphore_Surrender( 47df4: 2040 moveal %d0,%a0 47df6: 42a7 clrl %sp@- 47df8: 2f28 0008 movel %a0@(8),%sp@- 47dfc: 4868 001a pea %a0@(26) 47e00: 4eb9 0004 91cc jsr 491cc <_CORE_semaphore_Surrender> NULL /* XXX need to define a routine to handle this case */ #else NULL #endif ); _Thread_Enable_dispatch(); 47e06: 4eb9 0004 a2f2 jsr 4a2f2 <_Thread_Enable_dispatch> return 0; 47e0c: 4fef 000c lea %sp@(12),%sp NULL /* XXX need to define a routine to handle this case */ #else NULL #endif ); _Thread_Enable_dispatch(); 47e10: 4280 clrl %d0 return 0; 47e12: 600e bras 47e22 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 47e14: 4eb9 0005 07a0 jsr 507a0 <__errno> 47e1a: 7216 moveq #22,%d1 47e1c: 2040 moveal %d0,%a0 47e1e: 70ff moveq #-1,%d0 47e20: 2081 movel %d1,%a0@ } 47e22: 4e5e unlk %fp 47e24: 4e75 rts ... 00047e58 : */ int sem_trywait( sem_t *sem ) { 47e58: 4e56 0000 linkw %fp,#0 return _POSIX_Semaphore_Wait_support(sem, false, THREAD_QUEUE_WAIT_FOREVER); 47e5c: 42a7 clrl %sp@- 47e5e: 42a7 clrl %sp@- 47e60: 2f2e 0008 movel %fp@(8),%sp@- 47e64: 4eb9 0004 d604 jsr 4d604 <_POSIX_Semaphore_Wait_support> } 47e6a: 4e5e unlk %fp 47e6c: 4e75 rts ... 00047e70 : */ int sem_unlink( const char *name ) { 47e70: 4e56 fff0 linkw %fp,#-16 47e74: 2039 0006 1a90 movel 61a90 <_Thread_Dispatch_disable_level>,%d0 47e7a: 5280 addql #1,%d0 47e7c: 48d7 0c04 moveml %d2/%a2-%a3,%sp@ 47e80: 23c0 0006 1a90 movel %d0,61a90 <_Thread_Dispatch_disable_level> register POSIX_Semaphore_Control *the_semaphore; sem_t the_semaphore_id; _Thread_Disable_dispatch(); status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 47e86: 486e fffc pea %fp@(-4) 47e8a: 45f9 0004 a2f2 lea 4a2f2 <_Thread_Enable_dispatch>,%a2 47e90: 2f2e 0008 movel %fp@(8),%sp@- 47e94: 4eb9 0004 d590 jsr 4d590 <_POSIX_Semaphore_Name_to_id> if ( status != 0 ) { 47e9a: 508f addql #8,%sp register POSIX_Semaphore_Control *the_semaphore; sem_t the_semaphore_id; _Thread_Disable_dispatch(); status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 47e9c: 2400 movel %d0,%d2 if ( status != 0 ) { 47e9e: 6710 beqs 47eb0 _Thread_Enable_dispatch(); 47ea0: 4e92 jsr %a2@ rtems_set_errno_and_return_minus_one( status ); 47ea2: 4eb9 0005 07a0 jsr 507a0 <__errno> 47ea8: 2040 moveal %d0,%a0 47eaa: 70ff moveq #-1,%d0 47eac: 2082 movel %d2,%a0@ 47eae: 6034 bras 47ee4 } the_semaphore = (POSIX_Semaphore_Control *) _Objects_Get_local_object( 47eb0: 4280 clrl %d0 47eb2: 2079 0006 1d02 moveal 61d02 <_POSIX_Semaphore_Information+0x18>,%a0 47eb8: 302e fffe movew %fp@(-2),%d0 47ebc: 2670 0c00 moveal %a0@(00000000,%d0:l:4),%a3 &_POSIX_Semaphore_Information, _Objects_Get_index( the_semaphore_id ) ); the_semaphore->linked = false; 47ec0: 4200 clrb %d0 47ec2: 1740 0015 moveb %d0,%a3@(21) RTEMS_INLINE_ROUTINE void _POSIX_Semaphore_Namespace_remove ( POSIX_Semaphore_Control *the_semaphore ) { _Objects_Namespace_remove( 47ec6: 2f0b movel %a3,%sp@- 47ec8: 4879 0006 1cea pea 61cea <_POSIX_Semaphore_Information> 47ece: 4eb9 0004 9bf8 jsr 49bf8 <_Objects_Namespace_remove> _POSIX_Semaphore_Namespace_remove( the_semaphore ); _POSIX_Semaphore_Delete( the_semaphore ); 47ed4: 2f0b movel %a3,%sp@- 47ed6: 4eb9 0004 d540 jsr 4d540 <_POSIX_Semaphore_Delete> _Thread_Enable_dispatch(); 47edc: 4e92 jsr %a2@ return 0; 47ede: 4fef 000c lea %sp@(12),%sp the_semaphore->linked = false; _POSIX_Semaphore_Namespace_remove( the_semaphore ); _POSIX_Semaphore_Delete( the_semaphore ); _Thread_Enable_dispatch(); 47ee2: 4280 clrl %d0 return 0; } 47ee4: 4cee 0c04 fff0 moveml %fp@(-16),%d2/%a2-%a3 47eea: 4e5e unlk %fp 47eec: 4e75 rts ... 000455e4 : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 455e4: 4e56 ffec linkw %fp,#-20 455e8: 222e 0010 movel %fp@(16),%d1 455ec: 48d7 0c1c moveml %d2-%d4/%a2-%a3,%sp@ 455f0: 242e 0008 movel %fp@(8),%d2 455f4: 246e 000c moveal %fp@(12),%a2 ISR_Level level; if ( oact ) 455f8: 4a81 tstl %d1 455fa: 6722 beqs 4561e *oact = _POSIX_signals_Vectors[ sig ]; 455fc: 2602 movel %d2,%d3 455fe: 2002 movel %d2,%d0 45600: 4878 000c pea c 45604: e58b lsll #2,%d3 45606: e988 lsll #4,%d0 45608: 9083 subl %d3,%d0 4560a: 0680 0005 ed42 addil #388418,%d0 45610: 2f00 movel %d0,%sp@- 45612: 2f01 movel %d1,%sp@- 45614: 4eb9 0004 df4c jsr 4df4c 4561a: 4fef 000c lea %sp@(12),%sp if ( !sig ) 4561e: 4a82 tstl %d2 45620: 6710 beqs 45632 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 45622: 2002 movel %d2,%d0 45624: 5380 subql #1,%d0 45626: 721f moveq #31,%d1 45628: b280 cmpl %d0,%d1 4562a: 6506 bcss 45632 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 4562c: 7009 moveq #9,%d0 4562e: b082 cmpl %d2,%d0 45630: 6610 bnes 45642 rtems_set_errno_and_return_minus_one( EINVAL ); 45632: 4eb9 0004 d714 jsr 4d714 <__errno> 45638: 72ff moveq #-1,%d1 4563a: 2040 moveal %d0,%a0 4563c: 7016 moveq #22,%d0 4563e: 2080 movel %d0,%a0@ 45640: 6060 bras 456a2 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 45642: 4a8a tstl %a2 45644: 675a beqs 456a0 /* * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); 45646: 203c 0000 0700 movel #1792,%d0 4564c: 40c3 movew %sr,%d3 4564e: 8083 orl %d3,%d0 45650: 46c0 movew %d0,%sr 45652: 780c moveq #12,%d4 45654: 47f9 0004 df4c lea 4df4c ,%a3 4565a: 4c02 4800 mulsl %d2,%d4 if ( act->sa_handler == SIG_DFL ) { 4565e: 4aaa 0008 tstl %a2@(8) 45662: 661e bnes 45682 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 45664: 4878 000c pea c 45668: 2004 movel %d4,%d0 4566a: 0680 0005 c294 addil #377492,%d0 45670: 2f00 movel %d0,%sp@- 45672: 0684 0005 ed42 addil #388418,%d4 45678: 2f04 movel %d4,%sp@- 4567a: 4e93 jsr %a3@ 4567c: 4fef 000c lea %sp@(12),%sp 45680: 601c bras 4569e } else { _POSIX_signals_Clear_process_signals( sig ); 45682: 2f02 movel %d2,%sp@- _POSIX_signals_Vectors[ sig ] = *act; 45684: 0684 0005 ed42 addil #388418,%d4 _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); 4568a: 4eb9 0004 a6e0 jsr 4a6e0 <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; 45690: 4878 000c pea c 45694: 2f0a movel %a2,%sp@- 45696: 2f04 movel %d4,%sp@- 45698: 4e93 jsr %a3@ 4569a: 4fef 0010 lea %sp@(16),%sp } _ISR_Enable( level ); 4569e: 46c3 movew %d3,%sr 456a0: 4281 clrl %d1 * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; } 456a2: 2001 movel %d1,%d0 456a4: 4cee 0c1c ffec moveml %fp@(-20),%d2-%d4/%a2-%a3 456aa: 4e5e unlk %fp 456ac: 4e75 rts ... 00047234 : int sigdelset( sigset_t *set, int signo ) { 47234: 4e56 0000 linkw %fp,#0 47238: 226e 0008 moveal %fp@(8),%a1 4723c: 202e 000c movel %fp@(12),%d0 if ( !set ) 47240: 4a89 tstl %a1 47242: 6710 beqs 47254 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !signo ) 47244: 4a80 tstl %d0 47246: 6604 bnes 4724c 47248: 91c8 subal %a0,%a0 4724a: 6024 bras 47270 4724c: 5380 subql #1,%d0 return 0; if ( !is_valid_signo(signo) ) 4724e: 721f moveq #31,%d1 47250: b280 cmpl %d0,%d1 47252: 6412 bccs 47266 rtems_set_errno_and_return_minus_one( EINVAL ); 47254: 4eb9 0004 f238 jsr 4f238 <__errno> 4725a: 307c ffff moveaw #-1,%a0 4725e: 2240 moveal %d0,%a1 47260: 7016 moveq #22,%d0 47262: 2280 movel %d0,%a1@ 47264: 600a bras 47270 *set &= ~signo_to_mask(signo); 47266: 7201 moveq #1,%d1 47268: 91c8 subal %a0,%a0 4726a: e1a9 lsll %d0,%d1 4726c: 4681 notl %d1 4726e: c391 andl %d1,%a1@ return 0; } 47270: 2008 movel %a0,%d0 47272: 4e5e unlk %fp 47274: 4e75 rts ... 0004729c : #include int sigfillset( sigset_t *set ) { 4729c: 4e56 0000 linkw %fp,#0 472a0: 206e 0008 moveal %fp@(8),%a0 if ( !set ) 472a4: 4a88 tstl %a0 472a6: 6610 bnes 472b8 rtems_set_errno_and_return_minus_one( EINVAL ); 472a8: 4eb9 0004 f238 jsr 4f238 <__errno> 472ae: 7216 moveq #22,%d1 472b0: 2040 moveal %d0,%a0 472b2: 70ff moveq #-1,%d0 472b4: 2081 movel %d1,%a0@ 472b6: 6006 bras 472be *set = SIGNAL_ALL_MASK; 472b8: 70ff moveq #-1,%d0 472ba: 2080 movel %d0,%a0@ 472bc: 4280 clrl %d0 return 0; } 472be: 4e5e unlk %fp 472c0: 4e75 rts ... 000472c4 : int sigismember( const sigset_t *set, int signo ) { 472c4: 4e56 0000 linkw %fp,#0 472c8: 206e 0008 moveal %fp@(8),%a0 472cc: 222e 000c movel %fp@(12),%d1 if ( !set ) 472d0: 4a88 tstl %a0 472d2: 670c beqs 472e0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !signo ) 472d4: 4a81 tstl %d1 472d6: 6724 beqs 472fc 472d8: 5381 subql #1,%d1 return 0; if ( !is_valid_signo(signo) ) 472da: 701f moveq #31,%d0 472dc: b081 cmpl %d1,%d0 472de: 6410 bccs 472f0 rtems_set_errno_and_return_minus_one( EINVAL ); 472e0: 4eb9 0004 f238 jsr 4f238 <__errno> 472e6: 72ff moveq #-1,%d1 472e8: 2040 moveal %d0,%a0 472ea: 7016 moveq #22,%d0 472ec: 2080 movel %d0,%a0@ 472ee: 600c bras 472fc 472f0: 7001 moveq #1,%d0 472f2: e3a8 lsll %d1,%d0 472f4: c090 andl %a0@,%d0 472f6: 56c1 sne %d1 472f8: 49c1 extbl %d1 472fa: 4481 negl %d1 if ( *set & signo_to_mask(signo) ) return 1; return 0; } 472fc: 2001 movel %d1,%d0 472fe: 4e5e unlk %fp 47300: 4e75 rts ... 00045490 : sighandler_t signal( int signum, sighandler_t handler ) { 45490: 4e56 ffe8 linkw %fp,#-24 struct sigaction s; struct sigaction old; s.sa_handler = handler ; 45494: 2d6e 000c fffc movel %fp@(12),%fp@(-4) sigemptyset(&s.sa_mask); 4549a: 486e fff8 pea %fp@(-8) 4549e: 4eb9 0004 546c jsr 4546c s.sa_flags = SA_RESTART; #else s.sa_flags = 0; #endif sigaction( signum, &s, &old ); 454a4: 486e ffe8 pea %fp@(-24) 454a8: 486e fff4 pea %fp@(-12) 454ac: 2f2e 0008 movel %fp@(8),%sp@- s.sa_flags = SA_RESTART | SA_INTERRUPT | SA_NOMASK; s.sa_restorer= NULL ; #elif defined(signal_like_SVR4) s.sa_flags = SA_RESTART; #else s.sa_flags = 0; 454b0: 42ae fff4 clrl %fp@(-12) #endif sigaction( signum, &s, &old ); 454b4: 4eb9 0004 5360 jsr 45360 return (sighandler_t) old.sa_handler; } 454ba: 202e fff0 movel %fp@(-16),%d0 454be: 4e5e unlk %fp 454c0: 4e75 rts ... 00047348 : int sigqueue( pid_t pid, int signo, const union sigval value ) { 47348: 4e56 0000 linkw %fp,#0 return killinfo( pid, signo, &value ); 4734c: 486e 0010 pea %fp@(16) 47350: 2f2e 000c movel %fp@(12),%sp@- 47354: 2f2e 0008 movel %fp@(8),%sp@- 47358: 4eb9 0004 c3c8 jsr 4c3c8 } 4735e: 4e5e unlk %fp 47360: 4e75 rts ... 00047364 : #include int sigsuspend( const sigset_t *sigmask ) { 47364: 4e56 ffec linkw %fp,#-20 47368: 48d7 040c moveml %d2-%d3/%a2,%sp@ int status; POSIX_API_Control *api; api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; status = sigprocmask( SIG_BLOCK, sigmask, &saved_signals_blocked ); 4736c: 240e movel %fp,%d2 4736e: 5982 subql #4,%d2 47370: 45f9 0004 733c lea 4733c ,%a2 (void) sigfillset( &all_signals ); 47376: 260e movel %fp,%d3 47378: 5183 subql #8,%d3 int status; POSIX_API_Control *api; api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; status = sigprocmask( SIG_BLOCK, sigmask, &saved_signals_blocked ); 4737a: 2f02 movel %d2,%sp@- 4737c: 2f2e 0008 movel %fp@(8),%sp@- 47380: 4878 0001 pea 1 47384: 4e92 jsr %a2@ (void) sigfillset( &all_signals ); 47386: 2f03 movel %d3,%sp@- 47388: 4eb9 0004 729c jsr 4729c status = sigtimedwait( &all_signals, NULL, NULL ); 4738e: 42a7 clrl %sp@- 47390: 42a7 clrl %sp@- 47392: 2f03 movel %d3,%sp@- 47394: 4eb9 0004 7414 jsr 47414 4739a: 2600 movel %d0,%d3 (void) sigprocmask( SIG_SETMASK, &saved_signals_blocked, NULL ); 4739c: 42a7 clrl %sp@- 4739e: 2f02 movel %d2,%sp@- 473a0: 42a7 clrl %sp@- 473a2: 4e92 jsr %a2@ /* * sigtimedwait() returns the signal number while sigsuspend() * is supposed to return -1 and EINTR when a signal is caught. */ if ( status != -1 ) 473a4: 4fef 0028 lea %sp@(40),%sp 473a8: 70ff moveq #-1,%d0 473aa: b083 cmpl %d3,%d0 473ac: 670c beqs 473ba rtems_set_errno_and_return_minus_one( EINTR ); 473ae: 4eb9 0004 f238 jsr 4f238 <__errno> 473b4: 2040 moveal %d0,%a0 473b6: 7004 moveq #4,%d0 473b8: 2080 movel %d0,%a0@ return status; } 473ba: 70ff moveq #-1,%d0 473bc: 4cee 040c ffec moveml %fp@(-20),%d2-%d3/%a2 473c2: 4e5e unlk %fp 473c4: 4e75 rts ... 000475a0 : int sigwait( const sigset_t *set, int *sig ) { 475a0: 4e56 0000 linkw %fp,#0 475a4: 2f0a movel %a2,%sp@- 475a6: 246e 000c moveal %fp@(12),%a2 int status; status = sigtimedwait( set, NULL, NULL ); 475aa: 42a7 clrl %sp@- 475ac: 42a7 clrl %sp@- 475ae: 2f2e 0008 movel %fp@(8),%sp@- 475b2: 4eb9 0004 7414 jsr 47414 if ( status != -1 ) { 475b8: 4fef 000c lea %sp@(12),%sp 475bc: 72ff moveq #-1,%d1 475be: b280 cmpl %d0,%d1 475c0: 670a beqs 475cc if ( sig ) 475c2: 4a8a tstl %a2 475c4: 6702 beqs 475c8 *sig = status; 475c6: 2480 movel %d0,%a2@ 475c8: 4280 clrl %d0 475ca: 600a bras 475d6 return 0; } return errno; 475cc: 4eb9 0004 f238 jsr 4f238 <__errno> 475d2: 2040 moveal %d0,%a0 475d4: 2010 movel %a0@,%d0 } 475d6: 246e fffc moveal %fp@(-4),%a2 475da: 4e5e unlk %fp 475dc: 4e75 rts ... 00044b28 : long sysconf( int name ) { if ( name == _SC_CLK_TCK ) 44b28: 7002 moveq #2,%d0 */ long sysconf( int name ) { 44b2a: 4e56 0000 linkw %fp,#0 44b2e: 222e 0008 movel %fp@(8),%d1 44b32: 2f02 movel %d2,%sp@- if ( name == _SC_CLK_TCK ) 44b34: b081 cmpl %d1,%d0 44b36: 6612 bnes 44b4a return (TOD_MICROSECONDS_PER_SECOND / 44b38: 41f9 0005 ba44 lea 5ba44 ,%a0 44b3e: 203c 000f 4240 movel #1000000,%d0 44b44: 4c50 0000 remul %a0@,%d0,%d0 44b48: 6034 bras 44b7e rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 44b4a: 7004 moveq #4,%d0 44b4c: b081 cmpl %d1,%d0 44b4e: 6608 bnes 44b58 return rtems_libio_number_iops; 44b50: 2039 0005 b964 movel 5b964 ,%d0 44b56: 6026 bras 44b7e if ( name == _SC_GETPW_R_SIZE_MAX ) 44b58: 203c 0000 0400 movel #1024,%d0 44b5e: 7433 moveq #51,%d2 44b60: b481 cmpl %d1,%d2 44b62: 671a beqs 44b7e return 1024; if ( name == _SC_PAGESIZE ) 44b64: 143c 0008 moveb #8,%d2 44b68: 303c 1000 movew #4096,%d0 44b6c: b481 cmpl %d1,%d2 44b6e: 670e beqs 44b7e #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 44b70: 4eb9 0004 cedc jsr 4cedc <__errno> 44b76: 7216 moveq #22,%d1 44b78: 2040 moveal %d0,%a0 44b7a: 70ff moveq #-1,%d0 44b7c: 2081 movel %d1,%a0@ } 44b7e: 242e fffc movel %fp@(-4),%d2 44b82: 4e5e unlk %fp 44b84: 4e75 rts ... 00044bd0 : timer_t *timerid ) { POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 44bd0: 7001 moveq #1,%d0 int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 44bd2: 4e56 0000 linkw %fp,#0 44bd6: 2f0b movel %a3,%sp@- 44bd8: 266e 0010 moveal %fp@(16),%a3 44bdc: 2f0a movel %a2,%sp@- 44bde: 246e 000c moveal %fp@(12),%a2 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 44be2: b0ae 0008 cmpl %fp@(8),%d0 44be6: 6620 bnes 44c08 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 44be8: 4a8b tstl %a3 44bea: 671c beqs 44c08 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 44bec: 4a8a tstl %a2 44bee: 672a beqs 44c1a /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 44bf0: 2012 movel %a2@,%d0 44bf2: 7201 moveq #1,%d1 44bf4: 5380 subql #1,%d0 44bf6: b280 cmpl %d0,%d1 44bf8: 650e bcss 44c08 ( evp->sigev_notify != SIGEV_SIGNAL ) ) { /* The value of the field sigev_notify is not valid */ rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !evp->sigev_signo ) 44bfa: 202a 0004 movel %a2@(4),%d0 44bfe: 6708 beqs 44c08 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 44c00: 5380 subql #1,%d0 44c02: 721f moveq #31,%d1 44c04: b280 cmpl %d0,%d1 44c06: 6412 bccs 44c1a rtems_set_errno_and_return_minus_one( EINVAL ); 44c08: 4eb9 0004 d134 jsr 4d134 <__errno> 44c0e: 72ff moveq #-1,%d1 44c10: 2040 moveal %d0,%a0 44c12: 7016 moveq #22,%d0 44c14: 2080 movel %d0,%a0@ 44c16: 6000 00a4 braw 44cbc rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 44c1a: 2039 0005 d7f4 movel 5d7f4 <_Thread_Dispatch_disable_level>,%d0 44c20: 5280 addql #1,%d0 44c22: 23c0 0005 d7f4 movel %d0,5d7f4 <_Thread_Dispatch_disable_level> * the inactive chain of free timer control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Allocate( void ) { return (POSIX_Timer_Control *) _Objects_Allocate( &_POSIX_Timer_Information ); 44c28: 4879 0005 da88 pea 5da88 <_POSIX_Timer_Information> 44c2e: 4eb9 0004 67f4 jsr 467f4 <_Objects_Allocate> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 44c34: 588f addql #4,%sp 44c36: 2040 moveal %d0,%a0 44c38: 4a80 tstl %d0 44c3a: 6616 bnes 44c52 _Thread_Enable_dispatch(); 44c3c: 4eb9 0004 73ca jsr 473ca <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); 44c42: 4eb9 0004 d134 jsr 4d134 <__errno> 44c48: 72ff moveq #-1,%d1 44c4a: 2040 moveal %d0,%a0 44c4c: 700b moveq #11,%d0 44c4e: 2080 movel %d0,%a0@ 44c50: 606a bras 44cbc } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 44c52: 7002 moveq #2,%d0 44c54: 1140 003c moveb %d0,%a0@(60) ptimer->thread_id = _Thread_Executing->Object.id; 44c58: 2279 0005 d8ae moveal 5d8ae <_Thread_Executing>,%a1 44c5e: 2169 0008 0038 movel %a1@(8),%a0@(56) if ( evp != NULL ) { 44c64: 4a8a tstl %a2 44c66: 6710 beqs 44c78 ptimer->inf.sigev_notify = evp->sigev_notify; 44c68: 2152 003e movel %a2@,%a0@(62) ptimer->inf.sigev_signo = evp->sigev_signo; ptimer->inf.sigev_value = evp->sigev_value; 44c6c: 216a 0008 0046 movel %a2@(8),%a0@(70) ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; if ( evp != NULL ) { ptimer->inf.sigev_notify = evp->sigev_notify; ptimer->inf.sigev_signo = evp->sigev_signo; 44c72: 216a 0004 0042 movel %a2@(4),%a0@(66) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 44c78: 2028 0008 movel %a0@(8),%d0 44c7c: 4281 clrl %d1 44c7e: 2279 0005 daa0 moveal 5daa0 <_POSIX_Timer_Information+0x18>,%a1 44c84: 3200 movew %d0,%d1 ptimer->inf.sigev_value = evp->sigev_value; } ptimer->overrun = 0; 44c86: 42a8 0066 clrl %a0@(102) 44c8a: 2388 1c00 movel %a0,%a1@(00000000,%d1:l:4) ptimer->timer_data.it_value.tv_sec = 0; 44c8e: 42a8 005a clrl %a0@(90) _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 44c92: 42a8 000c clrl %a0@(12) ptimer->timer_data.it_value.tv_nsec = 0; 44c96: 42a8 005e clrl %a0@(94) ptimer->timer_data.it_interval.tv_sec = 0; 44c9a: 42a8 0052 clrl %a0@(82) ptimer->timer_data.it_interval.tv_nsec = 0; 44c9e: 42a8 0056 clrl %a0@(86) void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; 44ca2: 42a8 0030 clrl %a0@(48) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 44ca6: 42a8 0018 clrl %a0@(24) _Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL ); _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; 44caa: 2680 movel %d0,%a3@ the_watchdog->routine = routine; 44cac: 42a8 002c clrl %a0@(44) the_watchdog->id = id; the_watchdog->user_data = user_data; 44cb0: 42a8 0034 clrl %a0@(52) _Thread_Enable_dispatch(); 44cb4: 4eb9 0004 73ca jsr 473ca <_Thread_Enable_dispatch> 44cba: 4281 clrl %d1 return 0; } 44cbc: 246e fff8 moveal %fp@(-8),%a2 44cc0: 2001 movel %d1,%d0 44cc2: 266e fffc moveal %fp@(-4),%a3 44cc6: 4e5e unlk %fp 44cc8: 4e75 rts ... 000454b4 : int timer_delete( timer_t timerid ) { 454b4: 4e56 fffc linkw %fp,#-4 454b8: 2f0a movel %a2,%sp@- RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get ( timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) 454ba: 486e fffc pea %fp@(-4) 454be: 2f2e 0008 movel %fp@(8),%sp@- 454c2: 4879 0005 e420 pea 5e420 <_POSIX_Timer_Information> 454c8: 4eb9 0004 73d0 jsr 473d0 <_Objects_Get> */ POSIX_Timer_Control *ptimer; Objects_Locations location; ptimer = _POSIX_Timer_Get( timerid, &location ); switch ( location ) { 454ce: 4fef 000c lea %sp@(12),%sp 454d2: 2440 moveal %d0,%a2 454d4: 4aae fffc tstl %fp@(-4) 454d8: 663a bnes 45514 case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Timer_Information, &ptimer->Object ); 454da: 2f00 movel %d0,%sp@- 454dc: 4879 0005 e420 pea 5e420 <_POSIX_Timer_Information> 454e2: 4eb9 0004 7004 jsr 47004 <_Objects_Close> ptimer->state = POSIX_TIMER_STATE_FREE; 454e8: 7001 moveq #1,%d0 454ea: 1540 003c moveb %d0,%a2@(60) (void) _Watchdog_Remove( &ptimer->Timer ); 454ee: 486a 0010 pea %a2@(16) 454f2: 4eb9 0004 8c98 jsr 48c98 <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _POSIX_Timer_Free ( POSIX_Timer_Control *the_timer ) { _Objects_Free( &_POSIX_Timer_Information, &the_timer->Object ); 454f8: 2f0a movel %a2,%sp@- 454fa: 4879 0005 e420 pea 5e420 <_POSIX_Timer_Information> 45500: 4eb9 0004 7278 jsr 47278 <_Objects_Free> _POSIX_Timer_Free( ptimer ); _Thread_Enable_dispatch(); 45506: 4eb9 0004 7b5a jsr 47b5a <_Thread_Enable_dispatch> return 0; 4550c: 4fef 0014 lea %sp@(20),%sp case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Timer_Information, &ptimer->Object ); ptimer->state = POSIX_TIMER_STATE_FREE; (void) _Watchdog_Remove( &ptimer->Timer ); _POSIX_Timer_Free( ptimer ); _Thread_Enable_dispatch(); 45510: 4280 clrl %d0 return 0; 45512: 600e bras 45522 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 45514: 4eb9 0004 dc70 jsr 4dc70 <__errno> 4551a: 7216 moveq #22,%d1 4551c: 2040 moveal %d0,%a0 4551e: 70ff moveq #-1,%d0 45520: 2081 movel %d1,%a0@ } 45522: 246e fff8 moveal %fp@(-8),%a2 45526: 4e5e unlk %fp 45528: 4e75 rts ... 00045fc8 : * its execution, _POSIX_Timer_TSR will have to set this counter to 0. */ int timer_getoverrun( timer_t timerid ) { 45fc8: 4e56 fffc linkw %fp,#-4 45fcc: 2f02 movel %d2,%sp@- RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get ( timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) 45fce: 486e fffc pea %fp@(-4) 45fd2: 2f2e 0008 movel %fp@(8),%sp@- 45fd6: 4879 0005 f888 pea 5f888 <_POSIX_Timer_Information> 45fdc: 4eb9 0004 7e6c jsr 47e6c <_Objects_Get> int overrun; POSIX_Timer_Control *ptimer; Objects_Locations location; ptimer = _POSIX_Timer_Get( timerid, &location ); switch ( location ) { 45fe2: 4fef 000c lea %sp@(12),%sp 45fe6: 4aae fffc tstl %fp@(-4) 45fea: 6612 bnes 45ffe case OBJECTS_LOCAL: overrun = ptimer->overrun; 45fec: 2040 moveal %d0,%a0 45fee: 2428 0066 movel %a0@(102),%d2 ptimer->overrun = 0; 45ff2: 42a8 0066 clrl %a0@(102) _Thread_Enable_dispatch(); 45ff6: 4eb9 0004 85f6 jsr 485f6 <_Thread_Enable_dispatch> return overrun; 45ffc: 600e bras 4600c #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 45ffe: 4eb9 0004 e3e0 jsr 4e3e0 <__errno> 46004: 74ff moveq #-1,%d2 46006: 2040 moveal %d0,%a0 46008: 7016 moveq #22,%d0 4600a: 2080 movel %d0,%a0@ } 4600c: 2002 movel %d2,%d0 4600e: 242e fff8 movel %fp@(-8),%d2 46012: 4e5e unlk %fp 46014: 4e75 rts ... 00044d60 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 44d60: 4e56 ffe8 linkw %fp,#-24 44d64: 48d7 041c moveml %d2-%d4/%a2,%sp@ 44d68: 262e 0008 movel %fp@(8),%d3 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 44d6c: 4ab9 0005 ec76 tstl 5ec76 <_POSIX_signals_Ualarm_timer+0x1c> 44d72: 6622 bnes 44d96 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 44d74: 42b9 0005 ec62 clrl 5ec62 <_POSIX_signals_Ualarm_timer+0x8> the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 44d7a: 4282 clrl %d2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 44d7c: 203c 0004 4e4c movel #282188,%d0 the_watchdog->id = id; 44d82: 42b9 0005 ec7a clrl 5ec7a <_POSIX_signals_Ualarm_timer+0x20> Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 44d88: 23c0 0005 ec76 movel %d0,5ec76 <_POSIX_signals_Ualarm_timer+0x1c> the_watchdog->id = id; the_watchdog->user_data = user_data; 44d8e: 42b9 0005 ec7e clrl 5ec7e <_POSIX_signals_Ualarm_timer+0x24> 44d94: 6058 bras 44dee _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 44d96: 4879 0005 ec5a pea 5ec5a <_POSIX_signals_Ualarm_timer> 44d9c: 4eb9 0004 8330 jsr 48330 <_Watchdog_Remove> if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 44da2: 588f addql #4,%sp 44da4: 7201 moveq #1,%d1 44da6: 5580 subql #2,%d0 44da8: b280 cmpl %d0,%d1 44daa: 6404 bccs 44db0 44dac: 4282 clrl %d2 <== NOT EXECUTED 44dae: 603e bras 44dee <== NOT EXECUTED * boot. Since alarm() is dealing in seconds, we must account for * this. */ ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); 44db0: 2039 0005 ec6e movel 5ec6e <_POSIX_signals_Ualarm_timer+0x14>,%d0 44db6: d0b9 0005 ec66 addl 5ec66 <_POSIX_signals_Ualarm_timer+0xc>,%d0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 44dbc: 486e fff8 pea %fp@(-8) 44dc0: 90b9 0005 ec72 subl 5ec72 <_POSIX_signals_Ualarm_timer+0x18>,%d0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 44dc6: 283c 000f 4240 movel #1000000,%d4 ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 44dcc: 2f00 movel %d0,%sp@- 44dce: 4eb9 0004 7e58 jsr 47e58 <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 44dd4: 202e fff8 movel %fp@(-8),%d0 44dd8: 4c04 0800 mulsl %d4,%d0 remaining += tp.tv_nsec / 1000; 44ddc: 283c 0000 03e8 movel #1000,%d4 44de2: 508f addql #8,%sp 44de4: 242e fffc movel %fp@(-4),%d2 44de8: 4c44 2802 remsl %d4,%d2,%d2 44dec: d480 addl %d0,%d2 /* * If useconds is non-zero, then the caller wants to schedule * the alarm repeatedly at that interval. If the interval is * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { 44dee: 4a83 tstl %d3 44df0: 674e beqs 44e40 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); 44df2: 280e movel %fp,%d4 * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 44df4: 223c 000f 4240 movel #1000000,%d1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); 44dfa: 5184 subql #8,%d4 44dfc: 45f9 0004 7edc lea 47edc <_Timespec_To_ticks>,%a2 * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 44e02: 4c41 3000 remul %d1,%d0,%d3 44e06: 4c41 3003 remul %d1,%d3,%d3 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 44e0a: 223c 0000 03e8 movel #1000,%d1 44e10: 4c00 1800 mulsl %d0,%d1 ticks = _Timespec_To_ticks( &tp ); 44e14: 2f04 movel %d4,%sp@- */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 44e16: 2d41 fffc movel %d1,%fp@(-4) * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 44e1a: 2d43 fff8 movel %d3,%fp@(-8) tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); 44e1e: 4e92 jsr %a2@ if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 44e20: 2f04 movel %d4,%sp@- 44e22: 4e92 jsr %a2@ ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 44e24: 4879 0005 ec5a pea 5ec5a <_POSIX_signals_Ualarm_timer> 44e2a: 4879 0005 e50c pea 5e50c <_Watchdog_Ticks_chain> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 44e30: 23c0 0005 ec66 movel %d0,5ec66 <_POSIX_signals_Ualarm_timer+0xc> _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 44e36: 4eb9 0004 8214 jsr 48214 <_Watchdog_Insert> 44e3c: 4fef 0010 lea %sp@(16),%sp } return remaining; } 44e40: 2002 movel %d2,%d0 44e42: 4cee 041c ffe8 moveml %fp@(-24),%d2-%d4/%a2 44e48: 4e5e unlk %fp 44e4a: 4e75 rts 000450a0 : #include pid_t vfork(void) { return -1; } 450a0: 70ff moveq #-1,%d0 #include #include pid_t vfork(void) { 450a2: 4e56 0000 linkw %fp,#0 return -1; } 450a6: 4e5e unlk %fp 450a8: 4e75 rts ... 000450ac : #include int wait( int *stat_loc ) { 450ac: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 450b0: 4eb9 0004 d430 jsr 4d430 <__errno> 450b6: 7258 moveq #88,%d1 450b8: 2040 moveal %d0,%a0 } 450ba: 70ff moveq #-1,%d0 450bc: 4e5e unlk %fp int wait( int *stat_loc ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 450be: 2081 movel %d1,%a0@ } 450c0: 4e75 rts ... 000450c4 : int waitpid( pid_t pid, int *stat_loc, int options ) { 450c4: 4e56 0000 linkw %fp,#0 rtems_set_errno_and_return_minus_one( ENOSYS ); 450c8: 4eb9 0004 d430 jsr 4d430 <__errno> 450ce: 7258 moveq #88,%d1 450d0: 2040 moveal %d0,%a0 } 450d2: 70ff moveq #-1,%d0 450d4: 4e5e unlk %fp pid_t pid, int *stat_loc, int options ) { rtems_set_errno_and_return_minus_one( ENOSYS ); 450d6: 2081 movel %d1,%a0@ } 450d8: 4e75 rts ...