=============================================================================== 400069e8 <_API_extensions_Run_postdriver>: * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { 400069e8: 9d e3 bf a0 save %sp, -96, %sp the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } 400069ec: 23 10 00 59 sethi %hi(0x40016400), %l1 400069f0: e0 04 61 e4 ld [ %l1 + 0x1e4 ], %l0 ! 400165e4 <_API_extensions_List> 400069f4: a2 14 61 e4 or %l1, 0x1e4, %l1 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 400069f8: a2 04 60 04 add %l1, 4, %l1 400069fc: 80 a4 00 11 cmp %l0, %l1 40006a00: 02 80 00 09 be 40006a24 <_API_extensions_Run_postdriver+0x3c><== NEVER TAKEN 40006a04: 01 00 00 00 nop * Currently all APIs configure this hook so it is always non-NULL. */ #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); 40006a08: c2 04 20 08 ld [ %l0 + 8 ], %g1 40006a0c: 9f c0 40 00 call %g1 40006a10: 01 00 00 00 nop Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { 40006a14: e0 04 00 00 ld [ %l0 ], %l0 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40006a18: 80 a4 00 11 cmp %l0, %l1 40006a1c: 32 bf ff fc bne,a 40006a0c <_API_extensions_Run_postdriver+0x24> 40006a20: c2 04 20 08 ld [ %l0 + 8 ], %g1 40006a24: 81 c7 e0 08 ret 40006a28: 81 e8 00 00 restore =============================================================================== 40006a2c <_API_extensions_Run_postswitch>: * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { 40006a2c: 9d e3 bf a0 save %sp, -96, %sp the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } 40006a30: 23 10 00 59 sethi %hi(0x40016400), %l1 40006a34: e0 04 61 e4 ld [ %l1 + 0x1e4 ], %l0 ! 400165e4 <_API_extensions_List> 40006a38: a2 14 61 e4 or %l1, 0x1e4, %l1 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40006a3c: a2 04 60 04 add %l1, 4, %l1 40006a40: 80 a4 00 11 cmp %l0, %l1 40006a44: 02 80 00 0a be 40006a6c <_API_extensions_Run_postswitch+0x40><== NEVER TAKEN 40006a48: 25 10 00 5a sethi %hi(0x40016800), %l2 40006a4c: a4 14 a1 28 or %l2, 0x128, %l2 ! 40016928 <_Per_CPU_Information> !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); 40006a50: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40006a54: 9f c0 40 00 call %g1 40006a58: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { 40006a5c: e0 04 00 00 ld [ %l0 ], %l0 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40006a60: 80 a4 00 11 cmp %l0, %l1 40006a64: 32 bf ff fc bne,a 40006a54 <_API_extensions_Run_postswitch+0x28> 40006a68: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40006a6c: 81 c7 e0 08 ret 40006a70: 81 e8 00 00 restore =============================================================================== 4000936c <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 4000936c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 40009370: 03 10 00 6a sethi %hi(0x4001a800), %g1 * 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 ); 40009374: 7f ff e8 06 call 4000338c 40009378: e0 00 60 a4 ld [ %g1 + 0xa4 ], %l0 ! 4001a8a4 <_Per_CPU_Information+0xc> 4000937c: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 40009380: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 40009384: 80 a0 60 00 cmp %g1, 0 40009388: 02 80 00 2b be 40009434 <_CORE_RWLock_Release+0xc8> 4000938c: 80 a0 60 01 cmp %g1, 1 _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 40009390: 22 80 00 22 be,a 40009418 <_CORE_RWLock_Release+0xac> 40009394: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 return CORE_RWLOCK_SUCCESSFUL; } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 40009398: c0 24 20 34 clr [ %l0 + 0x34 ] /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; 4000939c: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 400093a0: 7f ff e7 ff call 4000339c 400093a4: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 400093a8: 40 00 07 36 call 4000b080 <_Thread_queue_Dequeue> 400093ac: 90 10 00 18 mov %i0, %o0 if ( next ) { 400093b0: 80 a2 20 00 cmp %o0, 0 400093b4: 22 80 00 24 be,a 40009444 <_CORE_RWLock_Release+0xd8> 400093b8: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 400093bc: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 400093c0: 80 a0 60 01 cmp %g1, 1 400093c4: 02 80 00 22 be 4000944c <_CORE_RWLock_Release+0xe0> 400093c8: 84 10 20 01 mov 1, %g2 } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 400093cc: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 400093d0: 82 00 60 01 inc %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 400093d4: c4 26 20 44 st %g2, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 400093d8: 10 80 00 09 b 400093fc <_CORE_RWLock_Release+0x90> 400093dc: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); if ( !next || 400093e0: 80 a0 60 01 cmp %g1, 1 400093e4: 02 80 00 0b be 40009410 <_CORE_RWLock_Release+0xa4> <== NEVER TAKEN 400093e8: 90 10 00 18 mov %i0, %o0 next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; 400093ec: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 400093f0: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 400093f4: 40 00 08 39 call 4000b4d8 <_Thread_queue_Extract> 400093f8: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); 400093fc: 40 00 08 8a call 4000b624 <_Thread_queue_First> 40009400: 90 10 00 18 mov %i0, %o0 if ( !next || 40009404: 92 92 20 00 orcc %o0, 0, %o1 40009408: 32 bf ff f6 bne,a 400093e0 <_CORE_RWLock_Release+0x74> 4000940c: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 40009410: 81 c7 e0 08 ret 40009414: 91 e8 20 00 restore %g0, 0, %o0 _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { the_rwlock->number_of_readers -= 1; 40009418: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 4000941c: 80 a0 60 00 cmp %g1, 0 40009420: 02 bf ff de be 40009398 <_CORE_RWLock_Release+0x2c> 40009424: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 40009428: 7f ff e7 dd call 4000339c 4000942c: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 40009430: 30 80 00 05 b,a 40009444 <_CORE_RWLock_Release+0xd8> * If any thread is waiting, then we wait. */ _ISR_Disable( level ); if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ _ISR_Enable( level ); 40009434: 7f ff e7 da call 4000339c 40009438: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 4000943c: 82 10 20 02 mov 2, %g1 40009440: c2 24 20 34 st %g1, [ %l0 + 0x34 ] } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 40009444: 81 c7 e0 08 ret 40009448: 81 e8 00 00 restore next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); if ( next ) { if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 4000944c: 82 10 20 02 mov 2, %g1 40009450: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 40009454: 81 c7 e0 08 ret 40009458: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000945c <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 4000945c: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009460: 90 10 00 18 mov %i0, %o0 40009464: 40 00 06 37 call 4000ad40 <_Thread_Get> 40009468: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000946c: c2 07 bf fc ld [ %fp + -4 ], %g1 40009470: 80 a0 60 00 cmp %g1, 0 40009474: 12 80 00 08 bne 40009494 <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 40009478: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 4000947c: 40 00 08 b1 call 4000b740 <_Thread_queue_Process_timeout> 40009480: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40009484: 03 10 00 68 sethi %hi(0x4001a000), %g1 40009488: c4 00 63 40 ld [ %g1 + 0x340 ], %g2 ! 4001a340 <_Thread_Dispatch_disable_level> 4000948c: 84 00 bf ff add %g2, -1, %g2 40009490: c4 20 63 40 st %g2, [ %g1 + 0x340 ] 40009494: 81 c7 e0 08 ret 40009498: 81 e8 00 00 restore =============================================================================== 40017098 <_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 ) { 40017098: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 4001709c: c2 06 20 4c ld [ %i0 + 0x4c ], %g1 Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 400170a0: a0 10 00 18 mov %i0, %l0 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 400170a4: 80 a0 40 1a cmp %g1, %i2 400170a8: 0a 80 00 17 bcs 40017104 <_CORE_message_queue_Broadcast+0x6c><== NEVER TAKEN 400170ac: b0 10 20 01 mov 1, %i0 * 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 ) { 400170b0: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 400170b4: 80 a0 60 00 cmp %g1, 0 400170b8: 02 80 00 0a be 400170e0 <_CORE_message_queue_Broadcast+0x48> 400170bc: a4 10 20 00 clr %l2 *count = 0; 400170c0: c0 27 40 00 clr [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 400170c4: 81 c7 e0 08 ret 400170c8: 91 e8 20 00 restore %g0, 0, %o0 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 400170cc: d0 04 60 2c ld [ %l1 + 0x2c ], %o0 400170d0: 40 00 27 22 call 40020d58 400170d4: a4 04 a0 01 inc %l2 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 400170d8: c2 04 60 28 ld [ %l1 + 0x28 ], %g1 400170dc: f4 20 40 00 st %i2, [ %g1 ] /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 400170e0: 40 00 0b b0 call 40019fa0 <_Thread_queue_Dequeue> 400170e4: 90 10 00 10 mov %l0, %o0 400170e8: 92 10 00 19 mov %i1, %o1 400170ec: a2 10 00 08 mov %o0, %l1 400170f0: 80 a2 20 00 cmp %o0, 0 400170f4: 12 bf ff f6 bne 400170cc <_CORE_message_queue_Broadcast+0x34> 400170f8: 94 10 00 1a mov %i2, %o2 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 400170fc: e4 27 40 00 st %l2, [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 40017100: b0 10 20 00 clr %i0 } 40017104: 81 c7 e0 08 ret 40017108: 81 e8 00 00 restore =============================================================================== 40010950 <_CORE_message_queue_Initialize>: 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 ) { 40010950: 9d e3 bf a0 save %sp, -96, %sp size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; the_message_queue->number_of_pending_messages = 0; 40010954: c0 26 20 48 clr [ %i0 + 0x48 ] ) { size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; 40010958: f4 26 20 44 st %i2, [ %i0 + 0x44 ] the_message_queue->number_of_pending_messages = 0; the_message_queue->maximum_message_size = maximum_message_size; 4001095c: f6 26 20 4c st %i3, [ %i0 + 0x4c ] CORE_message_queue_Control *the_message_queue, CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; 40010960: c0 26 20 60 clr [ %i0 + 0x60 ] the_message_queue->notify_argument = the_argument; 40010964: c0 26 20 64 clr [ %i0 + 0x64 ] 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 ) { 40010968: a0 10 00 18 mov %i0, %l0 /* * 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)) { 4001096c: 80 8e e0 03 btst 3, %i3 40010970: 02 80 00 07 be 4001098c <_CORE_message_queue_Initialize+0x3c> 40010974: a4 10 00 1b mov %i3, %l2 allocated_message_size += sizeof(uint32_t); 40010978: a4 06 e0 04 add %i3, 4, %l2 allocated_message_size &= ~(sizeof(uint32_t) - 1); 4001097c: a4 0c bf fc and %l2, -4, %l2 } if (allocated_message_size < maximum_message_size) 40010980: 80 a6 c0 12 cmp %i3, %l2 40010984: 18 80 00 22 bgu 40010a0c <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 40010988: b0 10 20 00 clr %i0 /* * 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)); 4001098c: a2 04 a0 14 add %l2, 0x14, %l1 /* * 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 * 40010990: 92 10 00 1a mov %i2, %o1 40010994: 90 10 00 11 mov %l1, %o0 40010998: 40 00 43 a1 call 4002181c <.umul> 4001099c: b0 10 20 00 clr %i0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 400109a0: 80 a2 00 12 cmp %o0, %l2 400109a4: 0a 80 00 1a bcs 40010a0c <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 400109a8: 01 00 00 00 nop /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); 400109ac: 40 00 0c c7 call 40013cc8 <_Workspace_Allocate> 400109b0: 01 00 00 00 nop return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 400109b4: d0 24 20 5c st %o0, [ %l0 + 0x5c ] _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 400109b8: 80 a2 20 00 cmp %o0, 0 400109bc: 02 80 00 14 be 40010a0c <_CORE_message_queue_Initialize+0xbc> 400109c0: 92 10 00 08 mov %o0, %o1 /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 400109c4: 90 04 20 68 add %l0, 0x68, %o0 400109c8: 94 10 00 1a mov %i2, %o2 400109cc: 40 00 17 c5 call 400168e0 <_Chain_Initialize> 400109d0: 96 10 00 11 mov %l1, %o3 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 400109d4: 82 04 20 50 add %l0, 0x50, %g1 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 400109d8: c0 24 20 54 clr [ %l0 + 0x54 ] RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 400109dc: 84 04 20 54 add %l0, 0x54, %g2 head->next = tail; head->previous = NULL; tail->previous = head; 400109e0: c2 24 20 58 st %g1, [ %l0 + 0x58 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400109e4: c4 24 20 50 st %g2, [ %l0 + 0x50 ] allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 400109e8: c2 06 40 00 ld [ %i1 ], %g1 THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 400109ec: b0 10 20 01 mov 1, %i0 allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 400109f0: 82 18 60 01 xor %g1, 1, %g1 400109f4: 80 a0 00 01 cmp %g0, %g1 400109f8: 90 10 00 10 mov %l0, %o0 400109fc: 94 10 20 80 mov 0x80, %o2 40010a00: 92 60 3f ff subx %g0, -1, %o1 40010a04: 40 00 09 cf call 40013140 <_Thread_queue_Initialize> 40010a08: 96 10 20 06 mov 6, %o3 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 40010a0c: 81 c7 e0 08 ret 40010a10: 81 e8 00 00 restore =============================================================================== 40006d78 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 40006d78: 9d e3 bf a0 save %sp, -96, %sp _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 40006d7c: 21 10 00 58 sethi %hi(0x40016000), %l0 40006d80: c2 04 23 d0 ld [ %l0 + 0x3d0 ], %g1 ! 400163d0 <_Thread_Dispatch_disable_level> 40006d84: 80 a0 60 00 cmp %g1, 0 40006d88: 02 80 00 05 be 40006d9c <_CORE_mutex_Seize+0x24> 40006d8c: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40006d90: 80 8e a0 ff btst 0xff, %i2 40006d94: 12 80 00 1a bne 40006dfc <_CORE_mutex_Seize+0x84> <== ALWAYS TAKEN 40006d98: 03 10 00 59 sethi %hi(0x40016400), %g1 40006d9c: 90 10 00 18 mov %i0, %o0 40006da0: 40 00 16 b6 call 4000c878 <_CORE_mutex_Seize_interrupt_trylock> 40006da4: 92 07 a0 54 add %fp, 0x54, %o1 40006da8: 80 a2 20 00 cmp %o0, 0 40006dac: 02 80 00 12 be 40006df4 <_CORE_mutex_Seize+0x7c> 40006db0: 80 8e a0 ff btst 0xff, %i2 40006db4: 02 80 00 1a be 40006e1c <_CORE_mutex_Seize+0xa4> 40006db8: 01 00 00 00 nop 40006dbc: c4 04 23 d0 ld [ %l0 + 0x3d0 ], %g2 40006dc0: 03 10 00 5a sethi %hi(0x40016800), %g1 40006dc4: c2 00 61 34 ld [ %g1 + 0x134 ], %g1 ! 40016934 <_Per_CPU_Information+0xc> 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; 40006dc8: 86 10 20 01 mov 1, %g3 40006dcc: c6 26 20 30 st %g3, [ %i0 + 0x30 ] 40006dd0: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 40006dd4: f2 20 60 20 st %i1, [ %g1 + 0x20 ] 40006dd8: 82 00 a0 01 add %g2, 1, %g1 40006ddc: c2 24 23 d0 st %g1, [ %l0 + 0x3d0 ] 40006de0: 7f ff eb c2 call 40001ce8 40006de4: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40006de8: 90 10 00 18 mov %i0, %o0 40006dec: 7f ff ff c0 call 40006cec <_CORE_mutex_Seize_interrupt_blocking> 40006df0: 92 10 00 1b mov %i3, %o1 40006df4: 81 c7 e0 08 ret 40006df8: 81 e8 00 00 restore 40006dfc: c2 00 61 48 ld [ %g1 + 0x148 ], %g1 40006e00: 80 a0 60 01 cmp %g1, 1 40006e04: 28 bf ff e7 bleu,a 40006da0 <_CORE_mutex_Seize+0x28> 40006e08: 90 10 00 18 mov %i0, %o0 40006e0c: 90 10 20 00 clr %o0 40006e10: 92 10 20 00 clr %o1 40006e14: 40 00 01 d8 call 40007574 <_Internal_error_Occurred> 40006e18: 94 10 20 12 mov 0x12, %o2 40006e1c: 7f ff eb b3 call 40001ce8 40006e20: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40006e24: 03 10 00 5a sethi %hi(0x40016800), %g1 40006e28: c2 00 61 34 ld [ %g1 + 0x134 ], %g1 ! 40016934 <_Per_CPU_Information+0xc> 40006e2c: 84 10 20 01 mov 1, %g2 40006e30: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 40006e34: 81 c7 e0 08 ret 40006e38: 81 e8 00 00 restore =============================================================================== 40006fb8 <_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 ) { 40006fb8: 9d e3 bf a0 save %sp, -96, %sp 40006fbc: a0 10 00 18 mov %i0, %l0 Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 40006fc0: b0 10 20 00 clr %i0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 40006fc4: 40 00 07 06 call 40008bdc <_Thread_queue_Dequeue> 40006fc8: 90 10 00 10 mov %l0, %o0 40006fcc: 80 a2 20 00 cmp %o0, 0 40006fd0: 02 80 00 04 be 40006fe0 <_CORE_semaphore_Surrender+0x28> 40006fd4: 01 00 00 00 nop status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } 40006fd8: 81 c7 e0 08 ret 40006fdc: 81 e8 00 00 restore if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 40006fe0: 7f ff eb 3e call 40001cd8 40006fe4: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 40006fe8: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40006fec: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 40006ff0: 80 a0 40 02 cmp %g1, %g2 40006ff4: 1a 80 00 05 bcc 40007008 <_CORE_semaphore_Surrender+0x50> <== NEVER TAKEN 40006ff8: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 40006ffc: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 40007000: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 40007004: c2 24 20 48 st %g1, [ %l0 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 40007008: 7f ff eb 38 call 40001ce8 4000700c: 01 00 00 00 nop } return status; } 40007010: 81 c7 e0 08 ret 40007014: 81 e8 00 00 restore =============================================================================== 4000c810 <_Chain_Initialize>: Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { 4000c810: 9d e3 bf a0 save %sp, -96, %sp Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; 4000c814: c0 26 20 04 clr [ %i0 + 4 ] size_t node_size ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4000c818: a0 06 20 04 add %i0, 4, %l0 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000c81c: 80 a6 a0 00 cmp %i2, 0 4000c820: 02 80 00 12 be 4000c868 <_Chain_Initialize+0x58> <== NEVER TAKEN 4000c824: 90 10 00 18 mov %i0, %o0 4000c828: b4 06 bf ff add %i2, -1, %i2 { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; Chain_Node *next = starting_address; 4000c82c: 82 10 00 19 mov %i1, %g1 head->previous = NULL; while ( count-- ) { 4000c830: 92 10 00 1a mov %i2, %o1 ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; 4000c834: 10 80 00 05 b 4000c848 <_Chain_Initialize+0x38> 4000c838: 84 10 00 18 mov %i0, %g2 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000c83c: 84 10 00 01 mov %g1, %g2 4000c840: b4 06 bf ff add %i2, -1, %i2 current->next = next; next->previous = current; current = next; next = (Chain_Node *) 4000c844: 82 10 00 03 mov %g3, %g1 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { current->next = next; 4000c848: c2 20 80 00 st %g1, [ %g2 ] next->previous = current; 4000c84c: c4 20 60 04 st %g2, [ %g1 + 4 ] Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000c850: 80 a6 a0 00 cmp %i2, 0 4000c854: 12 bf ff fa bne 4000c83c <_Chain_Initialize+0x2c> 4000c858: 86 00 40 1b add %g1, %i3, %g3 * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( 4000c85c: 40 00 17 e9 call 40012800 <.umul> 4000c860: 90 10 00 1b mov %i3, %o0 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000c864: 90 06 40 08 add %i1, %o0, %o0 current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; 4000c868: e0 22 00 00 st %l0, [ %o0 ] tail->previous = current; 4000c86c: d0 26 20 08 st %o0, [ %i0 + 8 ] } 4000c870: 81 c7 e0 08 ret 4000c874: 81 e8 00 00 restore =============================================================================== 40005c00 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 40005c00: 9d e3 bf a0 save %sp, -96, %sp 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 ]; 40005c04: e0 06 21 54 ld [ %i0 + 0x154 ], %l0 option_set = (rtems_option) the_thread->Wait.option; _ISR_Disable( level ); 40005c08: 7f ff f0 34 call 40001cd8 40005c0c: e4 06 20 30 ld [ %i0 + 0x30 ], %l2 40005c10: a2 10 00 08 mov %o0, %l1 pending_events = api->pending_events; 40005c14: c4 04 00 00 ld [ %l0 ], %g2 event_condition = (rtems_event_set) the_thread->Wait.count; 40005c18: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { 40005c1c: 86 88 40 02 andcc %g1, %g2, %g3 40005c20: 02 80 00 3e be 40005d18 <_Event_Surrender+0x118> 40005c24: 09 10 00 5a sethi %hi(0x40016800), %g4 /* * 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() && 40005c28: 88 11 21 28 or %g4, 0x128, %g4 ! 40016928 <_Per_CPU_Information> 40005c2c: da 01 20 08 ld [ %g4 + 8 ], %o5 40005c30: 80 a3 60 00 cmp %o5, 0 40005c34: 32 80 00 1d bne,a 40005ca8 <_Event_Surrender+0xa8> 40005c38: c8 01 20 0c ld [ %g4 + 0xc ], %g4 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); 40005c3c: c8 06 20 10 ld [ %i0 + 0x10 ], %g4 } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 40005c40: 80 89 21 00 btst 0x100, %g4 40005c44: 02 80 00 33 be 40005d10 <_Event_Surrender+0x110> 40005c48: 80 a0 40 03 cmp %g1, %g3 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 40005c4c: 02 80 00 04 be 40005c5c <_Event_Surrender+0x5c> 40005c50: 80 8c a0 02 btst 2, %l2 40005c54: 02 80 00 2f be 40005d10 <_Event_Surrender+0x110> <== NEVER TAKEN 40005c58: 01 00 00 00 nop api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005c5c: c2 06 20 28 ld [ %i0 + 0x28 ], %g1 RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear( rtems_event_set the_event_set, rtems_event_set the_mask ) { return ( the_event_set & ~(the_mask) ); 40005c60: 84 28 80 03 andn %g2, %g3, %g2 /* * 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 ); 40005c64: c4 24 00 00 st %g2, [ %l0 ] the_thread->Wait.count = 0; 40005c68: c0 26 20 24 clr [ %i0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005c6c: c6 20 40 00 st %g3, [ %g1 ] _ISR_Flash( level ); 40005c70: 7f ff f0 1e call 40001ce8 40005c74: 90 10 00 11 mov %l1, %o0 40005c78: 7f ff f0 18 call 40001cd8 40005c7c: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 40005c80: c2 06 20 50 ld [ %i0 + 0x50 ], %g1 40005c84: 80 a0 60 02 cmp %g1, 2 40005c88: 02 80 00 26 be 40005d20 <_Event_Surrender+0x120> 40005c8c: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 40005c90: 90 10 00 11 mov %l1, %o0 40005c94: 7f ff f0 15 call 40001ce8 40005c98: 33 04 00 ff sethi %hi(0x1003fc00), %i1 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40005c9c: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 40005ca0: 40 00 0a 1a call 40008508 <_Thread_Clear_state> 40005ca4: 81 e8 00 00 restore /* * 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() && 40005ca8: 80 a6 00 04 cmp %i0, %g4 40005cac: 32 bf ff e5 bne,a 40005c40 <_Event_Surrender+0x40> 40005cb0: c8 06 20 10 ld [ %i0 + 0x10 ], %g4 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 40005cb4: 09 10 00 5b sethi %hi(0x40016c00), %g4 40005cb8: da 01 21 20 ld [ %g4 + 0x120 ], %o5 ! 40016d20 <_Event_Sync_state> /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && 40005cbc: 80 a3 60 02 cmp %o5, 2 40005cc0: 02 80 00 07 be 40005cdc <_Event_Surrender+0xdc> <== NEVER TAKEN 40005cc4: 80 a0 40 03 cmp %g1, %g3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 40005cc8: da 01 21 20 ld [ %g4 + 0x120 ], %o5 * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 40005ccc: 80 a3 60 01 cmp %o5, 1 40005cd0: 32 bf ff dc bne,a 40005c40 <_Event_Surrender+0x40> 40005cd4: c8 06 20 10 ld [ %i0 + 0x10 ], %g4 (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { 40005cd8: 80 a0 40 03 cmp %g1, %g3 40005cdc: 02 80 00 04 be 40005cec <_Event_Surrender+0xec> 40005ce0: 80 8c a0 02 btst 2, %l2 40005ce4: 02 80 00 09 be 40005d08 <_Event_Surrender+0x108> <== NEVER TAKEN 40005ce8: 01 00 00 00 nop api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005cec: c2 06 20 28 ld [ %i0 + 0x28 ], %g1 40005cf0: 84 28 80 03 andn %g2, %g3, %g2 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 40005cf4: c4 24 00 00 st %g2, [ %l0 ] the_thread->Wait.count = 0; 40005cf8: c0 26 20 24 clr [ %i0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005cfc: c6 20 40 00 st %g3, [ %g1 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 40005d00: 82 10 20 03 mov 3, %g1 40005d04: c2 21 21 20 st %g1, [ %g4 + 0x120 ] } _ISR_Enable( level ); 40005d08: 7f ff ef f8 call 40001ce8 40005d0c: 91 e8 00 11 restore %g0, %l1, %o0 _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 40005d10: 7f ff ef f6 call 40001ce8 40005d14: 91 e8 00 11 restore %g0, %l1, %o0 /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { _ISR_Enable( level ); 40005d18: 7f ff ef f4 call 40001ce8 40005d1c: 91 e8 00 08 restore %g0, %o0, %o0 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 40005d20: c2 26 20 50 st %g1, [ %i0 + 0x50 ] if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 40005d24: 7f ff ef f1 call 40001ce8 40005d28: 90 10 00 11 mov %l1, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 40005d2c: 40 00 0f 3d call 40009a20 <_Watchdog_Remove> 40005d30: 90 06 20 48 add %i0, 0x48, %o0 40005d34: 33 04 00 ff sethi %hi(0x1003fc00), %i1 40005d38: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 40005d3c: 40 00 09 f3 call 40008508 <_Thread_Clear_state> 40005d40: 81 e8 00 00 restore =============================================================================== 40005d48 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 40005d48: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 40005d4c: 90 10 00 18 mov %i0, %o0 40005d50: 40 00 0a d3 call 4000889c <_Thread_Get> 40005d54: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40005d58: c2 07 bf fc ld [ %fp + -4 ], %g1 40005d5c: 80 a0 60 00 cmp %g1, 0 40005d60: 12 80 00 15 bne 40005db4 <_Event_Timeout+0x6c> <== NEVER TAKEN 40005d64: a0 10 00 08 mov %o0, %l0 * * If it is not satisfied, then it is "nothing happened" and * this is the "timeout" transition. After a request is satisfied, * a timeout is not allowed to occur. */ _ISR_Disable( level ); 40005d68: 7f ff ef dc call 40001cd8 40005d6c: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40005d70: 03 10 00 5a sethi %hi(0x40016800), %g1 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 40005d74: c2 00 61 34 ld [ %g1 + 0x134 ], %g1 ! 40016934 <_Per_CPU_Information+0xc> 40005d78: 80 a4 00 01 cmp %l0, %g1 40005d7c: 02 80 00 10 be 40005dbc <_Event_Timeout+0x74> 40005d80: c0 24 20 24 clr [ %l0 + 0x24 ] if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40005d84: 82 10 20 06 mov 6, %g1 40005d88: c2 24 20 34 st %g1, [ %l0 + 0x34 ] _ISR_Enable( level ); 40005d8c: 7f ff ef d7 call 40001ce8 40005d90: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40005d94: 90 10 00 10 mov %l0, %o0 40005d98: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40005d9c: 40 00 09 db call 40008508 <_Thread_Clear_state> 40005da0: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40005da4: 03 10 00 58 sethi %hi(0x40016000), %g1 40005da8: c4 00 63 d0 ld [ %g1 + 0x3d0 ], %g2 ! 400163d0 <_Thread_Dispatch_disable_level> 40005dac: 84 00 bf ff add %g2, -1, %g2 40005db0: c4 20 63 d0 st %g2, [ %g1 + 0x3d0 ] 40005db4: 81 c7 e0 08 ret 40005db8: 81 e8 00 00 restore } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 40005dbc: 03 10 00 5b sethi %hi(0x40016c00), %g1 40005dc0: c4 00 61 20 ld [ %g1 + 0x120 ], %g2 ! 40016d20 <_Event_Sync_state> 40005dc4: 80 a0 a0 01 cmp %g2, 1 40005dc8: 32 bf ff f0 bne,a 40005d88 <_Event_Timeout+0x40> 40005dcc: 82 10 20 06 mov 6, %g1 _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 40005dd0: 84 10 20 02 mov 2, %g2 40005dd4: c4 20 61 20 st %g2, [ %g1 + 0x120 ] } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40005dd8: 10 bf ff ec b 40005d88 <_Event_Timeout+0x40> 40005ddc: 82 10 20 06 mov 6, %g1 =============================================================================== 4000ca68 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 4000ca68: 9d e3 bf 98 save %sp, -104, %sp 4000ca6c: a0 10 00 18 mov %i0, %l0 Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE 4000ca70: a4 06 60 04 add %i1, 4, %l2 - HEAP_ALLOC_BONUS; uintptr_t const page_size = heap->page_size; 4000ca74: fa 06 20 10 ld [ %i0 + 0x10 ], %i5 Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { 4000ca78: 80 a6 40 12 cmp %i1, %l2 4000ca7c: 18 80 00 6e bgu 4000cc34 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000ca80: b0 10 20 00 clr %i0 /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { 4000ca84: 80 a6 e0 00 cmp %i3, 0 4000ca88: 12 80 00 75 bne 4000cc5c <_Heap_Allocate_aligned_with_boundary+0x1f4> 4000ca8c: 80 a6 40 1b cmp %i1, %i3 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4000ca90: e8 04 20 08 ld [ %l0 + 8 ], %l4 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000ca94: 80 a4 00 14 cmp %l0, %l4 4000ca98: 02 80 00 67 be 4000cc34 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000ca9c: b0 10 20 00 clr %i0 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4000caa0: 82 07 60 07 add %i5, 7, %g1 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4000caa4: b8 10 20 04 mov 4, %i4 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000caa8: a2 10 20 01 mov 1, %l1 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4000caac: c2 27 bf fc st %g1, [ %fp + -4 ] + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4000cab0: b8 27 00 19 sub %i4, %i1, %i4 /* * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { 4000cab4: e6 05 20 04 ld [ %l4 + 4 ], %l3 4000cab8: 80 a4 80 13 cmp %l2, %l3 4000cabc: 3a 80 00 4b bcc,a 4000cbe8 <_Heap_Allocate_aligned_with_boundary+0x180> 4000cac0: e8 05 20 08 ld [ %l4 + 8 ], %l4 if ( alignment == 0 ) { 4000cac4: 80 a6 a0 00 cmp %i2, 0 4000cac8: 02 80 00 44 be 4000cbd8 <_Heap_Allocate_aligned_with_boundary+0x170> 4000cacc: b0 05 20 08 add %l4, 8, %i0 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; 4000cad0: c4 07 bf fc ld [ %fp + -4 ], %g2 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4000cad4: ee 04 20 14 ld [ %l0 + 0x14 ], %l7 - 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; 4000cad8: a6 0c ff fe and %l3, -2, %l3 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; 4000cadc: 82 20 80 17 sub %g2, %l7, %g1 uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; 4000cae0: a6 05 00 13 add %l4, %l3, %l3 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000cae4: 92 10 00 1a mov %i2, %o1 uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; uintptr_t alloc_begin = alloc_end - alloc_size; 4000cae8: b0 07 00 13 add %i4, %l3, %i0 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4000caec: a6 00 40 13 add %g1, %l3, %l3 4000caf0: 40 00 18 2a call 40012b98 <.urem> 4000caf4: 90 10 00 18 mov %i0, %o0 4000caf8: b0 26 00 08 sub %i0, %o0, %i0 uintptr_t alloc_begin = alloc_end - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { 4000cafc: 80 a4 c0 18 cmp %l3, %i0 4000cb00: 1a 80 00 06 bcc 4000cb18 <_Heap_Allocate_aligned_with_boundary+0xb0> 4000cb04: ac 05 20 08 add %l4, 8, %l6 4000cb08: 90 10 00 13 mov %l3, %o0 4000cb0c: 40 00 18 23 call 40012b98 <.urem> 4000cb10: 92 10 00 1a mov %i2, %o1 4000cb14: b0 24 c0 08 sub %l3, %o0, %i0 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { 4000cb18: 80 a6 e0 00 cmp %i3, 0 4000cb1c: 02 80 00 24 be 4000cbac <_Heap_Allocate_aligned_with_boundary+0x144> 4000cb20: 80 a5 80 18 cmp %l6, %i0 /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { alloc_begin = _Heap_Align_down( alloc_begin_ceiling, alignment ); } alloc_end = alloc_begin + alloc_size; 4000cb24: a6 06 00 19 add %i0, %i1, %l3 4000cb28: 92 10 00 1b mov %i3, %o1 4000cb2c: 40 00 18 1b call 40012b98 <.urem> 4000cb30: 90 10 00 13 mov %l3, %o0 4000cb34: 90 24 c0 08 sub %l3, %o0, %o0 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4000cb38: 80 a2 00 13 cmp %o0, %l3 4000cb3c: 1a 80 00 1b bcc 4000cba8 <_Heap_Allocate_aligned_with_boundary+0x140> 4000cb40: 80 a6 00 08 cmp %i0, %o0 4000cb44: 1a 80 00 1a bcc 4000cbac <_Heap_Allocate_aligned_with_boundary+0x144> 4000cb48: 80 a5 80 18 cmp %l6, %i0 alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; 4000cb4c: aa 05 80 19 add %l6, %i1, %l5 uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { 4000cb50: 80 a5 40 08 cmp %l5, %o0 4000cb54: 28 80 00 09 bleu,a 4000cb78 <_Heap_Allocate_aligned_with_boundary+0x110> 4000cb58: b0 22 00 19 sub %o0, %i1, %i0 if ( alloc_begin != 0 ) { break; } block = block->next; 4000cb5c: 10 80 00 23 b 4000cbe8 <_Heap_Allocate_aligned_with_boundary+0x180> 4000cb60: e8 05 20 08 ld [ %l4 + 8 ], %l4 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4000cb64: 1a 80 00 11 bcc 4000cba8 <_Heap_Allocate_aligned_with_boundary+0x140> 4000cb68: 80 a5 40 08 cmp %l5, %o0 if ( boundary_line < boundary_floor ) { 4000cb6c: 38 80 00 1f bgu,a 4000cbe8 <_Heap_Allocate_aligned_with_boundary+0x180><== NEVER TAKEN 4000cb70: e8 05 20 08 ld [ %l4 + 8 ], %l4 <== NOT EXECUTED return 0; } alloc_begin = boundary_line - alloc_size; 4000cb74: b0 22 00 19 sub %o0, %i1, %i0 4000cb78: 92 10 00 1a mov %i2, %o1 4000cb7c: 40 00 18 07 call 40012b98 <.urem> 4000cb80: 90 10 00 18 mov %i0, %o0 4000cb84: 92 10 00 1b mov %i3, %o1 4000cb88: b0 26 00 08 sub %i0, %o0, %i0 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; 4000cb8c: a6 06 00 19 add %i0, %i1, %l3 4000cb90: 40 00 18 02 call 40012b98 <.urem> 4000cb94: 90 10 00 13 mov %l3, %o0 4000cb98: 90 24 c0 08 sub %l3, %o0, %o0 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4000cb9c: 80 a2 00 13 cmp %o0, %l3 4000cba0: 0a bf ff f1 bcs 4000cb64 <_Heap_Allocate_aligned_with_boundary+0xfc> 4000cba4: 80 a6 00 08 cmp %i0, %o0 boundary_line = _Heap_Align_down( alloc_end, boundary ); } } /* Ensure that the we have a valid new block at the beginning */ if ( alloc_begin >= alloc_begin_floor ) { 4000cba8: 80 a5 80 18 cmp %l6, %i0 4000cbac: 38 80 00 0f bgu,a 4000cbe8 <_Heap_Allocate_aligned_with_boundary+0x180> 4000cbb0: e8 05 20 08 ld [ %l4 + 8 ], %l4 4000cbb4: 82 10 3f f8 mov -8, %g1 4000cbb8: 90 10 00 18 mov %i0, %o0 4000cbbc: a6 20 40 14 sub %g1, %l4, %l3 4000cbc0: 92 10 00 1d mov %i5, %o1 4000cbc4: 40 00 17 f5 call 40012b98 <.urem> 4000cbc8: a6 04 c0 18 add %l3, %i0, %l3 uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; if ( free_size >= min_block_size || free_size == 0 ) { 4000cbcc: 90 a4 c0 08 subcc %l3, %o0, %o0 4000cbd0: 12 80 00 1b bne 4000cc3c <_Heap_Allocate_aligned_with_boundary+0x1d4> 4000cbd4: 80 a2 00 17 cmp %o0, %l7 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { 4000cbd8: 80 a6 20 00 cmp %i0, 0 4000cbdc: 32 80 00 08 bne,a 4000cbfc <_Heap_Allocate_aligned_with_boundary+0x194><== ALWAYS TAKEN 4000cbe0: c4 04 20 48 ld [ %l0 + 0x48 ], %g2 break; } block = block->next; 4000cbe4: e8 05 20 08 ld [ %l4 + 8 ], %l4 <== NOT EXECUTED do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000cbe8: 80 a4 00 14 cmp %l0, %l4 4000cbec: 02 80 00 1a be 4000cc54 <_Heap_Allocate_aligned_with_boundary+0x1ec> 4000cbf0: 82 04 60 01 add %l1, 1, %g1 4000cbf4: 10 bf ff b0 b 4000cab4 <_Heap_Allocate_aligned_with_boundary+0x4c> 4000cbf8: a2 10 00 01 mov %g1, %l1 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; 4000cbfc: c2 04 20 4c ld [ %l0 + 0x4c ], %g1 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4000cc00: 84 00 a0 01 inc %g2 stats->searches += search_count; 4000cc04: 82 00 40 11 add %g1, %l1, %g1 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4000cc08: c4 24 20 48 st %g2, [ %l0 + 0x48 ] stats->searches += search_count; 4000cc0c: c2 24 20 4c st %g1, [ %l0 + 0x4c ] block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 4000cc10: 90 10 00 10 mov %l0, %o0 4000cc14: 92 10 00 14 mov %l4, %o1 4000cc18: 94 10 00 18 mov %i0, %o2 4000cc1c: 7f ff ea 0a call 40007444 <_Heap_Block_allocate> 4000cc20: 96 10 00 19 mov %i1, %o3 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { 4000cc24: c2 04 20 44 ld [ %l0 + 0x44 ], %g1 4000cc28: 80 a0 40 11 cmp %g1, %l1 4000cc2c: 2a 80 00 02 bcs,a 4000cc34 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000cc30: e2 24 20 44 st %l1, [ %l0 + 0x44 ] stats->max_search = search_count; } return (void *) alloc_begin; } 4000cc34: 81 c7 e0 08 ret 4000cc38: 81 e8 00 00 restore if ( alloc_begin >= alloc_begin_floor ) { uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; if ( free_size >= min_block_size || free_size == 0 ) { 4000cc3c: 1a bf ff e8 bcc 4000cbdc <_Heap_Allocate_aligned_with_boundary+0x174> 4000cc40: 80 a6 20 00 cmp %i0, 0 if ( alloc_begin != 0 ) { break; } block = block->next; 4000cc44: e8 05 20 08 ld [ %l4 + 8 ], %l4 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000cc48: 80 a4 00 14 cmp %l0, %l4 4000cc4c: 12 bf ff ea bne 4000cbf4 <_Heap_Allocate_aligned_with_boundary+0x18c> 4000cc50: 82 04 60 01 add %l1, 1, %g1 4000cc54: 10 bf ff f4 b 4000cc24 <_Heap_Allocate_aligned_with_boundary+0x1bc> 4000cc58: b0 10 20 00 clr %i0 /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { 4000cc5c: 18 bf ff f6 bgu 4000cc34 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000cc60: 80 a6 a0 00 cmp %i2, 0 return NULL; } if ( alignment == 0 ) { 4000cc64: 22 bf ff 8b be,a 4000ca90 <_Heap_Allocate_aligned_with_boundary+0x28> 4000cc68: b4 10 00 1d mov %i5, %i2 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4000cc6c: 10 bf ff 8a b 4000ca94 <_Heap_Allocate_aligned_with_boundary+0x2c> 4000cc70: e8 04 20 08 ld [ %l0 + 8 ], %l4 =============================================================================== 4000cf7c <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000cf7c: 9d e3 bf 98 save %sp, -104, %sp Heap_Block *start_block = first_block; Heap_Block *merge_below_block = NULL; Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; 4000cf80: c0 27 bf fc clr [ %fp + -4 ] Heap_Block *extend_last_block = NULL; 4000cf84: c0 27 bf f8 clr [ %fp + -8 ] Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000cf88: a0 10 00 18 mov %i0, %l0 Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; 4000cf8c: a2 06 40 1a add %i1, %i2, %l1 uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4000cf90: e4 06 20 20 ld [ %i0 + 0x20 ], %l2 Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; 4000cf94: e6 06 20 10 ld [ %i0 + 0x10 ], %l3 uintptr_t const min_block_size = heap->min_block_size; 4000cf98: d6 06 20 14 ld [ %i0 + 0x14 ], %o3 uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; uintptr_t const free_size = stats->free_size; 4000cf9c: e8 06 20 30 ld [ %i0 + 0x30 ], %l4 uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { 4000cfa0: 80 a6 40 11 cmp %i1, %l1 4000cfa4: 18 80 00 86 bgu 4000d1bc <_Heap_Extend+0x240> 4000cfa8: b0 10 20 00 clr %i0 return false; } extend_area_ok = _Heap_Get_first_and_last_block( 4000cfac: 90 10 00 19 mov %i1, %o0 4000cfb0: 92 10 00 1a mov %i2, %o1 4000cfb4: 94 10 00 13 mov %l3, %o2 4000cfb8: 98 07 bf fc add %fp, -4, %o4 4000cfbc: 7f ff e9 83 call 400075c8 <_Heap_Get_first_and_last_block> 4000cfc0: 9a 07 bf f8 add %fp, -8, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4000cfc4: 80 8a 20 ff btst 0xff, %o0 4000cfc8: 02 80 00 7d be 4000d1bc <_Heap_Extend+0x240> 4000cfcc: ba 10 20 00 clr %i5 4000cfd0: b0 10 00 12 mov %l2, %i0 4000cfd4: b8 10 20 00 clr %i4 4000cfd8: ac 10 20 00 clr %l6 4000cfdc: 10 80 00 14 b 4000d02c <_Heap_Extend+0xb0> 4000cfe0: ae 10 20 00 clr %l7 return false; } if ( extend_area_end == sub_area_begin ) { merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4000cfe4: 2a 80 00 02 bcs,a 4000cfec <_Heap_Extend+0x70> 4000cfe8: b8 10 00 18 mov %i0, %i4 4000cfec: 90 10 00 15 mov %l5, %o0 4000cff0: 40 00 18 3d call 400130e4 <.urem> 4000cff4: 92 10 00 13 mov %l3, %o1 4000cff8: 82 05 7f f8 add %l5, -8, %g1 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000cffc: 80 a5 40 19 cmp %l5, %i1 4000d000: 02 80 00 1c be 4000d070 <_Heap_Extend+0xf4> 4000d004: 82 20 40 08 sub %g1, %o0, %g1 start_block->prev_size = extend_area_end; merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4000d008: 80 a6 40 15 cmp %i1, %l5 4000d00c: 38 80 00 02 bgu,a 4000d014 <_Heap_Extend+0x98> 4000d010: ba 10 00 01 mov %g1, %i5 - 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; 4000d014: f0 00 60 04 ld [ %g1 + 4 ], %i0 4000d018: b0 0e 3f fe and %i0, -2, %i0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000d01c: b0 00 40 18 add %g1, %i0, %i0 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4000d020: 80 a4 80 18 cmp %l2, %i0 4000d024: 22 80 00 1b be,a 4000d090 <_Heap_Extend+0x114> 4000d028: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 4000d02c: 80 a6 00 12 cmp %i0, %l2 4000d030: 02 80 00 65 be 4000d1c4 <_Heap_Extend+0x248> 4000d034: 82 10 00 18 mov %i0, %g1 uintptr_t const sub_area_end = start_block->prev_size; Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 4000d038: 80 a0 40 11 cmp %g1, %l1 4000d03c: 0a 80 00 6f bcs 4000d1f8 <_Heap_Extend+0x27c> 4000d040: ea 06 00 00 ld [ %i0 ], %l5 sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { 4000d044: 80 a0 40 11 cmp %g1, %l1 4000d048: 12 bf ff e7 bne 4000cfe4 <_Heap_Extend+0x68> 4000d04c: 80 a4 40 15 cmp %l1, %l5 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000d050: 90 10 00 15 mov %l5, %o0 4000d054: 40 00 18 24 call 400130e4 <.urem> 4000d058: 92 10 00 13 mov %l3, %o1 4000d05c: 82 05 7f f8 add %l5, -8, %g1 4000d060: ae 10 00 18 mov %i0, %l7 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000d064: 80 a5 40 19 cmp %l5, %i1 4000d068: 12 bf ff e8 bne 4000d008 <_Heap_Extend+0x8c> <== ALWAYS TAKEN 4000d06c: 82 20 40 08 sub %g1, %o0, %g1 start_block->prev_size = extend_area_end; 4000d070: e2 26 00 00 st %l1, [ %i0 ] - 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; 4000d074: f0 00 60 04 ld [ %g1 + 4 ], %i0 4000d078: b0 0e 3f fe and %i0, -2, %i0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000d07c: b0 00 40 18 add %g1, %i0, %i0 } else if ( sub_area_end < extend_area_begin ) { link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4000d080: 80 a4 80 18 cmp %l2, %i0 4000d084: 12 bf ff ea bne 4000d02c <_Heap_Extend+0xb0> <== NEVER TAKEN 4000d088: ac 10 00 01 mov %g1, %l6 if ( extend_area_begin < heap->area_begin ) { 4000d08c: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000d090: 80 a6 40 01 cmp %i1, %g1 4000d094: 3a 80 00 54 bcc,a 4000d1e4 <_Heap_Extend+0x268> 4000d098: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 4000d09c: f2 24 20 18 st %i1, [ %l0 + 0x18 ] } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4000d0a0: c2 07 bf fc ld [ %fp + -4 ], %g1 4000d0a4: c4 07 bf f8 ld [ %fp + -8 ], %g2 extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 4000d0a8: c8 04 20 20 ld [ %l0 + 0x20 ], %g4 heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 4000d0ac: 86 20 80 01 sub %g2, %g1, %g3 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; 4000d0b0: e2 20 40 00 st %l1, [ %g1 ] extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4000d0b4: 9a 10 e0 01 or %g3, 1, %o5 extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = 4000d0b8: da 20 60 04 st %o5, [ %g1 + 4 ] extend_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; 4000d0bc: c6 20 80 00 st %g3, [ %g2 ] extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 4000d0c0: 80 a1 00 01 cmp %g4, %g1 4000d0c4: 08 80 00 42 bleu 4000d1cc <_Heap_Extend+0x250> 4000d0c8: c0 20 a0 04 clr [ %g2 + 4 ] heap->first_block = extend_first_block; 4000d0cc: c2 24 20 20 st %g1, [ %l0 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000d0d0: 80 a5 e0 00 cmp %l7, 0 4000d0d4: 02 80 00 62 be 4000d25c <_Heap_Extend+0x2e0> 4000d0d8: b2 06 60 08 add %i1, 8, %i1 Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; 4000d0dc: e4 04 20 10 ld [ %l0 + 0x10 ], %l2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; 4000d0e0: 92 10 00 12 mov %l2, %o1 4000d0e4: 40 00 18 00 call 400130e4 <.urem> 4000d0e8: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 4000d0ec: 80 a2 20 00 cmp %o0, 0 4000d0f0: 02 80 00 04 be 4000d100 <_Heap_Extend+0x184> <== ALWAYS TAKEN 4000d0f4: c4 05 c0 00 ld [ %l7 ], %g2 return value - remainder + alignment; 4000d0f8: b2 06 40 12 add %i1, %l2, %i1 <== NOT EXECUTED 4000d0fc: b2 26 40 08 sub %i1, %o0, %i1 <== NOT EXECUTED uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = 4000d100: 82 06 7f f8 add %i1, -8, %g1 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; 4000d104: c4 26 7f f8 st %g2, [ %i1 + -8 ] uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE; uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = 4000d108: 84 25 c0 01 sub %l7, %g1, %g2 first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; 4000d10c: 84 10 a0 01 or %g2, 1, %g2 _Heap_Free_block( heap, new_first_block ); 4000d110: 90 10 00 10 mov %l0, %o0 4000d114: 92 10 00 01 mov %g1, %o1 4000d118: 7f ff ff 8e call 4000cf50 <_Heap_Free_block> 4000d11c: c4 20 60 04 st %g2, [ %g1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000d120: 80 a5 a0 00 cmp %l6, 0 4000d124: 02 80 00 3a be 4000d20c <_Heap_Extend+0x290> 4000d128: a2 04 7f f8 add %l1, -8, %l1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000d12c: d2 04 20 10 ld [ %l0 + 0x10 ], %o1 uintptr_t extend_area_end ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( 4000d130: a2 24 40 16 sub %l1, %l6, %l1 4000d134: 40 00 17 ec call 400130e4 <.urem> 4000d138: 90 10 00 11 mov %l1, %o0 ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = (last_block->size_and_flag - last_block_new_size) 4000d13c: c2 05 a0 04 ld [ %l6 + 4 ], %g1 4000d140: a2 24 40 08 sub %l1, %o0, %l1 4000d144: 82 20 40 11 sub %g1, %l1, %g1 | HEAP_PREV_BLOCK_USED; 4000d148: 82 10 60 01 or %g1, 1, %g1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 4000d14c: 84 04 40 16 add %l1, %l6, %g2 4000d150: c2 20 a0 04 st %g1, [ %g2 + 4 ] RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000d154: c2 05 a0 04 ld [ %l6 + 4 ], %g1 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); 4000d158: 90 10 00 10 mov %l0, %o0 4000d15c: 82 08 60 01 and %g1, 1, %g1 4000d160: 92 10 00 16 mov %l6, %o1 block->size_and_flag = size | flag; 4000d164: a2 14 40 01 or %l1, %g1, %l1 4000d168: 7f ff ff 7a call 4000cf50 <_Heap_Free_block> 4000d16c: e2 25 a0 04 st %l1, [ %l6 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d170: 80 a5 a0 00 cmp %l6, 0 4000d174: 02 80 00 33 be 4000d240 <_Heap_Extend+0x2c4> 4000d178: 80 a5 e0 00 cmp %l7, 0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4000d17c: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 4000d180: da 04 20 20 ld [ %l0 + 0x20 ], %o5 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000d184: c8 00 60 04 ld [ %g1 + 4 ], %g4 _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; 4000d188: c4 04 20 2c ld [ %l0 + 0x2c ], %g2 _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000d18c: c6 04 20 30 ld [ %l0 + 0x30 ], %g3 * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 4000d190: 9a 23 40 01 sub %o5, %g1, %o5 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000d194: 88 09 20 01 and %g4, 1, %g4 block->size_and_flag = size | flag; 4000d198: 88 13 40 04 or %o5, %g4, %g4 4000d19c: c8 20 60 04 st %g4, [ %g1 + 4 ] 4000d1a0: a8 20 c0 14 sub %g3, %l4, %l4 /* Statistics */ stats->size += extended_size; 4000d1a4: 82 00 80 14 add %g2, %l4, %g1 4000d1a8: c2 24 20 2c st %g1, [ %l0 + 0x2c ] if ( extended_size_ptr != NULL ) 4000d1ac: 80 a6 e0 00 cmp %i3, 0 4000d1b0: 02 80 00 03 be 4000d1bc <_Heap_Extend+0x240> <== NEVER TAKEN 4000d1b4: b0 10 20 01 mov 1, %i0 *extended_size_ptr = extended_size; 4000d1b8: e8 26 c0 00 st %l4, [ %i3 ] 4000d1bc: 81 c7 e0 08 ret 4000d1c0: 81 e8 00 00 restore return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 4000d1c4: 10 bf ff 9d b 4000d038 <_Heap_Extend+0xbc> 4000d1c8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { heap->first_block = extend_first_block; } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 4000d1cc: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000d1d0: 80 a0 40 02 cmp %g1, %g2 4000d1d4: 2a bf ff bf bcs,a 4000d0d0 <_Heap_Extend+0x154> 4000d1d8: c4 24 20 24 st %g2, [ %l0 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000d1dc: 10 bf ff be b 4000d0d4 <_Heap_Extend+0x158> 4000d1e0: 80 a5 e0 00 cmp %l7, 0 start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); if ( extend_area_begin < heap->area_begin ) { heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { 4000d1e4: 80 a4 40 01 cmp %l1, %g1 4000d1e8: 38 bf ff ae bgu,a 4000d0a0 <_Heap_Extend+0x124> 4000d1ec: e2 24 20 1c st %l1, [ %l0 + 0x1c ] heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4000d1f0: 10 bf ff ad b 4000d0a4 <_Heap_Extend+0x128> 4000d1f4: c2 07 bf fc ld [ %fp + -4 ], %g1 (uintptr_t) start_block : heap->area_begin; uintptr_t const sub_area_end = start_block->prev_size; Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 4000d1f8: 80 a6 40 15 cmp %i1, %l5 4000d1fc: 1a bf ff 93 bcc 4000d048 <_Heap_Extend+0xcc> 4000d200: 80 a0 40 11 cmp %g1, %l1 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4000d204: 81 c7 e0 08 ret 4000d208: 91 e8 20 00 restore %g0, 0, %o0 ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { 4000d20c: 80 a7 60 00 cmp %i5, 0 4000d210: 02 bf ff d8 be 4000d170 <_Heap_Extend+0x1f4> 4000d214: c4 07 bf fc ld [ %fp + -4 ], %g2 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000d218: c6 07 60 04 ld [ %i5 + 4 ], %g3 _Heap_Link_above( 4000d21c: c2 07 bf f8 ld [ %fp + -8 ], %g1 4000d220: 86 08 e0 01 and %g3, 1, %g3 ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); 4000d224: 84 20 80 1d sub %g2, %i5, %g2 block->size_and_flag = size | flag; 4000d228: 84 10 80 03 or %g2, %g3, %g2 4000d22c: c4 27 60 04 st %g2, [ %i5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4000d230: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000d234: 84 10 a0 01 or %g2, 1, %g2 4000d238: 10 bf ff ce b 4000d170 <_Heap_Extend+0x1f4> 4000d23c: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d240: 32 bf ff d0 bne,a 4000d180 <_Heap_Extend+0x204> 4000d244: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 4000d248: d2 07 bf fc ld [ %fp + -4 ], %o1 4000d24c: 7f ff ff 41 call 4000cf50 <_Heap_Free_block> 4000d250: 90 10 00 10 mov %l0, %o0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4000d254: 10 bf ff cb b 4000d180 <_Heap_Extend+0x204> 4000d258: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { _Heap_Merge_below( heap, extend_area_begin, merge_below_block ); } else if ( link_below_block != NULL ) { 4000d25c: 80 a7 20 00 cmp %i4, 0 4000d260: 02 bf ff b1 be 4000d124 <_Heap_Extend+0x1a8> 4000d264: 80 a5 a0 00 cmp %l6, 0 { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = (link_begin - last_block_begin) | HEAP_PREV_BLOCK_USED; 4000d268: b8 27 00 02 sub %i4, %g2, %i4 4000d26c: b8 17 20 01 or %i4, 1, %i4 ) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = 4000d270: 10 bf ff ad b 4000d124 <_Heap_Extend+0x1a8> 4000d274: f8 20 a0 04 st %i4, [ %g2 + 4 ] =============================================================================== 4000cc74 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4000cc74: 9d e3 bf a0 save %sp, -96, %sp 4000cc78: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 4000cc7c: 40 00 17 c7 call 40012b98 <.urem> 4000cc80: 90 10 00 19 mov %i1, %o0 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 4000cc84: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 4000cc88: a0 10 00 18 mov %i0, %l0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000cc8c: a2 06 7f f8 add %i1, -8, %l1 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4000cc90: 90 24 40 08 sub %l1, %o0, %o0 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; 4000cc94: 80 a2 00 01 cmp %o0, %g1 4000cc98: 0a 80 00 4d bcs 4000cdcc <_Heap_Free+0x158> 4000cc9c: b0 10 20 00 clr %i0 4000cca0: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 4000cca4: 80 a2 00 03 cmp %o0, %g3 4000cca8: 18 80 00 49 bgu 4000cdcc <_Heap_Free+0x158> 4000ccac: 01 00 00 00 nop --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000ccb0: da 02 20 04 ld [ %o0 + 4 ], %o5 - 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; 4000ccb4: 88 0b 7f fe and %o5, -2, %g4 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000ccb8: 84 02 00 04 add %o0, %g4, %g2 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; 4000ccbc: 80 a0 40 02 cmp %g1, %g2 4000ccc0: 18 80 00 43 bgu 4000cdcc <_Heap_Free+0x158> <== NEVER TAKEN 4000ccc4: 80 a0 c0 02 cmp %g3, %g2 4000ccc8: 0a 80 00 41 bcs 4000cdcc <_Heap_Free+0x158> <== NEVER TAKEN 4000cccc: 01 00 00 00 nop 4000ccd0: d8 00 a0 04 ld [ %g2 + 4 ], %o4 if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 4000ccd4: 80 8b 20 01 btst 1, %o4 4000ccd8: 02 80 00 3d be 4000cdcc <_Heap_Free+0x158> <== NEVER TAKEN 4000ccdc: 96 0b 3f fe and %o4, -2, %o3 return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4000cce0: 80 a0 c0 02 cmp %g3, %g2 4000cce4: 02 80 00 06 be 4000ccfc <_Heap_Free+0x88> 4000cce8: 98 10 20 00 clr %o4 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000ccec: 98 00 80 0b add %g2, %o3, %o4 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; 4000ccf0: d8 03 20 04 ld [ %o4 + 4 ], %o4 4000ccf4: 98 0b 20 01 and %o4, 1, %o4 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) 4000ccf8: 98 1b 20 01 xor %o4, 1, %o4 next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { 4000ccfc: 80 8b 60 01 btst 1, %o5 4000cd00: 12 80 00 1d bne 4000cd74 <_Heap_Free+0x100> 4000cd04: 80 8b 20 ff btst 0xff, %o4 uintptr_t const prev_size = block->prev_size; 4000cd08: d4 02 00 00 ld [ %o0 ], %o2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000cd0c: 9a 22 00 0a sub %o0, %o2, %o5 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; 4000cd10: 80 a0 40 0d cmp %g1, %o5 4000cd14: 18 80 00 2e bgu 4000cdcc <_Heap_Free+0x158> <== NEVER TAKEN 4000cd18: b0 10 20 00 clr %i0 4000cd1c: 80 a0 c0 0d cmp %g3, %o5 4000cd20: 0a 80 00 2b bcs 4000cdcc <_Heap_Free+0x158> <== NEVER TAKEN 4000cd24: 01 00 00 00 nop 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; 4000cd28: c2 03 60 04 ld [ %o5 + 4 ], %g1 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) ) { 4000cd2c: 80 88 60 01 btst 1, %g1 4000cd30: 02 80 00 27 be 4000cdcc <_Heap_Free+0x158> <== NEVER TAKEN 4000cd34: 80 8b 20 ff btst 0xff, %o4 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4000cd38: 22 80 00 39 be,a 4000ce1c <_Heap_Free+0x1a8> 4000cd3c: 94 01 00 0a add %g4, %o2, %o2 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000cd40: c2 00 a0 08 ld [ %g2 + 8 ], %g1 4000cd44: c4 00 a0 0c ld [ %g2 + 0xc ], %g2 } 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; 4000cd48: c6 04 20 38 ld [ %l0 + 0x38 ], %g3 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 4000cd4c: c2 20 a0 08 st %g1, [ %g2 + 8 ] next->prev = prev; 4000cd50: c4 20 60 0c st %g2, [ %g1 + 0xc ] 4000cd54: 82 00 ff ff add %g3, -1, %g1 4000cd58: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; 4000cd5c: 96 01 00 0b add %g4, %o3, %o3 4000cd60: 94 02 c0 0a add %o3, %o2, %o2 _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000cd64: 82 12 a0 01 or %o2, 1, %g1 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 4000cd68: d4 23 40 0a st %o2, [ %o5 + %o2 ] 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; 4000cd6c: 10 80 00 0e b 4000cda4 <_Heap_Free+0x130> 4000cd70: c2 23 60 04 st %g1, [ %o5 + 4 ] uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4000cd74: 22 80 00 18 be,a 4000cdd4 <_Heap_Free+0x160> 4000cd78: c6 04 20 08 ld [ %l0 + 8 ], %g3 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000cd7c: c6 00 a0 08 ld [ %g2 + 8 ], %g3 4000cd80: c2 00 a0 0c ld [ %g2 + 0xc ], %g1 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; 4000cd84: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = prev; 4000cd88: c2 22 20 0c st %g1, [ %o0 + 0xc ] prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; 4000cd8c: 96 02 c0 04 add %o3, %g4, %o3 next->prev = new_block; 4000cd90: d0 20 e0 0c st %o0, [ %g3 + 0xc ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000cd94: 84 12 e0 01 or %o3, 1, %g2 prev->next = new_block; 4000cd98: d0 20 60 08 st %o0, [ %g1 + 8 ] 4000cd9c: c4 22 20 04 st %g2, [ %o0 + 4 ] next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4000cda0: d6 22 00 0b st %o3, [ %o0 + %o3 ] stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000cda4: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 ++stats->frees; 4000cda8: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 stats->free_size += block_size; 4000cdac: c6 04 20 30 ld [ %l0 + 0x30 ], %g3 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000cdb0: 84 00 bf ff add %g2, -1, %g2 ++stats->frees; 4000cdb4: 82 00 60 01 inc %g1 stats->free_size += block_size; 4000cdb8: 88 00 c0 04 add %g3, %g4, %g4 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000cdbc: c4 24 20 40 st %g2, [ %l0 + 0x40 ] ++stats->frees; 4000cdc0: c2 24 20 50 st %g1, [ %l0 + 0x50 ] stats->free_size += block_size; 4000cdc4: c8 24 20 30 st %g4, [ %l0 + 0x30 ] return( true ); 4000cdc8: b0 10 20 01 mov 1, %i0 } 4000cdcc: 81 c7 e0 08 ret 4000cdd0: 81 e8 00 00 restore 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; 4000cdd4: 82 11 20 01 or %g4, 1, %g1 4000cdd8: c2 22 20 04 st %g1, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000cddc: da 00 a0 04 ld [ %g2 + 4 ], %o5 next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000cde0: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 4000cde4: e0 22 20 0c st %l0, [ %o0 + 0xc ] Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4000cde8: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4000cdec: d0 20 e0 0c st %o0, [ %g3 + 0xc ] /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; 4000cdf0: c8 22 00 04 st %g4, [ %o0 + %g4 ] } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000cdf4: 86 0b 7f fe and %o5, -2, %g3 4000cdf8: c6 20 a0 04 st %g3, [ %g2 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { 4000cdfc: c4 04 20 3c ld [ %l0 + 0x3c ], %g2 block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000ce00: 82 00 60 01 inc %g1 { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; 4000ce04: d0 24 20 08 st %o0, [ %l0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 4000ce08: 80 a0 40 02 cmp %g1, %g2 4000ce0c: 08 bf ff e6 bleu 4000cda4 <_Heap_Free+0x130> 4000ce10: c2 24 20 38 st %g1, [ %l0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 4000ce14: 10 bf ff e4 b 4000cda4 <_Heap_Free+0x130> 4000ce18: c2 24 20 3c st %g1, [ %l0 + 0x3c ] 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; 4000ce1c: 82 12 a0 01 or %o2, 1, %g1 4000ce20: c2 23 60 04 st %g1, [ %o5 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000ce24: c2 00 a0 04 ld [ %g2 + 4 ], %g1 next_block->prev_size = size; 4000ce28: d4 22 00 04 st %o2, [ %o0 + %g4 ] _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000ce2c: 82 08 7f fe and %g1, -2, %g1 4000ce30: 10 bf ff dd b 4000cda4 <_Heap_Free+0x130> 4000ce34: c2 20 a0 04 st %g1, [ %g2 + 4 ] =============================================================================== 4000d998 <_Heap_Get_information>: void _Heap_Get_information( Heap_Control *the_heap, Heap_Information_block *the_info ) { 4000d998: 9d e3 bf a0 save %sp, -96, %sp Heap_Block *the_block = the_heap->first_block; 4000d99c: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 Heap_Block *const end = the_heap->last_block; 4000d9a0: c4 06 20 24 ld [ %i0 + 0x24 ], %g2 memset(the_info, 0, sizeof(*the_info)); 4000d9a4: c0 26 40 00 clr [ %i1 ] 4000d9a8: c0 26 60 04 clr [ %i1 + 4 ] 4000d9ac: c0 26 60 08 clr [ %i1 + 8 ] 4000d9b0: c0 26 60 0c clr [ %i1 + 0xc ] 4000d9b4: c0 26 60 10 clr [ %i1 + 0x10 ] while ( the_block != end ) { 4000d9b8: 80 a0 40 02 cmp %g1, %g2 4000d9bc: 02 80 00 17 be 4000da18 <_Heap_Get_information+0x80> <== NEVER TAKEN 4000d9c0: c0 26 60 14 clr [ %i1 + 0x14 ] 4000d9c4: da 00 60 04 ld [ %g1 + 4 ], %o5 - 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; 4000d9c8: 88 0b 7f fe and %o5, -2, %g4 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000d9cc: 82 00 40 04 add %g1, %g4, %g1 if ( info->largest < the_size ) info->largest = the_size; the_block = next_block; } } 4000d9d0: da 00 60 04 ld [ %g1 + 4 ], %o5 while ( the_block != end ) { uintptr_t const the_size = _Heap_Block_size(the_block); Heap_Block *const next_block = _Heap_Block_at(the_block, the_size); Heap_Information *info; if ( _Heap_Is_prev_used(next_block) ) 4000d9d4: 80 8b 60 01 btst 1, %o5 4000d9d8: 02 80 00 03 be 4000d9e4 <_Heap_Get_information+0x4c> 4000d9dc: 86 10 00 19 mov %i1, %g3 info = &the_info->Used; 4000d9e0: 86 06 60 0c add %i1, 0xc, %g3 else info = &the_info->Free; info->number++; 4000d9e4: d4 00 c0 00 ld [ %g3 ], %o2 info->total += the_size; 4000d9e8: d6 00 e0 08 ld [ %g3 + 8 ], %o3 if ( info->largest < the_size ) 4000d9ec: d8 00 e0 04 ld [ %g3 + 4 ], %o4 if ( _Heap_Is_prev_used(next_block) ) info = &the_info->Used; else info = &the_info->Free; info->number++; 4000d9f0: 94 02 a0 01 inc %o2 info->total += the_size; 4000d9f4: 96 02 c0 04 add %o3, %g4, %o3 if ( _Heap_Is_prev_used(next_block) ) info = &the_info->Used; else info = &the_info->Free; info->number++; 4000d9f8: d4 20 c0 00 st %o2, [ %g3 ] info->total += the_size; if ( info->largest < the_size ) 4000d9fc: 80 a3 00 04 cmp %o4, %g4 4000da00: 1a 80 00 03 bcc 4000da0c <_Heap_Get_information+0x74> 4000da04: d6 20 e0 08 st %o3, [ %g3 + 8 ] info->largest = the_size; 4000da08: c8 20 e0 04 st %g4, [ %g3 + 4 ] Heap_Block *the_block = the_heap->first_block; Heap_Block *const end = the_heap->last_block; memset(the_info, 0, sizeof(*the_info)); while ( the_block != end ) { 4000da0c: 80 a0 80 01 cmp %g2, %g1 4000da10: 12 bf ff ef bne 4000d9cc <_Heap_Get_information+0x34> 4000da14: 88 0b 7f fe and %o5, -2, %g4 4000da18: 81 c7 e0 08 ret 4000da1c: 81 e8 00 00 restore =============================================================================== 40014578 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 40014578: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4001457c: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 40014580: 7f ff f9 86 call 40012b98 <.urem> 40014584: 90 10 00 19 mov %i1, %o0 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 40014588: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 4001458c: a0 10 00 18 mov %i0, %l0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 40014590: 84 06 7f f8 add %i1, -8, %g2 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 40014594: 84 20 80 08 sub %g2, %o0, %g2 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; 40014598: 80 a0 80 01 cmp %g2, %g1 4001459c: 0a 80 00 15 bcs 400145f0 <_Heap_Size_of_alloc_area+0x78> 400145a0: b0 10 20 00 clr %i0 400145a4: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 400145a8: 80 a0 80 03 cmp %g2, %g3 400145ac: 18 80 00 11 bgu 400145f0 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 400145b0: 01 00 00 00 nop - 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; 400145b4: c8 00 a0 04 ld [ %g2 + 4 ], %g4 400145b8: 88 09 3f fe and %g4, -2, %g4 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 400145bc: 84 00 80 04 add %g2, %g4, %g2 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; 400145c0: 80 a0 40 02 cmp %g1, %g2 400145c4: 18 80 00 0b bgu 400145f0 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 400145c8: 80 a0 c0 02 cmp %g3, %g2 400145cc: 0a 80 00 09 bcs 400145f0 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 400145d0: 01 00 00 00 nop 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; 400145d4: c2 00 a0 04 ld [ %g2 + 4 ], %g1 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 400145d8: 80 88 60 01 btst 1, %g1 400145dc: 02 80 00 05 be 400145f0 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 400145e0: 84 20 80 19 sub %g2, %i1, %g2 return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; 400145e4: b0 10 20 01 mov 1, %i0 || !_Heap_Is_prev_used( next_block ) ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; 400145e8: 84 00 a0 04 add %g2, 4, %g2 400145ec: c4 26 80 00 st %g2, [ %i2 ] return true; } 400145f0: 81 c7 e0 08 ret 400145f4: 81 e8 00 00 restore =============================================================================== 40008408 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40008408: 9d e3 bf 80 save %sp, -128, %sp uintptr_t const min_block_size = heap->min_block_size; Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 4000840c: 23 10 00 20 sethi %hi(0x40008000), %l1 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40008410: a0 10 00 18 mov %i0, %l0 uintptr_t const page_size = heap->page_size; 40008414: e8 06 20 10 ld [ %i0 + 0x10 ], %l4 uintptr_t const min_block_size = heap->min_block_size; 40008418: e6 06 20 14 ld [ %i0 + 0x14 ], %l3 Heap_Block *const first_block = heap->first_block; 4000841c: e4 06 20 20 ld [ %i0 + 0x20 ], %l2 Heap_Block *const last_block = heap->last_block; 40008420: ea 06 20 24 ld [ %i0 + 0x24 ], %l5 Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 40008424: 80 8e a0 ff btst 0xff, %i2 40008428: 02 80 00 04 be 40008438 <_Heap_Walk+0x30> 4000842c: a2 14 63 9c or %l1, 0x39c, %l1 40008430: 23 10 00 20 sethi %hi(0x40008000), %l1 40008434: a2 14 63 a4 or %l1, 0x3a4, %l1 ! 400083a4 <_Heap_Walk_print> if ( !_System_state_Is_up( _System_state_Get() ) ) { 40008438: 03 10 00 63 sethi %hi(0x40018c00), %g1 4000843c: c2 00 60 f8 ld [ %g1 + 0xf8 ], %g1 ! 40018cf8 <_System_state_Current> 40008440: 80 a0 60 03 cmp %g1, 3 40008444: 12 80 00 33 bne 40008510 <_Heap_Walk+0x108> 40008448: b0 10 20 01 mov 1, %i0 Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; (*printer)( 4000844c: da 04 20 18 ld [ %l0 + 0x18 ], %o5 40008450: c6 04 20 1c ld [ %l0 + 0x1c ], %g3 40008454: c4 04 20 08 ld [ %l0 + 8 ], %g2 40008458: c2 04 20 0c ld [ %l0 + 0xc ], %g1 4000845c: 90 10 00 19 mov %i1, %o0 40008460: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 40008464: e4 23 a0 60 st %l2, [ %sp + 0x60 ] 40008468: ea 23 a0 64 st %l5, [ %sp + 0x64 ] 4000846c: c4 23 a0 68 st %g2, [ %sp + 0x68 ] 40008470: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40008474: 92 10 20 00 clr %o1 40008478: 96 10 00 14 mov %l4, %o3 4000847c: 15 10 00 58 sethi %hi(0x40016000), %o2 40008480: 98 10 00 13 mov %l3, %o4 40008484: 9f c4 40 00 call %l1 40008488: 94 12 a3 c8 or %o2, 0x3c8, %o2 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 4000848c: 80 a5 20 00 cmp %l4, 0 40008490: 02 80 00 2a be 40008538 <_Heap_Walk+0x130> 40008494: 80 8d 20 07 btst 7, %l4 (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 40008498: 12 80 00 30 bne 40008558 <_Heap_Walk+0x150> 4000849c: 90 10 00 13 mov %l3, %o0 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 400084a0: 7f ff e5 84 call 40001ab0 <.urem> 400084a4: 92 10 00 14 mov %l4, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 400084a8: 80 a2 20 00 cmp %o0, 0 400084ac: 12 80 00 34 bne 4000857c <_Heap_Walk+0x174> 400084b0: 90 04 a0 08 add %l2, 8, %o0 400084b4: 7f ff e5 7f call 40001ab0 <.urem> 400084b8: 92 10 00 14 mov %l4, %o1 ); return false; } if ( 400084bc: 80 a2 20 00 cmp %o0, 0 400084c0: 32 80 00 38 bne,a 400085a0 <_Heap_Walk+0x198> 400084c4: 90 10 00 19 mov %i1, %o0 block = next_block; } while ( block != first_block ); return true; } 400084c8: f8 04 a0 04 ld [ %l2 + 4 ], %i4 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 400084cc: 80 8f 20 01 btst 1, %i4 400084d0: 22 80 00 4d be,a 40008604 <_Heap_Walk+0x1fc> 400084d4: 90 10 00 19 mov %i1, %o0 - 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; 400084d8: c2 05 60 04 ld [ %l5 + 4 ], %g1 400084dc: 82 08 7f fe and %g1, -2, %g1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 400084e0: 82 05 40 01 add %l5, %g1, %g1 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; 400084e4: c4 00 60 04 ld [ %g1 + 4 ], %g2 ); return false; } if ( _Heap_Is_free( last_block ) ) { 400084e8: 80 88 a0 01 btst 1, %g2 400084ec: 02 80 00 0b be 40008518 <_Heap_Walk+0x110> 400084f0: 80 a4 80 01 cmp %l2, %g1 ); return false; } if ( 400084f4: 02 80 00 33 be 400085c0 <_Heap_Walk+0x1b8> <== ALWAYS TAKEN 400084f8: 90 10 00 19 mov %i1, %o0 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 400084fc: 92 10 20 01 mov 1, %o1 <== NOT EXECUTED 40008500: 15 10 00 59 sethi %hi(0x40016400), %o2 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40008504: b0 10 20 00 clr %i0 <== NOT EXECUTED } if ( _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40008508: 9f c4 40 00 call %l1 <== NOT EXECUTED 4000850c: 94 12 a1 40 or %o2, 0x140, %o2 <== NOT EXECUTED 40008510: 81 c7 e0 08 ret 40008514: 81 e8 00 00 restore return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( 40008518: 90 10 00 19 mov %i1, %o0 4000851c: 92 10 20 01 mov 1, %o1 40008520: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40008524: b0 10 20 00 clr %i0 return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( 40008528: 9f c4 40 00 call %l1 4000852c: 94 12 a1 28 or %o2, 0x128, %o2 40008530: 81 c7 e0 08 ret 40008534: 81 e8 00 00 restore first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); 40008538: 90 10 00 19 mov %i1, %o0 4000853c: 92 10 20 01 mov 1, %o1 40008540: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40008544: b0 10 20 00 clr %i0 first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); 40008548: 9f c4 40 00 call %l1 4000854c: 94 12 a0 60 or %o2, 0x60, %o2 40008550: 81 c7 e0 08 ret 40008554: 81 e8 00 00 restore return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( 40008558: 90 10 00 19 mov %i1, %o0 4000855c: 92 10 20 01 mov 1, %o1 40008560: 96 10 00 14 mov %l4, %o3 40008564: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40008568: b0 10 20 00 clr %i0 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( 4000856c: 9f c4 40 00 call %l1 40008570: 94 12 a0 78 or %o2, 0x78, %o2 40008574: 81 c7 e0 08 ret 40008578: 81 e8 00 00 restore return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( 4000857c: 90 10 00 19 mov %i1, %o0 40008580: 92 10 20 01 mov 1, %o1 40008584: 96 10 00 13 mov %l3, %o3 40008588: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 4000858c: b0 10 20 00 clr %i0 return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( 40008590: 9f c4 40 00 call %l1 40008594: 94 12 a0 98 or %o2, 0x98, %o2 40008598: 81 c7 e0 08 ret 4000859c: 81 e8 00 00 restore } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 400085a0: 92 10 20 01 mov 1, %o1 400085a4: 96 10 00 12 mov %l2, %o3 400085a8: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400085ac: b0 10 20 00 clr %i0 } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 400085b0: 9f c4 40 00 call %l1 400085b4: 94 12 a0 c0 or %o2, 0xc0, %o2 400085b8: 81 c7 e0 08 ret 400085bc: 81 e8 00 00 restore block = next_block; } while ( block != first_block ); return true; } 400085c0: ee 04 20 08 ld [ %l0 + 8 ], %l7 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 400085c4: 80 a4 00 17 cmp %l0, %l7 400085c8: 02 80 01 18 be 40008a28 <_Heap_Walk+0x620> 400085cc: f6 04 20 10 ld [ %l0 + 0x10 ], %i3 block = next_block; } while ( block != first_block ); return true; } 400085d0: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 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; 400085d4: 80 a0 40 17 cmp %g1, %l7 400085d8: 08 80 00 12 bleu 40008620 <_Heap_Walk+0x218> <== ALWAYS TAKEN 400085dc: ac 10 00 17 mov %l7, %l6 const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( 400085e0: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 400085e4: 92 10 20 01 mov 1, %o1 400085e8: 96 10 00 16 mov %l6, %o3 400085ec: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400085f0: b0 10 20 00 clr %i0 const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( 400085f4: 9f c4 40 00 call %l1 400085f8: 94 12 a1 70 or %o2, 0x170, %o2 400085fc: 81 c7 e0 08 ret 40008600: 81 e8 00 00 restore return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( 40008604: 92 10 20 01 mov 1, %o1 40008608: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 4000860c: b0 10 20 00 clr %i0 return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( 40008610: 9f c4 40 00 call %l1 40008614: 94 12 a0 f8 or %o2, 0xf8, %o2 40008618: 81 c7 e0 08 ret 4000861c: 81 e8 00 00 restore 40008620: fa 04 20 24 ld [ %l0 + 0x24 ], %i5 40008624: 80 a7 40 17 cmp %i5, %l7 40008628: 0a bf ff ef bcs 400085e4 <_Heap_Walk+0x1dc> <== NEVER TAKEN 4000862c: 90 10 00 19 mov %i1, %o0 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008630: c2 27 bf fc st %g1, [ %fp + -4 ] 40008634: 90 05 e0 08 add %l7, 8, %o0 40008638: 7f ff e5 1e call 40001ab0 <.urem> 4000863c: 92 10 00 1b mov %i3, %o1 ); return false; } if ( 40008640: 80 a2 20 00 cmp %o0, 0 40008644: 12 80 00 2d bne 400086f8 <_Heap_Walk+0x2f0> <== NEVER TAKEN 40008648: c2 07 bf fc ld [ %fp + -4 ], %g1 - 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; 4000864c: c4 05 e0 04 ld [ %l7 + 4 ], %g2 40008650: 84 08 bf fe and %g2, -2, %g2 block = next_block; } while ( block != first_block ); return true; } 40008654: 84 05 c0 02 add %l7, %g2, %g2 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; 40008658: c4 00 a0 04 ld [ %g2 + 4 ], %g2 ); return false; } if ( _Heap_Is_used( free_block ) ) { 4000865c: 80 88 a0 01 btst 1, %g2 40008660: 12 80 00 2f bne 4000871c <_Heap_Walk+0x314> <== NEVER TAKEN 40008664: 84 10 00 10 mov %l0, %g2 40008668: 10 80 00 17 b 400086c4 <_Heap_Walk+0x2bc> 4000866c: b4 10 00 01 mov %g1, %i2 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 40008670: 80 a4 00 16 cmp %l0, %l6 40008674: 02 80 00 33 be 40008740 <_Heap_Walk+0x338> 40008678: 80 a6 80 16 cmp %i2, %l6 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; 4000867c: 18 bf ff da bgu 400085e4 <_Heap_Walk+0x1dc> 40008680: 90 10 00 19 mov %i1, %o0 40008684: 80 a5 80 1d cmp %l6, %i5 40008688: 18 bf ff d8 bgu 400085e8 <_Heap_Walk+0x1e0> <== NEVER TAKEN 4000868c: 92 10 20 01 mov 1, %o1 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008690: 90 05 a0 08 add %l6, 8, %o0 40008694: 7f ff e5 07 call 40001ab0 <.urem> 40008698: 92 10 00 1b mov %i3, %o1 ); return false; } if ( 4000869c: 80 a2 20 00 cmp %o0, 0 400086a0: 12 80 00 16 bne 400086f8 <_Heap_Walk+0x2f0> 400086a4: 84 10 00 17 mov %l7, %g2 - 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; 400086a8: c2 05 a0 04 ld [ %l6 + 4 ], %g1 400086ac: 82 08 7f fe and %g1, -2, %g1 block = next_block; } while ( block != first_block ); return true; } 400086b0: 82 00 40 16 add %g1, %l6, %g1 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; 400086b4: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 400086b8: 80 88 60 01 btst 1, %g1 400086bc: 12 80 00 18 bne 4000871c <_Heap_Walk+0x314> 400086c0: ae 10 00 16 mov %l6, %l7 ); return false; } if ( free_block->prev != prev_block ) { 400086c4: d8 05 e0 0c ld [ %l7 + 0xc ], %o4 400086c8: 80 a3 00 02 cmp %o4, %g2 400086cc: 22 bf ff e9 be,a 40008670 <_Heap_Walk+0x268> 400086d0: ec 05 e0 08 ld [ %l7 + 8 ], %l6 (*printer)( 400086d4: 90 10 00 19 mov %i1, %o0 400086d8: 92 10 20 01 mov 1, %o1 400086dc: 96 10 00 17 mov %l7, %o3 400086e0: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400086e4: b0 10 20 00 clr %i0 return false; } if ( free_block->prev != prev_block ) { (*printer)( 400086e8: 9f c4 40 00 call %l1 400086ec: 94 12 a1 e0 or %o2, 0x1e0, %o2 400086f0: 81 c7 e0 08 ret 400086f4: 81 e8 00 00 restore } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 400086f8: 90 10 00 19 mov %i1, %o0 400086fc: 92 10 20 01 mov 1, %o1 40008700: 96 10 00 16 mov %l6, %o3 40008704: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40008708: b0 10 20 00 clr %i0 } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 4000870c: 9f c4 40 00 call %l1 40008710: 94 12 a1 90 or %o2, 0x190, %o2 40008714: 81 c7 e0 08 ret 40008718: 81 e8 00 00 restore return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( 4000871c: 90 10 00 19 mov %i1, %o0 40008720: 92 10 20 01 mov 1, %o1 40008724: 96 10 00 16 mov %l6, %o3 40008728: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 4000872c: b0 10 20 00 clr %i0 return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( 40008730: 9f c4 40 00 call %l1 40008734: 94 12 a1 c0 or %o2, 0x1c0, %o2 40008738: 81 c7 e0 08 ret 4000873c: 81 e8 00 00 restore 40008740: 82 10 00 1a mov %i2, %g1 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40008744: 35 10 00 59 sethi %hi(0x40016400), %i2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 40008748: 31 10 00 59 sethi %hi(0x40016400), %i0 ); return false; } if ( _Heap_Is_used( free_block ) ) { 4000874c: ae 10 00 12 mov %l2, %l7 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40008750: b4 16 a3 a0 or %i2, 0x3a0, %i2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 40008754: b0 16 23 88 or %i0, 0x388, %i0 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40008758: 37 10 00 59 sethi %hi(0x40016400), %i3 - 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; 4000875c: ba 0f 3f fe and %i4, -2, %i5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 40008760: ac 07 40 17 add %i5, %l7, %l6 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; 40008764: 80 a0 40 16 cmp %g1, %l6 40008768: 28 80 00 0c bleu,a 40008798 <_Heap_Walk+0x390> <== ALWAYS TAKEN 4000876c: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { (*printer)( 40008770: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 40008774: 92 10 20 01 mov 1, %o1 40008778: 96 10 00 17 mov %l7, %o3 4000877c: 15 10 00 59 sethi %hi(0x40016400), %o2 40008780: 98 10 00 16 mov %l6, %o4 40008784: 94 12 a2 18 or %o2, 0x218, %o2 40008788: 9f c4 40 00 call %l1 4000878c: b0 10 20 00 clr %i0 "block 0x%08x: next block 0x%08x not in heap\n", block, next_block ); return false; 40008790: 81 c7 e0 08 ret 40008794: 81 e8 00 00 restore 40008798: 80 a0 40 16 cmp %g1, %l6 4000879c: 0a bf ff f6 bcs 40008774 <_Heap_Walk+0x36c> 400087a0: 90 10 00 19 mov %i1, %o0 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; 400087a4: 82 1d c0 15 xor %l7, %l5, %g1 400087a8: 80 a0 00 01 cmp %g0, %g1 400087ac: 82 40 20 00 addx %g0, 0, %g1 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 400087b0: 90 10 00 1d mov %i5, %o0 400087b4: c2 27 bf fc st %g1, [ %fp + -4 ] 400087b8: 7f ff e4 be call 40001ab0 <.urem> 400087bc: 92 10 00 14 mov %l4, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 400087c0: 80 a2 20 00 cmp %o0, 0 400087c4: 02 80 00 05 be 400087d8 <_Heap_Walk+0x3d0> 400087c8: c2 07 bf fc ld [ %fp + -4 ], %g1 400087cc: 80 88 60 ff btst 0xff, %g1 400087d0: 12 80 00 79 bne 400089b4 <_Heap_Walk+0x5ac> 400087d4: 90 10 00 19 mov %i1, %o0 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 400087d8: 80 a4 c0 1d cmp %l3, %i5 400087dc: 08 80 00 05 bleu 400087f0 <_Heap_Walk+0x3e8> 400087e0: 80 a5 c0 16 cmp %l7, %l6 400087e4: 80 88 60 ff btst 0xff, %g1 400087e8: 12 80 00 7c bne 400089d8 <_Heap_Walk+0x5d0> <== ALWAYS TAKEN 400087ec: 80 a5 c0 16 cmp %l7, %l6 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 400087f0: 2a 80 00 06 bcs,a 40008808 <_Heap_Walk+0x400> 400087f4: c2 05 a0 04 ld [ %l6 + 4 ], %g1 400087f8: 80 88 60 ff btst 0xff, %g1 400087fc: 12 80 00 82 bne 40008a04 <_Heap_Walk+0x5fc> 40008800: 90 10 00 19 mov %i1, %o0 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; 40008804: c2 05 a0 04 ld [ %l6 + 4 ], %g1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 40008808: 80 88 60 01 btst 1, %g1 4000880c: 02 80 00 19 be 40008870 <_Heap_Walk+0x468> 40008810: b8 0f 20 01 and %i4, 1, %i4 if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 40008814: 80 a7 20 00 cmp %i4, 0 40008818: 22 80 00 0e be,a 40008850 <_Heap_Walk+0x448> 4000881c: da 05 c0 00 ld [ %l7 ], %o5 (*printer)( 40008820: 90 10 00 19 mov %i1, %o0 40008824: 92 10 20 00 clr %o1 40008828: 94 10 00 18 mov %i0, %o2 4000882c: 96 10 00 17 mov %l7, %o3 40008830: 9f c4 40 00 call %l1 40008834: 98 10 00 1d mov %i5, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 40008838: 80 a4 80 16 cmp %l2, %l6 4000883c: 02 80 00 43 be 40008948 <_Heap_Walk+0x540> 40008840: ae 10 00 16 mov %l6, %l7 40008844: f8 05 a0 04 ld [ %l6 + 4 ], %i4 40008848: 10 bf ff c5 b 4000875c <_Heap_Walk+0x354> 4000884c: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40008850: 96 10 00 17 mov %l7, %o3 40008854: 90 10 00 19 mov %i1, %o0 40008858: 92 10 20 00 clr %o1 4000885c: 94 10 00 1a mov %i2, %o2 40008860: 9f c4 40 00 call %l1 40008864: 98 10 00 1d mov %i5, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 40008868: 10 bf ff f5 b 4000883c <_Heap_Walk+0x434> 4000886c: 80 a4 80 16 cmp %l2, %l6 false, "block 0x%08x: size %u, prev 0x%08x%s, next 0x%08x%s\n", block, block_size, block->prev, block->prev == first_free_block ? 40008870: da 05 e0 0c ld [ %l7 + 0xc ], %o5 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 40008874: c2 04 20 08 ld [ %l0 + 8 ], %g1 40008878: 05 10 00 58 sethi %hi(0x40016000), %g2 block = next_block; } while ( block != first_block ); return true; } 4000887c: c8 04 20 0c ld [ %l0 + 0xc ], %g4 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 40008880: 80 a0 40 0d cmp %g1, %o5 40008884: 02 80 00 05 be 40008898 <_Heap_Walk+0x490> 40008888: 86 10 a3 88 or %g2, 0x388, %g3 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 4000888c: 80 a4 00 0d cmp %l0, %o5 40008890: 02 80 00 3e be 40008988 <_Heap_Walk+0x580> 40008894: 86 16 e3 50 or %i3, 0x350, %g3 block->next, block->next == last_free_block ? 40008898: c2 05 e0 08 ld [ %l7 + 8 ], %g1 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 4000889c: 19 10 00 58 sethi %hi(0x40016000), %o4 400088a0: 80 a1 00 01 cmp %g4, %g1 400088a4: 02 80 00 05 be 400088b8 <_Heap_Walk+0x4b0> 400088a8: 84 13 23 a8 or %o4, 0x3a8, %g2 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 400088ac: 80 a4 00 01 cmp %l0, %g1 400088b0: 02 80 00 33 be 4000897c <_Heap_Walk+0x574> 400088b4: 84 16 e3 50 or %i3, 0x350, %g2 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 400088b8: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 400088bc: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 400088c0: c4 23 a0 64 st %g2, [ %sp + 0x64 ] 400088c4: 90 10 00 19 mov %i1, %o0 400088c8: 92 10 20 00 clr %o1 400088cc: 15 10 00 59 sethi %hi(0x40016400), %o2 400088d0: 96 10 00 17 mov %l7, %o3 400088d4: 94 12 a2 e0 or %o2, 0x2e0, %o2 400088d8: 9f c4 40 00 call %l1 400088dc: 98 10 00 1d mov %i5, %o4 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 400088e0: da 05 80 00 ld [ %l6 ], %o5 400088e4: 80 a7 40 0d cmp %i5, %o5 400088e8: 12 80 00 1a bne 40008950 <_Heap_Walk+0x548> 400088ec: 80 a7 20 00 cmp %i4, 0 ); return false; } if ( !prev_used ) { 400088f0: 02 80 00 29 be 40008994 <_Heap_Walk+0x58c> 400088f4: 90 10 00 19 mov %i1, %o0 block = next_block; } while ( block != first_block ); return true; } 400088f8: c2 04 20 08 ld [ %l0 + 8 ], %g1 ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 400088fc: 80 a4 00 01 cmp %l0, %g1 40008900: 02 80 00 0b be 4000892c <_Heap_Walk+0x524> <== NEVER TAKEN 40008904: 92 10 20 01 mov 1, %o1 if ( free_block == block ) { 40008908: 80 a5 c0 01 cmp %l7, %g1 4000890c: 02 bf ff cc be 4000883c <_Heap_Walk+0x434> 40008910: 80 a4 80 16 cmp %l2, %l6 return true; } free_block = free_block->next; 40008914: c2 00 60 08 ld [ %g1 + 8 ], %g1 ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 40008918: 80 a4 00 01 cmp %l0, %g1 4000891c: 12 bf ff fc bne 4000890c <_Heap_Walk+0x504> 40008920: 80 a5 c0 01 cmp %l7, %g1 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 40008924: 90 10 00 19 mov %i1, %o0 40008928: 92 10 20 01 mov 1, %o1 4000892c: 96 10 00 17 mov %l7, %o3 40008930: 15 10 00 59 sethi %hi(0x40016400), %o2 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 40008934: b0 10 20 00 clr %i0 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 40008938: 9f c4 40 00 call %l1 4000893c: 94 12 a3 c8 or %o2, 0x3c8, %o2 40008940: 81 c7 e0 08 ret 40008944: 81 e8 00 00 restore block = next_block; } while ( block != first_block ); return true; } 40008948: 81 c7 e0 08 ret 4000894c: 91 e8 20 01 restore %g0, 1, %o0 " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( 40008950: ec 23 a0 5c st %l6, [ %sp + 0x5c ] 40008954: 90 10 00 19 mov %i1, %o0 40008958: 92 10 20 01 mov 1, %o1 4000895c: 96 10 00 17 mov %l7, %o3 40008960: 15 10 00 59 sethi %hi(0x40016400), %o2 40008964: 98 10 00 1d mov %i5, %o4 40008968: 94 12 a3 18 or %o2, 0x318, %o2 4000896c: 9f c4 40 00 call %l1 40008970: b0 10 20 00 clr %i0 40008974: 81 c7 e0 08 ret 40008978: 81 e8 00 00 restore " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 4000897c: 09 10 00 58 sethi %hi(0x40016000), %g4 40008980: 10 bf ff ce b 400088b8 <_Heap_Walk+0x4b0> 40008984: 84 11 23 b8 or %g4, 0x3b8, %g2 ! 400163b8 <_Status_Object_name_errors_to_status+0x68> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 40008988: 19 10 00 58 sethi %hi(0x40016000), %o4 4000898c: 10 bf ff c3 b 40008898 <_Heap_Walk+0x490> 40008990: 86 13 23 98 or %o4, 0x398, %g3 ! 40016398 <_Status_Object_name_errors_to_status+0x48> return false; } if ( !prev_used ) { (*printer)( 40008994: 92 10 20 01 mov 1, %o1 40008998: 96 10 00 17 mov %l7, %o3 4000899c: 15 10 00 59 sethi %hi(0x40016400), %o2 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 400089a0: b0 10 20 00 clr %i0 return false; } if ( !prev_used ) { (*printer)( 400089a4: 9f c4 40 00 call %l1 400089a8: 94 12 a3 58 or %o2, 0x358, %o2 400089ac: 81 c7 e0 08 ret 400089b0: 81 e8 00 00 restore return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( 400089b4: 92 10 20 01 mov 1, %o1 400089b8: 96 10 00 17 mov %l7, %o3 400089bc: 15 10 00 59 sethi %hi(0x40016400), %o2 400089c0: 98 10 00 1d mov %i5, %o4 400089c4: 94 12 a2 48 or %o2, 0x248, %o2 400089c8: 9f c4 40 00 call %l1 400089cc: b0 10 20 00 clr %i0 "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; 400089d0: 81 c7 e0 08 ret 400089d4: 81 e8 00 00 restore } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( 400089d8: 90 10 00 19 mov %i1, %o0 400089dc: 92 10 20 01 mov 1, %o1 400089e0: 96 10 00 17 mov %l7, %o3 400089e4: 15 10 00 59 sethi %hi(0x40016400), %o2 400089e8: 98 10 00 1d mov %i5, %o4 400089ec: 94 12 a2 78 or %o2, 0x278, %o2 400089f0: 9a 10 00 13 mov %l3, %o5 400089f4: 9f c4 40 00 call %l1 400089f8: b0 10 20 00 clr %i0 block, block_size, min_block_size ); return false; 400089fc: 81 c7 e0 08 ret 40008a00: 81 e8 00 00 restore } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( 40008a04: 92 10 20 01 mov 1, %o1 40008a08: 96 10 00 17 mov %l7, %o3 40008a0c: 15 10 00 59 sethi %hi(0x40016400), %o2 40008a10: 98 10 00 16 mov %l6, %o4 40008a14: 94 12 a2 a8 or %o2, 0x2a8, %o2 40008a18: 9f c4 40 00 call %l1 40008a1c: b0 10 20 00 clr %i0 "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 40008a20: 81 c7 e0 08 ret 40008a24: 81 e8 00 00 restore const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 40008a28: 10 bf ff 47 b 40008744 <_Heap_Walk+0x33c> 40008a2c: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 =============================================================================== 40006890 <_IO_Initialize_all_drivers>: * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { 40006890: 9d e3 bf a0 save %sp, -96, %sp rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 40006894: 23 10 00 5b sethi %hi(0x40016c00), %l1 40006898: c2 04 61 64 ld [ %l1 + 0x164 ], %g1 ! 40016d64 <_IO_Number_of_drivers> 4000689c: 80 a0 60 00 cmp %g1, 0 400068a0: 02 80 00 0c be 400068d0 <_IO_Initialize_all_drivers+0x40> <== NEVER TAKEN 400068a4: a0 10 20 00 clr %l0 400068a8: a2 14 61 64 or %l1, 0x164, %l1 (void) rtems_io_initialize( major, 0, NULL ); 400068ac: 90 10 00 10 mov %l0, %o0 400068b0: 92 10 20 00 clr %o1 400068b4: 40 00 17 c0 call 4000c7b4 400068b8: 94 10 20 00 clr %o2 void _IO_Initialize_all_drivers( void ) { rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 400068bc: c2 04 40 00 ld [ %l1 ], %g1 400068c0: a0 04 20 01 inc %l0 400068c4: 80 a0 40 10 cmp %g1, %l0 400068c8: 18 bf ff fa bgu 400068b0 <_IO_Initialize_all_drivers+0x20> 400068cc: 90 10 00 10 mov %l0, %o0 400068d0: 81 c7 e0 08 ret 400068d4: 81 e8 00 00 restore =============================================================================== 400067c4 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { 400067c4: 9d e3 bf a0 save %sp, -96, %sp uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; 400067c8: 03 10 00 56 sethi %hi(0x40015800), %g1 400067cc: 82 10 62 68 or %g1, 0x268, %g1 ! 40015a68 drivers_in_table = Configuration.number_of_device_drivers; 400067d0: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 number_of_drivers = Configuration.maximum_drivers; 400067d4: e8 00 60 30 ld [ %g1 + 0x30 ], %l4 /* * If the user claims there are less drivers than are actually in * the table, then let's just go with the table's count. */ if ( number_of_drivers <= drivers_in_table ) 400067d8: 80 a4 40 14 cmp %l1, %l4 400067dc: 0a 80 00 08 bcs 400067fc <_IO_Manager_initialization+0x38> 400067e0: e0 00 60 38 ld [ %g1 + 0x38 ], %l0 * If the maximum number of driver is the same as the number in the * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { _IO_Driver_address_table = driver_table; 400067e4: 03 10 00 5b sethi %hi(0x40016c00), %g1 400067e8: e0 20 61 68 st %l0, [ %g1 + 0x168 ] ! 40016d68 <_IO_Driver_address_table> _IO_Number_of_drivers = number_of_drivers; 400067ec: 03 10 00 5b sethi %hi(0x40016c00), %g1 400067f0: e2 20 61 64 st %l1, [ %g1 + 0x164 ] ! 40016d64 <_IO_Number_of_drivers> return; 400067f4: 81 c7 e0 08 ret 400067f8: 81 e8 00 00 restore * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) 400067fc: 83 2d 20 03 sll %l4, 3, %g1 40006800: a7 2d 20 05 sll %l4, 5, %l3 40006804: a6 24 c0 01 sub %l3, %g1, %l3 * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( 40006808: 40 00 0d 12 call 40009c50 <_Workspace_Allocate_or_fatal_error> 4000680c: 90 10 00 13 mov %l3, %o0 sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 40006810: 03 10 00 5b sethi %hi(0x40016c00), %g1 /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 40006814: 25 10 00 5b sethi %hi(0x40016c00), %l2 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 40006818: e8 20 61 64 st %l4, [ %g1 + 0x164 ] /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 4000681c: d0 24 a1 68 st %o0, [ %l2 + 0x168 ] _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 40006820: 92 10 20 00 clr %o1 40006824: 40 00 24 b6 call 4000fafc 40006828: 94 10 00 13 mov %l3, %o2 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 4000682c: 80 a4 60 00 cmp %l1, 0 40006830: 02 bf ff f1 be 400067f4 <_IO_Manager_initialization+0x30> <== NEVER TAKEN 40006834: da 04 a1 68 ld [ %l2 + 0x168 ], %o5 40006838: 82 10 20 00 clr %g1 4000683c: 88 10 20 00 clr %g4 _IO_Driver_address_table[index] = driver_table[index]; 40006840: c4 04 00 01 ld [ %l0 + %g1 ], %g2 40006844: 86 04 00 01 add %l0, %g1, %g3 40006848: c4 23 40 01 st %g2, [ %o5 + %g1 ] 4000684c: d8 00 e0 04 ld [ %g3 + 4 ], %o4 40006850: 84 03 40 01 add %o5, %g1, %g2 40006854: d8 20 a0 04 st %o4, [ %g2 + 4 ] 40006858: d8 00 e0 08 ld [ %g3 + 8 ], %o4 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 4000685c: 88 01 20 01 inc %g4 _IO_Driver_address_table[index] = driver_table[index]; 40006860: d8 20 a0 08 st %o4, [ %g2 + 8 ] 40006864: d8 00 e0 0c ld [ %g3 + 0xc ], %o4 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 40006868: 82 00 60 18 add %g1, 0x18, %g1 _IO_Driver_address_table[index] = driver_table[index]; 4000686c: d8 20 a0 0c st %o4, [ %g2 + 0xc ] 40006870: d8 00 e0 10 ld [ %g3 + 0x10 ], %o4 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 40006874: 80 a4 40 04 cmp %l1, %g4 _IO_Driver_address_table[index] = driver_table[index]; 40006878: d8 20 a0 10 st %o4, [ %g2 + 0x10 ] 4000687c: c6 00 e0 14 ld [ %g3 + 0x14 ], %g3 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 40006880: 18 bf ff f0 bgu 40006840 <_IO_Manager_initialization+0x7c> 40006884: c6 20 a0 14 st %g3, [ %g2 + 0x14 ] 40006888: 81 c7 e0 08 ret 4000688c: 81 e8 00 00 restore =============================================================================== 40007574 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40007574: 9d e3 bf a0 save %sp, -96, %sp _Internal_errors_What_happened.the_source = the_source; 40007578: 1b 10 00 59 sethi %hi(0x40016400), %o5 4000757c: 86 13 60 84 or %o5, 0x84, %g3 ! 40016484 <_Internal_errors_What_happened> _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 ); 40007580: 90 10 00 18 mov %i0, %o0 40007584: 92 0e 60 ff and %i1, 0xff, %o1 40007588: 94 10 00 1a mov %i2, %o2 bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; 4000758c: f0 23 60 84 st %i0, [ %o5 + 0x84 ] _Internal_errors_What_happened.is_internal = is_internal; 40007590: f2 28 e0 04 stb %i1, [ %g3 + 4 ] _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 40007594: 40 00 08 4d call 400096c8 <_User_extensions_Fatal> 40007598: f4 20 e0 08 st %i2, [ %g3 + 8 ] RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 4000759c: 84 10 20 05 mov 5, %g2 <== NOT EXECUTED 400075a0: 03 10 00 59 sethi %hi(0x40016400), %g1 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 400075a4: 7f ff e9 cd call 40001cd8 <== NOT EXECUTED 400075a8: c4 20 61 48 st %g2, [ %g1 + 0x148 ] ! 40016548 <_System_state_Current><== NOT EXECUTED 400075ac: 82 10 00 08 mov %o0, %g1 <== NOT EXECUTED 400075b0: 30 80 00 00 b,a 400075b0 <_Internal_error_Occurred+0x3c> <== NOT EXECUTED =============================================================================== 40007628 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007628: 9d e3 bf a0 save %sp, -96, %sp * 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 ) 4000762c: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007630: a0 10 00 18 mov %i0, %l0 * 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 ) 40007634: 80 a0 60 00 cmp %g1, 0 40007638: 02 80 00 19 be 4000769c <_Objects_Allocate+0x74> <== NEVER TAKEN 4000763c: b0 10 20 00 clr %i0 /* * 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 ); 40007640: a2 04 20 20 add %l0, 0x20, %l1 40007644: 7f ff fd 5c call 40006bb4 <_Chain_Get> 40007648: 90 10 00 11 mov %l1, %o0 if ( information->auto_extend ) { 4000764c: c2 0c 20 12 ldub [ %l0 + 0x12 ], %g1 40007650: 80 a0 60 00 cmp %g1, 0 40007654: 02 80 00 12 be 4000769c <_Objects_Allocate+0x74> 40007658: b0 10 00 08 mov %o0, %i0 /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { 4000765c: 80 a2 20 00 cmp %o0, 0 40007660: 02 80 00 11 be 400076a4 <_Objects_Allocate+0x7c> 40007664: 01 00 00 00 nop } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 40007668: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 4000766c: d0 16 20 0a lduh [ %i0 + 0xa ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 40007670: d2 14 20 14 lduh [ %l0 + 0x14 ], %o1 40007674: 40 00 2c 9d call 400128e8 <.udiv> 40007678: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 4000767c: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 40007680: 91 2a 20 02 sll %o0, 2, %o0 40007684: c6 00 40 08 ld [ %g1 + %o0 ], %g3 information->inactive--; 40007688: c4 14 20 2c lduh [ %l0 + 0x2c ], %g2 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 4000768c: 86 00 ff ff add %g3, -1, %g3 40007690: c6 20 40 08 st %g3, [ %g1 + %o0 ] information->inactive--; 40007694: 82 00 bf ff add %g2, -1, %g1 40007698: c2 34 20 2c sth %g1, [ %l0 + 0x2c ] ); } #endif return the_object; } 4000769c: 81 c7 e0 08 ret 400076a0: 81 e8 00 00 restore * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { _Objects_Extend_information( information ); 400076a4: 40 00 00 11 call 400076e8 <_Objects_Extend_information> 400076a8: 90 10 00 10 mov %l0, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 400076ac: 7f ff fd 42 call 40006bb4 <_Chain_Get> 400076b0: 90 10 00 11 mov %l1, %o0 } if ( the_object ) { 400076b4: b0 92 20 00 orcc %o0, 0, %i0 400076b8: 32 bf ff ed bne,a 4000766c <_Objects_Allocate+0x44> 400076bc: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 ); } #endif return the_object; } 400076c0: 81 c7 e0 08 ret 400076c4: 81 e8 00 00 restore =============================================================================== 400076e8 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { 400076e8: 9d e3 bf 90 save %sp, -112, %sp minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 400076ec: e8 06 20 34 ld [ %i0 + 0x34 ], %l4 400076f0: 80 a5 20 00 cmp %l4, 0 400076f4: 02 80 00 a9 be 40007998 <_Objects_Extend_information+0x2b0> 400076f8: e4 16 20 0a lduh [ %i0 + 0xa ], %l2 block_count = 0; else { block_count = information->maximum / information->allocation_size; 400076fc: ea 16 20 10 lduh [ %i0 + 0x10 ], %l5 40007700: e6 16 20 14 lduh [ %i0 + 0x14 ], %l3 40007704: ab 2d 60 10 sll %l5, 0x10, %l5 40007708: 92 10 00 13 mov %l3, %o1 4000770c: 40 00 2c 77 call 400128e8 <.udiv> 40007710: 91 35 60 10 srl %l5, 0x10, %o0 40007714: bb 2a 20 10 sll %o0, 0x10, %i5 40007718: bb 37 60 10 srl %i5, 0x10, %i5 for ( ; block < block_count; block++ ) { 4000771c: 80 a7 60 00 cmp %i5, 0 40007720: 02 80 00 a6 be 400079b8 <_Objects_Extend_information+0x2d0><== NEVER TAKEN 40007724: 90 10 00 13 mov %l3, %o0 if ( information->object_blocks[ block ] == NULL ) { 40007728: c2 05 00 00 ld [ %l4 ], %g1 4000772c: 80 a0 60 00 cmp %g1, 0 40007730: 02 80 00 a6 be 400079c8 <_Objects_Extend_information+0x2e0><== NEVER TAKEN 40007734: a2 10 00 12 mov %l2, %l1 * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 40007738: 10 80 00 06 b 40007750 <_Objects_Extend_information+0x68> 4000773c: a0 10 20 00 clr %l0 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { 40007740: c2 05 00 01 ld [ %l4 + %g1 ], %g1 40007744: 80 a0 60 00 cmp %g1, 0 40007748: 22 80 00 08 be,a 40007768 <_Objects_Extend_information+0x80> 4000774c: a8 10 20 00 clr %l4 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 40007750: a0 04 20 01 inc %l0 if ( information->object_blocks[ block ] == NULL ) { do_extend = false; break; } else index_base += information->allocation_size; 40007754: a2 04 40 13 add %l1, %l3, %l1 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 40007758: 80 a7 40 10 cmp %i5, %l0 4000775c: 18 bf ff f9 bgu 40007740 <_Objects_Extend_information+0x58> 40007760: 83 2c 20 02 sll %l0, 2, %g1 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 40007764: a8 10 20 01 mov 1, %l4 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 40007768: ab 35 60 10 srl %l5, 0x10, %l5 /* * 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 ) { 4000776c: 03 00 00 3f sethi %hi(0xfc00), %g1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 40007770: aa 05 40 08 add %l5, %o0, %l5 /* * 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 ) { 40007774: 82 10 63 ff or %g1, 0x3ff, %g1 40007778: 80 a5 40 01 cmp %l5, %g1 4000777c: 18 80 00 98 bgu 400079dc <_Objects_Extend_information+0x2f4> 40007780: 01 00 00 00 nop /* * 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; 40007784: 40 00 2c 1f call 40012800 <.umul> 40007788: d2 06 20 18 ld [ %i0 + 0x18 ], %o1 if ( information->auto_extend ) { 4000778c: c2 0e 20 12 ldub [ %i0 + 0x12 ], %g1 40007790: 80 a0 60 00 cmp %g1, 0 40007794: 02 80 00 6d be 40007948 <_Objects_Extend_information+0x260> 40007798: 01 00 00 00 nop new_object_block = _Workspace_Allocate( block_size ); 4000779c: 40 00 09 1d call 40009c10 <_Workspace_Allocate> 400077a0: 01 00 00 00 nop if ( !new_object_block ) 400077a4: a6 92 20 00 orcc %o0, 0, %l3 400077a8: 02 80 00 8d be 400079dc <_Objects_Extend_information+0x2f4> 400077ac: 01 00 00 00 nop } /* * Do we need to grow the tables? */ if ( do_extend ) { 400077b0: 80 8d 20 ff btst 0xff, %l4 400077b4: 22 80 00 42 be,a 400078bc <_Objects_Extend_information+0x1d4> 400077b8: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 */ /* * Up the block count and maximum */ block_count++; 400077bc: a8 07 60 01 add %i5, 1, %l4 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 400077c0: 91 2d 20 01 sll %l4, 1, %o0 400077c4: 90 02 00 14 add %o0, %l4, %o0 ((maximum + minimum_index) * sizeof(Objects_Control *)); 400077c8: 90 05 40 08 add %l5, %o0, %o0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 400077cc: 90 02 00 12 add %o0, %l2, %o0 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); 400077d0: 40 00 09 10 call 40009c10 <_Workspace_Allocate> 400077d4: 91 2a 20 02 sll %o0, 2, %o0 if ( !object_blocks ) { 400077d8: ac 92 20 00 orcc %o0, 0, %l6 400077dc: 02 80 00 7e be 400079d4 <_Objects_Extend_information+0x2ec> 400077e0: a9 2d 20 02 sll %l4, 2, %l4 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 400077e4: c2 16 20 10 lduh [ %i0 + 0x10 ], %g1 400077e8: 80 a4 80 01 cmp %l2, %g1 400077ec: ae 05 80 14 add %l6, %l4, %l7 400077f0: 0a 80 00 5a bcs 40007958 <_Objects_Extend_information+0x270> 400077f4: a8 05 c0 14 add %l7, %l4, %l4 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 400077f8: 80 a4 a0 00 cmp %l2, 0 400077fc: 02 80 00 07 be 40007818 <_Objects_Extend_information+0x130><== NEVER TAKEN 40007800: 82 10 20 00 clr %g1 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 40007804: 85 28 60 02 sll %g1, 2, %g2 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 40007808: 82 00 60 01 inc %g1 4000780c: 80 a4 80 01 cmp %l2, %g1 40007810: 18 bf ff fd bgu 40007804 <_Objects_Extend_information+0x11c><== NEVER TAKEN 40007814: c0 20 80 14 clr [ %g2 + %l4 ] 40007818: bb 2f 60 02 sll %i5, 2, %i5 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 4000781c: c6 16 20 14 lduh [ %i0 + 0x14 ], %g3 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 40007820: c0 25 80 1d clr [ %l6 + %i5 ] inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 40007824: 86 04 40 03 add %l1, %g3, %g3 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 40007828: 80 a4 40 03 cmp %l1, %g3 4000782c: 1a 80 00 0a bcc 40007854 <_Objects_Extend_information+0x16c><== NEVER TAKEN 40007830: c0 25 c0 1d clr [ %l7 + %i5 ] * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 40007834: 83 2c 60 02 sll %l1, 2, %g1 40007838: 84 10 00 11 mov %l1, %g2 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 4000783c: 82 05 00 01 add %l4, %g1, %g1 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; 40007840: c0 20 40 00 clr [ %g1 ] object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { 40007844: 84 00 a0 01 inc %g2 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 40007848: 80 a0 80 03 cmp %g2, %g3 4000784c: 0a bf ff fd bcs 40007840 <_Objects_Extend_information+0x158> 40007850: 82 00 60 04 add %g1, 4, %g1 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; } _ISR_Disable( level ); 40007854: 7f ff e9 21 call 40001cd8 40007858: 01 00 00 00 nop uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 4000785c: c6 06 00 00 ld [ %i0 ], %g3 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( 40007860: c4 16 20 04 lduh [ %i0 + 4 ], %g2 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; 40007864: e4 06 20 34 ld [ %i0 + 0x34 ], %l2 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; 40007868: ea 36 20 10 sth %l5, [ %i0 + 0x10 ] 4000786c: 87 28 e0 18 sll %g3, 0x18, %g3 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 40007870: 85 28 a0 1b sll %g2, 0x1b, %g2 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; 40007874: ec 26 20 34 st %l6, [ %i0 + 0x34 ] information->inactive_per_block = inactive_per_block; 40007878: ee 26 20 30 st %l7, [ %i0 + 0x30 ] information->local_table = local_table; 4000787c: e8 26 20 1c st %l4, [ %i0 + 0x1c ] information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 40007880: ab 2d 60 10 sll %l5, 0x10, %l5 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 40007884: 03 00 00 40 sethi %hi(0x10000), %g1 40007888: ab 35 60 10 srl %l5, 0x10, %l5 4000788c: 82 10 c0 01 or %g3, %g1, %g1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 40007890: 82 10 40 02 or %g1, %g2, %g1 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 40007894: 82 10 40 15 or %g1, %l5, %g1 40007898: c2 26 20 0c st %g1, [ %i0 + 0xc ] information->the_class, _Objects_Local_node, information->maximum ); _ISR_Enable( level ); 4000789c: 7f ff e9 13 call 40001ce8 400078a0: 01 00 00 00 nop if ( old_tables ) 400078a4: 80 a4 a0 00 cmp %l2, 0 400078a8: 22 80 00 05 be,a 400078bc <_Objects_Extend_information+0x1d4> 400078ac: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 _Workspace_Free( old_tables ); 400078b0: 40 00 08 e1 call 40009c34 <_Workspace_Free> 400078b4: 90 10 00 12 mov %l2, %o0 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 400078b8: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 400078bc: d4 16 20 14 lduh [ %i0 + 0x14 ], %o2 400078c0: d6 06 20 18 ld [ %i0 + 0x18 ], %o3 400078c4: 92 10 00 13 mov %l3, %o1 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 400078c8: a1 2c 20 02 sll %l0, 2, %l0 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 400078cc: a4 07 bf f4 add %fp, -12, %l2 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 400078d0: e6 20 40 10 st %l3, [ %g1 + %l0 ] /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 400078d4: 90 10 00 12 mov %l2, %o0 400078d8: 40 00 13 ce call 4000c810 <_Chain_Initialize> 400078dc: 29 00 00 40 sethi %hi(0x10000), %l4 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 400078e0: 10 80 00 0d b 40007914 <_Objects_Extend_information+0x22c> 400078e4: a6 06 20 20 add %i0, 0x20, %l3 the_object->id = _Objects_Build_id( 400078e8: c6 16 20 04 lduh [ %i0 + 4 ], %g3 400078ec: 85 28 a0 18 sll %g2, 0x18, %g2 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 400078f0: 87 28 e0 1b sll %g3, 0x1b, %g3 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 400078f4: 84 10 80 14 or %g2, %l4, %g2 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 400078f8: 84 10 80 03 or %g2, %g3, %g2 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 400078fc: 84 10 80 11 or %g2, %l1, %g2 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 40007900: 90 10 00 13 mov %l3, %o0 40007904: 92 10 00 01 mov %g1, %o1 index++; 40007908: a2 04 60 01 inc %l1 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 4000790c: 7f ff fc 94 call 40006b5c <_Chain_Append> 40007910: c4 20 60 08 st %g2, [ %g1 + 8 ] /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 40007914: 7f ff fc a8 call 40006bb4 <_Chain_Get> 40007918: 90 10 00 12 mov %l2, %o0 4000791c: 82 92 20 00 orcc %o0, 0, %g1 40007920: 32 bf ff f2 bne,a 400078e8 <_Objects_Extend_information+0x200> 40007924: c4 06 00 00 ld [ %i0 ], %g2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 40007928: c8 16 20 14 lduh [ %i0 + 0x14 ], %g4 4000792c: c6 06 20 30 ld [ %i0 + 0x30 ], %g3 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 40007930: c4 16 20 2c lduh [ %i0 + 0x2c ], %g2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 40007934: c8 20 c0 10 st %g4, [ %g3 + %l0 ] information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 40007938: 82 00 80 04 add %g2, %g4, %g1 index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = 4000793c: c2 36 20 2c sth %g1, [ %i0 + 0x2c ] 40007940: 81 c7 e0 08 ret 40007944: 81 e8 00 00 restore if ( information->auto_extend ) { new_object_block = _Workspace_Allocate( block_size ); if ( !new_object_block ) return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); 40007948: 40 00 08 c2 call 40009c50 <_Workspace_Allocate_or_fatal_error> 4000794c: 01 00 00 00 nop 40007950: 10 bf ff 98 b 400077b0 <_Objects_Extend_information+0xc8> 40007954: a6 10 00 08 mov %o0, %l3 /* * 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, 40007958: d2 06 20 34 ld [ %i0 + 0x34 ], %o1 information->object_blocks, block_count * sizeof(void*) ); 4000795c: bb 2f 60 02 sll %i5, 2, %i5 /* * 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, 40007960: 40 00 20 2e call 4000fa18 40007964: 94 10 00 1d mov %i5, %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, 40007968: d2 06 20 30 ld [ %i0 + 0x30 ], %o1 4000796c: 94 10 00 1d mov %i5, %o2 40007970: 40 00 20 2a call 4000fa18 40007974: 90 10 00 17 mov %l7, %o0 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 40007978: d4 16 20 10 lduh [ %i0 + 0x10 ], %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 4000797c: d2 06 20 1c ld [ %i0 + 0x1c ], %o1 information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 40007980: 94 04 80 0a add %l2, %o2, %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 40007984: 90 10 00 14 mov %l4, %o0 40007988: 40 00 20 24 call 4000fa18 4000798c: 95 2a a0 02 sll %o2, 2, %o2 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 40007990: 10 bf ff a4 b 40007820 <_Objects_Extend_information+0x138> 40007994: c6 16 20 14 lduh [ %i0 + 0x14 ], %g3 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 40007998: ea 16 20 10 lduh [ %i0 + 0x10 ], %l5 4000799c: d0 16 20 14 lduh [ %i0 + 0x14 ], %o0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 400079a0: a2 10 00 12 mov %l2, %l1 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 400079a4: a8 10 20 01 mov 1, %l4 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 400079a8: a0 10 20 00 clr %l0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; 400079ac: ba 10 20 00 clr %i5 400079b0: 10 bf ff 6e b 40007768 <_Objects_Extend_information+0x80> 400079b4: ab 2d 60 10 sll %l5, 0x10, %l5 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 400079b8: a2 10 00 12 mov %l2, %l1 <== NOT EXECUTED /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 400079bc: a8 10 20 01 mov 1, %l4 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 400079c0: 10 bf ff 6a b 40007768 <_Objects_Extend_information+0x80> <== NOT EXECUTED 400079c4: a0 10 20 00 clr %l0 <== NOT EXECUTED else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { do_extend = false; 400079c8: a8 10 20 00 clr %l4 <== NOT EXECUTED * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 400079cc: 10 bf ff 67 b 40007768 <_Objects_Extend_information+0x80> <== NOT EXECUTED 400079d0: a0 10 20 00 clr %l0 <== NOT EXECUTED (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); if ( !object_blocks ) { _Workspace_Free( new_object_block ); 400079d4: 40 00 08 98 call 40009c34 <_Workspace_Free> 400079d8: 90 10 00 13 mov %l3, %o0 return; 400079dc: 81 c7 e0 08 ret 400079e0: 81 e8 00 00 restore =============================================================================== 40007a90 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 40007a90: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 40007a94: b3 2e 60 10 sll %i1, 0x10, %i1 40007a98: b3 36 60 10 srl %i1, 0x10, %i1 40007a9c: 80 a6 60 00 cmp %i1, 0 40007aa0: 12 80 00 04 bne 40007ab0 <_Objects_Get_information+0x20> 40007aa4: a0 10 20 00 clr %l0 if ( info->maximum == 0 ) return NULL; #endif return info; } 40007aa8: 81 c7 e0 08 ret 40007aac: 91 e8 00 10 restore %g0, %l0, %o0 /* * 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 ); 40007ab0: 40 00 14 e2 call 4000ce38 <_Objects_API_maximum_class> 40007ab4: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 40007ab8: 80 a2 20 00 cmp %o0, 0 40007abc: 02 bf ff fb be 40007aa8 <_Objects_Get_information+0x18> 40007ac0: 80 a2 00 19 cmp %o0, %i1 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 40007ac4: 0a bf ff f9 bcs 40007aa8 <_Objects_Get_information+0x18> 40007ac8: 03 10 00 58 sethi %hi(0x40016000), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 40007acc: b1 2e 20 02 sll %i0, 2, %i0 40007ad0: 82 10 63 38 or %g1, 0x338, %g1 40007ad4: c2 00 40 18 ld [ %g1 + %i0 ], %g1 40007ad8: 80 a0 60 00 cmp %g1, 0 40007adc: 02 bf ff f3 be 40007aa8 <_Objects_Get_information+0x18> <== NEVER TAKEN 40007ae0: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 40007ae4: e0 00 40 19 ld [ %g1 + %i1 ], %l0 if ( !info ) 40007ae8: 80 a4 20 00 cmp %l0, 0 40007aec: 02 bf ff ef be 40007aa8 <_Objects_Get_information+0x18> <== NEVER TAKEN 40007af0: 01 00 00 00 nop * 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 ) 40007af4: c2 14 20 10 lduh [ %l0 + 0x10 ], %g1 return NULL; 40007af8: 80 a0 00 01 cmp %g0, %g1 40007afc: 82 60 20 00 subx %g0, 0, %g1 40007b00: 10 bf ff ea b 40007aa8 <_Objects_Get_information+0x18> 40007b04: a0 0c 00 01 and %l0, %g1, %l0 =============================================================================== 40009828 <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { 40009828: 9d e3 bf 90 save %sp, -112, %sp char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) 4000982c: 80 a6 60 00 cmp %i1, 0 40009830: 12 80 00 05 bne 40009844 <_Objects_Get_name_as_string+0x1c> 40009834: 80 a6 a0 00 cmp %i2, 0 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; 40009838: b4 10 20 00 clr %i2 _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } 4000983c: 81 c7 e0 08 ret 40009840: 91 e8 00 1a restore %g0, %i2, %o0 Objects_Id tmpId; if ( length == 0 ) return NULL; if ( name == NULL ) 40009844: 02 bf ff fe be 4000983c <_Objects_Get_name_as_string+0x14> 40009848: 80 a6 20 00 cmp %i0, 0 return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 4000984c: 12 80 00 04 bne 4000985c <_Objects_Get_name_as_string+0x34> 40009850: 03 10 00 a4 sethi %hi(0x40029000), %g1 40009854: c2 00 61 d4 ld [ %g1 + 0x1d4 ], %g1 ! 400291d4 <_Per_CPU_Information+0xc> 40009858: f0 00 60 08 ld [ %g1 + 8 ], %i0 information = _Objects_Get_information_id( tmpId ); 4000985c: 7f ff ff b1 call 40009720 <_Objects_Get_information_id> 40009860: 90 10 00 18 mov %i0, %o0 if ( !information ) 40009864: a0 92 20 00 orcc %o0, 0, %l0 40009868: 22 bf ff f5 be,a 4000983c <_Objects_Get_name_as_string+0x14> 4000986c: b4 10 20 00 clr %i2 return NULL; the_object = _Objects_Get( information, tmpId, &location ); 40009870: 92 10 00 18 mov %i0, %o1 40009874: 40 00 00 36 call 4000994c <_Objects_Get> 40009878: 94 07 bf fc add %fp, -4, %o2 switch ( location ) { 4000987c: c2 07 bf fc ld [ %fp + -4 ], %g1 40009880: 80 a0 60 00 cmp %g1, 0 40009884: 32 bf ff ee bne,a 4000983c <_Objects_Get_name_as_string+0x14> 40009888: b4 10 20 00 clr %i2 return NULL; case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 4000988c: c2 0c 20 38 ldub [ %l0 + 0x38 ], %g1 40009890: 80 a0 60 00 cmp %g1, 0 40009894: 22 80 00 24 be,a 40009924 <_Objects_Get_name_as_string+0xfc> 40009898: c2 02 20 0c ld [ %o0 + 0xc ], %g1 s = the_object->name.name_p; 4000989c: c8 02 20 0c ld [ %o0 + 0xc ], %g4 lname[ 4 ] = '\0'; s = lname; } d = name; if ( s ) { 400098a0: 80 a1 20 00 cmp %g4, 0 400098a4: 02 80 00 1d be 40009918 <_Objects_Get_name_as_string+0xf0> 400098a8: 84 10 00 1a mov %i2, %g2 for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 400098ac: b2 86 7f ff addcc %i1, -1, %i1 400098b0: 02 80 00 1a be 40009918 <_Objects_Get_name_as_string+0xf0><== NEVER TAKEN 400098b4: 84 10 00 1a mov %i2, %g2 400098b8: c2 49 00 00 ldsb [ %g4 ], %g1 400098bc: 80 a0 60 00 cmp %g1, 0 400098c0: 02 80 00 16 be 40009918 <_Objects_Get_name_as_string+0xf0> 400098c4: c6 09 00 00 ldub [ %g4 ], %g3 400098c8: 17 10 00 81 sethi %hi(0x40020400), %o3 400098cc: 82 10 20 00 clr %g1 400098d0: 10 80 00 06 b 400098e8 <_Objects_Get_name_as_string+0xc0> 400098d4: 96 12 e2 30 or %o3, 0x230, %o3 400098d8: da 49 00 01 ldsb [ %g4 + %g1 ], %o5 400098dc: 80 a3 60 00 cmp %o5, 0 400098e0: 02 80 00 0e be 40009918 <_Objects_Get_name_as_string+0xf0> 400098e4: c6 09 00 01 ldub [ %g4 + %g1 ], %g3 *d = (isprint((unsigned char)*s)) ? *s : '*'; 400098e8: d8 02 c0 00 ld [ %o3 ], %o4 400098ec: 9a 08 e0 ff and %g3, 0xff, %o5 400098f0: 9a 03 00 0d add %o4, %o5, %o5 400098f4: da 4b 60 01 ldsb [ %o5 + 1 ], %o5 400098f8: 80 8b 60 97 btst 0x97, %o5 400098fc: 22 80 00 02 be,a 40009904 <_Objects_Get_name_as_string+0xdc> 40009900: 86 10 20 2a mov 0x2a, %g3 40009904: c6 28 80 00 stb %g3, [ %g2 ] s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 40009908: 82 00 60 01 inc %g1 4000990c: 80 a0 40 19 cmp %g1, %i1 40009910: 0a bf ff f2 bcs 400098d8 <_Objects_Get_name_as_string+0xb0> 40009914: 84 00 a0 01 inc %g2 *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; _Thread_Enable_dispatch(); 40009918: 40 00 03 1b call 4000a584 <_Thread_Enable_dispatch> 4000991c: c0 28 80 00 clrb [ %g2 ] return name; 40009920: 30 bf ff c7 b,a 4000983c <_Objects_Get_name_as_string+0x14> lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; 40009924: c0 2f bf f4 clrb [ %fp + -12 ] } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; 40009928: 89 30 60 18 srl %g1, 0x18, %g4 lname[ 1 ] = (u32_name >> 16) & 0xff; 4000992c: 87 30 60 10 srl %g1, 0x10, %g3 lname[ 2 ] = (u32_name >> 8) & 0xff; 40009930: 85 30 60 08 srl %g1, 8, %g2 } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; 40009934: c8 2f bf f0 stb %g4, [ %fp + -16 ] lname[ 1 ] = (u32_name >> 16) & 0xff; 40009938: c6 2f bf f1 stb %g3, [ %fp + -15 ] lname[ 2 ] = (u32_name >> 8) & 0xff; 4000993c: c4 2f bf f2 stb %g2, [ %fp + -14 ] lname[ 3 ] = (u32_name >> 0) & 0xff; 40009940: c2 2f bf f3 stb %g1, [ %fp + -13 ] lname[ 4 ] = '\0'; s = lname; 40009944: 10 bf ff da b 400098ac <_Objects_Get_name_as_string+0x84> 40009948: 88 07 bf f0 add %fp, -16, %g4 =============================================================================== 40018ef8 <_Objects_Get_no_protection>: /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; 40018ef8: c4 02 20 08 ld [ %o0 + 8 ], %g2 if ( information->maximum >= index ) { 40018efc: c2 12 20 10 lduh [ %o0 + 0x10 ], %g1 /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; 40018f00: 84 22 40 02 sub %o1, %g2, %g2 40018f04: 84 00 a0 01 inc %g2 if ( information->maximum >= index ) { 40018f08: 80 a0 80 01 cmp %g2, %g1 40018f0c: 18 80 00 09 bgu 40018f30 <_Objects_Get_no_protection+0x38> 40018f10: 85 28 a0 02 sll %g2, 2, %g2 if ( (the_object = information->local_table[ index ]) != NULL ) { 40018f14: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 40018f18: d0 00 40 02 ld [ %g1 + %g2 ], %o0 40018f1c: 80 a2 20 00 cmp %o0, 0 40018f20: 02 80 00 05 be 40018f34 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 40018f24: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 40018f28: 81 c3 e0 08 retl 40018f2c: c0 22 80 00 clr [ %o2 ] /* * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; 40018f30: 82 10 20 01 mov 1, %g1 return NULL; 40018f34: 90 10 20 00 clr %o0 } 40018f38: 81 c3 e0 08 retl 40018f3c: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 40009334 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 40009334: 9d e3 bf 98 save %sp, -104, %sp /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 40009338: 80 a6 20 00 cmp %i0, 0 4000933c: 12 80 00 06 bne 40009354 <_Objects_Id_to_name+0x20> 40009340: 83 36 20 18 srl %i0, 0x18, %g1 40009344: 03 10 00 81 sethi %hi(0x40020400), %g1 40009348: c2 00 60 e4 ld [ %g1 + 0xe4 ], %g1 ! 400204e4 <_Per_CPU_Information+0xc> 4000934c: f0 00 60 08 ld [ %g1 + 8 ], %i0 40009350: 83 36 20 18 srl %i0, 0x18, %g1 40009354: 82 08 60 07 and %g1, 7, %g1 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) 40009358: 84 00 7f ff add %g1, -1, %g2 4000935c: 80 a0 a0 02 cmp %g2, 2 40009360: 18 80 00 12 bgu 400093a8 <_Objects_Id_to_name+0x74> 40009364: a0 10 20 03 mov 3, %l0 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 40009368: 83 28 60 02 sll %g1, 2, %g1 4000936c: 05 10 00 7f sethi %hi(0x4001fc00), %g2 40009370: 84 10 a2 e8 or %g2, 0x2e8, %g2 ! 4001fee8 <_Objects_Information_table> 40009374: c2 00 80 01 ld [ %g2 + %g1 ], %g1 40009378: 80 a0 60 00 cmp %g1, 0 4000937c: 02 80 00 0b be 400093a8 <_Objects_Id_to_name+0x74> 40009380: 85 36 20 1b srl %i0, 0x1b, %g2 return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 40009384: 85 28 a0 02 sll %g2, 2, %g2 40009388: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 4000938c: 80 a2 20 00 cmp %o0, 0 40009390: 02 80 00 06 be 400093a8 <_Objects_Id_to_name+0x74> <== NEVER TAKEN 40009394: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 40009398: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 4000939c: 80 a0 60 00 cmp %g1, 0 400093a0: 02 80 00 04 be 400093b0 <_Objects_Id_to_name+0x7c> <== ALWAYS TAKEN 400093a4: 92 10 00 18 mov %i0, %o1 return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 400093a8: 81 c7 e0 08 ret 400093ac: 91 e8 00 10 restore %g0, %l0, %o0 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 400093b0: 7f ff ff c4 call 400092c0 <_Objects_Get> 400093b4: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 400093b8: 80 a2 20 00 cmp %o0, 0 400093bc: 02 bf ff fb be 400093a8 <_Objects_Id_to_name+0x74> 400093c0: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 400093c4: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 400093c8: a0 10 20 00 clr %l0 the_object = _Objects_Get( information, tmpId, &ignored_location ); if ( !the_object ) return OBJECTS_INVALID_ID; *name = the_object->name; 400093cc: c2 26 40 00 st %g1, [ %i1 ] _Thread_Enable_dispatch(); 400093d0: 40 00 03 21 call 4000a054 <_Thread_Enable_dispatch> 400093d4: b0 10 00 10 mov %l0, %i0 return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 400093d8: 81 c7 e0 08 ret 400093dc: 81 e8 00 00 restore =============================================================================== 40007df4 <_Objects_Shrink_information>: */ void _Objects_Shrink_information( Objects_Information *information ) { 40007df4: 9d e3 bf a0 save %sp, -96, %sp /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); 40007df8: e0 16 20 0a lduh [ %i0 + 0xa ], %l0 block_count = (information->maximum - index_base) / 40007dfc: e2 16 20 14 lduh [ %i0 + 0x14 ], %l1 40007e00: d0 16 20 10 lduh [ %i0 + 0x10 ], %o0 40007e04: 92 10 00 11 mov %l1, %o1 40007e08: 40 00 2a b8 call 400128e8 <.udiv> 40007e0c: 90 22 00 10 sub %o0, %l0, %o0 information->allocation_size; for ( block = 0; block < block_count; block++ ) { 40007e10: 80 a2 20 00 cmp %o0, 0 40007e14: 02 80 00 34 be 40007ee4 <_Objects_Shrink_information+0xf0><== NEVER TAKEN 40007e18: 01 00 00 00 nop if ( information->inactive_per_block[ block ] == 40007e1c: c8 06 20 30 ld [ %i0 + 0x30 ], %g4 40007e20: c2 01 00 00 ld [ %g4 ], %g1 40007e24: 80 a4 40 01 cmp %l1, %g1 40007e28: 02 80 00 0f be 40007e64 <_Objects_Shrink_information+0x70><== NEVER TAKEN 40007e2c: 82 10 20 00 clr %g1 40007e30: 10 80 00 07 b 40007e4c <_Objects_Shrink_information+0x58> 40007e34: a4 10 20 04 mov 4, %l2 information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; 40007e38: 86 04 a0 04 add %l2, 4, %g3 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { if ( information->inactive_per_block[ block ] == 40007e3c: 80 a4 40 02 cmp %l1, %g2 40007e40: 02 80 00 0a be 40007e68 <_Objects_Shrink_information+0x74> 40007e44: a0 04 00 11 add %l0, %l1, %l0 40007e48: a4 10 00 03 mov %g3, %l2 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 40007e4c: 82 00 60 01 inc %g1 40007e50: 80 a2 00 01 cmp %o0, %g1 40007e54: 38 bf ff f9 bgu,a 40007e38 <_Objects_Shrink_information+0x44> 40007e58: c4 01 00 12 ld [ %g4 + %l2 ], %g2 40007e5c: 81 c7 e0 08 ret 40007e60: 81 e8 00 00 restore if ( information->inactive_per_block[ block ] == 40007e64: a4 10 20 00 clr %l2 <== NOT EXECUTED information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); 40007e68: 10 80 00 06 b 40007e80 <_Objects_Shrink_information+0x8c> 40007e6c: d0 06 20 20 ld [ %i0 + 0x20 ], %o0 if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); 40007e70: 80 a4 60 00 cmp %l1, 0 40007e74: 22 80 00 12 be,a 40007ebc <_Objects_Shrink_information+0xc8> 40007e78: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 index = _Objects_Get_index( the_object->id ); /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; 40007e7c: 90 10 00 11 mov %l1, %o0 * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); do { index = _Objects_Get_index( the_object->id ); 40007e80: c2 12 20 0a lduh [ %o0 + 0xa ], %g1 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && 40007e84: 80 a0 40 10 cmp %g1, %l0 40007e88: 0a bf ff fa bcs 40007e70 <_Objects_Shrink_information+0x7c> 40007e8c: e2 02 00 00 ld [ %o0 ], %l1 (index < (index_base + information->allocation_size))) { 40007e90: c4 16 20 14 lduh [ %i0 + 0x14 ], %g2 40007e94: 84 04 00 02 add %l0, %g2, %g2 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && 40007e98: 80 a0 40 02 cmp %g1, %g2 40007e9c: 1a bf ff f6 bcc 40007e74 <_Objects_Shrink_information+0x80> 40007ea0: 80 a4 60 00 cmp %l1, 0 (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); 40007ea4: 7f ff fb 3a call 40006b8c <_Chain_Extract> 40007ea8: 01 00 00 00 nop } } while ( the_object ); 40007eac: 80 a4 60 00 cmp %l1, 0 40007eb0: 12 bf ff f4 bne 40007e80 <_Objects_Shrink_information+0x8c><== ALWAYS TAKEN 40007eb4: 90 10 00 11 mov %l1, %o0 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); 40007eb8: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 <== NOT EXECUTED 40007ebc: 40 00 07 5e call 40009c34 <_Workspace_Free> 40007ec0: d0 00 40 12 ld [ %g1 + %l2 ], %o0 information->object_blocks[ block ] = NULL; 40007ec4: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 information->inactive_per_block[ block ] = 0; 40007ec8: c6 06 20 30 ld [ %i0 + 0x30 ], %g3 information->inactive -= information->allocation_size; 40007ecc: c4 16 20 2c lduh [ %i0 + 0x2c ], %g2 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; 40007ed0: c0 20 40 12 clr [ %g1 + %l2 ] information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; 40007ed4: c2 16 20 14 lduh [ %i0 + 0x14 ], %g1 * 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; 40007ed8: c0 20 c0 12 clr [ %g3 + %l2 ] information->inactive -= information->allocation_size; 40007edc: 82 20 80 01 sub %g2, %g1, %g1 40007ee0: c2 36 20 2c sth %g1, [ %i0 + 0x2c ] return; 40007ee4: 81 c7 e0 08 ret 40007ee8: 81 e8 00 00 restore =============================================================================== 4000b238 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4000b238: 9d e3 bf 98 save %sp, -104, %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( 4000b23c: 11 10 00 a2 sethi %hi(0x40028800), %o0 4000b240: 92 10 00 18 mov %i0, %o1 4000b244: 90 12 20 bc or %o0, 0xbc, %o0 4000b248: 40 00 0d 5a call 4000e7b0 <_Objects_Get> 4000b24c: 94 07 bf fc add %fp, -4, %o2 Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 4000b250: c2 07 bf fc ld [ %fp + -4 ], %g1 4000b254: 80 a0 60 00 cmp %g1, 0 4000b258: 22 80 00 08 be,a 4000b278 <_POSIX_Message_queue_Receive_support+0x40> 4000b25c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000b260: 40 00 2d 1c call 400166d0 <__errno> 4000b264: b0 10 3f ff mov -1, %i0 4000b268: 82 10 20 09 mov 9, %g1 4000b26c: c2 22 00 00 st %g1, [ %o0 ] } 4000b270: 81 c7 e0 08 ret 4000b274: 81 e8 00 00 restore the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 4000b278: 84 08 60 03 and %g1, 3, %g2 4000b27c: 80 a0 a0 01 cmp %g2, 1 4000b280: 02 80 00 36 be 4000b358 <_POSIX_Message_queue_Receive_support+0x120> 4000b284: 01 00 00 00 nop _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 4000b288: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 4000b28c: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 4000b290: 80 a0 80 1a cmp %g2, %i2 4000b294: 18 80 00 20 bgu 4000b314 <_POSIX_Message_queue_Receive_support+0xdc> 4000b298: 84 10 3f ff mov -1, %g2 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 4000b29c: c4 27 bf f8 st %g2, [ %fp + -8 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000b2a0: 80 8f 20 ff btst 0xff, %i4 4000b2a4: 12 80 00 17 bne 4000b300 <_POSIX_Message_queue_Receive_support+0xc8><== ALWAYS TAKEN 4000b2a8: 98 10 20 00 clr %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4000b2ac: 9a 10 00 1d mov %i5, %o5 4000b2b0: 90 02 20 1c add %o0, 0x1c, %o0 4000b2b4: 92 10 00 18 mov %i0, %o1 4000b2b8: 94 10 00 19 mov %i1, %o2 4000b2bc: 40 00 08 ca call 4000d5e4 <_CORE_message_queue_Seize> 4000b2c0: 96 07 bf f8 add %fp, -8, %o3 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 4000b2c4: 40 00 10 67 call 4000f460 <_Thread_Enable_dispatch> 4000b2c8: 3b 10 00 a2 sethi %hi(0x40028800), %i5 *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4000b2cc: ba 17 61 28 or %i5, 0x128, %i5 ! 40028928 <_Per_CPU_Information> 4000b2d0: c2 07 60 0c ld [ %i5 + 0xc ], %g1 RTEMS_INLINE_ROUTINE unsigned int _POSIX_Message_queue_Priority_from_core( CORE_message_queue_Submit_types priority ) { /* absolute value without a library dependency */ return ((priority >= 0) ? priority : -priority); 4000b2d4: c4 00 60 24 ld [ %g1 + 0x24 ], %g2 if ( !_Thread_Executing->Wait.return_code ) 4000b2d8: c6 00 60 34 ld [ %g1 + 0x34 ], %g3 4000b2dc: 83 38 a0 1f sra %g2, 0x1f, %g1 4000b2e0: 84 18 40 02 xor %g1, %g2, %g2 4000b2e4: 82 20 80 01 sub %g2, %g1, %g1 4000b2e8: 80 a0 e0 00 cmp %g3, 0 4000b2ec: 12 80 00 12 bne 4000b334 <_POSIX_Message_queue_Receive_support+0xfc> 4000b2f0: c2 26 c0 00 st %g1, [ %i3 ] return length_out; 4000b2f4: f0 07 bf f8 ld [ %fp + -8 ], %i0 4000b2f8: 81 c7 e0 08 ret 4000b2fc: 81 e8 00 00 restore /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000b300: 05 00 00 10 sethi %hi(0x4000), %g2 4000b304: 82 08 40 02 and %g1, %g2, %g1 length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000b308: 80 a0 00 01 cmp %g0, %g1 4000b30c: 10 bf ff e8 b 4000b2ac <_POSIX_Message_queue_Receive_support+0x74> 4000b310: 98 60 3f ff subx %g0, -1, %o4 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { _Thread_Enable_dispatch(); 4000b314: 40 00 10 53 call 4000f460 <_Thread_Enable_dispatch> 4000b318: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EMSGSIZE ); 4000b31c: 40 00 2c ed call 400166d0 <__errno> 4000b320: 01 00 00 00 nop 4000b324: 82 10 20 7a mov 0x7a, %g1 ! 7a 4000b328: c2 22 00 00 st %g1, [ %o0 ] 4000b32c: 81 c7 e0 08 ret 4000b330: 81 e8 00 00 restore _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) return length_out; rtems_set_errno_and_return_minus_one( 4000b334: 40 00 2c e7 call 400166d0 <__errno> 4000b338: b0 10 3f ff mov -1, %i0 4000b33c: c2 07 60 0c ld [ %i5 + 0xc ], %g1 4000b340: b6 10 00 08 mov %o0, %i3 4000b344: 40 00 00 b1 call 4000b608 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000b348: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000b34c: d0 26 c0 00 st %o0, [ %i3 ] 4000b350: 81 c7 e0 08 ret 4000b354: 81 e8 00 00 restore the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { _Thread_Enable_dispatch(); 4000b358: 40 00 10 42 call 4000f460 <_Thread_Enable_dispatch> 4000b35c: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EBADF ); 4000b360: 40 00 2c dc call 400166d0 <__errno> 4000b364: 01 00 00 00 nop 4000b368: 82 10 20 09 mov 9, %g1 ! 9 4000b36c: c2 22 00 00 st %g1, [ %o0 ] 4000b370: 81 c7 e0 08 ret 4000b374: 81 e8 00 00 restore =============================================================================== 4000b390 <_POSIX_Message_queue_Send_support>: size_t msg_len, uint32_t msg_prio, bool wait, Watchdog_Interval timeout ) { 4000b390: 9d e3 bf 90 save %sp, -112, %sp /* * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) 4000b394: 80 a6 e0 20 cmp %i3, 0x20 4000b398: 18 80 00 48 bgu 4000b4b8 <_POSIX_Message_queue_Send_support+0x128> 4000b39c: 92 10 00 18 mov %i0, %o1 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( 4000b3a0: 11 10 00 a2 sethi %hi(0x40028800), %o0 4000b3a4: 94 07 bf fc add %fp, -4, %o2 4000b3a8: 40 00 0d 02 call 4000e7b0 <_Objects_Get> 4000b3ac: 90 12 20 bc or %o0, 0xbc, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 4000b3b0: c2 07 bf fc ld [ %fp + -4 ], %g1 4000b3b4: 80 a0 60 00 cmp %g1, 0 4000b3b8: 12 80 00 32 bne 4000b480 <_POSIX_Message_queue_Send_support+0xf0> 4000b3bc: 01 00 00 00 nop case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { 4000b3c0: c4 02 20 14 ld [ %o0 + 0x14 ], %g2 4000b3c4: 80 88 a0 03 btst 3, %g2 4000b3c8: 02 80 00 42 be 4000b4d0 <_POSIX_Message_queue_Send_support+0x140> 4000b3cc: 80 8f 20 ff btst 0xff, %i4 _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 4000b3d0: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000b3d4: 12 80 00 15 bne 4000b428 <_POSIX_Message_queue_Send_support+0x98> 4000b3d8: 82 10 20 00 clr %g1 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( 4000b3dc: 92 10 00 19 mov %i1, %o1 4000b3e0: 94 10 00 1a mov %i2, %o2 4000b3e4: 96 10 00 18 mov %i0, %o3 4000b3e8: 98 10 20 00 clr %o4 4000b3ec: 9a 20 00 1b neg %i3, %o5 4000b3f0: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 4000b3f4: fa 23 a0 60 st %i5, [ %sp + 0x60 ] 4000b3f8: 40 00 08 bc call 4000d6e8 <_CORE_message_queue_Submit> 4000b3fc: 90 02 20 1c add %o0, 0x1c, %o0 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); 4000b400: 40 00 10 18 call 4000f460 <_Thread_Enable_dispatch> 4000b404: ba 10 00 08 mov %o0, %i5 * 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 ) 4000b408: 80 a7 60 07 cmp %i5, 7 4000b40c: 02 80 00 1a be 4000b474 <_POSIX_Message_queue_Send_support+0xe4><== NEVER TAKEN 4000b410: 03 10 00 a2 sethi %hi(0x40028800), %g1 msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) 4000b414: 80 a7 60 00 cmp %i5, 0 4000b418: 12 80 00 20 bne 4000b498 <_POSIX_Message_queue_Send_support+0x108> 4000b41c: b0 10 20 00 clr %i0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } 4000b420: 81 c7 e0 08 ret 4000b424: 81 e8 00 00 restore /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000b428: 03 00 00 10 sethi %hi(0x4000), %g1 4000b42c: 84 08 80 01 and %g2, %g1, %g2 the_mq = the_mq_fd->Queue; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000b430: 80 a0 00 02 cmp %g0, %g2 4000b434: 82 60 3f ff subx %g0, -1, %g1 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( 4000b438: 92 10 00 19 mov %i1, %o1 4000b43c: 94 10 00 1a mov %i2, %o2 4000b440: 96 10 00 18 mov %i0, %o3 4000b444: 98 10 20 00 clr %o4 4000b448: 9a 20 00 1b neg %i3, %o5 4000b44c: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 4000b450: fa 23 a0 60 st %i5, [ %sp + 0x60 ] 4000b454: 40 00 08 a5 call 4000d6e8 <_CORE_message_queue_Submit> 4000b458: 90 02 20 1c add %o0, 0x1c, %o0 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); 4000b45c: 40 00 10 01 call 4000f460 <_Thread_Enable_dispatch> 4000b460: ba 10 00 08 mov %o0, %i5 * 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 ) 4000b464: 80 a7 60 07 cmp %i5, 7 4000b468: 12 bf ff ec bne 4000b418 <_POSIX_Message_queue_Send_support+0x88> 4000b46c: 80 a7 60 00 cmp %i5, 0 msg_status = _Thread_Executing->Wait.return_code; 4000b470: 03 10 00 a2 sethi %hi(0x40028800), %g1 4000b474: c2 00 61 34 ld [ %g1 + 0x134 ], %g1 ! 40028934 <_Per_CPU_Information+0xc> 4000b478: 10 bf ff e7 b 4000b414 <_POSIX_Message_queue_Send_support+0x84> 4000b47c: fa 00 60 34 ld [ %g1 + 0x34 ], %i5 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000b480: 40 00 2c 94 call 400166d0 <__errno> 4000b484: b0 10 3f ff mov -1, %i0 4000b488: 82 10 20 09 mov 9, %g1 4000b48c: c2 22 00 00 st %g1, [ %o0 ] } 4000b490: 81 c7 e0 08 ret 4000b494: 81 e8 00 00 restore msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) return msg_status; rtems_set_errno_and_return_minus_one( 4000b498: 40 00 2c 8e call 400166d0 <__errno> 4000b49c: b0 10 3f ff mov -1, %i0 4000b4a0: b8 10 00 08 mov %o0, %i4 4000b4a4: 40 00 00 59 call 4000b608 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000b4a8: 90 10 00 1d mov %i5, %o0 4000b4ac: d0 27 00 00 st %o0, [ %i4 ] 4000b4b0: 81 c7 e0 08 ret 4000b4b4: 81 e8 00 00 restore * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) rtems_set_errno_and_return_minus_one( EINVAL ); 4000b4b8: 40 00 2c 86 call 400166d0 <__errno> 4000b4bc: b0 10 3f ff mov -1, %i0 4000b4c0: 82 10 20 16 mov 0x16, %g1 4000b4c4: c2 22 00 00 st %g1, [ %o0 ] 4000b4c8: 81 c7 e0 08 ret 4000b4cc: 81 e8 00 00 restore the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { _Thread_Enable_dispatch(); 4000b4d0: 40 00 0f e4 call 4000f460 <_Thread_Enable_dispatch> 4000b4d4: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EBADF ); 4000b4d8: 40 00 2c 7e call 400166d0 <__errno> 4000b4dc: 01 00 00 00 nop 4000b4e0: 82 10 20 09 mov 9, %g1 ! 9 4000b4e4: c2 22 00 00 st %g1, [ %o0 ] 4000b4e8: 81 c7 e0 08 ret 4000b4ec: 81 e8 00 00 restore =============================================================================== 4000bda0 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>: Thread_Control *the_thread ) { POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000bda0: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000bda4: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 4000bda8: 80 a0 a0 00 cmp %g2, 0 4000bdac: 12 80 00 06 bne 4000bdc4 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x24><== NEVER TAKEN 4000bdb0: 01 00 00 00 nop 4000bdb4: c4 00 60 dc ld [ %g1 + 0xdc ], %g2 4000bdb8: 80 a0 a0 01 cmp %g2, 1 4000bdbc: 22 80 00 05 be,a 4000bdd0 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x30> 4000bdc0: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); } else _Thread_Enable_dispatch(); 4000bdc4: 82 13 c0 00 mov %o7, %g1 4000bdc8: 7f ff f3 8c call 40008bf8 <_Thread_Enable_dispatch> 4000bdcc: 9e 10 40 00 mov %g1, %o7 POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 4000bdd0: 80 a0 60 00 cmp %g1, 0 4000bdd4: 02 bf ff fc be 4000bdc4 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x24> 4000bdd8: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000bddc: 03 10 00 5e sethi %hi(0x40017800), %g1 4000bde0: c4 00 60 d0 ld [ %g1 + 0xd0 ], %g2 ! 400178d0 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 4000bde4: 92 10 3f ff mov -1, %o1 4000bde8: 84 00 bf ff add %g2, -1, %g2 4000bdec: c4 20 60 d0 st %g2, [ %g1 + 0xd0 ] 4000bdf0: 82 13 c0 00 mov %o7, %g1 4000bdf4: 40 00 02 27 call 4000c690 <_POSIX_Thread_Exit> 4000bdf8: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000d360 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4000d360: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4000d364: d0 06 40 00 ld [ %i1 ], %o0 4000d368: 7f ff ff f1 call 4000d32c <_POSIX_Priority_Is_valid> 4000d36c: a0 10 00 18 mov %i0, %l0 4000d370: 80 8a 20 ff btst 0xff, %o0 4000d374: 02 80 00 0e be 4000d3ac <_POSIX_Thread_Translate_sched_param+0x4c><== NEVER TAKEN 4000d378: b0 10 20 16 mov 0x16, %i0 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4000d37c: c0 26 80 00 clr [ %i2 ] *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 4000d380: 80 a4 20 00 cmp %l0, 0 4000d384: 02 80 00 0c be 4000d3b4 <_POSIX_Thread_Translate_sched_param+0x54> 4000d388: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { 4000d38c: 80 a4 20 01 cmp %l0, 1 4000d390: 02 80 00 07 be 4000d3ac <_POSIX_Thread_Translate_sched_param+0x4c> 4000d394: b0 10 20 00 clr %i0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 4000d398: 80 a4 20 02 cmp %l0, 2 4000d39c: 02 80 00 2e be 4000d454 <_POSIX_Thread_Translate_sched_param+0xf4> 4000d3a0: 80 a4 20 04 cmp %l0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { 4000d3a4: 02 80 00 08 be 4000d3c4 <_POSIX_Thread_Translate_sched_param+0x64> 4000d3a8: b0 10 20 16 mov 0x16, %i0 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } 4000d3ac: 81 c7 e0 08 ret 4000d3b0: 81 e8 00 00 restore *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000d3b4: 82 10 20 01 mov 1, %g1 4000d3b8: c2 26 80 00 st %g1, [ %i2 ] return 0; 4000d3bc: 81 c7 e0 08 ret 4000d3c0: 91 e8 20 00 restore %g0, 0, %o0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { if ( (param->sched_ss_repl_period.tv_sec == 0) && 4000d3c4: c2 06 60 08 ld [ %i1 + 8 ], %g1 4000d3c8: 80 a0 60 00 cmp %g1, 0 4000d3cc: 32 80 00 07 bne,a 4000d3e8 <_POSIX_Thread_Translate_sched_param+0x88> 4000d3d0: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d3d4: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000d3d8: 80 a0 60 00 cmp %g1, 0 4000d3dc: 02 80 00 1f be 4000d458 <_POSIX_Thread_Translate_sched_param+0xf8> 4000d3e0: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4000d3e4: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d3e8: 80 a0 60 00 cmp %g1, 0 4000d3ec: 12 80 00 06 bne 4000d404 <_POSIX_Thread_Translate_sched_param+0xa4> 4000d3f0: 01 00 00 00 nop 4000d3f4: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000d3f8: 80 a0 60 00 cmp %g1, 0 4000d3fc: 02 bf ff ec be 4000d3ac <_POSIX_Thread_Translate_sched_param+0x4c> 4000d400: b0 10 20 16 mov 0x16, %i0 (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 4000d404: 7f ff f4 e4 call 4000a794 <_Timespec_To_ticks> 4000d408: 90 06 60 08 add %i1, 8, %o0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; 4000d40c: b0 10 20 16 mov 0x16, %i0 if ( (param->sched_ss_init_budget.tv_sec == 0) && (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 4000d410: a0 10 00 08 mov %o0, %l0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 4000d414: 7f ff f4 e0 call 4000a794 <_Timespec_To_ticks> 4000d418: 90 06 60 10 add %i1, 0x10, %o0 if ( (param->sched_ss_init_budget.tv_sec == 0) && (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 4000d41c: 80 a4 00 08 cmp %l0, %o0 4000d420: 0a 80 00 0e bcs 4000d458 <_POSIX_Thread_Translate_sched_param+0xf8> 4000d424: 01 00 00 00 nop _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) 4000d428: 7f ff ff c1 call 4000d32c <_POSIX_Priority_Is_valid> 4000d42c: d0 06 60 04 ld [ %i1 + 4 ], %o0 4000d430: 80 8a 20 ff btst 0xff, %o0 4000d434: 02 bf ff de be 4000d3ac <_POSIX_Thread_Translate_sched_param+0x4c> 4000d438: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4000d43c: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 4000d440: 03 10 00 1a sethi %hi(0x40006800), %g1 4000d444: 82 10 60 b8 or %g1, 0xb8, %g1 ! 400068b8 <_POSIX_Threads_Sporadic_budget_callout> 4000d448: c2 26 c0 00 st %g1, [ %i3 ] return 0; } return EINVAL; } 4000d44c: 81 c7 e0 08 ret 4000d450: 91 e8 20 00 restore %g0, 0, %o0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 4000d454: e0 26 80 00 st %l0, [ %i2 ] return 0; 4000d458: 81 c7 e0 08 ret 4000d45c: 81 e8 00 00 restore =============================================================================== 400065a8 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 400065a8: 9d e3 bf 58 save %sp, -168, %sp uint32_t maximum; posix_initialization_threads_table *user_threads; pthread_t thread_id; pthread_attr_t attr; user_threads = Configuration_POSIX_API.User_initialization_threads_table; 400065ac: 03 10 00 79 sethi %hi(0x4001e400), %g1 400065b0: 82 10 63 4c or %g1, 0x34c, %g1 ! 4001e74c maximum = Configuration_POSIX_API.number_of_initialization_threads; 400065b4: e6 00 60 30 ld [ %g1 + 0x30 ], %l3 if ( !user_threads || maximum == 0 ) 400065b8: 80 a4 e0 00 cmp %l3, 0 400065bc: 02 80 00 1a be 40006624 <_POSIX_Threads_Initialize_user_threads_body+0x7c><== NEVER TAKEN 400065c0: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 400065c4: 80 a4 60 00 cmp %l1, 0 400065c8: 02 80 00 17 be 40006624 <_POSIX_Threads_Initialize_user_threads_body+0x7c><== NEVER TAKEN 400065cc: a4 10 20 00 clr %l2 400065d0: a0 07 bf bc add %fp, -68, %l0 400065d4: a8 07 bf fc add %fp, -4, %l4 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); 400065d8: 40 00 1b a2 call 4000d460 400065dc: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 400065e0: 92 10 20 02 mov 2, %o1 400065e4: 40 00 1b ab call 4000d490 400065e8: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 400065ec: d2 04 60 04 ld [ %l1 + 4 ], %o1 400065f0: 40 00 1b b8 call 4000d4d0 400065f4: 90 10 00 10 mov %l0, %o0 status = pthread_create( 400065f8: d4 04 40 00 ld [ %l1 ], %o2 400065fc: 90 10 00 14 mov %l4, %o0 40006600: 92 10 00 10 mov %l0, %o1 40006604: 7f ff ff 1b call 40006270 40006608: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 4000660c: 94 92 20 00 orcc %o0, 0, %o2 40006610: 12 80 00 07 bne 4000662c <_POSIX_Threads_Initialize_user_threads_body+0x84> 40006614: a4 04 a0 01 inc %l2 * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { 40006618: 80 a4 c0 12 cmp %l3, %l2 4000661c: 18 bf ff ef bgu 400065d8 <_POSIX_Threads_Initialize_user_threads_body+0x30><== NEVER TAKEN 40006620: a2 04 60 08 add %l1, 8, %l1 40006624: 81 c7 e0 08 ret 40006628: 81 e8 00 00 restore &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 4000662c: 90 10 20 02 mov 2, %o0 40006630: 40 00 08 70 call 400087f0 <_Internal_error_Occurred> 40006634: 92 10 20 01 mov 1, %o1 =============================================================================== 4000c128 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 4000c128: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *the_thread; POSIX_API_Control *api; the_thread = argument; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000c12c: e0 06 61 58 ld [ %i1 + 0x158 ], %l0 /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); 4000c130: 40 00 04 60 call 4000d2b0 <_Timespec_To_ticks> 4000c134: 90 04 20 98 add %l0, 0x98, %o0 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 4000c138: c4 04 20 88 ld [ %l0 + 0x88 ], %g2 4000c13c: 03 10 00 56 sethi %hi(0x40015800), %g1 4000c140: d2 08 62 64 ldub [ %g1 + 0x264 ], %o1 ! 40015a64 */ #if 0 printk( "TSR %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 4000c144: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 4000c148: 92 22 40 02 sub %o1, %g2, %o1 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); the_thread->cpu_time_budget = ticks; 4000c14c: d0 26 60 78 st %o0, [ %i1 + 0x78 ] */ #if 0 printk( "TSR %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 4000c150: 80 a0 60 00 cmp %g1, 0 4000c154: 12 80 00 06 bne 4000c16c <_POSIX_Threads_Sporadic_budget_TSR+0x44><== NEVER TAKEN 4000c158: d2 26 60 18 st %o1, [ %i1 + 0x18 ] /* * If this would make them less important, then do not change it. */ if ( the_thread->current_priority > new_priority ) { 4000c15c: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000c160: 80 a0 40 09 cmp %g1, %o1 4000c164: 38 80 00 09 bgu,a 4000c188 <_POSIX_Threads_Sporadic_budget_TSR+0x60> 4000c168: 90 10 00 19 mov %i1, %o0 #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); 4000c16c: 40 00 04 51 call 4000d2b0 <_Timespec_To_ticks> 4000c170: 90 04 20 90 add %l0, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000c174: 31 10 00 59 sethi %hi(0x40016400), %i0 4000c178: b2 04 20 a8 add %l0, 0xa8, %i1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000c17c: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000c180: 7f ff f5 bd call 40009874 <_Watchdog_Insert> 4000c184: 91 ee 20 b0 restore %i0, 0xb0, %o0 if ( the_thread->resource_count == 0 ) { /* * If this would make them less important, then do not change it. */ if ( the_thread->current_priority > new_priority ) { _Thread_Change_priority( the_thread, new_priority, true ); 4000c188: 7f ff f0 79 call 4000836c <_Thread_Change_priority> 4000c18c: 94 10 20 01 mov 1, %o2 #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); 4000c190: 40 00 04 48 call 4000d2b0 <_Timespec_To_ticks> 4000c194: 90 04 20 90 add %l0, 0x90, %o0 4000c198: 31 10 00 59 sethi %hi(0x40016400), %i0 4000c19c: b2 04 20 a8 add %l0, 0xa8, %i1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000c1a0: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000c1a4: 7f ff f5 b4 call 40009874 <_Watchdog_Insert> 4000c1a8: 91 ee 20 b0 restore %i0, 0xb0, %o0 =============================================================================== 4000c1b0 <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000c1b0: c4 02 21 58 ld [ %o0 + 0x158 ], %g2 4000c1b4: c6 00 a0 8c ld [ %g2 + 0x8c ], %g3 4000c1b8: 05 10 00 56 sethi %hi(0x40015800), %g2 4000c1bc: d2 08 a2 64 ldub [ %g2 + 0x264 ], %o1 ! 40015a64 */ #if 0 printk( "callout %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 4000c1c0: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 4000c1c4: 92 22 40 03 sub %o1, %g3, %o1 /* * This will prevent the thread from consuming its entire "budget" * while at low priority. */ the_thread->cpu_time_budget = 0xFFFFFFFF; /* XXX should be based on MAX_U32 */ 4000c1c8: 86 10 3f ff mov -1, %g3 new_priority = _POSIX_Priority_To_core(api->schedparam.sched_ss_low_priority); the_thread->real_priority = new_priority; 4000c1cc: d2 22 20 18 st %o1, [ %o0 + 0x18 ] */ #if 0 printk( "callout %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 4000c1d0: 80 a0 a0 00 cmp %g2, 0 4000c1d4: 12 80 00 06 bne 4000c1ec <_POSIX_Threads_Sporadic_budget_callout+0x3c><== NEVER TAKEN 4000c1d8: c6 22 20 78 st %g3, [ %o0 + 0x78 ] /* * Make sure we are actually lowering it. If they have lowered it * to logically lower than sched_ss_low_priority, then we do not want to * change it. */ if ( the_thread->current_priority < new_priority ) { 4000c1dc: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000c1e0: 80 a0 40 09 cmp %g1, %o1 4000c1e4: 0a 80 00 04 bcs 4000c1f4 <_POSIX_Threads_Sporadic_budget_callout+0x44><== ALWAYS TAKEN 4000c1e8: 94 10 20 01 mov 1, %o2 4000c1ec: 81 c3 e0 08 retl <== NOT EXECUTED 4000c1f0: 01 00 00 00 nop <== NOT EXECUTED _Thread_Change_priority( the_thread, new_priority, true ); 4000c1f4: 82 13 c0 00 mov %o7, %g1 4000c1f8: 7f ff f0 5d call 4000836c <_Thread_Change_priority> 4000c1fc: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000e720 <_POSIX_Threads_cancel_run>: #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { 4000e720: 9d e3 bf a0 save %sp, -96, %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 ]; 4000e724: e2 06 21 58 ld [ %i0 + 0x158 ], %l1 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; 4000e728: 84 10 20 01 mov 1, %g2 while ( !_Chain_Is_empty( handler_stack ) ) { 4000e72c: c2 04 60 e4 ld [ %l1 + 0xe4 ], %g1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000e730: a4 04 60 e8 add %l1, 0xe8, %l2 4000e734: 80 a0 40 12 cmp %g1, %l2 4000e738: 02 80 00 14 be 4000e788 <_POSIX_Threads_cancel_run+0x68> 4000e73c: c4 24 60 d8 st %g2, [ %l1 + 0xd8 ] _ISR_Disable( level ); 4000e740: 7f ff cd 66 call 40001cd8 4000e744: 01 00 00 00 nop handler = (POSIX_Cancel_Handler_control *) 4000e748: e0 04 60 ec ld [ %l1 + 0xec ], %l0 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4000e74c: c4 04 00 00 ld [ %l0 ], %g2 previous = the_node->previous; 4000e750: c2 04 20 04 ld [ %l0 + 4 ], %g1 next->previous = previous; 4000e754: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000e758: c4 20 40 00 st %g2, [ %g1 ] _Chain_Tail( handler_stack )->previous; _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); 4000e75c: 7f ff cd 63 call 40001ce8 4000e760: 01 00 00 00 nop (*handler->routine)( handler->arg ); 4000e764: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000e768: 9f c0 40 00 call %g1 4000e76c: d0 04 20 0c ld [ %l0 + 0xc ], %o0 _Workspace_Free( handler ); 4000e770: 7f ff ed 31 call 40009c34 <_Workspace_Free> 4000e774: 90 10 00 10 mov %l0, %o0 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { 4000e778: c2 04 60 e4 ld [ %l1 + 0xe4 ], %g1 4000e77c: 80 a0 40 12 cmp %g1, %l2 4000e780: 12 bf ff f0 bne 4000e740 <_POSIX_Threads_cancel_run+0x20> <== NEVER TAKEN 4000e784: 01 00 00 00 nop 4000e788: 81 c7 e0 08 ret 4000e78c: 81 e8 00 00 restore =============================================================================== 40006328 <_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) { 40006328: 9d e3 bf a0 save %sp, -96, %sp bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 4000632c: c4 06 60 68 ld [ %i1 + 0x68 ], %g2 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 40006330: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 40006334: 84 00 a0 01 inc %g2 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 40006338: 80 a0 60 00 cmp %g1, 0 4000633c: 12 80 00 0e bne 40006374 <_POSIX_Timer_TSR+0x4c> 40006340: c4 26 60 68 st %g2, [ %i1 + 0x68 ] 40006344: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 40006348: 80 a0 60 00 cmp %g1, 0 4000634c: 32 80 00 0b bne,a 40006378 <_POSIX_Timer_TSR+0x50> <== ALWAYS TAKEN 40006350: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 40006354: 82 10 20 04 mov 4, %g1 40006358: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] <== NOT EXECUTED /* * 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 ) ) { 4000635c: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 40006360: 40 00 1a 1f call 4000cbdc 40006364: d2 06 60 44 ld [ %i1 + 0x44 ], %o1 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 40006368: c0 26 60 68 clr [ %i1 + 0x68 ] 4000636c: 81 c7 e0 08 ret 40006370: 81 e8 00 00 restore ptimer->overrun = ptimer->overrun + 1; /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 40006374: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40006378: d4 06 60 08 ld [ %i1 + 8 ], %o2 4000637c: 90 06 60 10 add %i1, 0x10, %o0 40006380: 98 10 00 19 mov %i1, %o4 40006384: 17 10 00 18 sethi %hi(0x40006000), %o3 40006388: 40 00 1b 42 call 4000d090 <_POSIX_Timer_Insert_helper> 4000638c: 96 12 e3 28 or %o3, 0x328, %o3 ! 40006328 <_POSIX_Timer_TSR> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 40006390: 80 8a 20 ff btst 0xff, %o0 40006394: 02 bf ff f6 be 4000636c <_POSIX_Timer_TSR+0x44> <== NEVER TAKEN 40006398: 01 00 00 00 nop return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 4000639c: 40 00 06 03 call 40007ba8 <_TOD_Get> 400063a0: 90 06 60 6c add %i1, 0x6c, %o0 /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 400063a4: 82 10 20 03 mov 3, %g1 400063a8: 10 bf ff ed b 4000635c <_POSIX_Timer_TSR+0x34> 400063ac: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] =============================================================================== 4000e840 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000e840: 9d e3 bf 68 save %sp, -152, %sp siginfo_t siginfo_struct; sigset_t saved_signals_blocked; Thread_Wait_information stored_thread_wait_information; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 4000e844: 98 10 20 01 mov 1, %o4 4000e848: 90 10 00 18 mov %i0, %o0 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000e84c: a0 10 00 18 mov %i0, %l0 siginfo_t siginfo_struct; sigset_t saved_signals_blocked; Thread_Wait_information stored_thread_wait_information; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 4000e850: a2 07 bf f4 add %fp, -12, %l1 4000e854: 92 10 00 19 mov %i1, %o1 4000e858: 94 10 00 11 mov %l1, %o2 4000e85c: 96 0e a0 ff and %i2, 0xff, %o3 4000e860: 40 00 00 2d call 4000e914 <_POSIX_signals_Clear_signals> 4000e864: b0 10 20 00 clr %i0 4000e868: 80 8a 20 ff btst 0xff, %o0 4000e86c: 02 80 00 23 be 4000e8f8 <_POSIX_signals_Check_signal+0xb8> 4000e870: 83 2e 60 02 sll %i1, 2, %g1 #endif /* * Just to prevent sending a signal which is currently being ignored. */ if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN ) 4000e874: 29 10 00 5a sethi %hi(0x40016800), %l4 4000e878: a7 2e 60 04 sll %i1, 4, %l3 4000e87c: a8 15 21 80 or %l4, 0x180, %l4 4000e880: a6 24 c0 01 sub %l3, %g1, %l3 4000e884: 82 05 00 13 add %l4, %l3, %g1 4000e888: e4 00 60 08 ld [ %g1 + 8 ], %l2 4000e88c: 80 a4 a0 01 cmp %l2, 1 4000e890: 02 80 00 1a be 4000e8f8 <_POSIX_signals_Check_signal+0xb8><== NEVER TAKEN 4000e894: 2f 10 00 5a sethi %hi(0x40016800), %l7 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 4000e898: ea 04 20 d0 ld [ %l0 + 0xd0 ], %l5 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000e89c: c2 00 60 04 ld [ %g1 + 4 ], %g1 /* * We have to save the blocking information of the current wait queue * because the signal handler may subsequently go on and put the thread * on a wait queue, for its own purposes. */ memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait, 4000e8a0: ae 15 e1 28 or %l7, 0x128, %l7 4000e8a4: d2 05 e0 0c ld [ %l7 + 0xc ], %o1 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000e8a8: 82 10 40 15 or %g1, %l5, %g1 /* * We have to save the blocking information of the current wait queue * because the signal handler may subsequently go on and put the thread * on a wait queue, for its own purposes. */ memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait, 4000e8ac: ac 07 bf cc add %fp, -52, %l6 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000e8b0: c2 24 20 d0 st %g1, [ %l0 + 0xd0 ] /* * We have to save the blocking information of the current wait queue * because the signal handler may subsequently go on and put the thread * on a wait queue, for its own purposes. */ memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait, 4000e8b4: 90 10 00 16 mov %l6, %o0 4000e8b8: 92 02 60 20 add %o1, 0x20, %o1 4000e8bc: 40 00 04 57 call 4000fa18 4000e8c0: 94 10 20 28 mov 0x28, %o2 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 4000e8c4: c2 05 00 13 ld [ %l4 + %l3 ], %g1 4000e8c8: 80 a0 60 02 cmp %g1, 2 4000e8cc: 02 80 00 0d be 4000e900 <_POSIX_signals_Check_signal+0xc0> 4000e8d0: 90 10 00 19 mov %i1, %o0 &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 4000e8d4: 9f c4 80 00 call %l2 4000e8d8: 90 10 00 19 mov %i1, %o0 } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 4000e8dc: d0 05 e0 0c ld [ %l7 + 0xc ], %o0 4000e8e0: 92 10 00 16 mov %l6, %o1 4000e8e4: 90 02 20 20 add %o0, 0x20, %o0 4000e8e8: 94 10 20 28 mov 0x28, %o2 4000e8ec: 40 00 04 4b call 4000fa18 4000e8f0: b0 10 20 01 mov 1, %i0 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 4000e8f4: ea 24 20 d0 st %l5, [ %l0 + 0xd0 ] return true; } 4000e8f8: 81 c7 e0 08 ret 4000e8fc: 81 e8 00 00 restore /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 4000e900: 92 10 00 11 mov %l1, %o1 4000e904: 9f c4 80 00 call %l2 4000e908: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 4000e90c: 10 bf ff f5 b 4000e8e0 <_POSIX_signals_Check_signal+0xa0> 4000e910: d0 05 e0 0c ld [ %l7 + 0xc ], %o0 =============================================================================== 4000f014 <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 4000f014: 9d e3 bf a0 save %sp, -96, %sp clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4000f018: 7f ff cb 30 call 40001cd8 4000f01c: 01 00 00 00 nop if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4000f020: 85 2e 20 04 sll %i0, 4, %g2 4000f024: 83 2e 20 02 sll %i0, 2, %g1 4000f028: 82 20 80 01 sub %g2, %g1, %g1 4000f02c: 05 10 00 5a sethi %hi(0x40016800), %g2 4000f030: 84 10 a1 80 or %g2, 0x180, %g2 ! 40016980 <_POSIX_signals_Vectors> 4000f034: c4 00 80 01 ld [ %g2 + %g1 ], %g2 4000f038: 80 a0 a0 02 cmp %g2, 2 4000f03c: 02 80 00 0b be 4000f068 <_POSIX_signals_Clear_process_signals+0x54> 4000f040: 05 10 00 5a sethi %hi(0x40016800), %g2 if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 4000f044: 03 10 00 5a sethi %hi(0x40016800), %g1 4000f048: c4 00 63 74 ld [ %g1 + 0x374 ], %g2 ! 40016b74 <_POSIX_signals_Pending> 4000f04c: 86 10 20 01 mov 1, %g3 4000f050: b0 06 3f ff add %i0, -1, %i0 4000f054: b1 28 c0 18 sll %g3, %i0, %i0 4000f058: b0 28 80 18 andn %g2, %i0, %i0 4000f05c: f0 20 63 74 st %i0, [ %g1 + 0x374 ] } _ISR_Enable( level ); 4000f060: 7f ff cb 22 call 40001ce8 4000f064: 91 e8 00 08 restore %g0, %o0, %o0 } 4000f068: 84 10 a3 78 or %g2, 0x378, %g2 ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 4000f06c: c6 00 80 01 ld [ %g2 + %g1 ], %g3 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000f070: 82 00 40 02 add %g1, %g2, %g1 4000f074: 82 00 60 04 add %g1, 4, %g1 4000f078: 80 a0 c0 01 cmp %g3, %g1 4000f07c: 02 bf ff f3 be 4000f048 <_POSIX_signals_Clear_process_signals+0x34><== ALWAYS TAKEN 4000f080: 03 10 00 5a sethi %hi(0x40016800), %g1 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); 4000f084: 7f ff cb 19 call 40001ce8 <== NOT EXECUTED 4000f088: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED =============================================================================== 40006e08 <_POSIX_signals_Get_lowest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40006e08: 82 10 20 1b mov 0x1b, %g1 ! 1b 40006e0c: 86 10 20 01 mov 1, %g3 #include #include #include #include int _POSIX_signals_Get_lowest( 40006e10: 84 00 7f ff add %g1, -1, %g2 40006e14: 85 28 c0 02 sll %g3, %g2, %g2 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 40006e18: 80 88 80 08 btst %g2, %o0 40006e1c: 12 80 00 11 bne 40006e60 <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 40006e20: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40006e24: 82 00 60 01 inc %g1 40006e28: 80 a0 60 20 cmp %g1, 0x20 40006e2c: 12 bf ff fa bne 40006e14 <_POSIX_signals_Get_lowest+0xc> 40006e30: 84 00 7f ff add %g1, -1, %g2 40006e34: 82 10 20 01 mov 1, %g1 40006e38: 10 80 00 05 b 40006e4c <_POSIX_signals_Get_lowest+0x44> 40006e3c: 86 10 20 01 mov 1, %g3 */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 40006e40: 80 a0 60 1b cmp %g1, 0x1b 40006e44: 02 80 00 07 be 40006e60 <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 40006e48: 01 00 00 00 nop #include #include #include #include int _POSIX_signals_Get_lowest( 40006e4c: 84 00 7f ff add %g1, -1, %g2 40006e50: 85 28 c0 02 sll %g3, %g2, %g2 #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 40006e54: 80 88 80 08 btst %g2, %o0 40006e58: 22 bf ff fa be,a 40006e40 <_POSIX_signals_Get_lowest+0x38> 40006e5c: 82 00 60 01 inc %g1 * a return 0. This routine will NOT be called unless a signal * is pending in the set passed in. */ found_it: return signo; } 40006e60: 81 c3 e0 08 retl 40006e64: 90 10 00 01 mov %g1, %o0 =============================================================================== 4000bbc8 <_POSIX_signals_Post_switch_extension>: */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { 4000bbc8: 9d e3 bf a0 save %sp, -96, %sp POSIX_API_Control *api; int signo; ISR_Level level; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000bbcc: e2 06 21 58 ld [ %i0 + 0x158 ], %l1 /* * api may be NULL in case of a thread close in progress */ if ( !api ) 4000bbd0: 80 a4 60 00 cmp %l1, 0 4000bbd4: 02 80 00 34 be 4000bca4 <_POSIX_signals_Post_switch_extension+0xdc> 4000bbd8: 01 00 00 00 nop * * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); 4000bbdc: 7f ff d8 3f call 40001cd8 4000bbe0: 25 10 00 5a sethi %hi(0x40016800), %l2 4000bbe4: b0 10 00 08 mov %o0, %i0 4000bbe8: a4 14 a3 74 or %l2, 0x374, %l2 if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { 4000bbec: c6 04 80 00 ld [ %l2 ], %g3 4000bbf0: c2 04 60 d4 ld [ %l1 + 0xd4 ], %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000bbf4: c4 04 60 d0 ld [ %l1 + 0xd0 ], %g2 (api->signals_pending | _POSIX_signals_Pending)) ) { 4000bbf8: 82 10 c0 01 or %g3, %g1, %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000bbfc: 80 a8 40 02 andncc %g1, %g2, %g0 4000bc00: 02 80 00 27 be 4000bc9c <_POSIX_signals_Post_switch_extension+0xd4> 4000bc04: 01 00 00 00 nop (api->signals_pending | _POSIX_signals_Pending)) ) { _ISR_Enable( level ); break; } _ISR_Enable( level ); 4000bc08: 7f ff d8 38 call 40001ce8 4000bc0c: a0 10 20 1b mov 0x1b, %l0 ! 1b for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); 4000bc10: 92 10 00 10 mov %l0, %o1 4000bc14: 94 10 20 00 clr %o2 4000bc18: 40 00 0b 0a call 4000e840 <_POSIX_signals_Check_signal> 4000bc1c: 90 10 00 11 mov %l1, %o0 _POSIX_signals_Check_signal( api, signo, true ); 4000bc20: 92 10 00 10 mov %l0, %o1 4000bc24: 90 10 00 11 mov %l1, %o0 4000bc28: 40 00 0b 06 call 4000e840 <_POSIX_signals_Check_signal> 4000bc2c: 94 10 20 01 mov 1, %o2 _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 4000bc30: a0 04 20 01 inc %l0 4000bc34: 80 a4 20 20 cmp %l0, 0x20 4000bc38: 12 bf ff f7 bne 4000bc14 <_POSIX_signals_Post_switch_extension+0x4c> 4000bc3c: 92 10 00 10 mov %l0, %o1 4000bc40: a0 10 20 01 mov 1, %l0 _POSIX_signals_Check_signal( api, signo, true ); } /* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */ for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); 4000bc44: 92 10 00 10 mov %l0, %o1 4000bc48: 94 10 20 00 clr %o2 4000bc4c: 40 00 0a fd call 4000e840 <_POSIX_signals_Check_signal> 4000bc50: 90 10 00 11 mov %l1, %o0 _POSIX_signals_Check_signal( api, signo, true ); 4000bc54: 92 10 00 10 mov %l0, %o1 4000bc58: 90 10 00 11 mov %l1, %o0 4000bc5c: 40 00 0a f9 call 4000e840 <_POSIX_signals_Check_signal> 4000bc60: 94 10 20 01 mov 1, %o2 _POSIX_signals_Check_signal( api, signo, false ); _POSIX_signals_Check_signal( api, signo, true ); } /* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */ for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 4000bc64: a0 04 20 01 inc %l0 4000bc68: 80 a4 20 1b cmp %l0, 0x1b 4000bc6c: 12 bf ff f7 bne 4000bc48 <_POSIX_signals_Post_switch_extension+0x80> 4000bc70: 92 10 00 10 mov %l0, %o1 * * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); 4000bc74: 7f ff d8 19 call 40001cd8 4000bc78: 01 00 00 00 nop 4000bc7c: b0 10 00 08 mov %o0, %i0 if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { 4000bc80: c6 04 80 00 ld [ %l2 ], %g3 4000bc84: c2 04 60 d4 ld [ %l1 + 0xd4 ], %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000bc88: c4 04 60 d0 ld [ %l1 + 0xd0 ], %g2 (api->signals_pending | _POSIX_signals_Pending)) ) { 4000bc8c: 82 10 c0 01 or %g3, %g1, %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000bc90: 80 a8 40 02 andncc %g1, %g2, %g0 4000bc94: 12 bf ff dd bne 4000bc08 <_POSIX_signals_Post_switch_extension+0x40><== NEVER TAKEN 4000bc98: 01 00 00 00 nop (api->signals_pending | _POSIX_signals_Pending)) ) { _ISR_Enable( level ); 4000bc9c: 7f ff d8 13 call 40001ce8 4000bca0: 81 e8 00 00 restore 4000bca4: 81 c7 e0 08 ret 4000bca8: 81 e8 00 00 restore =============================================================================== 400249c4 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 400249c4: 9d e3 bf a0 save %sp, -96, %sp /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 400249c8: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 400249cc: 05 04 00 20 sethi %hi(0x10008000), %g2 400249d0: 86 10 20 01 mov 1, %g3 400249d4: 9a 06 7f ff add %i1, -1, %o5 400249d8: 88 08 40 02 and %g1, %g2, %g4 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 400249dc: a0 10 00 18 mov %i0, %l0 POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 400249e0: d8 06 21 58 ld [ %i0 + 0x158 ], %o4 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 400249e4: 80 a1 00 02 cmp %g4, %g2 400249e8: 02 80 00 28 be 40024a88 <_POSIX_signals_Unblock_thread+0xc4> 400249ec: 9b 28 c0 0d sll %g3, %o5, %o5 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 400249f0: c4 03 20 d0 ld [ %o4 + 0xd0 ], %g2 400249f4: 80 ab 40 02 andncc %o5, %g2, %g0 400249f8: 02 80 00 15 be 40024a4c <_POSIX_signals_Unblock_thread+0x88> 400249fc: b0 10 20 00 clr %i0 40024a00: 05 04 00 00 sethi %hi(0x10000000), %g2 * it is not blocked, THEN * we need to dispatch at the end of this ISR. * + Any other combination, do nothing. */ if ( _States_Is_interruptible_by_signal( the_thread->current_state ) ) { 40024a04: 80 88 40 02 btst %g1, %g2 40024a08: 02 80 00 13 be 40024a54 <_POSIX_signals_Unblock_thread+0x90> 40024a0c: 80 a0 60 00 cmp %g1, 0 the_thread->Wait.return_code = EINTR; 40024a10: 84 10 20 04 mov 4, %g2 40024a14: c4 24 20 34 st %g2, [ %l0 + 0x34 ] */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 40024a18: 05 00 00 ef sethi %hi(0x3bc00), %g2 40024a1c: 84 10 a2 e0 or %g2, 0x2e0, %g2 ! 3bee0 /* * In pthread_cond_wait, a thread will be blocking on a thread * queue, but is also interruptible by a POSIX signal. */ if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) ) 40024a20: 80 88 40 02 btst %g1, %g2 40024a24: 12 80 00 31 bne 40024ae8 <_POSIX_signals_Unblock_thread+0x124> 40024a28: 80 88 60 08 btst 8, %g1 _Thread_queue_Extract_with_proxy( the_thread ); else if ( _States_Is_delaying(the_thread->current_state) ) { 40024a2c: 02 80 00 31 be 40024af0 <_POSIX_signals_Unblock_thread+0x12c><== NEVER TAKEN 40024a30: 01 00 00 00 nop (void) _Watchdog_Remove( &the_thread->Timer ); 40024a34: 7f ff ab 47 call 4000f750 <_Watchdog_Remove> 40024a38: 90 04 20 48 add %l0, 0x48, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40024a3c: 90 10 00 10 mov %l0, %o0 40024a40: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40024a44: 7f ff a5 fd call 4000e238 <_Thread_Clear_state> 40024a48: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 40024a4c: 81 c7 e0 08 ret 40024a50: 81 e8 00 00 restore _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 40024a54: 12 bf ff fe bne 40024a4c <_POSIX_signals_Unblock_thread+0x88><== NEVER TAKEN 40024a58: 03 10 00 a1 sethi %hi(0x40028400), %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40024a5c: 82 10 61 78 or %g1, 0x178, %g1 ! 40028578 <_Per_CPU_Information> 40024a60: c4 00 60 08 ld [ %g1 + 8 ], %g2 40024a64: 80 a0 a0 00 cmp %g2, 0 40024a68: 02 80 00 22 be 40024af0 <_POSIX_signals_Unblock_thread+0x12c> 40024a6c: 01 00 00 00 nop 40024a70: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40024a74: 80 a4 00 02 cmp %l0, %g2 40024a78: 22 bf ff f5 be,a 40024a4c <_POSIX_signals_Unblock_thread+0x88><== ALWAYS TAKEN 40024a7c: c6 28 60 18 stb %g3, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } } return false; } 40024a80: 81 c7 e0 08 ret <== NOT EXECUTED 40024a84: 81 e8 00 00 restore <== NOT EXECUTED * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 40024a88: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 40024a8c: 80 8b 40 01 btst %o5, %g1 40024a90: 22 80 00 12 be,a 40024ad8 <_POSIX_signals_Unblock_thread+0x114> 40024a94: c2 03 20 d0 ld [ %o4 + 0xd0 ], %g1 the_thread->Wait.return_code = EINTR; 40024a98: 82 10 20 04 mov 4, %g1 40024a9c: c2 24 20 34 st %g1, [ %l0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 40024aa0: 80 a6 a0 00 cmp %i2, 0 40024aa4: 02 80 00 15 be 40024af8 <_POSIX_signals_Unblock_thread+0x134> 40024aa8: c2 04 20 28 ld [ %l0 + 0x28 ], %g1 the_info->si_signo = signo; the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; } else { *the_info = *info; 40024aac: c4 06 80 00 ld [ %i2 ], %g2 40024ab0: c4 20 40 00 st %g2, [ %g1 ] 40024ab4: c4 06 a0 04 ld [ %i2 + 4 ], %g2 40024ab8: c4 20 60 04 st %g2, [ %g1 + 4 ] 40024abc: c4 06 a0 08 ld [ %i2 + 8 ], %g2 40024ac0: c4 20 60 08 st %g2, [ %g1 + 8 ] } _Thread_queue_Extract_with_proxy( the_thread ); 40024ac4: 90 10 00 10 mov %l0, %o0 40024ac8: 7f ff a8 a7 call 4000ed64 <_Thread_queue_Extract_with_proxy> 40024acc: b0 10 20 01 mov 1, %i0 return true; 40024ad0: 81 c7 e0 08 ret 40024ad4: 81 e8 00 00 restore * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 40024ad8: 80 ab 40 01 andncc %o5, %g1, %g0 40024adc: 12 bf ff ef bne 40024a98 <_POSIX_signals_Unblock_thread+0xd4> 40024ae0: b0 10 20 00 clr %i0 40024ae4: 30 80 00 03 b,a 40024af0 <_POSIX_signals_Unblock_thread+0x12c> /* * In pthread_cond_wait, a thread will be blocking on a thread * queue, but is also interruptible by a POSIX signal. */ if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) ) _Thread_queue_Extract_with_proxy( the_thread ); 40024ae8: 7f ff a8 9f call 4000ed64 <_Thread_queue_Extract_with_proxy> 40024aec: 90 10 00 10 mov %l0, %o0 40024af0: 81 c7 e0 08 ret 40024af4: 81 e8 00 00 restore the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; the_info->si_code = SI_USER; 40024af8: 84 10 20 01 mov 1, %g2 the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; 40024afc: f2 20 40 00 st %i1, [ %g1 ] the_info->si_code = SI_USER; 40024b00: c4 20 60 04 st %g2, [ %g1 + 4 ] the_info->si_value.sival_int = 0; 40024b04: 10 bf ff f0 b 40024ac4 <_POSIX_signals_Unblock_thread+0x100> 40024b08: c0 20 60 08 clr [ %g1 + 8 ] =============================================================================== 400064b0 <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { 400064b0: 9d e3 bf 98 save %sp, -104, %sp rtems_initialization_tasks_table *user_tasks; /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; 400064b4: 03 10 00 56 sethi %hi(0x40015800), %g1 400064b8: 82 10 62 30 or %g1, 0x230, %g1 ! 40015a30 400064bc: e0 00 60 2c ld [ %g1 + 0x2c ], %l0 maximum = Configuration_RTEMS_API.number_of_initialization_tasks; /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) 400064c0: 80 a4 20 00 cmp %l0, 0 400064c4: 02 80 00 19 be 40006528 <_RTEMS_tasks_Initialize_user_tasks_body+0x78> 400064c8: e4 00 60 28 ld [ %g1 + 0x28 ], %l2 return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 400064cc: 80 a4 a0 00 cmp %l2, 0 400064d0: 02 80 00 16 be 40006528 <_RTEMS_tasks_Initialize_user_tasks_body+0x78><== NEVER TAKEN 400064d4: a2 10 20 00 clr %l1 400064d8: a6 07 bf fc add %fp, -4, %l3 return_value = rtems_task_create( 400064dc: d4 04 20 04 ld [ %l0 + 4 ], %o2 400064e0: d0 04 00 00 ld [ %l0 ], %o0 400064e4: d2 04 20 08 ld [ %l0 + 8 ], %o1 400064e8: d6 04 20 14 ld [ %l0 + 0x14 ], %o3 400064ec: d8 04 20 0c ld [ %l0 + 0xc ], %o4 400064f0: 7f ff ff 6d call 400062a4 400064f4: 9a 10 00 13 mov %l3, %o5 user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) 400064f8: 94 92 20 00 orcc %o0, 0, %o2 400064fc: 12 80 00 0d bne 40006530 <_RTEMS_tasks_Initialize_user_tasks_body+0x80> 40006500: d0 07 bf fc ld [ %fp + -4 ], %o0 _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( 40006504: d4 04 20 18 ld [ %l0 + 0x18 ], %o2 40006508: 40 00 00 0e call 40006540 4000650c: d2 04 20 10 ld [ %l0 + 0x10 ], %o1 id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) 40006510: 94 92 20 00 orcc %o0, 0, %o2 40006514: 12 80 00 07 bne 40006530 <_RTEMS_tasks_Initialize_user_tasks_body+0x80> 40006518: a2 04 60 01 inc %l1 return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 4000651c: 80 a4 80 11 cmp %l2, %l1 40006520: 18 bf ff ef bgu 400064dc <_RTEMS_tasks_Initialize_user_tasks_body+0x2c><== NEVER TAKEN 40006524: a0 04 20 1c add %l0, 0x1c, %l0 40006528: 81 c7 e0 08 ret 4000652c: 81 e8 00 00 restore id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); 40006530: 90 10 20 01 mov 1, %o0 40006534: 40 00 04 10 call 40007574 <_Internal_error_Occurred> 40006538: 92 10 20 01 mov 1, %o1 =============================================================================== 4000c4e0 <_RTEMS_tasks_Switch_extension>: /* * Per Task Variables */ tvp = executing->task_variables; 4000c4e0: c2 02 21 60 ld [ %o0 + 0x160 ], %g1 while (tvp) { 4000c4e4: 80 a0 60 00 cmp %g1, 0 4000c4e8: 22 80 00 0b be,a 4000c514 <_RTEMS_tasks_Switch_extension+0x34> 4000c4ec: c2 02 61 60 ld [ %o1 + 0x160 ], %g1 tvp->tval = *tvp->ptr; 4000c4f0: c4 00 60 04 ld [ %g1 + 4 ], %g2 *tvp->ptr = tvp->gval; 4000c4f4: c6 00 60 08 ld [ %g1 + 8 ], %g3 * Per Task Variables */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; 4000c4f8: c8 00 80 00 ld [ %g2 ], %g4 4000c4fc: c8 20 60 0c st %g4, [ %g1 + 0xc ] *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; 4000c500: c2 00 40 00 ld [ %g1 ], %g1 /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { 4000c504: 80 a0 60 00 cmp %g1, 0 4000c508: 12 bf ff fa bne 4000c4f0 <_RTEMS_tasks_Switch_extension+0x10><== NEVER TAKEN 4000c50c: c6 20 80 00 st %g3, [ %g2 ] tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; 4000c510: c2 02 61 60 ld [ %o1 + 0x160 ], %g1 while (tvp) { 4000c514: 80 a0 60 00 cmp %g1, 0 4000c518: 02 80 00 0a be 4000c540 <_RTEMS_tasks_Switch_extension+0x60> 4000c51c: 01 00 00 00 nop tvp->gval = *tvp->ptr; 4000c520: c4 00 60 04 ld [ %g1 + 4 ], %g2 *tvp->ptr = tvp->tval; 4000c524: c6 00 60 0c ld [ %g1 + 0xc ], %g3 tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { tvp->gval = *tvp->ptr; 4000c528: c8 00 80 00 ld [ %g2 ], %g4 4000c52c: c8 20 60 08 st %g4, [ %g1 + 8 ] *tvp->ptr = tvp->tval; tvp = (rtems_task_variable_t *)tvp->next; 4000c530: c2 00 40 00 ld [ %g1 ], %g1 *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { 4000c534: 80 a0 60 00 cmp %g1, 0 4000c538: 12 bf ff fa bne 4000c520 <_RTEMS_tasks_Switch_extension+0x40><== NEVER TAKEN 4000c53c: c6 20 80 00 st %g3, [ %g2 ] 4000c540: 81 c3 e0 08 retl =============================================================================== 400077c8 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 400077c8: 9d e3 bf 98 save %sp, -104, %sp 400077cc: 11 10 00 81 sethi %hi(0x40020400), %o0 400077d0: 92 10 00 18 mov %i0, %o1 400077d4: 90 12 20 dc or %o0, 0xdc, %o0 400077d8: 40 00 08 64 call 40009968 <_Objects_Get> 400077dc: 94 07 bf fc add %fp, -4, %o2 /* * When we get here, the Timer is already off the chain so we do not * have to worry about that -- hence no _Watchdog_Remove(). */ the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 400077e0: c2 07 bf fc ld [ %fp + -4 ], %g1 400077e4: 80 a0 60 00 cmp %g1, 0 400077e8: 12 80 00 16 bne 40007840 <_Rate_monotonic_Timeout+0x78> <== NEVER TAKEN 400077ec: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: the_thread = the_period->owner; 400077f0: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 400077f4: 03 00 00 10 sethi %hi(0x4000), %g1 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_period ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_PERIOD); 400077f8: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 400077fc: 80 88 80 01 btst %g2, %g1 40007800: 22 80 00 08 be,a 40007820 <_Rate_monotonic_Timeout+0x58> 40007804: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 40007808: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 4000780c: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007810: 80 a0 80 01 cmp %g2, %g1 40007814: 02 80 00 19 be 40007878 <_Rate_monotonic_Timeout+0xb0> 40007818: 13 04 00 ff sethi %hi(0x1003fc00), %o1 _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { 4000781c: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 40007820: 80 a0 60 01 cmp %g1, 1 40007824: 02 80 00 09 be 40007848 <_Rate_monotonic_Timeout+0x80> 40007828: 82 10 20 04 mov 4, %g1 _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 4000782c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40007830: 03 10 00 81 sethi %hi(0x40020400), %g1 40007834: c4 00 62 40 ld [ %g1 + 0x240 ], %g2 ! 40020640 <_Thread_Dispatch_disable_level> 40007838: 84 00 bf ff add %g2, -1, %g2 4000783c: c4 20 62 40 st %g2, [ %g1 + 0x240 ] 40007840: 81 c7 e0 08 ret 40007844: 81 e8 00 00 restore _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 40007848: 82 10 20 03 mov 3, %g1 _Rate_monotonic_Initiate_statistics( the_period ); 4000784c: 90 10 00 10 mov %l0, %o0 _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 40007850: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 40007854: 7f ff fe 4c call 40007184 <_Rate_monotonic_Initiate_statistics> 40007858: 01 00 00 00 nop Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000785c: c2 04 20 3c ld [ %l0 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007860: 11 10 00 81 sethi %hi(0x40020400), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007864: c2 24 20 1c st %g1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007868: 90 12 23 20 or %o0, 0x320, %o0 4000786c: 40 00 0f f8 call 4000b84c <_Watchdog_Insert> 40007870: 92 04 20 10 add %l0, 0x10, %o1 40007874: 30 bf ff ef b,a 40007830 <_Rate_monotonic_Timeout+0x68> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40007878: 40 00 0a 9f call 4000a2f4 <_Thread_Clear_state> 4000787c: 92 12 63 f8 or %o1, 0x3f8, %o1 the_thread = the_period->owner; if ( _States_Is_waiting_for_period( the_thread->current_state ) && the_thread->Wait.id == the_period->Object.id ) { _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); 40007880: 10 bf ff f5 b 40007854 <_Rate_monotonic_Timeout+0x8c> 40007884: 90 10 00 10 mov %l0, %o0 =============================================================================== 4000ce60 <_Scheduler_priority_Block>: void _Scheduler_priority_Block( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { 4000ce60: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_extract( Thread_Control *the_thread ) { Chain_Control *ready = the_thread->scheduler.priority->ready_chain; 4000ce64: c2 06 60 8c ld [ %i1 + 0x8c ], %g1 4000ce68: c2 00 40 00 ld [ %g1 ], %g1 if ( _Chain_Has_only_one_node( ready ) ) { 4000ce6c: c6 00 40 00 ld [ %g1 ], %g3 4000ce70: c4 00 60 08 ld [ %g1 + 8 ], %g2 4000ce74: 80 a0 c0 02 cmp %g3, %g2 4000ce78: 22 80 00 39 be,a 4000cf5c <_Scheduler_priority_Block+0xfc> 4000ce7c: c0 20 60 04 clr [ %g1 + 4 ] ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4000ce80: c4 06 40 00 ld [ %i1 ], %g2 previous = the_node->previous; 4000ce84: c2 06 60 04 ld [ %i1 + 4 ], %g1 next->previous = previous; 4000ce88: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000ce8c: c4 20 40 00 st %g2, [ %g1 ] RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); 4000ce90: 03 10 00 5a sethi %hi(0x40016800), %g1 4000ce94: 82 10 61 28 or %g1, 0x128, %g1 ! 40016928 <_Per_CPU_Information> { _Scheduler_priority_Ready_queue_extract(the_thread); /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) 4000ce98: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000ce9c: 80 a6 40 02 cmp %i1, %g2 4000cea0: 02 80 00 09 be 4000cec4 <_Scheduler_priority_Block+0x64> 4000cea4: 05 10 00 5a sethi %hi(0x40016800), %g2 _Scheduler_priority_Schedule_body(the_scheduler); if ( _Thread_Is_executing( the_thread ) ) 4000cea8: c4 00 60 0c ld [ %g1 + 0xc ], %g2 4000ceac: 80 a6 40 02 cmp %i1, %g2 4000ceb0: 12 80 00 03 bne 4000cebc <_Scheduler_priority_Block+0x5c> 4000ceb4: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 4000ceb8: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 4000cebc: 81 c7 e0 08 ret 4000cec0: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4000cec4: c4 10 a1 50 lduh [ %g2 + 0x150 ], %g2 4000cec8: 85 28 a0 10 sll %g2, 0x10, %g2 4000cecc: 89 30 a0 10 srl %g2, 0x10, %g4 4000ced0: 80 a1 20 ff cmp %g4, 0xff 4000ced4: 18 80 00 38 bgu 4000cfb4 <_Scheduler_priority_Block+0x154> 4000ced8: c6 06 00 00 ld [ %i0 ], %g3 4000cedc: 1b 10 00 53 sethi %hi(0x40014c00), %o5 4000cee0: 9a 13 63 50 or %o5, 0x350, %o5 ! 40014f50 <__log2table> 4000cee4: c4 0b 40 04 ldub [ %o5 + %g4 ], %g2 4000cee8: 84 00 a0 08 add %g2, 8, %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4000ceec: 85 28 a0 10 sll %g2, 0x10, %g2 4000cef0: 19 10 00 5a sethi %hi(0x40016800), %o4 4000cef4: 89 30 a0 0f srl %g2, 0xf, %g4 4000cef8: 98 13 21 60 or %o4, 0x160, %o4 4000cefc: c8 13 00 04 lduh [ %o4 + %g4 ], %g4 4000cf00: 89 29 20 10 sll %g4, 0x10, %g4 4000cf04: 99 31 20 10 srl %g4, 0x10, %o4 4000cf08: 80 a3 20 ff cmp %o4, 0xff 4000cf0c: 38 80 00 28 bgu,a 4000cfac <_Scheduler_priority_Block+0x14c> 4000cf10: 89 31 20 18 srl %g4, 0x18, %g4 4000cf14: c8 0b 40 0c ldub [ %o5 + %o4 ], %g4 4000cf18: 88 01 20 08 add %g4, 8, %g4 return (_Priority_Bits_index( major ) << 4) + 4000cf1c: 85 30 a0 0c srl %g2, 0xc, %g2 _Priority_Bits_index( minor ); 4000cf20: 89 29 20 10 sll %g4, 0x10, %g4 4000cf24: 89 31 20 10 srl %g4, 0x10, %g4 Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); return (_Priority_Bits_index( major ) << 4) + 4000cf28: 88 01 00 02 add %g4, %g2, %g4 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 4000cf2c: 9b 29 20 02 sll %g4, 2, %o5 4000cf30: 85 29 20 04 sll %g4, 4, %g2 4000cf34: 84 20 80 0d sub %g2, %o5, %g2 _Scheduler_priority_Block_body(the_scheduler, the_thread); } 4000cf38: da 00 c0 02 ld [ %g3 + %g2 ], %o5 4000cf3c: 84 00 c0 02 add %g3, %g2, %g2 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000cf40: 84 00 a0 04 add %g2, 4, %g2 4000cf44: 80 a3 40 02 cmp %o5, %g2 4000cf48: 02 80 00 03 be 4000cf54 <_Scheduler_priority_Block+0xf4> <== NEVER TAKEN 4000cf4c: 88 10 20 00 clr %g4 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 4000cf50: 88 10 00 0d mov %o5, %g4 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 4000cf54: 10 bf ff d5 b 4000cea8 <_Scheduler_priority_Block+0x48> 4000cf58: c8 20 60 10 st %g4, [ %g1 + 0x10 ] Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; tail->previous = head; 4000cf5c: c2 20 60 08 st %g1, [ %g1 + 8 ] RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4000cf60: 84 00 60 04 add %g1, 4, %g2 head->next = tail; 4000cf64: c4 20 40 00 st %g2, [ %g1 ] { Chain_Control *ready = the_thread->scheduler.priority->ready_chain; if ( _Chain_Has_only_one_node( ready ) ) { _Chain_Initialize_empty( ready ); _Priority_bit_map_Remove( &the_thread->scheduler.priority->Priority_map ); 4000cf68: c2 06 60 8c ld [ %i1 + 0x8c ], %g1 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; 4000cf6c: c6 00 60 04 ld [ %g1 + 4 ], %g3 4000cf70: c4 10 60 0e lduh [ %g1 + 0xe ], %g2 4000cf74: c8 10 c0 00 lduh [ %g3 ], %g4 4000cf78: 84 09 00 02 and %g4, %g2, %g2 4000cf7c: c4 30 c0 00 sth %g2, [ %g3 ] if ( *the_priority_map->minor == 0 ) 4000cf80: 85 28 a0 10 sll %g2, 0x10, %g2 4000cf84: 80 a0 a0 00 cmp %g2, 0 4000cf88: 32 bf ff c3 bne,a 4000ce94 <_Scheduler_priority_Block+0x34> 4000cf8c: 03 10 00 5a sethi %hi(0x40016800), %g1 _Priority_Major_bit_map &= the_priority_map->block_major; 4000cf90: 05 10 00 5a sethi %hi(0x40016800), %g2 4000cf94: c2 10 60 0c lduh [ %g1 + 0xc ], %g1 4000cf98: c6 10 a1 50 lduh [ %g2 + 0x150 ], %g3 4000cf9c: 82 08 c0 01 and %g3, %g1, %g1 4000cfa0: c2 30 a1 50 sth %g1, [ %g2 + 0x150 ] 4000cfa4: 10 bf ff bc b 4000ce94 <_Scheduler_priority_Block+0x34> 4000cfa8: 03 10 00 5a sethi %hi(0x40016800), %g1 { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4000cfac: 10 bf ff dc b 4000cf1c <_Scheduler_priority_Block+0xbc> 4000cfb0: c8 0b 40 04 ldub [ %o5 + %g4 ], %g4 RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4000cfb4: 1b 10 00 53 sethi %hi(0x40014c00), %o5 4000cfb8: 85 30 a0 18 srl %g2, 0x18, %g2 4000cfbc: 9a 13 63 50 or %o5, 0x350, %o5 4000cfc0: 10 bf ff cb b 4000ceec <_Scheduler_priority_Block+0x8c> 4000cfc4: c4 0b 40 02 ldub [ %o5 + %g2 ], %g2 =============================================================================== 40008060 <_Scheduler_priority_Schedule>: */ void _Scheduler_priority_Schedule( Scheduler_Control *the_scheduler ) { 40008060: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 40008064: 03 10 00 5a sethi %hi(0x40016800), %g1 40008068: c2 10 61 50 lduh [ %g1 + 0x150 ], %g1 ! 40016950 <_Priority_Major_bit_map> 4000806c: 83 28 60 10 sll %g1, 0x10, %g1 40008070: 87 30 60 10 srl %g1, 0x10, %g3 40008074: 80 a0 e0 ff cmp %g3, 0xff 40008078: 18 80 00 26 bgu 40008110 <_Scheduler_priority_Schedule+0xb0> 4000807c: c4 06 00 00 ld [ %i0 ], %g2 40008080: 09 10 00 53 sethi %hi(0x40014c00), %g4 40008084: 88 11 23 50 or %g4, 0x350, %g4 ! 40014f50 <__log2table> 40008088: c2 09 00 03 ldub [ %g4 + %g3 ], %g1 4000808c: 82 00 60 08 add %g1, 8, %g1 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40008090: 83 28 60 10 sll %g1, 0x10, %g1 40008094: 1b 10 00 5a sethi %hi(0x40016800), %o5 40008098: 87 30 60 0f srl %g1, 0xf, %g3 4000809c: 9a 13 61 60 or %o5, 0x160, %o5 400080a0: c6 13 40 03 lduh [ %o5 + %g3 ], %g3 400080a4: 87 28 e0 10 sll %g3, 0x10, %g3 400080a8: 9b 30 e0 10 srl %g3, 0x10, %o5 400080ac: 80 a3 60 ff cmp %o5, 0xff 400080b0: 38 80 00 16 bgu,a 40008108 <_Scheduler_priority_Schedule+0xa8> 400080b4: 87 30 e0 18 srl %g3, 0x18, %g3 400080b8: c6 09 00 0d ldub [ %g4 + %o5 ], %g3 400080bc: 86 00 e0 08 add %g3, 8, %g3 return (_Priority_Bits_index( major ) << 4) + 400080c0: 83 30 60 0c srl %g1, 0xc, %g1 _Priority_Bits_index( minor ); 400080c4: 87 28 e0 10 sll %g3, 0x10, %g3 400080c8: 87 30 e0 10 srl %g3, 0x10, %g3 Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); return (_Priority_Bits_index( major ) << 4) + 400080cc: 86 00 c0 01 add %g3, %g1, %g3 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 400080d0: 89 28 e0 02 sll %g3, 2, %g4 400080d4: 83 28 e0 04 sll %g3, 4, %g1 400080d8: 82 20 40 04 sub %g1, %g4, %g1 _Scheduler_priority_Schedule_body( the_scheduler ); } 400080dc: c8 00 80 01 ld [ %g2 + %g1 ], %g4 400080e0: 82 00 80 01 add %g2, %g1, %g1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 400080e4: 82 00 60 04 add %g1, 4, %g1 400080e8: 80 a1 00 01 cmp %g4, %g1 400080ec: 02 80 00 03 be 400080f8 <_Scheduler_priority_Schedule+0x98><== NEVER TAKEN 400080f0: 86 10 20 00 clr %g3 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 400080f4: 86 10 00 04 mov %g4, %g3 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 400080f8: 03 10 00 5a sethi %hi(0x40016800), %g1 400080fc: c6 20 61 38 st %g3, [ %g1 + 0x138 ] ! 40016938 <_Per_CPU_Information+0x10> 40008100: 81 c7 e0 08 ret 40008104: 81 e8 00 00 restore { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40008108: 10 bf ff ee b 400080c0 <_Scheduler_priority_Schedule+0x60> 4000810c: c6 09 00 03 ldub [ %g4 + %g3 ], %g3 RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 40008110: 09 10 00 53 sethi %hi(0x40014c00), %g4 40008114: 83 30 60 18 srl %g1, 0x18, %g1 40008118: 88 11 23 50 or %g4, 0x350, %g4 4000811c: 10 bf ff dd b 40008090 <_Scheduler_priority_Schedule+0x30> 40008120: c2 09 00 01 ldub [ %g4 + %g1 ], %g1 =============================================================================== 40007150 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40007150: 9d e3 bf a0 save %sp, -96, %sp uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 40007154: 03 10 00 81 sethi %hi(0x40020400), %g1 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40007158: a0 10 00 18 mov %i0, %l0 uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 4000715c: d2 00 60 e4 ld [ %g1 + 0xe4 ], %o1 if ((!the_tod) || 40007160: 80 a4 20 00 cmp %l0, 0 40007164: 02 80 00 2c be 40007214 <_TOD_Validate+0xc4> <== NEVER TAKEN 40007168: b0 10 20 00 clr %i0 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 4000716c: 11 00 03 d0 sethi %hi(0xf4000), %o0 40007170: 40 00 4d 0f call 4001a5ac <.udiv> 40007174: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 40007178: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000717c: 80 a2 00 01 cmp %o0, %g1 40007180: 08 80 00 25 bleu 40007214 <_TOD_Validate+0xc4> 40007184: 01 00 00 00 nop (the_tod->ticks >= ticks_per_second) || 40007188: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 4000718c: 80 a0 60 3b cmp %g1, 0x3b 40007190: 18 80 00 21 bgu 40007214 <_TOD_Validate+0xc4> 40007194: 01 00 00 00 nop (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 40007198: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 4000719c: 80 a0 60 3b cmp %g1, 0x3b 400071a0: 18 80 00 1d bgu 40007214 <_TOD_Validate+0xc4> 400071a4: 01 00 00 00 nop (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 400071a8: c2 04 20 0c ld [ %l0 + 0xc ], %g1 400071ac: 80 a0 60 17 cmp %g1, 0x17 400071b0: 18 80 00 19 bgu 40007214 <_TOD_Validate+0xc4> 400071b4: 01 00 00 00 nop (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 400071b8: c2 04 20 04 ld [ %l0 + 4 ], %g1 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || 400071bc: 80 a0 60 00 cmp %g1, 0 400071c0: 02 80 00 15 be 40007214 <_TOD_Validate+0xc4> <== NEVER TAKEN 400071c4: 80 a0 60 0c cmp %g1, 0xc (the_tod->month == 0) || 400071c8: 18 80 00 13 bgu 40007214 <_TOD_Validate+0xc4> 400071cc: 01 00 00 00 nop (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 400071d0: c4 04 00 00 ld [ %l0 ], %g2 (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || 400071d4: 80 a0 a7 c3 cmp %g2, 0x7c3 400071d8: 08 80 00 0f bleu 40007214 <_TOD_Validate+0xc4> 400071dc: 01 00 00 00 nop (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 400071e0: c6 04 20 08 ld [ %l0 + 8 ], %g3 (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) || 400071e4: 80 a0 e0 00 cmp %g3, 0 400071e8: 02 80 00 0b be 40007214 <_TOD_Validate+0xc4> <== NEVER TAKEN 400071ec: 80 88 a0 03 btst 3, %g2 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 400071f0: 32 80 00 0b bne,a 4000721c <_TOD_Validate+0xcc> 400071f4: 83 28 60 02 sll %g1, 2, %g1 days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 400071f8: 82 00 60 0d add %g1, 0xd, %g1 400071fc: 05 10 00 7b sethi %hi(0x4001ec00), %g2 40007200: 83 28 60 02 sll %g1, 2, %g1 40007204: 84 10 a3 f0 or %g2, 0x3f0, %g2 40007208: c2 00 80 01 ld [ %g2 + %g1 ], %g1 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 4000720c: 80 a0 40 03 cmp %g1, %g3 40007210: b0 60 3f ff subx %g0, -1, %i0 if ( the_tod->day > days_in_month ) return false; return true; } 40007214: 81 c7 e0 08 ret 40007218: 81 e8 00 00 restore return false; if ( (the_tod->year % 4) == 0 ) days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 4000721c: 05 10 00 7b sethi %hi(0x4001ec00), %g2 40007220: 84 10 a3 f0 or %g2, 0x3f0, %g2 ! 4001eff0 <_TOD_Days_per_month> 40007224: c2 00 80 01 ld [ %g2 + %g1 ], %g1 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 40007228: 80 a0 40 03 cmp %g1, %g3 4000722c: b0 60 3f ff subx %g0, -1, %i0 40007230: 81 c7 e0 08 ret 40007234: 81 e8 00 00 restore =============================================================================== 4000836c <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 4000836c: 9d e3 bf a0 save %sp, -96, %sp */ /* * Save original state */ original_state = the_thread->current_state; 40008370: e2 06 20 10 ld [ %i0 + 0x10 ], %l1 /* * 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 ); 40008374: 40 00 03 ad call 40009228 <_Thread_Set_transient> 40008378: 90 10 00 18 mov %i0, %o0 /* * Do not bother recomputing all the priority related information if * we are not REALLY changing priority. */ if ( the_thread->current_priority != new_priority ) 4000837c: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40008380: 80 a0 40 19 cmp %g1, %i1 40008384: 02 80 00 05 be 40008398 <_Thread_Change_priority+0x2c> 40008388: a0 10 00 18 mov %i0, %l0 _Thread_Set_priority( the_thread, new_priority ); 4000838c: 90 10 00 18 mov %i0, %o0 40008390: 40 00 03 89 call 400091b4 <_Thread_Set_priority> 40008394: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 40008398: 7f ff e6 50 call 40001cd8 4000839c: 01 00 00 00 nop 400083a0: b0 10 00 08 mov %o0, %i0 /* * 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; 400083a4: e4 04 20 10 ld [ %l0 + 0x10 ], %l2 if ( state != STATES_TRANSIENT ) { 400083a8: 80 a4 a0 04 cmp %l2, 4 400083ac: 02 80 00 18 be 4000840c <_Thread_Change_priority+0xa0> 400083b0: 80 8c 60 04 btst 4, %l1 /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 400083b4: 02 80 00 0b be 400083e0 <_Thread_Change_priority+0x74> <== ALWAYS TAKEN 400083b8: 82 0c bf fb and %l2, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); _ISR_Enable( level ); 400083bc: 7f ff e6 4b call 40001ce8 <== NOT EXECUTED 400083c0: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 400083c4: 03 00 00 ef sethi %hi(0x3bc00), %g1 <== NOT EXECUTED 400083c8: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 <== NOT EXECUTED if ( _States_Is_waiting_on_thread_queue( state ) ) { 400083cc: 80 8c 80 01 btst %l2, %g1 <== NOT EXECUTED 400083d0: 32 80 00 0d bne,a 40008404 <_Thread_Change_priority+0x98><== NOT EXECUTED 400083d4: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 <== NOT EXECUTED 400083d8: 81 c7 e0 08 ret 400083dc: 81 e8 00 00 restore */ state = the_thread->current_state; if ( state != STATES_TRANSIENT ) { /* 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 ); 400083e0: c2 24 20 10 st %g1, [ %l0 + 0x10 ] _ISR_Enable( level ); 400083e4: 7f ff e6 41 call 40001ce8 400083e8: 90 10 00 18 mov %i0, %o0 400083ec: 03 00 00 ef sethi %hi(0x3bc00), %g1 400083f0: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 400083f4: 80 8c 80 01 btst %l2, %g1 400083f8: 02 bf ff f8 be 400083d8 <_Thread_Change_priority+0x6c> 400083fc: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 40008400: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 40008404: 40 00 03 3c call 400090f4 <_Thread_queue_Requeue> 40008408: 93 e8 00 10 restore %g0, %l0, %o1 } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { 4000840c: 12 80 00 15 bne 40008460 <_Thread_Change_priority+0xf4> <== NEVER TAKEN 40008410: 80 8e a0 ff btst 0xff, %i2 * FIXME: hard-coded for priority scheduling. Might be ok since this * function is specific to priority scheduling? */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); if ( prepend_it ) 40008414: 02 80 00 2a be 400084bc <_Thread_Change_priority+0x150> 40008418: c0 24 20 10 clr [ %l0 + 0x10 ] RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_enqueue_first( Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); 4000841c: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 40008420: 07 10 00 5a sethi %hi(0x40016800), %g3 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 40008424: c8 00 60 04 ld [ %g1 + 4 ], %g4 40008428: da 10 60 0a lduh [ %g1 + 0xa ], %o5 4000842c: d8 11 00 00 lduh [ %g4 ], %o4 _Chain_Prepend_unprotected( the_thread->scheduler.priority->ready_chain, 40008430: c4 00 40 00 ld [ %g1 ], %g2 40008434: 9a 13 00 0d or %o4, %o5, %o5 40008438: da 31 00 00 sth %o5, [ %g4 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 4000843c: c8 10 60 08 lduh [ %g1 + 8 ], %g4 40008440: da 10 e1 50 lduh [ %g3 + 0x150 ], %o5 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 40008444: c2 00 80 00 ld [ %g2 ], %g1 40008448: 88 13 40 04 or %o5, %g4, %g4 4000844c: c8 30 e1 50 sth %g4, [ %g3 + 0x150 ] Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 40008450: c4 24 20 04 st %g2, [ %l0 + 4 ] before_node = after_node->next; after_node->next = the_node; 40008454: e0 20 80 00 st %l0, [ %g2 ] the_node->next = before_node; 40008458: c2 24 00 00 st %g1, [ %l0 ] before_node->previous = the_node; 4000845c: e0 20 60 04 st %l0, [ %g1 + 4 ] _Scheduler_priority_Ready_queue_enqueue_first( the_thread ); else _Scheduler_priority_Ready_queue_enqueue( the_thread ); } _ISR_Flash( level ); 40008460: 7f ff e6 22 call 40001ce8 40008464: 90 10 00 18 mov %i0, %o0 40008468: 7f ff e6 1c call 40001cd8 4000846c: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( Scheduler_Control *the_scheduler ) { the_scheduler->Operations.schedule( the_scheduler ); 40008470: 11 10 00 59 sethi %hi(0x40016400), %o0 40008474: 90 12 20 54 or %o0, 0x54, %o0 ! 40016454 <_Scheduler> 40008478: c2 02 20 04 ld [ %o0 + 4 ], %g1 4000847c: 9f c0 40 00 call %g1 40008480: 01 00 00 00 nop * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 40008484: 03 10 00 5a sethi %hi(0x40016800), %g1 40008488: 82 10 61 28 or %g1, 0x128, %g1 ! 40016928 <_Per_CPU_Information> 4000848c: c4 00 60 0c ld [ %g1 + 0xc ], %g2 * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Scheduler_Schedule(&_Scheduler); if ( !_Thread_Is_executing_also_the_heir() && 40008490: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40008494: 80 a0 80 03 cmp %g2, %g3 40008498: 02 80 00 07 be 400084b4 <_Thread_Change_priority+0x148> 4000849c: 01 00 00 00 nop 400084a0: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 400084a4: 80 a0 a0 00 cmp %g2, 0 400084a8: 02 80 00 03 be 400084b4 <_Thread_Change_priority+0x148> 400084ac: 84 10 20 01 mov 1, %g2 _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 400084b0: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] _ISR_Enable( level ); 400084b4: 7f ff e6 0d call 40001ce8 400084b8: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_enqueue( Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); 400084bc: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 400084c0: 07 10 00 5a sethi %hi(0x40016800), %g3 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 400084c4: c8 00 60 04 ld [ %g1 + 4 ], %g4 400084c8: da 10 60 0a lduh [ %g1 + 0xa ], %o5 400084cc: d8 11 00 00 lduh [ %g4 ], %o4 _Chain_Append_unprotected( the_thread->scheduler.priority->ready_chain, 400084d0: c4 00 40 00 ld [ %g1 ], %g2 400084d4: 9a 13 00 0d or %o4, %o5, %o5 400084d8: da 31 00 00 sth %o5, [ %g4 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 400084dc: c8 10 60 08 lduh [ %g1 + 8 ], %g4 400084e0: da 10 e1 50 lduh [ %g3 + 0x150 ], %o5 Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 400084e4: c2 00 a0 08 ld [ %g2 + 8 ], %g1 400084e8: 88 13 40 04 or %o5, %g4, %g4 400084ec: c8 30 e1 50 sth %g4, [ %g3 + 0x150 ] the_node->next = tail; tail->previous = the_node; 400084f0: e0 20 a0 08 st %l0, [ %g2 + 8 ] RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 400084f4: 86 00 a0 04 add %g2, 4, %g3 Chain_Node *old_last = tail->previous; the_node->next = tail; 400084f8: c6 24 00 00 st %g3, [ %l0 ] tail->previous = the_node; old_last->next = the_node; 400084fc: e0 20 40 00 st %l0, [ %g1 ] the_node->previous = old_last; 40008500: 10 bf ff d8 b 40008460 <_Thread_Change_priority+0xf4> 40008504: c2 24 20 04 st %g1, [ %l0 + 4 ] =============================================================================== 400086e4 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 400086e4: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 400086e8: 90 10 00 18 mov %i0, %o0 400086ec: 40 00 00 6c call 4000889c <_Thread_Get> 400086f0: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 400086f4: c2 07 bf fc ld [ %fp + -4 ], %g1 400086f8: 80 a0 60 00 cmp %g1, 0 400086fc: 12 80 00 08 bne 4000871c <_Thread_Delay_ended+0x38> <== NEVER TAKEN 40008700: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 40008704: 7f ff ff 81 call 40008508 <_Thread_Clear_state> 40008708: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 4000870c: 03 10 00 58 sethi %hi(0x40016000), %g1 40008710: c4 00 63 d0 ld [ %g1 + 0x3d0 ], %g2 ! 400163d0 <_Thread_Dispatch_disable_level> 40008714: 84 00 bf ff add %g2, -1, %g2 40008718: c4 20 63 d0 st %g2, [ %g1 + 0x3d0 ] 4000871c: 81 c7 e0 08 ret 40008720: 81 e8 00 00 restore =============================================================================== 40008724 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 40008724: 9d e3 bf 90 save %sp, -112, %sp Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 40008728: 25 10 00 5a sethi %hi(0x40016800), %l2 4000872c: a4 14 a1 28 or %l2, 0x128, %l2 ! 40016928 <_Per_CPU_Information> _ISR_Disable( level ); 40008730: 7f ff e5 6a call 40001cd8 40008734: e2 04 a0 0c ld [ %l2 + 0xc ], %l1 while ( _Thread_Dispatch_necessary == true ) { 40008738: c2 0c a0 18 ldub [ %l2 + 0x18 ], %g1 4000873c: 80 a0 60 00 cmp %g1, 0 40008740: 02 80 00 42 be 40008848 <_Thread_Dispatch+0x124> 40008744: 2d 10 00 58 sethi %hi(0x40016000), %l6 heir = _Thread_Heir; 40008748: e0 04 a0 10 ld [ %l2 + 0x10 ], %l0 _Thread_Dispatch_disable_level = 1; 4000874c: 82 10 20 01 mov 1, %g1 40008750: c2 25 a3 d0 st %g1, [ %l6 + 0x3d0 ] _Thread_Dispatch_necessary = false; 40008754: c0 2c a0 18 clrb [ %l2 + 0x18 ] /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) 40008758: 80 a4 40 10 cmp %l1, %l0 4000875c: 02 80 00 3b be 40008848 <_Thread_Dispatch+0x124> 40008760: e0 24 a0 0c st %l0, [ %l2 + 0xc ] 40008764: 27 10 00 59 sethi %hi(0x40016400), %l3 40008768: 3b 10 00 59 sethi %hi(0x40016400), %i5 4000876c: a6 14 e0 9c or %l3, 0x9c, %l3 40008770: aa 07 bf f8 add %fp, -8, %l5 40008774: a8 07 bf f0 add %fp, -16, %l4 40008778: ba 17 60 74 or %i5, 0x74, %i5 #if __RTEMS_ADA__ executing->rtems_ada_self = rtems_ada_self; rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000877c: 37 10 00 58 sethi %hi(0x40016000), %i3 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 40008780: ae 10 00 13 mov %l3, %l7 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 40008784: 10 80 00 2b b 40008830 <_Thread_Dispatch+0x10c> 40008788: b8 10 20 01 mov 1, %i4 rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) heir->cpu_time_budget = _Thread_Ticks_per_timeslice; _ISR_Enable( level ); 4000878c: 7f ff e5 57 call 40001ce8 40008790: 01 00 00 00 nop #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 40008794: 40 00 10 9a call 4000c9fc <_TOD_Get_uptime> 40008798: 90 10 00 15 mov %l5, %o0 _Timestamp_Subtract( 4000879c: 90 10 00 17 mov %l7, %o0 400087a0: 92 10 00 15 mov %l5, %o1 400087a4: 40 00 03 5e call 4000951c <_Timespec_Subtract> 400087a8: 94 10 00 14 mov %l4, %o2 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 400087ac: 92 10 00 14 mov %l4, %o1 400087b0: 40 00 03 42 call 400094b8 <_Timespec_Add_to> 400087b4: 90 04 60 84 add %l1, 0x84, %o0 _Thread_Time_of_last_context_switch = uptime; 400087b8: c4 07 bf f8 ld [ %fp + -8 ], %g2 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 400087bc: c2 07 40 00 ld [ %i5 ], %g1 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 400087c0: c4 24 c0 00 st %g2, [ %l3 ] 400087c4: c4 07 bf fc ld [ %fp + -4 ], %g2 if ( _Thread_libc_reent ) { executing->libc_reent = *_Thread_libc_reent; *_Thread_libc_reent = heir->libc_reent; } _User_extensions_Thread_switch( executing, heir ); 400087c8: 90 10 00 11 mov %l1, %o0 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 400087cc: c4 24 e0 04 st %g2, [ %l3 + 4 ] #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 400087d0: 80 a0 60 00 cmp %g1, 0 400087d4: 02 80 00 06 be 400087ec <_Thread_Dispatch+0xc8> <== NEVER TAKEN 400087d8: 92 10 00 10 mov %l0, %o1 executing->libc_reent = *_Thread_libc_reent; 400087dc: c4 00 40 00 ld [ %g1 ], %g2 400087e0: c4 24 61 50 st %g2, [ %l1 + 0x150 ] *_Thread_libc_reent = heir->libc_reent; 400087e4: c4 04 21 50 ld [ %l0 + 0x150 ], %g2 400087e8: c4 20 40 00 st %g2, [ %g1 ] } _User_extensions_Thread_switch( executing, heir ); 400087ec: 40 00 04 10 call 4000982c <_User_extensions_Thread_switch> 400087f0: 01 00 00 00 nop if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 400087f4: 90 04 60 c8 add %l1, 0xc8, %o0 400087f8: 40 00 05 25 call 40009c8c <_CPU_Context_switch> 400087fc: 92 04 20 c8 add %l0, 0xc8, %o1 #endif #endif executing = _Thread_Executing; _ISR_Disable( level ); 40008800: 7f ff e5 36 call 40001cd8 40008804: e2 04 a0 0c ld [ %l2 + 0xc ], %l1 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 40008808: c2 0c a0 18 ldub [ %l2 + 0x18 ], %g1 4000880c: 80 a0 60 00 cmp %g1, 0 40008810: 02 80 00 0e be 40008848 <_Thread_Dispatch+0x124> 40008814: 01 00 00 00 nop heir = _Thread_Heir; 40008818: e0 04 a0 10 ld [ %l2 + 0x10 ], %l0 _Thread_Dispatch_disable_level = 1; 4000881c: f8 25 a3 d0 st %i4, [ %l6 + 0x3d0 ] _Thread_Dispatch_necessary = false; 40008820: c0 2c a0 18 clrb [ %l2 + 0x18 ] /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) 40008824: 80 a4 00 11 cmp %l0, %l1 40008828: 02 80 00 08 be 40008848 <_Thread_Dispatch+0x124> <== NEVER TAKEN 4000882c: e0 24 a0 0c st %l0, [ %l2 + 0xc ] */ #if __RTEMS_ADA__ executing->rtems_ada_self = rtems_ada_self; rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) 40008830: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40008834: 80 a0 60 01 cmp %g1, 1 40008838: 12 bf ff d5 bne 4000878c <_Thread_Dispatch+0x68> 4000883c: c2 06 e3 34 ld [ %i3 + 0x334 ], %g1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 40008840: 10 bf ff d3 b 4000878c <_Thread_Dispatch+0x68> 40008844: c2 24 20 78 st %g1, [ %l0 + 0x78 ] _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 40008848: c0 25 a3 d0 clr [ %l6 + 0x3d0 ] _ISR_Enable( level ); 4000884c: 7f ff e5 27 call 40001ce8 40008850: 01 00 00 00 nop _API_extensions_Run_postswitch(); 40008854: 7f ff f8 76 call 40006a2c <_API_extensions_Run_postswitch> 40008858: 01 00 00 00 nop } 4000885c: 81 c7 e0 08 ret 40008860: 81 e8 00 00 restore =============================================================================== 4000ee7c <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 4000ee7c: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 4000ee80: 03 10 00 5a sethi %hi(0x40016800), %g1 4000ee84: e0 00 61 34 ld [ %g1 + 0x134 ], %l0 ! 40016934 <_Per_CPU_Information+0xc> /* * Some CPUs need to tinker with the call frame or registers when the * thread actually begins to execute for the first time. This is a * hook point where the port gets a shot at doing whatever it requires. */ _Context_Initialization_at_thread_begin(); 4000ee88: 3f 10 00 3b sethi %hi(0x4000ec00), %i7 4000ee8c: be 17 e2 7c or %i7, 0x27c, %i7 ! 4000ee7c <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4000ee90: d0 04 20 ac ld [ %l0 + 0xac ], %o0 _ISR_Set_level(level); 4000ee94: 7f ff cb 95 call 40001ce8 4000ee98: 91 2a 20 08 sll %o0, 8, %o0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000ee9c: 03 10 00 58 sethi %hi(0x40016000), %g1 doneConstructors = 1; 4000eea0: 84 10 20 01 mov 1, %g2 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000eea4: e2 08 61 94 ldub [ %g1 + 0x194 ], %l1 /* * Take care that 'begin' extensions get to complete before * 'switch' extensions can run. This means must keep dispatch * disabled until all 'begin' extensions complete. */ _User_extensions_Thread_begin( executing ); 4000eea8: 90 10 00 10 mov %l0, %o0 4000eeac: 7f ff e9 e0 call 4000962c <_User_extensions_Thread_begin> 4000eeb0: c4 28 61 94 stb %g2, [ %g1 + 0x194 ] /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4000eeb4: 7f ff e6 6c call 40008864 <_Thread_Enable_dispatch> 4000eeb8: a3 2c 60 18 sll %l1, 0x18, %l1 /* * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { 4000eebc: 80 a4 60 00 cmp %l1, 0 4000eec0: 02 80 00 0f be 4000eefc <_Thread_Handler+0x80> 4000eec4: 01 00 00 00 nop INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000eec8: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000eecc: 80 a0 60 00 cmp %g1, 0 4000eed0: 22 80 00 12 be,a 4000ef18 <_Thread_Handler+0x9c> 4000eed4: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 (*(Thread_Entry_numeric) executing->Start.entry_point)( executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { 4000eed8: 80 a0 60 01 cmp %g1, 1 4000eedc: 22 80 00 13 be,a 4000ef28 <_Thread_Handler+0xac> <== ALWAYS TAKEN 4000eee0: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 * was placed in return_argument. This assumed that if it returned * anything (which is not supporting in all APIs), then it would be * able to fit in a (void *). */ _User_extensions_Thread_exitted( executing ); 4000eee4: 7f ff e9 e6 call 4000967c <_User_extensions_Thread_exitted> 4000eee8: 90 10 00 10 mov %l0, %o0 _Internal_error_Occurred( 4000eeec: 90 10 20 00 clr %o0 4000eef0: 92 10 20 01 mov 1, %o1 4000eef4: 7f ff e1 a0 call 40007574 <_Internal_error_Occurred> 4000eef8: 94 10 20 05 mov 5, %o2 * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { INIT_NAME (); 4000eefc: 40 00 1a 9b call 40015968 <_init> 4000ef00: 01 00 00 00 nop } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000ef04: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000ef08: 80 a0 60 00 cmp %g1, 0 4000ef0c: 12 bf ff f4 bne 4000eedc <_Thread_Handler+0x60> 4000ef10: 80 a0 60 01 cmp %g1, 1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4000ef14: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000ef18: 9f c0 40 00 call %g1 4000ef1c: d0 04 20 9c ld [ %l0 + 0x9c ], %o0 INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = 4000ef20: 10 bf ff f1 b 4000eee4 <_Thread_Handler+0x68> 4000ef24: d0 24 20 28 st %o0, [ %l0 + 0x28 ] ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 4000ef28: 9f c0 40 00 call %g1 4000ef2c: d0 04 20 98 ld [ %l0 + 0x98 ], %o0 executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = 4000ef30: 10 bf ff ed b 4000eee4 <_Thread_Handler+0x68> 4000ef34: d0 24 20 28 st %o0, [ %l0 + 0x28 ] =============================================================================== 40008934 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 40008934: 9d e3 bf a0 save %sp, -96, %sp 40008938: c2 07 a0 6c ld [ %fp + 0x6c ], %g1 /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; 4000893c: c0 26 61 54 clr [ %i1 + 0x154 ] 40008940: c0 26 61 58 clr [ %i1 + 0x158 ] extensions_area = NULL; the_thread->libc_reent = NULL; 40008944: c0 26 61 50 clr [ %i1 + 0x150 ] Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 40008948: e0 07 a0 60 ld [ %fp + 0x60 ], %l0 4000894c: e4 00 40 00 ld [ %g1 ], %l2 if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { 40008950: 80 a6 a0 00 cmp %i2, 0 40008954: 02 80 00 6c be 40008b04 <_Thread_Initialize+0x1d0> 40008958: e2 0f a0 5f ldub [ %fp + 0x5f ], %l1 stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 4000895c: c0 2e 60 b4 clrb [ %i1 + 0xb4 ] 40008960: 90 10 00 1b mov %i3, %o0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 40008964: 27 10 00 59 sethi %hi(0x40016400), %l3 40008968: c2 04 e0 80 ld [ %l3 + 0x80 ], %g1 ! 40016480 <_Thread_Maximum_extensions> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 4000896c: f4 26 60 bc st %i2, [ %i1 + 0xbc ] the_stack->size = size; 40008970: d0 26 60 b8 st %o0, [ %i1 + 0xb8 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40008974: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 40008978: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 4000897c: c0 26 60 68 clr [ %i1 + 0x68 ] 40008980: 80 a0 60 00 cmp %g1, 0 40008984: 12 80 00 4f bne 40008ac0 <_Thread_Initialize+0x18c> 40008988: c0 26 60 6c clr [ %i1 + 0x6c ] (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; 4000898c: c0 26 61 5c clr [ %i1 + 0x15c ] * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; 40008990: b6 10 20 00 clr %i3 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 40008994: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 40008998: e2 2e 60 a0 stb %l1, [ %i1 + 0xa0 ] the_thread->Start.budget_algorithm = budget_algorithm; 4000899c: e0 26 60 a4 st %l0, [ %i1 + 0xa4 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 400089a0: 80 a4 20 02 cmp %l0, 2 400089a4: 12 80 00 05 bne 400089b8 <_Thread_Initialize+0x84> 400089a8: c2 26 60 a8 st %g1, [ %i1 + 0xa8 ] case THREAD_CPU_BUDGET_ALGORITHM_NONE: case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: break; #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 400089ac: 03 10 00 58 sethi %hi(0x40016000), %g1 400089b0: c2 00 63 34 ld [ %g1 + 0x334 ], %g1 ! 40016334 <_Thread_Ticks_per_timeslice> 400089b4: c2 26 60 78 st %g1, [ %i1 + 0x78 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 400089b8: c4 07 a0 68 ld [ %fp + 0x68 ], %g2 Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_allocate( the_scheduler, the_thread ); 400089bc: 11 10 00 59 sethi %hi(0x40016400), %o0 400089c0: 90 12 20 54 or %o0, 0x54, %o0 ! 40016454 <_Scheduler> RTEMS_INLINE_ROUTINE void* _Scheduler_Thread_scheduler_allocate( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return 400089c4: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 400089c8: c4 26 60 ac st %g2, [ %i1 + 0xac ] the_thread->current_state = STATES_DORMANT; 400089cc: 84 10 20 01 mov 1, %g2 the_thread->Wait.queue = NULL; 400089d0: c0 26 60 44 clr [ %i1 + 0x44 ] #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; 400089d4: c4 26 60 10 st %g2, [ %i1 + 0x10 ] the_thread->Wait.queue = NULL; the_thread->resource_count = 0; 400089d8: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 400089dc: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; 400089e0: fa 26 60 b0 st %i5, [ %i1 + 0xb0 ] 400089e4: 9f c0 40 00 call %g1 400089e8: 92 10 00 19 mov %i1, %o1 sched =_Scheduler_Thread_scheduler_allocate( &_Scheduler, the_thread ); if ( !sched ) 400089ec: a0 92 20 00 orcc %o0, 0, %l0 400089f0: 02 80 00 11 be 40008a34 <_Thread_Initialize+0x100> 400089f4: 90 10 00 19 mov %i1, %o0 goto failed; _Thread_Set_priority( the_thread, priority ); 400089f8: 40 00 01 ef call 400091b4 <_Thread_Set_priority> 400089fc: 92 10 00 1d mov %i5, %o1 _Thread_Stack_Free( the_thread ); return false; } 40008a00: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40008a04: c2 16 60 0a lduh [ %i1 + 0xa ], %g1 /* * Initialize the CPU usage statistics */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Set_to_zero( &the_thread->cpu_time_used ); 40008a08: c0 26 60 84 clr [ %i1 + 0x84 ] 40008a0c: c0 26 60 88 clr [ %i1 + 0x88 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40008a10: 83 28 60 02 sll %g1, 2, %g1 40008a14: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40008a18: e4 26 60 0c st %l2, [ %i1 + 0xc ] * enabled when we get here. We want to be able to run the * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); 40008a1c: 90 10 00 19 mov %i1, %o0 40008a20: 40 00 03 3e call 40009718 <_User_extensions_Thread_create> 40008a24: b0 10 20 01 mov 1, %i0 if ( extension_status ) 40008a28: 80 8a 20 ff btst 0xff, %o0 40008a2c: 12 80 00 23 bne 40008ab8 <_Thread_Initialize+0x184> 40008a30: 01 00 00 00 nop return true; failed: if ( the_thread->libc_reent ) 40008a34: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 40008a38: 80 a2 20 00 cmp %o0, 0 40008a3c: 22 80 00 05 be,a 40008a50 <_Thread_Initialize+0x11c> 40008a40: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 _Workspace_Free( the_thread->libc_reent ); 40008a44: 40 00 04 7c call 40009c34 <_Workspace_Free> 40008a48: 01 00 00 00 nop for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 40008a4c: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 40008a50: 80 a2 20 00 cmp %o0, 0 40008a54: 22 80 00 05 be,a 40008a68 <_Thread_Initialize+0x134> 40008a58: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 _Workspace_Free( the_thread->API_Extensions[i] ); 40008a5c: 40 00 04 76 call 40009c34 <_Workspace_Free> 40008a60: 01 00 00 00 nop failed: if ( the_thread->libc_reent ) _Workspace_Free( the_thread->libc_reent ); for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 40008a64: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 40008a68: 80 a2 20 00 cmp %o0, 0 40008a6c: 02 80 00 05 be 40008a80 <_Thread_Initialize+0x14c> 40008a70: 80 a6 e0 00 cmp %i3, 0 _Workspace_Free( the_thread->API_Extensions[i] ); 40008a74: 40 00 04 70 call 40009c34 <_Workspace_Free> 40008a78: 01 00 00 00 nop if ( extensions_area ) 40008a7c: 80 a6 e0 00 cmp %i3, 0 40008a80: 02 80 00 05 be 40008a94 <_Thread_Initialize+0x160> 40008a84: 80 a4 20 00 cmp %l0, 0 (void) _Workspace_Free( extensions_area ); 40008a88: 40 00 04 6b call 40009c34 <_Workspace_Free> 40008a8c: 90 10 00 1b mov %i3, %o0 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( fp_area ) (void) _Workspace_Free( fp_area ); #endif if ( sched ) 40008a90: 80 a4 20 00 cmp %l0, 0 40008a94: 02 80 00 05 be 40008aa8 <_Thread_Initialize+0x174> 40008a98: 90 10 00 19 mov %i1, %o0 (void) _Workspace_Free( sched ); 40008a9c: 40 00 04 66 call 40009c34 <_Workspace_Free> 40008aa0: 90 10 00 10 mov %l0, %o0 _Thread_Stack_Free( the_thread ); 40008aa4: 90 10 00 19 mov %i1, %o0 40008aa8: 40 00 02 22 call 40009330 <_Thread_Stack_Free> 40008aac: b0 10 20 00 clr %i0 return false; 40008ab0: 81 c7 e0 08 ret 40008ab4: 81 e8 00 00 restore 40008ab8: 81 c7 e0 08 ret 40008abc: 81 e8 00 00 restore /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { extensions_area = _Workspace_Allocate( 40008ac0: 82 00 60 01 inc %g1 40008ac4: 40 00 04 53 call 40009c10 <_Workspace_Allocate> 40008ac8: 91 28 60 02 sll %g1, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 40008acc: b6 92 20 00 orcc %o0, 0, %i3 40008ad0: 02 80 00 1a be 40008b38 <_Thread_Initialize+0x204> 40008ad4: c6 04 e0 80 ld [ %l3 + 0x80 ], %g3 goto failed; } the_thread->extensions = (void **) extensions_area; 40008ad8: f6 26 61 5c st %i3, [ %i1 + 0x15c ] * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 40008adc: 84 10 20 00 clr %g2 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; 40008ae0: 82 10 20 00 clr %g1 * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) the_thread->extensions[i] = NULL; 40008ae4: 85 28 a0 02 sll %g2, 2, %g2 40008ae8: c0 26 c0 02 clr [ %i3 + %g2 ] * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 40008aec: 82 00 60 01 inc %g1 40008af0: 80 a0 40 03 cmp %g1, %g3 40008af4: 08 bf ff fc bleu 40008ae4 <_Thread_Initialize+0x1b0> 40008af8: 84 10 00 01 mov %g1, %g2 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 40008afc: 10 bf ff a7 b 40008998 <_Thread_Initialize+0x64> 40008b00: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 40008b04: 90 10 00 19 mov %i1, %o0 40008b08: 40 00 01 ef call 400092c4 <_Thread_Stack_Allocate> 40008b0c: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 40008b10: 80 a2 00 1b cmp %o0, %i3 40008b14: 0a 80 00 07 bcs 40008b30 <_Thread_Initialize+0x1fc> 40008b18: 80 a2 20 00 cmp %o0, 0 40008b1c: 02 80 00 05 be 40008b30 <_Thread_Initialize+0x1fc> <== NEVER TAKEN 40008b20: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 40008b24: f4 06 60 c0 ld [ %i1 + 0xc0 ], %i2 the_thread->Start.core_allocated_stack = true; 40008b28: 10 bf ff 8f b 40008964 <_Thread_Initialize+0x30> 40008b2c: c2 2e 60 b4 stb %g1, [ %i1 + 0xb4 ] _Thread_Stack_Free( the_thread ); return false; } 40008b30: 81 c7 e0 08 ret 40008b34: 91 e8 20 00 restore %g0, 0, %o0 size_t actual_stack_size = 0; void *stack = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) void *fp_area; #endif void *sched = NULL; 40008b38: 10 bf ff bf b 40008a34 <_Thread_Initialize+0x100> 40008b3c: a0 10 20 00 clr %l0 =============================================================================== 4000cbbc <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { 4000cbbc: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 4000cbc0: 7f ff d4 b4 call 40001e90 4000cbc4: 01 00 00 00 nop 4000cbc8: a0 10 00 08 mov %o0, %l0 current_state = the_thread->current_state; 4000cbcc: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 if ( current_state & STATES_SUSPENDED ) { 4000cbd0: 80 88 60 02 btst 2, %g1 4000cbd4: 02 80 00 05 be 4000cbe8 <_Thread_Resume+0x2c> <== NEVER TAKEN 4000cbd8: 82 08 7f fd and %g1, -3, %g1 current_state = the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); if ( _States_Is_ready( current_state ) ) { 4000cbdc: 80 a0 60 00 cmp %g1, 0 4000cbe0: 02 80 00 04 be 4000cbf0 <_Thread_Resume+0x34> 4000cbe4: c2 26 20 10 st %g1, [ %i0 + 0x10 ] _Scheduler_Unblock( &_Scheduler, the_thread ); } } _ISR_Enable( level ); 4000cbe8: 7f ff d4 ae call 40001ea0 4000cbec: 91 e8 00 10 restore %g0, %l0, %o0 RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { the_scheduler->Operations.unblock( the_scheduler, the_thread ); 4000cbf0: 11 10 00 68 sethi %hi(0x4001a000), %o0 4000cbf4: 90 12 23 54 or %o0, 0x354, %o0 ! 4001a354 <_Scheduler> 4000cbf8: c2 02 20 10 ld [ %o0 + 0x10 ], %g1 4000cbfc: 9f c0 40 00 call %g1 4000cc00: 92 10 00 18 mov %i0, %o1 4000cc04: 7f ff d4 a7 call 40001ea0 4000cc08: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40009404 <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 40009404: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing; executing = _Thread_Executing; 40009408: 03 10 00 5a sethi %hi(0x40016800), %g1 4000940c: e0 00 61 34 ld [ %g1 + 0x134 ], %l0 ! 40016934 <_Per_CPU_Information+0xc> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 40009410: c2 0c 20 74 ldub [ %l0 + 0x74 ], %g1 40009414: 80 a0 60 00 cmp %g1, 0 40009418: 02 80 00 26 be 400094b0 <_Thread_Tickle_timeslice+0xac> 4000941c: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 40009420: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40009424: 80 a0 60 00 cmp %g1, 0 40009428: 12 80 00 22 bne 400094b0 <_Thread_Tickle_timeslice+0xac> 4000942c: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 40009430: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40009434: 80 a0 60 01 cmp %g1, 1 40009438: 0a 80 00 07 bcs 40009454 <_Thread_Tickle_timeslice+0x50> 4000943c: 80 a0 60 02 cmp %g1, 2 40009440: 28 80 00 10 bleu,a 40009480 <_Thread_Tickle_timeslice+0x7c> 40009444: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 40009448: 80 a0 60 03 cmp %g1, 3 4000944c: 22 80 00 04 be,a 4000945c <_Thread_Tickle_timeslice+0x58><== ALWAYS TAKEN 40009450: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 40009454: 81 c7 e0 08 ret 40009458: 81 e8 00 00 restore } break; #if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: if ( --executing->cpu_time_budget == 0 ) 4000945c: 82 00 7f ff add %g1, -1, %g1 40009460: 80 a0 60 00 cmp %g1, 0 40009464: 12 bf ff fc bne 40009454 <_Thread_Tickle_timeslice+0x50> 40009468: c2 24 20 78 st %g1, [ %l0 + 0x78 ] (*executing->budget_callout)( executing ); 4000946c: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 40009470: 9f c0 40 00 call %g1 40009474: 90 10 00 10 mov %l0, %o0 40009478: 81 c7 e0 08 ret 4000947c: 81 e8 00 00 restore case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: #endif if ( (int)(--executing->cpu_time_budget) <= 0 ) { 40009480: 82 00 7f ff add %g1, -1, %g1 40009484: 80 a0 60 00 cmp %g1, 0 40009488: 14 bf ff f3 bg 40009454 <_Thread_Tickle_timeslice+0x50> 4000948c: c2 24 20 78 st %g1, [ %l0 + 0x78 ] * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield( &_Scheduler ); 40009490: 11 10 00 59 sethi %hi(0x40016400), %o0 40009494: 90 12 20 54 or %o0, 0x54, %o0 ! 40016454 <_Scheduler> 40009498: c2 02 20 08 ld [ %o0 + 8 ], %g1 4000949c: 9f c0 40 00 call %g1 400094a0: 01 00 00 00 nop * executing thread's timeslice is reset. Otherwise, the * currently executing thread is placed at the rear of the * FIFO for this priority and a new heir is selected. */ _Scheduler_Yield( ); executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 400094a4: 03 10 00 58 sethi %hi(0x40016000), %g1 400094a8: c2 00 63 34 ld [ %g1 + 0x334 ], %g1 ! 40016334 <_Thread_Ticks_per_timeslice> 400094ac: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 400094b0: 81 c7 e0 08 ret 400094b4: 81 e8 00 00 restore =============================================================================== 400090f4 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 400090f4: 9d e3 bf 98 save %sp, -104, %sp /* * Just in case the thread really wasn't blocked on a thread queue * when we get here. */ if ( !the_thread_queue ) 400090f8: 80 a6 20 00 cmp %i0, 0 400090fc: 02 80 00 13 be 40009148 <_Thread_queue_Requeue+0x54> <== NEVER TAKEN 40009100: 01 00 00 00 nop /* * If queueing by FIFO, there is nothing to do. This only applies to * priority blocking discipline. */ if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) { 40009104: e2 06 20 34 ld [ %i0 + 0x34 ], %l1 40009108: 80 a4 60 01 cmp %l1, 1 4000910c: 02 80 00 04 be 4000911c <_Thread_queue_Requeue+0x28> <== ALWAYS TAKEN 40009110: 01 00 00 00 nop 40009114: 81 c7 e0 08 ret <== NOT EXECUTED 40009118: 81 e8 00 00 restore <== NOT EXECUTED Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 4000911c: 7f ff e2 ef call 40001cd8 40009120: 01 00 00 00 nop 40009124: a0 10 00 08 mov %o0, %l0 40009128: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 4000912c: 03 00 00 ef sethi %hi(0x3bc00), %g1 40009130: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 40009134: 80 88 80 01 btst %g2, %g1 40009138: 12 80 00 06 bne 40009150 <_Thread_queue_Requeue+0x5c> <== ALWAYS TAKEN 4000913c: 90 10 00 18 mov %i0, %o0 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); } _ISR_Enable( level ); 40009140: 7f ff e2 ea call 40001ce8 40009144: 90 10 00 10 mov %l0, %o0 40009148: 81 c7 e0 08 ret 4000914c: 81 e8 00 00 restore ISR_Level level_ignored; _ISR_Disable( level ); if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 40009150: 92 10 00 19 mov %i1, %o1 40009154: 94 10 20 01 mov 1, %o2 40009158: 40 00 0f f6 call 4000d130 <_Thread_queue_Extract_priority_helper> 4000915c: e2 26 20 30 st %l1, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 40009160: 90 10 00 18 mov %i0, %o0 40009164: 92 10 00 19 mov %i1, %o1 40009168: 7f ff ff 31 call 40008e2c <_Thread_queue_Enqueue_priority> 4000916c: 94 07 bf fc add %fp, -4, %o2 40009170: 30 bf ff f4 b,a 40009140 <_Thread_queue_Requeue+0x4c> =============================================================================== 40009174 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 40009174: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009178: 90 10 00 18 mov %i0, %o0 4000917c: 7f ff fd c8 call 4000889c <_Thread_Get> 40009180: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009184: c2 07 bf fc ld [ %fp + -4 ], %g1 40009188: 80 a0 60 00 cmp %g1, 0 4000918c: 12 80 00 08 bne 400091ac <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 40009190: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40009194: 40 00 10 22 call 4000d21c <_Thread_queue_Process_timeout> 40009198: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000919c: 03 10 00 58 sethi %hi(0x40016000), %g1 400091a0: c4 00 63 d0 ld [ %g1 + 0x3d0 ], %g2 ! 400163d0 <_Thread_Dispatch_disable_level> 400091a4: 84 00 bf ff add %g2, -1, %g2 400091a8: c4 20 63 d0 st %g2, [ %g1 + 0x3d0 ] 400091ac: 81 c7 e0 08 ret 400091b0: 81 e8 00 00 restore =============================================================================== 40016308 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 40016308: 9d e3 bf 88 save %sp, -120, %sp 4001630c: 2f 10 00 fa sethi %hi(0x4003e800), %l7 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40016310: ba 07 bf f4 add %fp, -12, %i5 40016314: aa 07 bf f8 add %fp, -8, %l5 40016318: a4 07 bf e8 add %fp, -24, %l2 4001631c: a8 07 bf ec add %fp, -20, %l4 40016320: 2d 10 00 fa sethi %hi(0x4003e800), %l6 40016324: 39 10 00 fa sethi %hi(0x4003e800), %i4 40016328: ea 27 bf f4 st %l5, [ %fp + -12 ] head->previous = NULL; 4001632c: c0 27 bf f8 clr [ %fp + -8 ] tail->previous = head; 40016330: fa 27 bf fc st %i5, [ %fp + -4 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40016334: e8 27 bf e8 st %l4, [ %fp + -24 ] head->previous = NULL; 40016338: c0 27 bf ec clr [ %fp + -20 ] tail->previous = head; 4001633c: e4 27 bf f0 st %l2, [ %fp + -16 ] 40016340: ae 15 e3 60 or %l7, 0x360, %l7 40016344: a2 06 20 30 add %i0, 0x30, %l1 40016348: ac 15 a2 d8 or %l6, 0x2d8, %l6 4001634c: a6 06 20 68 add %i0, 0x68, %l3 40016350: b8 17 22 30 or %i4, 0x230, %i4 40016354: b4 06 20 08 add %i0, 8, %i2 40016358: b6 06 20 40 add %i0, 0x40, %i3 Chain_Control *tmp; /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; 4001635c: fa 26 20 78 st %i5, [ %i0 + 0x78 ] static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 40016360: c2 05 c0 00 ld [ %l7 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 40016364: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40016368: 94 10 00 12 mov %l2, %o2 4001636c: 90 10 00 11 mov %l1, %o0 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 40016370: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40016374: 40 00 12 df call 4001aef0 <_Watchdog_Adjust_to_chain> 40016378: 92 20 40 09 sub %g1, %o1, %o1 Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 4001637c: d4 06 20 74 ld [ %i0 + 0x74 ], %o2 static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 40016380: e0 05 80 00 ld [ %l6 ], %l0 /* * 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 ) { 40016384: 80 a4 00 0a cmp %l0, %o2 40016388: 18 80 00 43 bgu 40016494 <_Timer_server_Body+0x18c> 4001638c: 92 24 00 0a sub %l0, %o2, %o1 * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { 40016390: 0a 80 00 39 bcs 40016474 <_Timer_server_Body+0x16c> 40016394: 90 10 00 13 mov %l3, %o0 */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; 40016398: e0 26 20 74 st %l0, [ %i0 + 0x74 ] } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 4001639c: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 400163a0: 40 00 03 11 call 40016fe4 <_Chain_Get> 400163a4: 01 00 00 00 nop if ( timer == NULL ) { 400163a8: 92 92 20 00 orcc %o0, 0, %o1 400163ac: 02 80 00 10 be 400163ec <_Timer_server_Body+0xe4> 400163b0: 01 00 00 00 nop static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 400163b4: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 400163b8: 80 a0 60 01 cmp %g1, 1 400163bc: 02 80 00 32 be 40016484 <_Timer_server_Body+0x17c> 400163c0: 80 a0 60 03 cmp %g1, 3 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 400163c4: 12 bf ff f6 bne 4001639c <_Timer_server_Body+0x94> <== NEVER TAKEN 400163c8: 92 02 60 10 add %o1, 0x10, %o1 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 400163cc: 40 00 12 fc call 4001afbc <_Watchdog_Insert> 400163d0: 90 10 00 13 mov %l3, %o0 } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 400163d4: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 400163d8: 40 00 03 03 call 40016fe4 <_Chain_Get> 400163dc: 01 00 00 00 nop if ( timer == NULL ) { 400163e0: 92 92 20 00 orcc %o0, 0, %o1 400163e4: 32 bf ff f5 bne,a 400163b8 <_Timer_server_Body+0xb0> <== NEVER TAKEN 400163e8: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 <== 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 ); 400163ec: 7f ff e2 31 call 4000ecb0 400163f0: 01 00 00 00 nop tmp = ts->insert_chain; 400163f4: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 if ( _Chain_Is_empty( insert_chain ) ) { 400163f8: c2 07 bf f4 ld [ %fp + -12 ], %g1 400163fc: 80 a0 40 15 cmp %g1, %l5 40016400: 02 80 00 29 be 400164a4 <_Timer_server_Body+0x19c> <== ALWAYS TAKEN 40016404: a0 10 20 01 mov 1, %l0 ts->insert_chain = NULL; do_loop = false; } _ISR_Enable( level ); 40016408: 7f ff e2 2e call 4000ecc0 4001640c: 01 00 00 00 nop * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; while ( do_loop ) { 40016410: 80 8c 20 ff btst 0xff, %l0 40016414: 12 bf ff d3 bne 40016360 <_Timer_server_Body+0x58> <== NEVER TAKEN 40016418: c2 07 bf e8 ld [ %fp + -24 ], %g1 _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 ) ) { 4001641c: 80 a0 40 14 cmp %g1, %l4 40016420: 12 80 00 0c bne 40016450 <_Timer_server_Body+0x148> 40016424: 01 00 00 00 nop 40016428: 30 80 00 22 b,a 400164b0 <_Timer_server_Body+0x1a8> Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; new_first->previous = head; 4001642c: e4 20 60 04 st %l2, [ %g1 + 4 ] { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; 40016430: c2 27 bf e8 st %g1, [ %fp + -24 ] * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; 40016434: c0 24 20 08 clr [ %l0 + 8 ] _ISR_Enable( level ); 40016438: 7f ff e2 22 call 4000ecc0 4001643c: 01 00 00 00 nop /* * 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 ); 40016440: d0 04 20 20 ld [ %l0 + 0x20 ], %o0 40016444: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40016448: 9f c0 40 00 call %g1 4001644c: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 40016450: 7f ff e2 18 call 4000ecb0 40016454: 01 00 00 00 nop initialized = false; } #endif return status; } 40016458: e0 07 bf e8 ld [ %fp + -24 ], %l0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 4001645c: 80 a4 00 14 cmp %l0, %l4 40016460: 32 bf ff f3 bne,a 4001642c <_Timer_server_Body+0x124> 40016464: c2 04 00 00 ld [ %l0 ], %g1 watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 40016468: 7f ff e2 16 call 4000ecc0 4001646c: 01 00 00 00 nop 40016470: 30 bf ff bb b,a 4001635c <_Timer_server_Body+0x54> /* * 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 ); 40016474: 92 10 20 01 mov 1, %o1 ! 1 40016478: 40 00 12 6e call 4001ae30 <_Watchdog_Adjust> 4001647c: 94 22 80 10 sub %o2, %l0, %o2 40016480: 30 bf ff c6 b,a 40016398 <_Timer_server_Body+0x90> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 40016484: 90 10 00 11 mov %l1, %o0 40016488: 40 00 12 cd call 4001afbc <_Watchdog_Insert> 4001648c: 92 02 60 10 add %o1, 0x10, %o1 40016490: 30 bf ff c3 b,a 4001639c <_Timer_server_Body+0x94> /* * 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 ); 40016494: 90 10 00 13 mov %l3, %o0 40016498: 40 00 12 96 call 4001aef0 <_Watchdog_Adjust_to_chain> 4001649c: 94 10 00 12 mov %l2, %o2 400164a0: 30 bf ff be b,a 40016398 <_Timer_server_Body+0x90> _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); tmp = ts->insert_chain; if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; 400164a4: c0 26 20 78 clr [ %i0 + 0x78 ] do_loop = false; 400164a8: 10 bf ff d8 b 40016408 <_Timer_server_Body+0x100> 400164ac: a0 10 20 00 clr %l0 * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 400164b0: c0 2e 20 7c clrb [ %i0 + 0x7c ] 400164b4: c2 07 00 00 ld [ %i4 ], %g1 400164b8: 82 00 60 01 inc %g1 400164bc: c2 27 00 00 st %g1, [ %i4 ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 400164c0: d0 06 00 00 ld [ %i0 ], %o0 400164c4: 40 00 10 66 call 4001a65c <_Thread_Set_state> 400164c8: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 400164cc: 7f ff ff 65 call 40016260 <_Timer_server_Reset_interval_system_watchdog> 400164d0: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 400164d4: 7f ff ff 78 call 400162b4 <_Timer_server_Reset_tod_system_watchdog> 400164d8: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 400164dc: 40 00 0d d3 call 40019c28 <_Thread_Enable_dispatch> 400164e0: 01 00 00 00 nop ts->active = true; 400164e4: 82 10 20 01 mov 1, %g1 ! 1 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 400164e8: 90 10 00 1a mov %i2, %o0 _Thread_Set_state( ts->thread, STATES_DELAYING ); _Timer_server_Reset_interval_system_watchdog( ts ); _Timer_server_Reset_tod_system_watchdog( ts ); _Thread_Enable_dispatch(); ts->active = true; 400164ec: c2 2e 20 7c stb %g1, [ %i0 + 0x7c ] static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 400164f0: 40 00 13 1e call 4001b168 <_Watchdog_Remove> 400164f4: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 400164f8: 40 00 13 1c call 4001b168 <_Watchdog_Remove> 400164fc: 90 10 00 1b mov %i3, %o0 40016500: 30 bf ff 97 b,a 4001635c <_Timer_server_Body+0x54> =============================================================================== 40016504 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 40016504: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 40016508: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 4001650c: 80 a0 60 00 cmp %g1, 0 40016510: 02 80 00 05 be 40016524 <_Timer_server_Schedule_operation_method+0x20> 40016514: a0 10 00 19 mov %i1, %l0 * 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 ); 40016518: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 4001651c: 40 00 02 9c call 40016f8c <_Chain_Append> 40016520: 81 e8 00 00 restore 40016524: 03 10 00 fa sethi %hi(0x4003e800), %g1 40016528: c4 00 62 30 ld [ %g1 + 0x230 ], %g2 ! 4003ea30 <_Thread_Dispatch_disable_level> 4001652c: 84 00 a0 01 inc %g2 40016530: c4 20 62 30 st %g2, [ %g1 + 0x230 ] * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 40016534: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 40016538: 80 a0 60 01 cmp %g1, 1 4001653c: 02 80 00 28 be 400165dc <_Timer_server_Schedule_operation_method+0xd8> 40016540: 80 a0 60 03 cmp %g1, 3 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); if ( !ts->active ) { _Timer_server_Reset_interval_system_watchdog( ts ); } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 40016544: 02 80 00 04 be 40016554 <_Timer_server_Schedule_operation_method+0x50> 40016548: 01 00 00 00 nop if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 4001654c: 40 00 0d b7 call 40019c28 <_Thread_Enable_dispatch> 40016550: 81 e8 00 00 restore } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 40016554: 7f ff e1 d7 call 4000ecb0 40016558: 01 00 00 00 nop initialized = false; } #endif return status; } 4001655c: c4 06 20 68 ld [ %i0 + 0x68 ], %g2 * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; 40016560: c6 06 20 74 ld [ %i0 + 0x74 ], %g3 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40016564: 88 06 20 6c add %i0, 0x6c, %g4 /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 40016568: 03 10 00 fa sethi %hi(0x4003e800), %g1 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 4001656c: 80 a0 80 04 cmp %g2, %g4 40016570: 02 80 00 0d be 400165a4 <_Timer_server_Schedule_operation_method+0xa0> 40016574: c2 00 62 d8 ld [ %g1 + 0x2d8 ], %g1 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 40016578: da 00 a0 10 ld [ %g2 + 0x10 ], %o5 if ( snapshot > last_snapshot ) { 4001657c: 80 a0 40 03 cmp %g1, %g3 } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 40016580: 88 03 40 03 add %o5, %g3, %g4 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { 40016584: 08 80 00 07 bleu 400165a0 <_Timer_server_Schedule_operation_method+0x9c> 40016588: 88 21 00 01 sub %g4, %g1, %g4 /* * We advanced in time. */ delta = snapshot - last_snapshot; 4001658c: 86 20 40 03 sub %g1, %g3, %g3 if (delta_interval > delta) { 40016590: 80 a3 40 03 cmp %o5, %g3 40016594: 08 80 00 03 bleu 400165a0 <_Timer_server_Schedule_operation_method+0x9c><== NEVER TAKEN 40016598: 88 10 20 00 clr %g4 delta_interval -= delta; 4001659c: 88 23 40 03 sub %o5, %g3, %g4 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 400165a0: c8 20 a0 10 st %g4, [ %g2 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 400165a4: c2 26 20 74 st %g1, [ %i0 + 0x74 ] _ISR_Enable( level ); 400165a8: 7f ff e1 c6 call 4000ecc0 400165ac: 01 00 00 00 nop _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 400165b0: 90 06 20 68 add %i0, 0x68, %o0 400165b4: 40 00 12 82 call 4001afbc <_Watchdog_Insert> 400165b8: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 400165bc: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 400165c0: 80 a0 60 00 cmp %g1, 0 400165c4: 12 bf ff e2 bne 4001654c <_Timer_server_Schedule_operation_method+0x48> 400165c8: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 400165cc: 7f ff ff 3a call 400162b4 <_Timer_server_Reset_tod_system_watchdog> 400165d0: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 400165d4: 40 00 0d 95 call 40019c28 <_Thread_Enable_dispatch> 400165d8: 81 e8 00 00 restore if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 400165dc: 7f ff e1 b5 call 4000ecb0 400165e0: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 400165e4: 05 10 00 fa sethi %hi(0x4003e800), %g2 initialized = false; } #endif return status; } 400165e8: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = _Watchdog_Ticks_since_boot; 400165ec: c4 00 a3 60 ld [ %g2 + 0x360 ], %g2 last_snapshot = ts->Interval_watchdogs.last_snapshot; 400165f0: c8 06 20 3c ld [ %i0 + 0x3c ], %g4 400165f4: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 400165f8: 80 a0 40 03 cmp %g1, %g3 400165fc: 02 80 00 08 be 4001661c <_Timer_server_Schedule_operation_method+0x118> 40016600: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 40016604: da 00 60 10 ld [ %g1 + 0x10 ], %o5 if (delta_interval > delta) { 40016608: 80 a1 00 0d cmp %g4, %o5 4001660c: 1a 80 00 03 bcc 40016618 <_Timer_server_Schedule_operation_method+0x114> 40016610: 86 10 20 00 clr %g3 delta_interval -= delta; 40016614: 86 23 40 04 sub %o5, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 40016618: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 4001661c: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 40016620: 7f ff e1 a8 call 4000ecc0 40016624: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 40016628: 90 06 20 30 add %i0, 0x30, %o0 4001662c: 40 00 12 64 call 4001afbc <_Watchdog_Insert> 40016630: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 40016634: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 40016638: 80 a0 60 00 cmp %g1, 0 4001663c: 12 bf ff c4 bne 4001654c <_Timer_server_Schedule_operation_method+0x48> 40016640: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 40016644: 7f ff ff 07 call 40016260 <_Timer_server_Reset_interval_system_watchdog> 40016648: 90 10 00 18 mov %i0, %o0 if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 4001664c: 40 00 0d 77 call 40019c28 <_Thread_Enable_dispatch> 40016650: 81 e8 00 00 restore =============================================================================== 400096c8 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 400096c8: 9d e3 bf a0 save %sp, -96, %sp the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 400096cc: 23 10 00 59 sethi %hi(0x40016400), %l1 400096d0: a2 14 61 d8 or %l1, 0x1d8, %l1 ! 400165d8 <_User_extensions_List> 400096d4: e0 04 60 08 ld [ %l1 + 8 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 400096d8: 80 a4 00 11 cmp %l0, %l1 400096dc: 02 80 00 0d be 40009710 <_User_extensions_Fatal+0x48> <== NEVER TAKEN 400096e0: b2 0e 60 ff and %i1, 0xff, %i1 !_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 ) 400096e4: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 400096e8: 80 a0 60 00 cmp %g1, 0 400096ec: 02 80 00 05 be 40009700 <_User_extensions_Fatal+0x38> 400096f0: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 400096f4: 92 10 00 19 mov %i1, %o1 400096f8: 9f c0 40 00 call %g1 400096fc: 94 10 00 1a mov %i2, %o2 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 40009700: e0 04 20 04 ld [ %l0 + 4 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 40009704: 80 a4 00 11 cmp %l0, %l1 40009708: 32 bf ff f8 bne,a 400096e8 <_User_extensions_Fatal+0x20> <== ALWAYS TAKEN 4000970c: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 40009710: 81 c7 e0 08 ret <== NOT EXECUTED 40009714: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40009574 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 40009574: 9d e3 bf a0 save %sp, -96, %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; 40009578: 07 10 00 56 sethi %hi(0x40015800), %g3 4000957c: 86 10 e2 68 or %g3, 0x268, %g3 ! 40015a68 initial_extensions = Configuration.User_extension_table; 40009580: e6 00 e0 40 ld [ %g3 + 0x40 ], %l3 40009584: 1b 10 00 59 sethi %hi(0x40016400), %o5 40009588: 09 10 00 58 sethi %hi(0x40016000), %g4 4000958c: 84 13 61 d8 or %o5, 0x1d8, %g2 40009590: 82 11 23 d4 or %g4, 0x3d4, %g1 40009594: 96 00 a0 04 add %g2, 4, %o3 40009598: 98 00 60 04 add %g1, 4, %o4 4000959c: d6 23 61 d8 st %o3, [ %o5 + 0x1d8 ] head->previous = NULL; 400095a0: c0 20 a0 04 clr [ %g2 + 4 ] tail->previous = head; 400095a4: c4 20 a0 08 st %g2, [ %g2 + 8 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400095a8: d8 21 23 d4 st %o4, [ %g4 + 0x3d4 ] head->previous = NULL; 400095ac: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 400095b0: c2 20 60 08 st %g1, [ %g1 + 8 ] _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 400095b4: 80 a4 e0 00 cmp %l3, 0 400095b8: 02 80 00 1b be 40009624 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 400095bc: e4 00 e0 3c ld [ %g3 + 0x3c ], %l2 extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) 400095c0: 83 2c a0 02 sll %l2, 2, %g1 400095c4: a3 2c a0 04 sll %l2, 4, %l1 400095c8: a2 24 40 01 sub %l1, %g1, %l1 400095cc: a2 04 40 12 add %l1, %l2, %l1 400095d0: a3 2c 60 02 sll %l1, 2, %l1 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( 400095d4: 40 00 01 9f call 40009c50 <_Workspace_Allocate_or_fatal_error> 400095d8: 90 10 00 11 mov %l1, %o0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 400095dc: 92 10 20 00 clr %o1 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( 400095e0: a0 10 00 08 mov %o0, %l0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 400095e4: 40 00 19 46 call 4000fafc 400095e8: 94 10 00 11 mov %l1, %o2 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 400095ec: 80 a4 a0 00 cmp %l2, 0 400095f0: 02 80 00 0d be 40009624 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 400095f4: a2 10 20 00 clr %l1 #include #include #include #include void _User_extensions_Handler_initialization(void) 400095f8: 93 2c 60 05 sll %l1, 5, %o1 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; 400095fc: 94 10 20 20 mov 0x20, %o2 40009600: 92 04 c0 09 add %l3, %o1, %o1 40009604: 40 00 19 05 call 4000fa18 40009608: 90 04 20 14 add %l0, 0x14, %o0 _User_extensions_Add_set( extension ); 4000960c: 40 00 0f 47 call 4000d328 <_User_extensions_Add_set> 40009610: 90 10 00 10 mov %l0, %o0 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 40009614: a2 04 60 01 inc %l1 40009618: 80 a4 80 11 cmp %l2, %l1 4000961c: 18 bf ff f7 bgu 400095f8 <_User_extensions_Handler_initialization+0x84> 40009620: a0 04 20 34 add %l0, 0x34, %l0 40009624: 81 c7 e0 08 ret 40009628: 81 e8 00 00 restore =============================================================================== 4000962c <_User_extensions_Thread_begin>: #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { 4000962c: 9d e3 bf a0 save %sp, -96, %sp the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 40009630: 23 10 00 59 sethi %hi(0x40016400), %l1 40009634: e0 04 61 d8 ld [ %l1 + 0x1d8 ], %l0 ! 400165d8 <_User_extensions_List> 40009638: a2 14 61 d8 or %l1, 0x1d8, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000963c: a2 04 60 04 add %l1, 4, %l1 40009640: 80 a4 00 11 cmp %l0, %l1 40009644: 02 80 00 0c be 40009674 <_User_extensions_Thread_begin+0x48><== NEVER TAKEN 40009648: 01 00 00 00 nop !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_begin != NULL ) 4000964c: c2 04 20 28 ld [ %l0 + 0x28 ], %g1 40009650: 80 a0 60 00 cmp %g1, 0 40009654: 02 80 00 04 be 40009664 <_User_extensions_Thread_begin+0x38> 40009658: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.thread_begin)( executing ); 4000965c: 9f c0 40 00 call %g1 40009660: 01 00 00 00 nop Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 40009664: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 40009668: 80 a4 00 11 cmp %l0, %l1 4000966c: 32 bf ff f9 bne,a 40009650 <_User_extensions_Thread_begin+0x24> 40009670: c2 04 20 28 ld [ %l0 + 0x28 ], %g1 40009674: 81 c7 e0 08 ret 40009678: 81 e8 00 00 restore =============================================================================== 40009718 <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 40009718: 9d e3 bf a0 save %sp, -96, %sp return false; } } return true; } 4000971c: 23 10 00 59 sethi %hi(0x40016400), %l1 40009720: e0 04 61 d8 ld [ %l1 + 0x1d8 ], %l0 ! 400165d8 <_User_extensions_List> #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 40009724: a6 10 00 18 mov %i0, %l3 return false; } } return true; } 40009728: a2 14 61 d8 or %l1, 0x1d8, %l1 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); 4000972c: a2 04 60 04 add %l1, 4, %l1 40009730: 80 a4 00 11 cmp %l0, %l1 40009734: 02 80 00 13 be 40009780 <_User_extensions_Thread_create+0x68><== NEVER TAKEN 40009738: b0 10 20 01 mov 1, %i0 the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { status = (*the_extension->Callouts.thread_create)( 4000973c: 25 10 00 5a sethi %hi(0x40016800), %l2 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { 40009740: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40009744: 80 a0 60 00 cmp %g1, 0 40009748: 02 80 00 08 be 40009768 <_User_extensions_Thread_create+0x50> 4000974c: 84 14 a1 28 or %l2, 0x128, %g2 status = (*the_extension->Callouts.thread_create)( 40009750: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 40009754: 9f c0 40 00 call %g1 40009758: 92 10 00 13 mov %l3, %o1 _Thread_Executing, the_thread ); if ( !status ) 4000975c: 80 8a 20 ff btst 0xff, %o0 40009760: 22 80 00 08 be,a 40009780 <_User_extensions_Thread_create+0x68> 40009764: b0 10 20 00 clr %i0 User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 40009768: e0 04 00 00 ld [ %l0 ], %l0 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); 4000976c: 80 a4 00 11 cmp %l0, %l1 40009770: 32 bf ff f5 bne,a 40009744 <_User_extensions_Thread_create+0x2c> 40009774: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 if ( !status ) return false; } } return true; 40009778: 81 c7 e0 08 ret 4000977c: 91 e8 20 01 restore %g0, 1, %o0 } 40009780: 81 c7 e0 08 ret 40009784: 81 e8 00 00 restore =============================================================================== 40009788 <_User_extensions_Thread_delete>: #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { 40009788: 9d e3 bf a0 save %sp, -96, %sp (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } 4000978c: 23 10 00 59 sethi %hi(0x40016400), %l1 40009790: a2 14 61 d8 or %l1, 0x1d8, %l1 ! 400165d8 <_User_extensions_List> 40009794: e0 04 60 08 ld [ %l1 + 8 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 40009798: 80 a4 00 11 cmp %l0, %l1 4000979c: 02 80 00 0d be 400097d0 <_User_extensions_Thread_delete+0x48><== NEVER TAKEN 400097a0: 25 10 00 5a sethi %hi(0x40016800), %l2 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_delete != NULL ) 400097a4: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 400097a8: 80 a0 60 00 cmp %g1, 0 400097ac: 02 80 00 05 be 400097c0 <_User_extensions_Thread_delete+0x38> 400097b0: 84 14 a1 28 or %l2, 0x128, %g2 (*the_extension->Callouts.thread_delete)( 400097b4: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 400097b8: 9f c0 40 00 call %g1 400097bc: 92 10 00 18 mov %i0, %o1 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 400097c0: e0 04 20 04 ld [ %l0 + 4 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 400097c4: 80 a4 00 11 cmp %l0, %l1 400097c8: 32 bf ff f8 bne,a 400097a8 <_User_extensions_Thread_delete+0x20> 400097cc: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 400097d0: 81 c7 e0 08 ret 400097d4: 81 e8 00 00 restore =============================================================================== 4000967c <_User_extensions_Thread_exitted>: } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { 4000967c: 9d e3 bf a0 save %sp, -96, %sp the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 40009680: 23 10 00 59 sethi %hi(0x40016400), %l1 40009684: a2 14 61 d8 or %l1, 0x1d8, %l1 ! 400165d8 <_User_extensions_List> 40009688: e0 04 60 08 ld [ %l1 + 8 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 4000968c: 80 a4 00 11 cmp %l0, %l1 40009690: 02 80 00 0c be 400096c0 <_User_extensions_Thread_exitted+0x44><== NEVER TAKEN 40009694: 01 00 00 00 nop !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) 40009698: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 4000969c: 80 a0 60 00 cmp %g1, 0 400096a0: 02 80 00 04 be 400096b0 <_User_extensions_Thread_exitted+0x34> 400096a4: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.thread_exitted)( executing ); 400096a8: 9f c0 40 00 call %g1 400096ac: 01 00 00 00 nop Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 400096b0: e0 04 20 04 ld [ %l0 + 4 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 400096b4: 80 a4 00 11 cmp %l0, %l1 400096b8: 32 bf ff f9 bne,a 4000969c <_User_extensions_Thread_exitted+0x20> 400096bc: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 400096c0: 81 c7 e0 08 ret 400096c4: 81 e8 00 00 restore =============================================================================== 4000a500 <_User_extensions_Thread_restart>: #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { 4000a500: 9d e3 bf a0 save %sp, -96, %sp (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } 4000a504: 23 10 00 7c sethi %hi(0x4001f000), %l1 4000a508: e0 04 63 d8 ld [ %l1 + 0x3d8 ], %l0 ! 4001f3d8 <_User_extensions_List> 4000a50c: a2 14 63 d8 or %l1, 0x3d8, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a510: a2 04 60 04 add %l1, 4, %l1 4000a514: 80 a4 00 11 cmp %l0, %l1 4000a518: 02 80 00 0d be 4000a54c <_User_extensions_Thread_restart+0x4c><== NEVER TAKEN 4000a51c: 25 10 00 7d sethi %hi(0x4001f400), %l2 !_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 ) 4000a520: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 4000a524: 80 a0 60 00 cmp %g1, 0 4000a528: 02 80 00 05 be 4000a53c <_User_extensions_Thread_restart+0x3c> 4000a52c: 84 14 a3 28 or %l2, 0x328, %g2 (*the_extension->Callouts.thread_restart)( 4000a530: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 4000a534: 9f c0 40 00 call %g1 4000a538: 92 10 00 18 mov %i0, %o1 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 4000a53c: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a540: 80 a4 00 11 cmp %l0, %l1 4000a544: 32 bf ff f8 bne,a 4000a524 <_User_extensions_Thread_restart+0x24> 4000a548: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 4000a54c: 81 c7 e0 08 ret 4000a550: 81 e8 00 00 restore =============================================================================== 400097d8 <_User_extensions_Thread_start>: #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { 400097d8: 9d e3 bf a0 save %sp, -96, %sp (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } 400097dc: 23 10 00 59 sethi %hi(0x40016400), %l1 400097e0: e0 04 61 d8 ld [ %l1 + 0x1d8 ], %l0 ! 400165d8 <_User_extensions_List> 400097e4: a2 14 61 d8 or %l1, 0x1d8, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 400097e8: a2 04 60 04 add %l1, 4, %l1 400097ec: 80 a4 00 11 cmp %l0, %l1 400097f0: 02 80 00 0d be 40009824 <_User_extensions_Thread_start+0x4c><== NEVER TAKEN 400097f4: 25 10 00 5a sethi %hi(0x40016800), %l2 !_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 ) 400097f8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 400097fc: 80 a0 60 00 cmp %g1, 0 40009800: 02 80 00 05 be 40009814 <_User_extensions_Thread_start+0x3c> 40009804: 84 14 a1 28 or %l2, 0x128, %g2 (*the_extension->Callouts.thread_start)( 40009808: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 4000980c: 9f c0 40 00 call %g1 40009810: 92 10 00 18 mov %i0, %o1 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 40009814: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 40009818: 80 a4 00 11 cmp %l0, %l1 4000981c: 32 bf ff f8 bne,a 400097fc <_User_extensions_Thread_start+0x24> 40009820: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40009824: 81 c7 e0 08 ret 40009828: 81 e8 00 00 restore =============================================================================== 4000982c <_User_extensions_Thread_switch>: void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { 4000982c: 9d e3 bf a0 save %sp, -96, %sp the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } 40009830: 23 10 00 58 sethi %hi(0x40016000), %l1 40009834: e0 04 63 d4 ld [ %l1 + 0x3d4 ], %l0 ! 400163d4 <_User_extensions_Switches_list> 40009838: a2 14 63 d4 or %l1, 0x3d4, %l1 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); 4000983c: a2 04 60 04 add %l1, 4, %l1 40009840: 80 a4 00 11 cmp %l0, %l1 40009844: 02 80 00 0a be 4000986c <_User_extensions_Thread_switch+0x40><== NEVER TAKEN 40009848: 01 00 00 00 nop !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); 4000984c: c2 04 20 08 ld [ %l0 + 8 ], %g1 40009850: 90 10 00 18 mov %i0, %o0 40009854: 9f c0 40 00 call %g1 40009858: 92 10 00 19 mov %i1, %o1 Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { 4000985c: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); 40009860: 80 a4 00 11 cmp %l0, %l1 40009864: 32 bf ff fb bne,a 40009850 <_User_extensions_Thread_switch+0x24> 40009868: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000986c: 81 c7 e0 08 ret 40009870: 81 e8 00 00 restore =============================================================================== 4000b8dc <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4000b8dc: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 4000b8e0: 7f ff dc dd call 40002c54 4000b8e4: a0 10 00 18 mov %i0, %l0 } } _ISR_Enable( level ); } 4000b8e8: c2 06 00 00 ld [ %i0 ], %g1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000b8ec: a4 06 20 04 add %i0, 4, %l2 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { 4000b8f0: 80 a0 40 12 cmp %g1, %l2 4000b8f4: 02 80 00 1f be 4000b970 <_Watchdog_Adjust+0x94> 4000b8f8: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 4000b8fc: 12 80 00 1f bne 4000b978 <_Watchdog_Adjust+0x9c> 4000b900: 80 a6 60 01 cmp %i1, 1 case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4000b904: 80 a6 a0 00 cmp %i2, 0 4000b908: 02 80 00 1a be 4000b970 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000b90c: 01 00 00 00 nop if ( units < _Watchdog_First( header )->delta_interval ) { 4000b910: e2 00 60 10 ld [ %g1 + 0x10 ], %l1 4000b914: 80 a6 80 11 cmp %i2, %l1 4000b918: 1a 80 00 0b bcc 4000b944 <_Watchdog_Adjust+0x68> <== ALWAYS TAKEN 4000b91c: a6 10 20 01 mov 1, %l3 _Watchdog_First( header )->delta_interval -= units; 4000b920: 10 80 00 1d b 4000b994 <_Watchdog_Adjust+0xb8> <== NOT EXECUTED 4000b924: a2 24 40 1a sub %l1, %i2, %l1 <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4000b928: b4 a6 80 11 subcc %i2, %l1, %i2 4000b92c: 02 80 00 11 be 4000b970 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000b930: 01 00 00 00 nop if ( units < _Watchdog_First( header )->delta_interval ) { 4000b934: e2 00 60 10 ld [ %g1 + 0x10 ], %l1 4000b938: 80 a4 40 1a cmp %l1, %i2 4000b93c: 38 80 00 16 bgu,a 4000b994 <_Watchdog_Adjust+0xb8> 4000b940: a2 24 40 1a sub %l1, %i2, %l1 _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; 4000b944: e6 20 60 10 st %l3, [ %g1 + 0x10 ] _ISR_Enable( level ); 4000b948: 7f ff dc c7 call 40002c64 4000b94c: 01 00 00 00 nop _Watchdog_Tickle( header ); 4000b950: 40 00 00 b4 call 4000bc20 <_Watchdog_Tickle> 4000b954: 90 10 00 10 mov %l0, %o0 _ISR_Disable( level ); 4000b958: 7f ff dc bf call 40002c54 4000b95c: 01 00 00 00 nop } } _ISR_Enable( level ); } 4000b960: c4 04 00 00 ld [ %l0 ], %g2 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) 4000b964: 80 a4 80 02 cmp %l2, %g2 4000b968: 12 bf ff f0 bne 4000b928 <_Watchdog_Adjust+0x4c> 4000b96c: 82 10 00 02 mov %g2, %g1 } break; } } _ISR_Enable( level ); 4000b970: 7f ff dc bd call 40002c64 4000b974: 91 e8 00 08 restore %g0, %o0, %o0 * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { 4000b978: 12 bf ff fe bne 4000b970 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000b97c: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4000b980: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000b984: b4 00 80 1a add %g2, %i2, %i2 4000b988: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } break; } } _ISR_Enable( level ); 4000b98c: 7f ff dc b6 call 40002c64 4000b990: 91 e8 00 08 restore %g0, %o0, %o0 break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; 4000b994: 10 bf ff f7 b 4000b970 <_Watchdog_Adjust+0x94> 4000b998: e2 20 60 10 st %l1, [ %g1 + 0x10 ] =============================================================================== 40009a20 <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 40009a20: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 40009a24: 7f ff e0 ad call 40001cd8 40009a28: 01 00 00 00 nop previous_state = the_watchdog->state; 40009a2c: e0 06 20 08 ld [ %i0 + 8 ], %l0 switch ( previous_state ) { 40009a30: 80 a4 20 01 cmp %l0, 1 40009a34: 02 80 00 2a be 40009adc <_Watchdog_Remove+0xbc> 40009a38: 03 10 00 59 sethi %hi(0x40016400), %g1 40009a3c: 1a 80 00 09 bcc 40009a60 <_Watchdog_Remove+0x40> 40009a40: 80 a4 20 03 cmp %l0, 3 _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 40009a44: 03 10 00 59 sethi %hi(0x40016400), %g1 40009a48: c2 00 61 00 ld [ %g1 + 0x100 ], %g1 ! 40016500 <_Watchdog_Ticks_since_boot> 40009a4c: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 40009a50: 7f ff e0 a6 call 40001ce8 40009a54: b0 10 00 10 mov %l0, %i0 return( previous_state ); } 40009a58: 81 c7 e0 08 ret 40009a5c: 81 e8 00 00 restore Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; switch ( previous_state ) { 40009a60: 18 bf ff fa bgu 40009a48 <_Watchdog_Remove+0x28> <== NEVER TAKEN 40009a64: 03 10 00 59 sethi %hi(0x40016400), %g1 } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } 40009a68: c2 06 00 00 ld [ %i0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 40009a6c: c0 26 20 08 clr [ %i0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 40009a70: c4 00 40 00 ld [ %g1 ], %g2 40009a74: 80 a0 a0 00 cmp %g2, 0 40009a78: 02 80 00 07 be 40009a94 <_Watchdog_Remove+0x74> 40009a7c: 05 10 00 59 sethi %hi(0x40016400), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 40009a80: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40009a84: c4 06 20 10 ld [ %i0 + 0x10 ], %g2 40009a88: 84 00 c0 02 add %g3, %g2, %g2 40009a8c: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 40009a90: 05 10 00 59 sethi %hi(0x40016400), %g2 40009a94: c4 00 a0 fc ld [ %g2 + 0xfc ], %g2 ! 400164fc <_Watchdog_Sync_count> 40009a98: 80 a0 a0 00 cmp %g2, 0 40009a9c: 22 80 00 07 be,a 40009ab8 <_Watchdog_Remove+0x98> 40009aa0: c4 06 20 04 ld [ %i0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 40009aa4: 05 10 00 5a sethi %hi(0x40016800), %g2 40009aa8: c6 00 a1 30 ld [ %g2 + 0x130 ], %g3 ! 40016930 <_Per_CPU_Information+0x8> 40009aac: 05 10 00 59 sethi %hi(0x40016400), %g2 40009ab0: c6 20 a0 94 st %g3, [ %g2 + 0x94 ] ! 40016494 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 40009ab4: c4 06 20 04 ld [ %i0 + 4 ], %g2 next->previous = previous; 40009ab8: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 40009abc: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 40009ac0: 03 10 00 59 sethi %hi(0x40016400), %g1 40009ac4: c2 00 61 00 ld [ %g1 + 0x100 ], %g1 ! 40016500 <_Watchdog_Ticks_since_boot> 40009ac8: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 40009acc: 7f ff e0 87 call 40001ce8 40009ad0: b0 10 00 10 mov %l0, %i0 return( previous_state ); } 40009ad4: 81 c7 e0 08 ret 40009ad8: 81 e8 00 00 restore _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 40009adc: c2 00 61 00 ld [ %g1 + 0x100 ], %g1 /* * It is not actually on the chain so just change the state and * the Insert operation we interrupted will be aborted. */ the_watchdog->state = WATCHDOG_INACTIVE; 40009ae0: c0 26 20 08 clr [ %i0 + 8 ] _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 40009ae4: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 40009ae8: 7f ff e0 80 call 40001ce8 40009aec: b0 10 00 10 mov %l0, %i0 return( previous_state ); } 40009af0: 81 c7 e0 08 ret 40009af4: 81 e8 00 00 restore =============================================================================== 4000b114 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4000b114: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4000b118: 7f ff dd a1 call 4000279c 4000b11c: 01 00 00 00 nop 4000b120: a0 10 00 08 mov %o0, %l0 printk( "Watchdog Chain: %s %p\n", name, header ); 4000b124: 11 10 00 7a sethi %hi(0x4001e800), %o0 4000b128: 94 10 00 19 mov %i1, %o2 4000b12c: 92 10 00 18 mov %i0, %o1 4000b130: 7f ff e4 7a call 40004318 4000b134: 90 12 20 b0 or %o0, 0xb0, %o0 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 4000b138: e2 06 40 00 ld [ %i1 ], %l1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000b13c: b2 06 60 04 add %i1, 4, %i1 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { 4000b140: 80 a4 40 19 cmp %l1, %i1 4000b144: 02 80 00 0f be 4000b180 <_Watchdog_Report_chain+0x6c> 4000b148: 11 10 00 7a sethi %hi(0x4001e800), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4000b14c: 92 10 00 11 mov %l1, %o1 4000b150: 40 00 00 0f call 4000b18c <_Watchdog_Report> 4000b154: 90 10 20 00 clr %o0 _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; node != _Chain_Tail(header) ; node = node->next ) 4000b158: e2 04 40 00 ld [ %l1 ], %l1 Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; 4000b15c: 80 a4 40 19 cmp %l1, %i1 4000b160: 12 bf ff fc bne 4000b150 <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 4000b164: 92 10 00 11 mov %l1, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4000b168: 11 10 00 7a sethi %hi(0x4001e800), %o0 4000b16c: 92 10 00 18 mov %i0, %o1 4000b170: 7f ff e4 6a call 40004318 4000b174: 90 12 20 c8 or %o0, 0xc8, %o0 } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); 4000b178: 7f ff dd 8d call 400027ac 4000b17c: 91 e8 00 10 restore %g0, %l0, %o0 _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); 4000b180: 7f ff e4 66 call 40004318 4000b184: 90 12 20 d8 or %o0, 0xd8, %o0 4000b188: 30 bf ff fc b,a 4000b178 <_Watchdog_Report_chain+0x64> =============================================================================== 40006128 : int adjtime( struct timeval *delta, struct timeval *olddelta ) { 40006128: 9d e3 bf 98 save %sp, -104, %sp long adjustment; /* * Simple validations */ if ( !delta ) 4000612c: a0 96 20 00 orcc %i0, 0, %l0 40006130: 02 80 00 54 be 40006280 40006134: 03 00 03 d0 sethi %hi(0xf4000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) 40006138: c4 04 20 04 ld [ %l0 + 4 ], %g2 4000613c: 82 10 62 3f or %g1, 0x23f, %g1 40006140: 80 a0 80 01 cmp %g2, %g1 40006144: 18 80 00 4f bgu 40006280 40006148: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { 4000614c: 22 80 00 06 be,a 40006164 40006150: c2 04 00 00 ld [ %l0 ], %g1 olddelta->tv_sec = 0; olddelta->tv_usec = 0; 40006154: c0 26 60 04 clr [ %i1 + 4 ] 40006158: c4 04 20 04 ld [ %l0 + 4 ], %g2 if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { olddelta->tv_sec = 0; 4000615c: c0 26 40 00 clr [ %i1 ] olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); 40006160: c2 04 00 00 ld [ %l0 ], %g1 adjustment += delta->tv_usec; /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 40006164: 07 10 00 7a sethi %hi(0x4001e800), %g3 40006168: c8 00 e2 e4 ld [ %g3 + 0x2e4 ], %g4 ! 4001eae4 olddelta->tv_sec = 0; olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); 4000616c: 9b 28 60 08 sll %g1, 8, %o5 40006170: 87 28 60 03 sll %g1, 3, %g3 40006174: 86 23 40 03 sub %o5, %g3, %g3 40006178: 9b 28 e0 06 sll %g3, 6, %o5 4000617c: 86 23 40 03 sub %o5, %g3, %g3 40006180: 82 00 c0 01 add %g3, %g1, %g1 40006184: 83 28 60 06 sll %g1, 6, %g1 adjustment += delta->tv_usec; 40006188: 84 00 80 01 add %g2, %g1, %g2 /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 4000618c: 80 a0 80 04 cmp %g2, %g4 40006190: 0a 80 00 3a bcs 40006278 40006194: b0 10 20 00 clr %i0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006198: 03 10 00 7d sethi %hi(0x4001f400), %g1 4000619c: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 ! 4001f560 <_Thread_Dispatch_disable_level> 400061a0: 84 00 a0 01 inc %g2 400061a4: c4 20 61 60 st %g2, [ %g1 + 0x160 ] * This prevents context switches while we are adjusting the TOD */ _Thread_Disable_dispatch(); _TOD_Get( &ts ); 400061a8: a2 07 bf f8 add %fp, -8, %l1 400061ac: 40 00 06 93 call 40007bf8 <_TOD_Get> 400061b0: 90 10 00 11 mov %l1, %o0 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 400061b4: c2 04 20 04 ld [ %l0 + 4 ], %g1 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 400061b8: c8 07 bf f8 ld [ %fp + -8 ], %g4 400061bc: c4 04 00 00 ld [ %l0 ], %g2 ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 400061c0: 87 28 60 02 sll %g1, 2, %g3 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 400061c4: 84 01 00 02 add %g4, %g2, %g2 ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 400061c8: 89 28 60 07 sll %g1, 7, %g4 400061cc: 86 21 00 03 sub %g4, %g3, %g3 400061d0: 82 00 c0 01 add %g3, %g1, %g1 400061d4: c6 07 bf fc ld [ %fp + -4 ], %g3 400061d8: 83 28 60 03 sll %g1, 3, %g1 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 400061dc: c4 27 bf f8 st %g2, [ %fp + -8 ] ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 400061e0: 82 00 40 03 add %g1, %g3, %g1 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 400061e4: 07 0e e6 b2 sethi %hi(0x3b9ac800), %g3 400061e8: 86 10 e1 ff or %g3, 0x1ff, %g3 ! 3b9ac9ff 400061ec: 80 a0 40 03 cmp %g1, %g3 400061f0: 08 80 00 0a bleu 40006218 400061f4: c2 27 bf fc st %g1, [ %fp + -4 ] ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 400061f8: 09 31 19 4d sethi %hi(0xc4653400), %g4 400061fc: 88 11 22 00 or %g4, 0x200, %g4 ! c4653600 40006200: 82 00 40 04 add %g1, %g4, %g1 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 40006204: 80 a0 40 03 cmp %g1, %g3 40006208: 18 bf ff fe bgu 40006200 <== NEVER TAKEN 4000620c: 84 00 a0 01 inc %g2 40006210: c2 27 bf fc st %g1, [ %fp + -4 ] 40006214: c4 27 bf f8 st %g2, [ %fp + -8 ] ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 40006218: 09 31 19 4d sethi %hi(0xc4653400), %g4 4000621c: 88 11 22 00 or %g4, 0x200, %g4 ! c4653600 40006220: 80 a0 40 04 cmp %g1, %g4 40006224: 18 80 00 0a bgu 4000624c <== NEVER TAKEN 40006228: c4 07 bf f8 ld [ %fp + -8 ], %g2 ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; 4000622c: 07 0e e6 b2 sethi %hi(0x3b9ac800), %g3 40006230: 86 10 e2 00 or %g3, 0x200, %g3 ! 3b9aca00 40006234: 82 00 40 03 add %g1, %g3, %g1 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 40006238: 80 a0 40 04 cmp %g1, %g4 4000623c: 08 bf ff fe bleu 40006234 40006240: 84 00 bf ff add %g2, -1, %g2 40006244: c2 27 bf fc st %g1, [ %fp + -4 ] 40006248: c4 27 bf f8 st %g2, [ %fp + -8 ] ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; } _TOD_Set( &ts ); 4000624c: 40 00 06 95 call 40007ca0 <_TOD_Set> 40006250: 90 10 00 11 mov %l1, %o0 _Thread_Enable_dispatch(); 40006254: 40 00 0c 79 call 40009438 <_Thread_Enable_dispatch> 40006258: b0 10 20 00 clr %i0 /* set the user's output */ if ( olddelta ) 4000625c: 80 a6 60 00 cmp %i1, 0 40006260: 02 80 00 0c be 40006290 40006264: 01 00 00 00 nop *olddelta = *delta; 40006268: c2 04 00 00 ld [ %l0 ], %g1 4000626c: c2 26 40 00 st %g1, [ %i1 ] 40006270: c2 04 20 04 ld [ %l0 + 4 ], %g1 40006274: c2 26 60 04 st %g1, [ %i1 + 4 ] return 0; } 40006278: 81 c7 e0 08 ret 4000627c: 81 e8 00 00 restore */ if ( !delta ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); 40006280: 40 00 26 db call 4000fdec <__errno> 40006284: b0 10 3f ff mov -1, %i0 40006288: 82 10 20 16 mov 0x16, %g1 4000628c: c2 22 00 00 st %g1, [ %o0 ] 40006290: 81 c7 e0 08 ret 40006294: 81 e8 00 00 restore =============================================================================== 400069e4 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 400069e4: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 400069e8: 21 10 00 65 sethi %hi(0x40019400), %l0 400069ec: 40 00 04 74 call 40007bbc 400069f0: 90 14 20 74 or %l0, 0x74, %o0 ! 40019474 if (fcntl (fildes, F_GETFD) < 0) { 400069f4: 90 10 00 18 mov %i0, %o0 400069f8: 40 00 1e 3c call 4000e2e8 400069fc: 92 10 20 01 mov 1, %o1 40006a00: 80 a2 20 00 cmp %o0, 0 40006a04: 06 80 00 64 bl 40006b94 40006a08: 80 a6 60 00 cmp %i1, 0 pthread_mutex_unlock(&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EBADF); } /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { 40006a0c: 02 80 00 21 be 40006a90 40006a10: 92 10 00 18 mov %i0, %o1 pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { 40006a14: e2 06 40 00 ld [ %i1 ], %l1 40006a18: 80 a4 40 18 cmp %l1, %i0 40006a1c: 12 80 00 51 bne 40006b60 40006a20: 90 14 20 74 or %l0, 0x74, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EINVAL); } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 40006a24: 92 10 00 11 mov %l1, %o1 40006a28: 11 10 00 65 sethi %hi(0x40019400), %o0 40006a2c: 94 10 20 00 clr %o2 40006a30: 90 12 20 bc or %o0, 0xbc, %o0 40006a34: 40 00 00 c3 call 40006d40 40006a38: b0 10 20 02 mov 2, %i0 if (r_chain == NULL) { 40006a3c: 80 a2 20 00 cmp %o0, 0 40006a40: 12 80 00 12 bne 40006a88 40006a44: a0 14 20 74 or %l0, 0x74, %l0 if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40006a48: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 40006a4c: 82 04 20 58 add %l0, 0x58, %g1 40006a50: 80 a0 80 01 cmp %g2, %g1 40006a54: 02 80 00 23 be 40006ae0 <== NEVER TAKEN 40006a58: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40006a5c: 92 10 00 11 mov %l1, %o1 40006a60: 40 00 00 b8 call 40006d40 40006a64: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40006a68: 80 a2 20 00 cmp %o0, 0 40006a6c: 02 80 00 3c be 40006b5c 40006a70: 92 10 00 19 mov %i1, %o1 rtems_set_errno_and_return_minus_one (EINVAL); } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 40006a74: 40 00 01 bb call 40007160 40006a78: 90 02 20 08 add %o0, 8, %o0 40006a7c: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&aio_request_queue.mutex); 40006a80: 40 00 04 70 call 40007c40 40006a84: 90 10 00 10 mov %l0, %o0 return result; 40006a88: 81 c7 e0 08 ret 40006a8c: 81 e8 00 00 restore /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { AIO_printf ("Cancel all requests\n"); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 40006a90: 11 10 00 65 sethi %hi(0x40019400), %o0 40006a94: 94 10 20 00 clr %o2 40006a98: 40 00 00 aa call 40006d40 40006a9c: 90 12 20 bc or %o0, 0xbc, %o0 if (r_chain == NULL) { 40006aa0: a2 92 20 00 orcc %o0, 0, %l1 40006aa4: 02 80 00 13 be 40006af0 40006aa8: b2 04 60 1c add %l1, 0x1c, %i1 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 40006aac: 40 00 04 44 call 40007bbc 40006ab0: 90 10 00 19 mov %i1, %o0 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40006ab4: 40 00 0b 2d call 40009768 <_Chain_Extract> 40006ab8: 90 10 00 11 mov %l1, %o0 rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40006abc: 40 00 01 95 call 40007110 40006ac0: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&r_chain->mutex); 40006ac4: 40 00 04 5f call 40007c40 40006ac8: 90 10 00 19 mov %i1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40006acc: 90 14 20 74 or %l0, 0x74, %o0 40006ad0: 40 00 04 5c call 40007c40 40006ad4: b0 10 20 00 clr %i0 return AIO_CANCELED; 40006ad8: 81 c7 e0 08 ret 40006adc: 81 e8 00 00 restore result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } else { pthread_mutex_unlock (&aio_request_queue.mutex); 40006ae0: 40 00 04 58 call 40007c40 <== NOT EXECUTED 40006ae4: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); return result; } } return AIO_ALLDONE; } 40006ae8: 81 c7 e0 08 ret <== NOT EXECUTED 40006aec: 81 e8 00 00 restore <== NOT EXECUTED 40006af0: a0 14 20 74 or %l0, 0x74, %l0 r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { AIO_printf ("Request chain not on [WQ]\n"); if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40006af4: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 40006af8: 82 04 20 58 add %l0, 0x58, %g1 40006afc: 80 a0 80 01 cmp %g2, %g1 40006b00: 02 80 00 20 be 40006b80 <== NEVER TAKEN 40006b04: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40006b08: 92 10 00 18 mov %i0, %o1 40006b0c: 40 00 00 8d call 40006d40 40006b10: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40006b14: a2 92 20 00 orcc %o0, 0, %l1 40006b18: 22 80 00 1b be,a 40006b84 40006b1c: 90 10 00 10 mov %l0, %o0 40006b20: 40 00 0b 12 call 40009768 <_Chain_Extract> 40006b24: b2 04 60 1c add %l1, 0x1c, %i1 } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40006b28: 40 00 01 7a call 40007110 40006b2c: 90 10 00 11 mov %l1, %o0 pthread_mutex_destroy (&r_chain->mutex); 40006b30: 40 00 03 76 call 40007908 40006b34: 90 10 00 19 mov %i1, %o0 pthread_cond_destroy (&r_chain->mutex); 40006b38: 40 00 02 94 call 40007588 40006b3c: 90 10 00 19 mov %i1, %o0 free (r_chain); 40006b40: 7f ff f2 0c call 40003370 40006b44: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; 40006b48: b0 10 20 00 clr %i0 rtems_aio_remove_fd (r_chain); pthread_mutex_destroy (&r_chain->mutex); pthread_cond_destroy (&r_chain->mutex); free (r_chain); pthread_mutex_unlock (&aio_request_queue.mutex); 40006b4c: 40 00 04 3d call 40007c40 40006b50: 90 10 00 10 mov %l0, %o0 return AIO_CANCELED; 40006b54: 81 c7 e0 08 ret 40006b58: 81 e8 00 00 restore r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); if (r_chain == NULL) { pthread_mutex_unlock (&aio_request_queue.mutex); 40006b5c: 90 10 00 10 mov %l0, %o0 40006b60: 40 00 04 38 call 40007c40 40006b64: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one (EINVAL); 40006b68: 40 00 2c 8d call 40011d9c <__errno> 40006b6c: 01 00 00 00 nop 40006b70: 82 10 20 16 mov 0x16, %g1 ! 16 40006b74: c2 22 00 00 st %g1, [ %o0 ] 40006b78: 81 c7 e0 08 ret 40006b7c: 81 e8 00 00 restore pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; } pthread_mutex_unlock (&aio_request_queue.mutex); 40006b80: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40006b84: 40 00 04 2f call 40007c40 40006b88: b0 10 20 02 mov 2, %i0 return AIO_ALLDONE; 40006b8c: 81 c7 e0 08 ret 40006b90: 81 e8 00 00 restore int result; pthread_mutex_lock (&aio_request_queue.mutex); if (fcntl (fildes, F_GETFD) < 0) { pthread_mutex_unlock(&aio_request_queue.mutex); 40006b94: 40 00 04 2b call 40007c40 40006b98: 90 14 20 74 or %l0, 0x74, %o0 rtems_set_errno_and_return_minus_one (EBADF); 40006b9c: 40 00 2c 80 call 40011d9c <__errno> 40006ba0: b0 10 3f ff mov -1, %i0 40006ba4: 82 10 20 09 mov 9, %g1 40006ba8: c2 22 00 00 st %g1, [ %o0 ] 40006bac: 81 c7 e0 08 ret 40006bb0: 81 e8 00 00 restore =============================================================================== 40006bbc : int aio_fsync( int op, struct aiocb *aiocbp ) { 40006bbc: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; if (op != O_SYNC) 40006bc0: 03 00 00 08 sethi %hi(0x2000), %g1 40006bc4: 80 a6 00 01 cmp %i0, %g1 40006bc8: 12 80 00 14 bne 40006c18 40006bcc: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40006bd0: d0 06 40 00 ld [ %i1 ], %o0 40006bd4: 40 00 1d c5 call 4000e2e8 40006bd8: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40006bdc: 90 0a 20 03 and %o0, 3, %o0 40006be0: 90 02 3f ff add %o0, -1, %o0 40006be4: 80 a2 20 01 cmp %o0, 1 40006be8: 18 80 00 0c bgu 40006c18 40006bec: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40006bf0: 7f ff f3 7a call 400039d8 40006bf4: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40006bf8: 80 a2 20 00 cmp %o0, 0 40006bfc: 02 80 00 06 be 40006c14 <== NEVER TAKEN 40006c00: 82 10 20 03 mov 3, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 40006c04: f2 22 20 14 st %i1, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_SYNC; 40006c08: c2 26 60 30 st %g1, [ %i1 + 0x30 ] return rtems_aio_enqueue (req); 40006c0c: 40 00 01 72 call 400071d4 40006c10: 91 e8 00 08 restore %g0, %o0, %o0 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40006c14: a0 10 20 0b mov 0xb, %l0 40006c18: 82 10 3f ff mov -1, %g1 40006c1c: e0 26 60 34 st %l0, [ %i1 + 0x34 ] 40006c20: c2 26 60 38 st %g1, [ %i1 + 0x38 ] 40006c24: 40 00 2c 5e call 40011d9c <__errno> 40006c28: b0 10 3f ff mov -1, %i0 40006c2c: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } 40006c30: 81 c7 e0 08 ret 40006c34: 81 e8 00 00 restore =============================================================================== 400073b8 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 400073b8: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 400073bc: d0 06 00 00 ld [ %i0 ], %o0 400073c0: 40 00 1b ca call 4000e2e8 400073c4: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 400073c8: 90 0a 20 03 and %o0, 3, %o0 400073cc: 80 a2 20 02 cmp %o0, 2 400073d0: 12 80 00 1b bne 4000743c 400073d4: 80 a2 20 00 cmp %o0, 0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 400073d8: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 400073dc: 80 a0 60 00 cmp %g1, 0 400073e0: 12 80 00 0f bne 4000741c 400073e4: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 400073e8: c2 06 20 08 ld [ %i0 + 8 ], %g1 400073ec: 80 a0 60 00 cmp %g1, 0 400073f0: 06 80 00 0c bl 40007420 400073f4: 82 10 3f ff mov -1, %g1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 400073f8: 7f ff f1 78 call 400039d8 400073fc: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007400: 80 a2 20 00 cmp %o0, 0 40007404: 02 80 00 12 be 4000744c <== NEVER TAKEN 40007408: 82 10 20 01 mov 1, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 4000740c: f0 22 20 14 st %i0, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_READ; 40007410: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 40007414: 7f ff ff 70 call 400071d4 40007418: 91 e8 00 08 restore %g0, %o0, %o0 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 4000741c: 82 10 3f ff mov -1, %g1 40007420: e0 26 20 34 st %l0, [ %i0 + 0x34 ] 40007424: c2 26 20 38 st %g1, [ %i0 + 0x38 ] 40007428: 40 00 2a 5d call 40011d9c <__errno> 4000742c: b0 10 3f ff mov -1, %i0 40007430: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; return rtems_aio_enqueue (req); } 40007434: 81 c7 e0 08 ret 40007438: 81 e8 00 00 restore { rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 4000743c: 02 bf ff e7 be 400073d8 <== NEVER TAKEN 40007440: a0 10 20 09 mov 9, %l0 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007444: 10 bf ff f7 b 40007420 40007448: 82 10 3f ff mov -1, %g1 4000744c: 10 bf ff f4 b 4000741c <== NOT EXECUTED 40007450: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED =============================================================================== 4000745c : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 4000745c: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007460: d0 06 00 00 ld [ %i0 ], %o0 40007464: 40 00 1b a1 call 4000e2e8 40007468: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 4000746c: 90 0a 20 03 and %o0, 3, %o0 40007470: 90 02 3f ff add %o0, -1, %o0 40007474: 80 a2 20 01 cmp %o0, 1 40007478: 18 80 00 14 bgu 400074c8 4000747c: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 40007480: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 40007484: 80 a0 60 00 cmp %g1, 0 40007488: 12 80 00 10 bne 400074c8 4000748c: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007490: c2 06 20 08 ld [ %i0 + 8 ], %g1 40007494: 80 a0 60 00 cmp %g1, 0 40007498: 06 80 00 0d bl 400074cc 4000749c: 82 10 3f ff mov -1, %g1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 400074a0: 7f ff f1 4e call 400039d8 400074a4: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 400074a8: 80 a2 20 00 cmp %o0, 0 400074ac: 02 80 00 06 be 400074c4 <== NEVER TAKEN 400074b0: 82 10 20 02 mov 2, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 400074b4: f0 22 20 14 st %i0, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_WRITE; 400074b8: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 400074bc: 7f ff ff 46 call 400071d4 400074c0: 91 e8 00 08 restore %g0, %o0, %o0 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 400074c4: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED 400074c8: 82 10 3f ff mov -1, %g1 400074cc: e0 26 20 34 st %l0, [ %i0 + 0x34 ] 400074d0: c2 26 20 38 st %g1, [ %i0 + 0x38 ] 400074d4: 40 00 2a 32 call 40011d9c <__errno> 400074d8: b0 10 3f ff mov -1, %i0 400074dc: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; return rtems_aio_enqueue (req); } 400074e0: 81 c7 e0 08 ret 400074e4: 81 e8 00 00 restore =============================================================================== 40005f94 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 40005f94: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40005f98: 80 a6 60 00 cmp %i1, 0 40005f9c: 02 80 00 20 be 4000601c 40005fa0: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40005fa4: 02 80 00 19 be 40006008 40005fa8: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 40005fac: 02 80 00 12 be 40005ff4 <== NEVER TAKEN 40005fb0: 80 a6 20 02 cmp %i0, 2 return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 40005fb4: 02 80 00 10 be 40005ff4 40005fb8: 80 a6 20 03 cmp %i0, 3 return 0; } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 40005fbc: 02 80 00 08 be 40005fdc 40005fc0: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40005fc4: 40 00 29 1b call 40010430 <__errno> 40005fc8: b0 10 3f ff mov -1, %i0 ! ffffffff 40005fcc: 82 10 20 16 mov 0x16, %g1 40005fd0: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40005fd4: 81 c7 e0 08 ret 40005fd8: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); 40005fdc: 40 00 29 15 call 40010430 <__errno> 40005fe0: b0 10 3f ff mov -1, %i0 40005fe4: 82 10 20 58 mov 0x58, %g1 40005fe8: c2 22 00 00 st %g1, [ %o0 ] 40005fec: 81 c7 e0 08 ret 40005ff0: 81 e8 00 00 restore } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { _TOD_Get_uptime_as_timespec( tp ); 40005ff4: 90 10 00 19 mov %i1, %o0 40005ff8: 40 00 08 6f call 400081b4 <_TOD_Get_uptime_as_timespec> 40005ffc: b0 10 20 00 clr %i0 return 0; 40006000: 81 c7 e0 08 ret 40006004: 81 e8 00 00 restore { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { _TOD_Get(tp); 40006008: 90 10 00 19 mov %i1, %o0 4000600c: 40 00 08 4f call 40008148 <_TOD_Get> 40006010: b0 10 20 00 clr %i0 return 0; 40006014: 81 c7 e0 08 ret 40006018: 81 e8 00 00 restore clockid_t clock_id, struct timespec *tp ) { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); 4000601c: 40 00 29 05 call 40010430 <__errno> 40006020: b0 10 3f ff mov -1, %i0 40006024: 82 10 20 16 mov 0x16, %g1 40006028: c2 22 00 00 st %g1, [ %o0 ] 4000602c: 81 c7 e0 08 ret 40006030: 81 e8 00 00 restore =============================================================================== 40006034 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 40006034: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40006038: 80 a6 60 00 cmp %i1, 0 4000603c: 02 80 00 24 be 400060cc <== NEVER TAKEN 40006040: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40006044: 02 80 00 0c be 40006074 40006048: 80 a6 20 02 cmp %i0, 2 _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 4000604c: 02 80 00 1a be 400060b4 40006050: 80 a6 20 03 cmp %i0, 3 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) 40006054: 02 80 00 18 be 400060b4 40006058: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 4000605c: 40 00 28 f5 call 40010430 <__errno> 40006060: b0 10 3f ff mov -1, %i0 ! ffffffff 40006064: 82 10 20 16 mov 0x16, %g1 40006068: c2 22 00 00 st %g1, [ %o0 ] return 0; } 4000606c: 81 c7 e0 08 ret 40006070: 81 e8 00 00 restore { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 40006074: c4 06 40 00 ld [ %i1 ], %g2 40006078: 03 08 76 b9 sethi %hi(0x21dae400), %g1 4000607c: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 40006080: 80 a0 80 01 cmp %g2, %g1 40006084: 08 80 00 12 bleu 400060cc 40006088: 03 10 00 80 sethi %hi(0x40020000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4000608c: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 ! 40020160 <_Thread_Dispatch_disable_level> 40006090: 84 00 a0 01 inc %g2 40006094: c4 20 61 60 st %g2, [ %g1 + 0x160 ] rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); 40006098: 90 10 00 19 mov %i1, %o0 4000609c: 40 00 08 5e call 40008214 <_TOD_Set> 400060a0: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 400060a4: 40 00 0e 42 call 400099ac <_Thread_Enable_dispatch> 400060a8: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; 400060ac: 81 c7 e0 08 ret 400060b0: 81 e8 00 00 restore else if ( clock_id == CLOCK_PROCESS_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); 400060b4: 40 00 28 df call 40010430 <__errno> 400060b8: b0 10 3f ff mov -1, %i0 400060bc: 82 10 20 58 mov 0x58, %g1 400060c0: c2 22 00 00 st %g1, [ %o0 ] 400060c4: 81 c7 e0 08 ret 400060c8: 81 e8 00 00 restore if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) rtems_set_errno_and_return_minus_one( EINVAL ); 400060cc: 40 00 28 d9 call 40010430 <__errno> 400060d0: b0 10 3f ff mov -1, %i0 400060d4: 82 10 20 16 mov 0x16, %g1 400060d8: c2 22 00 00 st %g1, [ %o0 ] 400060dc: 81 c7 e0 08 ret 400060e0: 81 e8 00 00 restore =============================================================================== 40024670 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 40024670: 9d e3 bf 90 save %sp, -112, %sp POSIX_signals_Siginfo_node *psiginfo; /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) 40024674: 7f ff ff 20 call 400242f4 40024678: 01 00 00 00 nop 4002467c: 80 a2 00 18 cmp %o0, %i0 40024680: 12 80 00 b3 bne 4002494c 40024684: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); /* * Validate the signal passed. */ if ( !sig ) 40024688: 02 80 00 b7 be 40024964 4002468c: 82 06 7f ff add %i1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 40024690: 80 a0 60 1f cmp %g1, 0x1f 40024694: 18 80 00 b4 bgu 40024964 40024698: a5 2e 60 02 sll %i1, 2, %l2 rtems_set_errno_and_return_minus_one( EINVAL ); /* * If the signal is being ignored, then we are out of here. */ if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) 4002469c: 23 10 00 a1 sethi %hi(0x40028400), %l1 400246a0: a7 2e 60 04 sll %i1, 4, %l3 400246a4: a2 14 61 d0 or %l1, 0x1d0, %l1 400246a8: 84 24 c0 12 sub %l3, %l2, %g2 400246ac: 84 04 40 02 add %l1, %g2, %g2 400246b0: c4 00 a0 08 ld [ %g2 + 8 ], %g2 400246b4: 80 a0 a0 01 cmp %g2, 1 400246b8: 02 80 00 42 be 400247c0 400246bc: b0 10 20 00 clr %i0 /* * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) 400246c0: 80 a6 60 04 cmp %i1, 4 400246c4: 02 80 00 41 be 400247c8 400246c8: 80 a6 60 08 cmp %i1, 8 400246cc: 02 80 00 3f be 400247c8 400246d0: 80 a6 60 0b cmp %i1, 0xb 400246d4: 02 80 00 3d be 400247c8 400246d8: a0 10 20 01 mov 1, %l0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 400246dc: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 400246e0: e0 27 bf f8 st %l0, [ %fp + -8 ] if ( !value ) { 400246e4: 80 a6 a0 00 cmp %i2, 0 400246e8: 02 80 00 3e be 400247e0 400246ec: a1 2c 00 01 sll %l0, %g1, %l0 siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; 400246f0: c2 06 80 00 ld [ %i2 ], %g1 400246f4: c2 27 bf fc st %g1, [ %fp + -4 ] 400246f8: 03 10 00 a0 sethi %hi(0x40028000), %g1 400246fc: c4 00 60 20 ld [ %g1 + 0x20 ], %g2 ! 40028020 <_Thread_Dispatch_disable_level> 40024700: 84 00 a0 01 inc %g2 40024704: c4 20 60 20 st %g2, [ %g1 + 0x20 ] /* * Is the currently executing thread interested? If so then it will * get it an execute it as soon as the dispatcher executes. */ the_thread = _Thread_Executing; 40024708: 03 10 00 a1 sethi %hi(0x40028400), %g1 4002470c: d0 00 61 84 ld [ %g1 + 0x184 ], %o0 ! 40028584 <_Per_CPU_Information+0xc> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 40024710: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 40024714: c2 00 60 d0 ld [ %g1 + 0xd0 ], %g1 40024718: 80 ac 00 01 andncc %l0, %g1, %g0 4002471c: 12 80 00 1a bne 40024784 40024720: 09 10 00 a1 sethi %hi(0x40028400), %g4 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 40024724: c2 01 23 5c ld [ %g4 + 0x35c ], %g1 ! 4002875c <_POSIX_signals_Wait_queue> 40024728: 88 11 23 5c or %g4, 0x35c, %g4 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); 4002472c: 88 01 20 04 add %g4, 4, %g4 40024730: 80 a0 40 04 cmp %g1, %g4 40024734: 02 80 00 2d be 400247e8 40024738: 90 10 00 01 mov %g1, %o0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 4002473c: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 40024740: 80 8c 00 02 btst %l0, %g2 40024744: 02 80 00 0c be 40024774 40024748: c6 00 61 58 ld [ %g1 + 0x158 ], %g3 /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 4002474c: 10 80 00 0f b 40024788 40024750: 92 10 00 19 mov %i1, %o1 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); 40024754: 80 a0 40 04 cmp %g1, %g4 40024758: 22 80 00 25 be,a 400247ec <== ALWAYS TAKEN 4002475c: 03 10 00 9d sethi %hi(0x40027400), %g1 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 40024760: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 ! 40027430 <_RTEMS_version+0x20><== NOT EXECUTED for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40024764: c6 00 61 58 ld [ %g1 + 0x158 ], %g3 <== NOT EXECUTED #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 40024768: 80 8c 00 02 btst %l0, %g2 <== NOT EXECUTED 4002476c: 12 80 00 06 bne 40024784 <== NOT EXECUTED 40024770: 90 10 00 01 mov %g1, %o0 <== NOT EXECUTED /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 40024774: c4 00 e0 d0 ld [ %g3 + 0xd0 ], %g2 40024778: 80 ac 00 02 andncc %l0, %g2, %g0 4002477c: 22 bf ff f6 be,a 40024754 40024780: c2 00 40 00 ld [ %g1 ], %g1 /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 40024784: 92 10 00 19 mov %i1, %o1 40024788: 40 00 00 8f call 400249c4 <_POSIX_signals_Unblock_thread> 4002478c: 94 07 bf f4 add %fp, -12, %o2 40024790: 80 8a 20 ff btst 0xff, %o0 40024794: 12 80 00 5b bne 40024900 40024798: 01 00 00 00 nop /* * We may have woken up a thread but we definitely need to post the * signal to the process wide information set. */ _POSIX_signals_Set_process_signals( mask ); 4002479c: 40 00 00 80 call 4002499c <_POSIX_signals_Set_process_signals> 400247a0: 90 10 00 10 mov %l0, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 400247a4: a4 24 c0 12 sub %l3, %l2, %l2 400247a8: c2 04 40 12 ld [ %l1 + %l2 ], %g1 400247ac: 80 a0 60 02 cmp %g1, 2 400247b0: 02 80 00 58 be 40024910 400247b4: 11 10 00 a1 sethi %hi(0x40028400), %o0 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 400247b8: 7f ff a7 77 call 4000e594 <_Thread_Enable_dispatch> 400247bc: b0 10 20 00 clr %i0 return 0; } 400247c0: 81 c7 e0 08 ret 400247c4: 81 e8 00 00 restore * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) return pthread_kill( pthread_self(), sig ); 400247c8: 40 00 01 0e call 40024c00 400247cc: 01 00 00 00 nop 400247d0: 40 00 00 cf call 40024b0c 400247d4: 92 10 00 19 mov %i1, %o1 400247d8: 81 c7 e0 08 ret 400247dc: 91 e8 00 08 restore %g0, %o0, %o0 */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { siginfo->si_value.sival_int = 0; 400247e0: 10 bf ff c6 b 400246f8 400247e4: c0 27 bf fc clr [ %fp + -4 ] * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 400247e8: 03 10 00 9d sethi %hi(0x40027400), %g1 400247ec: c8 08 61 34 ldub [ %g1 + 0x134 ], %g4 ! 40027534 400247f0: 15 10 00 9f sethi %hi(0x40027c00), %o2 400247f4: 88 01 20 01 inc %g4 400247f8: 94 12 a3 90 or %o2, 0x390, %o2 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 400247fc: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 40024800: 92 02 a0 08 add %o2, 8, %o1 */ RTEMS_INLINE_ROUTINE bool _States_Is_interruptible_by_signal ( States_Control the_states ) { return (the_states & STATES_INTERRUPTIBLE_BY_SIGNAL); 40024804: 35 04 00 00 sethi %hi(0x10000000), %i2 for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { /* * This can occur when no one is interested and an API is not configured. */ if ( !_Objects_Information_table[ the_api ] ) 40024808: c2 02 80 00 ld [ %o2 ], %g1 4002480c: 80 a0 60 00 cmp %g1, 0 40024810: 22 80 00 31 be,a 400248d4 <== NEVER TAKEN 40024814: 94 02 a0 04 add %o2, 4, %o2 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 40024818: c2 00 60 04 ld [ %g1 + 4 ], %g1 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 4002481c: da 10 60 10 lduh [ %g1 + 0x10 ], %o5 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40024820: 80 a3 60 00 cmp %o5, 0 40024824: 02 80 00 2b be 400248d0 40024828: d8 00 60 1c ld [ %g1 + 0x1c ], %o4 4002482c: 82 10 20 01 mov 1, %g1 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 40024830: 85 28 60 02 sll %g1, 2, %g2 maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { the_thread = (Thread_Control *) object_table[ index ]; 40024834: c4 03 00 02 ld [ %o4 + %g2 ], %g2 if ( !the_thread ) 40024838: 80 a0 a0 00 cmp %g2, 0 4002483c: 22 80 00 22 be,a 400248c4 40024840: 82 00 60 01 inc %g1 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 40024844: c6 00 a0 14 ld [ %g2 + 0x14 ], %g3 40024848: 80 a0 c0 04 cmp %g3, %g4 4002484c: 38 80 00 1e bgu,a 400248c4 40024850: 82 00 60 01 inc %g1 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 40024854: d6 00 a1 58 ld [ %g2 + 0x158 ], %o3 40024858: d6 02 e0 d0 ld [ %o3 + 0xd0 ], %o3 4002485c: 80 ac 00 0b andncc %l0, %o3, %g0 40024860: 22 80 00 19 be,a 400248c4 40024864: 82 00 60 01 inc %g1 * * NOTE: We initialized interested_priority to PRIORITY_MAXIMUM + 1 * so we never have to worry about deferencing a NULL * interested thread. */ if ( the_thread->current_priority < interested_priority ) { 40024868: 80 a0 c0 04 cmp %g3, %g4 4002486c: 2a 80 00 14 bcs,a 400248bc 40024870: 88 10 00 03 mov %g3, %g4 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { 40024874: 80 a2 20 00 cmp %o0, 0 40024878: 22 80 00 13 be,a 400248c4 <== NEVER TAKEN 4002487c: 82 00 60 01 inc %g1 <== NOT EXECUTED 40024880: d6 02 20 10 ld [ %o0 + 0x10 ], %o3 40024884: 80 a2 e0 00 cmp %o3, 0 40024888: 22 80 00 0f be,a 400248c4 <== NEVER TAKEN 4002488c: 82 00 60 01 inc %g1 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 40024890: de 00 a0 10 ld [ %g2 + 0x10 ], %o7 40024894: 80 a3 e0 00 cmp %o7, 0 40024898: 22 80 00 09 be,a 400248bc 4002489c: 88 10 00 03 mov %g3, %g4 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 400248a0: 80 8a c0 1a btst %o3, %i2 400248a4: 32 80 00 08 bne,a 400248c4 400248a8: 82 00 60 01 inc %g1 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 400248ac: 80 8b c0 1a btst %o7, %i2 400248b0: 22 80 00 05 be,a 400248c4 400248b4: 82 00 60 01 inc %g1 */ if ( interested && !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 400248b8: 88 10 00 03 mov %g3, %g4 400248bc: 90 10 00 02 mov %g2, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 400248c0: 82 00 60 01 inc %g1 400248c4: 80 a3 40 01 cmp %o5, %g1 400248c8: 1a bf ff db bcc 40024834 400248cc: 85 28 60 02 sll %g1, 2, %g2 400248d0: 94 02 a0 04 add %o2, 4, %o2 * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { 400248d4: 80 a2 80 09 cmp %o2, %o1 400248d8: 32 bf ff cd bne,a 4002480c 400248dc: c2 02 80 00 ld [ %o2 ], %g1 } } } } if ( interested ) { 400248e0: 80 a2 20 00 cmp %o0, 0 400248e4: 02 bf ff ae be 4002479c 400248e8: 92 10 00 19 mov %i1, %o1 /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 400248ec: 40 00 00 36 call 400249c4 <_POSIX_signals_Unblock_thread> 400248f0: 94 07 bf f4 add %fp, -12, %o2 400248f4: 80 8a 20 ff btst 0xff, %o0 400248f8: 02 bf ff a9 be 4002479c <== ALWAYS TAKEN 400248fc: 01 00 00 00 nop _Thread_Enable_dispatch(); 40024900: 7f ff a7 25 call 4000e594 <_Thread_Enable_dispatch> 40024904: b0 10 20 00 clr %i0 ! 0 return 0; 40024908: 81 c7 e0 08 ret 4002490c: 81 e8 00 00 restore _POSIX_signals_Set_process_signals( mask ); if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 40024910: 7f ff 9f f1 call 4000c8d4 <_Chain_Get> 40024914: 90 12 23 50 or %o0, 0x350, %o0 if ( !psiginfo ) { 40024918: 92 92 20 00 orcc %o0, 0, %o1 4002491c: 02 80 00 18 be 4002497c 40024920: c2 07 bf f4 ld [ %fp + -12 ], %g1 rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 40024924: 11 10 00 a1 sethi %hi(0x40028400), %o0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 40024928: c2 22 60 08 st %g1, [ %o1 + 8 ] 4002492c: c2 07 bf f8 ld [ %fp + -8 ], %g1 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 40024930: 90 12 23 c8 or %o0, 0x3c8, %o0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 40024934: c2 22 60 0c st %g1, [ %o1 + 0xc ] 40024938: c2 07 bf fc ld [ %fp + -4 ], %g1 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 4002493c: 90 02 00 12 add %o0, %l2, %o0 40024940: 7f ff 9f cf call 4000c87c <_Chain_Append> 40024944: c2 22 60 10 st %g1, [ %o1 + 0x10 ] 40024948: 30 bf ff 9c b,a 400247b8 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) rtems_set_errno_and_return_minus_one( ESRCH ); 4002494c: 7f ff c1 5c call 40014ebc <__errno> 40024950: b0 10 3f ff mov -1, %i0 40024954: 82 10 20 03 mov 3, %g1 40024958: c2 22 00 00 st %g1, [ %o0 ] 4002495c: 81 c7 e0 08 ret 40024960: 81 e8 00 00 restore */ if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); 40024964: 7f ff c1 56 call 40014ebc <__errno> 40024968: b0 10 3f ff mov -1, %i0 4002496c: 82 10 20 16 mov 0x16, %g1 40024970: c2 22 00 00 st %g1, [ %o0 ] 40024974: 81 c7 e0 08 ret 40024978: 81 e8 00 00 restore if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { _Thread_Enable_dispatch(); 4002497c: 7f ff a7 06 call 4000e594 <_Thread_Enable_dispatch> 40024980: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EAGAIN ); 40024984: 7f ff c1 4e call 40014ebc <__errno> 40024988: 01 00 00 00 nop 4002498c: 82 10 20 0b mov 0xb, %g1 ! b 40024990: c2 22 00 00 st %g1, [ %o0 ] 40024994: 81 c7 e0 08 ret 40024998: 81 e8 00 00 restore =============================================================================== 4000b044 : int oflag, ... /* mode_t mode, */ /* struct mq_attr attr */ ) { 4000b044: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4000b048: 03 10 00 a0 sethi %hi(0x40028000), %g1 4000b04c: c4 00 63 d0 ld [ %g1 + 0x3d0 ], %g2 ! 400283d0 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 4000b050: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 4000b054: 84 00 a0 01 inc %g2 4000b058: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 4000b05c: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 4000b060: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 4000b064: c4 20 63 d0 st %g2, [ %g1 + 0x3d0 ] POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 4000b068: a8 8e 62 00 andcc %i1, 0x200, %l4 4000b06c: 12 80 00 34 bne 4000b13c 4000b070: a6 10 20 00 clr %l3 RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) _Objects_Allocate( &_POSIX_Message_queue_Information_fds ); 4000b074: 23 10 00 a2 sethi %hi(0x40028800), %l1 4000b078: 40 00 0c 79 call 4000e25c <_Objects_Allocate> 4000b07c: 90 14 60 bc or %l1, 0xbc, %o0 ! 400288bc <_POSIX_Message_queue_Information_fds> attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { 4000b080: a0 92 20 00 orcc %o0, 0, %l0 4000b084: 02 80 00 37 be 4000b160 <== NEVER TAKEN 4000b088: 01 00 00 00 nop _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENFILE ); } the_mq_fd->oflag = oflag; 4000b08c: f2 24 20 14 st %i1, [ %l0 + 0x14 ] status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); 4000b090: 90 10 00 18 mov %i0, %o0 4000b094: 40 00 1e 7f call 40012a90 <_POSIX_Message_queue_Name_to_id> 4000b098: 92 07 bf f8 add %fp, -8, %o1 * 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 ) { 4000b09c: a4 92 20 00 orcc %o0, 0, %l2 4000b0a0: 22 80 00 0f be,a 4000b0dc 4000b0a4: b2 0e 6a 00 and %i1, 0xa00, %i1 /* * 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) ) ) { 4000b0a8: 80 a4 a0 02 cmp %l2, 2 4000b0ac: 02 80 00 40 be 4000b1ac 4000b0b0: 80 a5 20 00 cmp %l4, 0 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 ); 4000b0b4: 90 14 60 bc or %l1, 0xbc, %o0 4000b0b8: 40 00 0d 58 call 4000e618 <_Objects_Free> 4000b0bc: 92 10 00 10 mov %l0, %o1 _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 4000b0c0: 40 00 10 e8 call 4000f460 <_Thread_Enable_dispatch> 4000b0c4: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); 4000b0c8: 40 00 2d 82 call 400166d0 <__errno> 4000b0cc: 01 00 00 00 nop 4000b0d0: e4 22 00 00 st %l2, [ %o0 ] 4000b0d4: 81 c7 e0 08 ret 4000b0d8: 81 e8 00 00 restore } else { /* name -> ID translation succeeded */ /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 4000b0dc: 80 a6 6a 00 cmp %i1, 0xa00 4000b0e0: 02 80 00 28 be 4000b180 4000b0e4: d2 07 bf f8 ld [ %fp + -8 ], %o1 Objects_Id id, Objects_Locations *location ) { return (POSIX_Message_queue_Control *) _Objects_Get( &_POSIX_Message_queue_Information, id, location ); 4000b0e8: 94 07 bf f0 add %fp, -16, %o2 4000b0ec: 11 10 00 a1 sethi %hi(0x40028400), %o0 4000b0f0: 40 00 0d b0 call 4000e7b0 <_Objects_Get> 4000b0f4: 90 12 23 30 or %o0, 0x330, %o0 ! 40028730 <_POSIX_Message_queue_Information> /* * 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; 4000b0f8: c4 02 20 18 ld [ %o0 + 0x18 ], %g2 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( 4000b0fc: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 4000b100: 84 00 a0 01 inc %g2 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } 4000b104: a2 14 60 bc or %l1, 0xbc, %l1 /* * 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; 4000b108: c4 22 20 18 st %g2, [ %o0 + 0x18 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000b10c: c4 04 60 1c ld [ %l1 + 0x1c ], %g2 /* * 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 ); 4000b110: d0 27 bf f4 st %o0, [ %fp + -12 ] the_mq->open_count += 1; the_mq_fd->Queue = the_mq; 4000b114: d0 24 20 10 st %o0, [ %l0 + 0x10 ] 4000b118: 83 28 60 02 sll %g1, 2, %g1 4000b11c: e0 20 80 01 st %l0, [ %g2 + %g1 ] _Objects_Open_string( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 4000b120: 40 00 10 d0 call 4000f460 <_Thread_Enable_dispatch> 4000b124: c0 24 20 0c clr [ %l0 + 0xc ] _Thread_Enable_dispatch(); 4000b128: 40 00 10 ce call 4000f460 <_Thread_Enable_dispatch> 4000b12c: 01 00 00 00 nop return (mqd_t)the_mq_fd->Object.id; 4000b130: f0 04 20 08 ld [ %l0 + 8 ], %i0 4000b134: 81 c7 e0 08 ret 4000b138: 81 e8 00 00 restore _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); 4000b13c: 82 07 a0 54 add %fp, 0x54, %g1 4000b140: e6 07 a0 50 ld [ %fp + 0x50 ], %l3 4000b144: c2 27 bf fc st %g1, [ %fp + -4 ] RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) _Objects_Allocate( &_POSIX_Message_queue_Information_fds ); 4000b148: 23 10 00 a2 sethi %hi(0x40028800), %l1 4000b14c: 40 00 0c 44 call 4000e25c <_Objects_Allocate> 4000b150: 90 14 60 bc or %l1, 0xbc, %o0 ! 400288bc <_POSIX_Message_queue_Information_fds> va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { 4000b154: a0 92 20 00 orcc %o0, 0, %l0 4000b158: 32 bf ff ce bne,a 4000b090 4000b15c: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _Thread_Enable_dispatch(); 4000b160: 40 00 10 c0 call 4000f460 <_Thread_Enable_dispatch> 4000b164: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( ENFILE ); 4000b168: 40 00 2d 5a call 400166d0 <__errno> 4000b16c: 01 00 00 00 nop 4000b170: 82 10 20 17 mov 0x17, %g1 ! 17 4000b174: c2 22 00 00 st %g1, [ %o0 ] 4000b178: 81 c7 e0 08 ret 4000b17c: 81 e8 00 00 restore 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 ); 4000b180: 90 14 60 bc or %l1, 0xbc, %o0 4000b184: 40 00 0d 25 call 4000e618 <_Objects_Free> 4000b188: 92 10 00 10 mov %l0, %o1 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 4000b18c: 40 00 10 b5 call 4000f460 <_Thread_Enable_dispatch> 4000b190: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t ); 4000b194: 40 00 2d 4f call 400166d0 <__errno> 4000b198: 01 00 00 00 nop 4000b19c: 82 10 20 11 mov 0x11, %g1 ! 11 4000b1a0: c2 22 00 00 st %g1, [ %o0 ] 4000b1a4: 81 c7 e0 08 ret 4000b1a8: 81 e8 00 00 restore if ( status ) { /* * 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) ) ) { 4000b1ac: 02 bf ff c3 be 4000b0b8 4000b1b0: 90 14 60 bc or %l1, 0xbc, %o0 /* * 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( 4000b1b4: 90 10 00 18 mov %i0, %o0 4000b1b8: 92 10 20 01 mov 1, %o1 4000b1bc: 94 10 00 13 mov %l3, %o2 4000b1c0: 40 00 1d d0 call 40012900 <_POSIX_Message_queue_Create_support> 4000b1c4: 96 07 bf f4 add %fp, -12, %o3 ); /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { 4000b1c8: 80 a2 3f ff cmp %o0, -1 4000b1cc: 02 80 00 0d be 4000b200 4000b1d0: c6 07 bf f4 ld [ %fp + -12 ], %g3 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( 4000b1d4: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } 4000b1d8: a2 14 60 bc or %l1, 0xbc, %l1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000b1dc: c4 04 60 1c ld [ %l1 + 0x1c ], %g2 _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); return (mqd_t) -1; } the_mq_fd->Queue = the_mq; 4000b1e0: c6 24 20 10 st %g3, [ %l0 + 0x10 ] 4000b1e4: 83 28 60 02 sll %g1, 2, %g1 4000b1e8: e0 20 80 01 st %l0, [ %g2 + %g1 ] &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 4000b1ec: 40 00 10 9d call 4000f460 <_Thread_Enable_dispatch> 4000b1f0: c0 24 20 0c clr [ %l0 + 0xc ] return (mqd_t) the_mq_fd->Object.id; 4000b1f4: f0 04 20 08 ld [ %l0 + 8 ], %i0 } 4000b1f8: 81 c7 e0 08 ret 4000b1fc: 81 e8 00 00 restore 4000b200: 90 14 60 bc or %l1, 0xbc, %o0 4000b204: 92 10 00 10 mov %l0, %o1 4000b208: 40 00 0d 04 call 4000e618 <_Objects_Free> 4000b20c: b0 10 3f ff mov -1, %i0 /* * 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(); 4000b210: 40 00 10 94 call 4000f460 <_Thread_Enable_dispatch> 4000b214: 01 00 00 00 nop return (mqd_t) -1; 4000b218: 81 c7 e0 08 ret 4000b21c: 81 e8 00 00 restore =============================================================================== 4000b73c : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 4000b73c: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 4000b740: 80 a0 60 00 cmp %g1, 0 4000b744: 02 80 00 09 be 4000b768 4000b748: 90 10 20 16 mov 0x16, %o0 4000b74c: c4 00 40 00 ld [ %g1 ], %g2 4000b750: 80 a0 a0 00 cmp %g2, 0 4000b754: 02 80 00 05 be 4000b768 4000b758: 80 a2 60 04 cmp %o1, 4 return EINVAL; switch ( policy ) { 4000b75c: 08 80 00 05 bleu 4000b770 4000b760: 84 10 20 01 mov 1, %g2 case SCHED_SPORADIC: attr->schedpolicy = policy; return 0; default: return ENOTSUP; 4000b764: 90 10 20 86 mov 0x86, %o0 } } 4000b768: 81 c3 e0 08 retl 4000b76c: 01 00 00 00 nop ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( policy ) { 4000b770: 85 28 80 09 sll %g2, %o1, %g2 4000b774: 80 88 a0 17 btst 0x17, %g2 4000b778: 22 bf ff fc be,a 4000b768 <== NEVER TAKEN 4000b77c: 90 10 20 86 mov 0x86, %o0 <== NOT EXECUTED case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 4000b780: d2 20 60 14 st %o1, [ %g1 + 0x14 ] return 0; 4000b784: 81 c3 e0 08 retl 4000b788: 90 10 20 00 clr %o0 =============================================================================== 40006528 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 40006528: 9d e3 bf 90 save %sp, -112, %sp 4000652c: a0 10 00 18 mov %i0, %l0 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 40006530: 80 a4 20 00 cmp %l0, 0 40006534: 02 80 00 26 be 400065cc 40006538: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( count == 0 ) 4000653c: 80 a6 a0 00 cmp %i2, 0 40006540: 02 80 00 23 be 400065cc 40006544: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40006548: 22 80 00 27 be,a 400065e4 4000654c: b2 07 bf f0 add %fp, -16, %i1 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40006550: c2 06 40 00 ld [ %i1 ], %g1 40006554: 80 a0 60 00 cmp %g1, 0 40006558: 02 80 00 1d be 400065cc 4000655c: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40006560: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006564: 80 a0 60 00 cmp %g1, 0 40006568: 12 80 00 19 bne 400065cc <== NEVER TAKEN 4000656c: 03 10 00 5f sethi %hi(0x40017c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006570: c4 00 61 20 ld [ %g1 + 0x120 ], %g2 ! 40017d20 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 40006574: c0 27 bf f8 clr [ %fp + -8 ] 40006578: 84 00 a0 01 inc %g2 the_attributes.maximum_count = count; 4000657c: f4 27 bf fc st %i2, [ %fp + -4 ] 40006580: c4 20 61 20 st %g2, [ %g1 + 0x120 ] * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) _Objects_Allocate( &_POSIX_Barrier_Information ); 40006584: 25 10 00 60 sethi %hi(0x40018000), %l2 40006588: 40 00 08 ee call 40008940 <_Objects_Allocate> 4000658c: 90 14 a1 00 or %l2, 0x100, %o0 ! 40018100 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 40006590: a2 92 20 00 orcc %o0, 0, %l1 40006594: 02 80 00 10 be 400065d4 40006598: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 4000659c: 40 00 06 30 call 40007e5c <_CORE_barrier_Initialize> 400065a0: 92 07 bf f8 add %fp, -8, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400065a4: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; _Thread_Enable_dispatch(); return 0; } 400065a8: a4 14 a1 00 or %l2, 0x100, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400065ac: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400065b0: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400065b4: 85 28 a0 02 sll %g2, 2, %g2 400065b8: e2 20 c0 02 st %l1, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 400065bc: c0 24 60 0c clr [ %l1 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 400065c0: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 400065c4: 40 00 0d 42 call 40009acc <_Thread_Enable_dispatch> 400065c8: b0 10 20 00 clr %i0 return 0; } 400065cc: 81 c7 e0 08 ret 400065d0: 81 e8 00 00 restore _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); 400065d4: 40 00 0d 3e call 40009acc <_Thread_Enable_dispatch> 400065d8: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 400065dc: 81 c7 e0 08 ret 400065e0: 81 e8 00 00 restore * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 400065e4: 7f ff ff 9a call 4000644c 400065e8: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 400065ec: 10 bf ff da b 40006554 400065f0: c2 06 40 00 ld [ %i1 ], %g1 =============================================================================== 40005da8 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 40005da8: 9d e3 bf a0 save %sp, -96, %sp /* * 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 ) 40005dac: 80 a6 20 00 cmp %i0, 0 40005db0: 02 80 00 15 be 40005e04 40005db4: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40005db8: 03 10 00 60 sethi %hi(0x40018000), %g1 40005dbc: c4 00 61 c0 ld [ %g1 + 0x1c0 ], %g2 ! 400181c0 <_Thread_Dispatch_disable_level> 40005dc0: 84 00 a0 01 inc %g2 40005dc4: c4 20 61 c0 st %g2, [ %g1 + 0x1c0 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 40005dc8: 40 00 12 9b call 4000a834 <_Workspace_Allocate> 40005dcc: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 40005dd0: 80 a2 20 00 cmp %o0, 0 40005dd4: 02 80 00 0a be 40005dfc <== NEVER TAKEN 40005dd8: 01 00 00 00 nop thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40005ddc: 03 10 00 61 sethi %hi(0x40018400), %g1 40005de0: c2 00 63 24 ld [ %g1 + 0x324 ], %g1 ! 40018724 <_Per_CPU_Information+0xc> handler_stack = &thread_support->Cancellation_Handlers; handler->routine = routine; handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); 40005de4: 92 10 00 08 mov %o0, %o1 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; 40005de8: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 handler->routine = routine; 40005dec: f0 22 20 08 st %i0, [ %o0 + 8 ] handler->arg = arg; 40005df0: f2 22 20 0c st %i1, [ %o0 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 40005df4: 40 00 06 61 call 40007778 <_Chain_Append> 40005df8: 90 00 60 e4 add %g1, 0xe4, %o0 } _Thread_Enable_dispatch(); 40005dfc: 40 00 0d 75 call 400093d0 <_Thread_Enable_dispatch> 40005e00: 81 e8 00 00 restore 40005e04: 81 c7 e0 08 ret 40005e08: 81 e8 00 00 restore =============================================================================== 40006d78 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 40006d78: 9d e3 bf a0 save %sp, -96, %sp POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; 40006d7c: 80 a6 60 00 cmp %i1, 0 40006d80: 02 80 00 26 be 40006e18 40006d84: a2 10 00 18 mov %i0, %l1 else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 40006d88: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006d8c: 80 a0 60 01 cmp %g1, 1 40006d90: 02 80 00 20 be 40006e10 <== NEVER TAKEN 40006d94: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !the_attr->is_initialized ) 40006d98: c2 06 40 00 ld [ %i1 ], %g1 40006d9c: 80 a0 60 00 cmp %g1, 0 40006da0: 02 80 00 1c be 40006e10 40006da4: 03 10 00 63 sethi %hi(0x40018c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006da8: c4 00 62 d0 ld [ %g1 + 0x2d0 ], %g2 ! 40018ed0 <_Thread_Dispatch_disable_level> 40006dac: 84 00 a0 01 inc %g2 40006db0: c4 20 62 d0 st %g2, [ %g1 + 0x2d0 ] RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 40006db4: 25 10 00 64 sethi %hi(0x40019000), %l2 40006db8: 40 00 0a 63 call 40009744 <_Objects_Allocate> 40006dbc: 90 14 a3 48 or %l2, 0x348, %o0 ! 40019348 <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 40006dc0: a0 92 20 00 orcc %o0, 0, %l0 40006dc4: 02 80 00 18 be 40006e24 40006dc8: 90 04 20 18 add %l0, 0x18, %o0 _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40006dcc: c2 06 60 04 ld [ %i1 + 4 ], %g1 the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40006dd0: 92 10 20 00 clr %o1 40006dd4: 15 04 00 02 sethi %hi(0x10000800), %o2 40006dd8: 96 10 20 74 mov 0x74, %o3 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40006ddc: c2 24 20 10 st %g1, [ %l0 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40006de0: 40 00 10 e9 call 4000b184 <_Thread_queue_Initialize> 40006de4: c0 24 20 14 clr [ %l0 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006de8: c4 14 20 0a lduh [ %l0 + 0xa ], %g2 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 40006dec: a4 14 a3 48 or %l2, 0x348, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006df0: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006df4: c2 04 20 08 ld [ %l0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006df8: 85 28 a0 02 sll %g2, 2, %g2 40006dfc: e0 20 c0 02 st %l0, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 40006e00: c0 24 20 0c clr [ %l0 + 0xc ] &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 40006e04: c2 24 40 00 st %g1, [ %l1 ] _Thread_Enable_dispatch(); 40006e08: 40 00 0e b2 call 4000a8d0 <_Thread_Enable_dispatch> 40006e0c: b0 10 20 00 clr %i0 return 0; } 40006e10: 81 c7 e0 08 ret 40006e14: 81 e8 00 00 restore { POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; else the_attr = &_POSIX_Condition_variables_Default_attributes; 40006e18: 33 10 00 5e sethi %hi(0x40017800), %i1 40006e1c: 10 bf ff db b 40006d88 40006e20: b2 16 62 0c or %i1, 0x20c, %i1 ! 40017a0c <_POSIX_Condition_variables_Default_attributes> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { _Thread_Enable_dispatch(); 40006e24: 40 00 0e ab call 4000a8d0 <_Thread_Enable_dispatch> 40006e28: b0 10 20 0c mov 0xc, %i0 return ENOMEM; 40006e2c: 81 c7 e0 08 ret 40006e30: 81 e8 00 00 restore =============================================================================== 40006bd8 : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 40006bd8: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 40006bdc: 80 a0 60 00 cmp %g1, 0 40006be0: 02 80 00 08 be 40006c00 40006be4: 90 10 20 16 mov 0x16, %o0 40006be8: c4 00 40 00 ld [ %g1 ], %g2 40006bec: 80 a0 a0 00 cmp %g2, 0 40006bf0: 02 80 00 04 be 40006c00 <== NEVER TAKEN 40006bf4: 01 00 00 00 nop return EINVAL; attr->is_initialized = false; 40006bf8: c0 20 40 00 clr [ %g1 ] return 0; 40006bfc: 90 10 20 00 clr %o0 } 40006c00: 81 c3 e0 08 retl =============================================================================== 40006270 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 40006270: 9d e3 bf 58 save %sp, -168, %sp 40006274: a0 10 00 18 mov %i0, %l0 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 40006278: 80 a6 a0 00 cmp %i2, 0 4000627c: 02 80 00 63 be 40006408 40006280: b0 10 20 0e mov 0xe, %i0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 40006284: 80 a6 60 00 cmp %i1, 0 40006288: 22 80 00 62 be,a 40006410 4000628c: 33 10 00 76 sethi %hi(0x4001d800), %i1 if ( !the_attr->is_initialized ) 40006290: c2 06 40 00 ld [ %i1 ], %g1 40006294: 80 a0 60 00 cmp %g1, 0 40006298: 02 80 00 5c be 40006408 4000629c: b0 10 20 16 mov 0x16, %i0 * stack space if it is allowed to allocate it itself. * * NOTE: If the user provides the stack we will let it drop below * twice the minimum. */ if ( the_attr->stackaddr && !_Stack_Is_enough(the_attr->stacksize) ) 400062a0: c2 06 60 04 ld [ %i1 + 4 ], %g1 400062a4: 80 a0 60 00 cmp %g1, 0 400062a8: 02 80 00 07 be 400062c4 400062ac: 03 10 00 79 sethi %hi(0x4001e400), %g1 400062b0: c4 06 60 08 ld [ %i1 + 8 ], %g2 400062b4: c2 00 63 84 ld [ %g1 + 0x384 ], %g1 400062b8: 80 a0 80 01 cmp %g2, %g1 400062bc: 0a 80 00 8d bcs 400064f0 400062c0: 01 00 00 00 nop * If inheritsched is set to PTHREAD_INHERIT_SCHED, then this thread * inherits scheduling attributes from the creating thread. If it is * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { 400062c4: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 400062c8: 80 a0 60 01 cmp %g1, 1 400062cc: 02 80 00 53 be 40006418 400062d0: 80 a0 60 02 cmp %g1, 2 400062d4: 12 80 00 4d bne 40006408 400062d8: b0 10 20 16 mov 0x16, %i0 schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 400062dc: d6 06 60 18 ld [ %i1 + 0x18 ], %o3 400062e0: d8 06 60 1c ld [ %i1 + 0x1c ], %o4 400062e4: da 06 60 20 ld [ %i1 + 0x20 ], %o5 400062e8: c8 06 60 24 ld [ %i1 + 0x24 ], %g4 400062ec: c6 06 60 28 ld [ %i1 + 0x28 ], %g3 400062f0: c4 06 60 2c ld [ %i1 + 0x2c ], %g2 400062f4: c2 06 60 30 ld [ %i1 + 0x30 ], %g1 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 400062f8: e2 06 60 14 ld [ %i1 + 0x14 ], %l1 schedparam = the_attr->schedparam; 400062fc: d6 27 bf dc st %o3, [ %fp + -36 ] 40006300: d8 27 bf e0 st %o4, [ %fp + -32 ] 40006304: da 27 bf e4 st %o5, [ %fp + -28 ] 40006308: c8 27 bf e8 st %g4, [ %fp + -24 ] 4000630c: c6 27 bf ec st %g3, [ %fp + -20 ] 40006310: c4 27 bf f0 st %g2, [ %fp + -16 ] 40006314: c2 27 bf f4 st %g1, [ %fp + -12 ] /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 40006318: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000631c: 80 a0 60 00 cmp %g1, 0 40006320: 12 80 00 3a bne 40006408 40006324: b0 10 20 86 mov 0x86, %i0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 40006328: d0 07 bf dc ld [ %fp + -36 ], %o0 4000632c: 40 00 1c 00 call 4000d32c <_POSIX_Priority_Is_valid> 40006330: b0 10 20 16 mov 0x16, %i0 40006334: 80 8a 20 ff btst 0xff, %o0 40006338: 02 80 00 34 be 40006408 <== NEVER TAKEN 4000633c: 03 10 00 79 sethi %hi(0x4001e400), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 40006340: e8 07 bf dc ld [ %fp + -36 ], %l4 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 40006344: 90 10 00 11 mov %l1, %o0 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 40006348: ea 08 63 88 ldub [ %g1 + 0x388 ], %l5 4000634c: 92 07 bf dc add %fp, -36, %o1 40006350: 94 07 bf fc add %fp, -4, %o2 40006354: 40 00 1c 03 call 4000d360 <_POSIX_Thread_Translate_sched_param> 40006358: 96 07 bf f8 add %fp, -8, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 4000635c: b0 92 20 00 orcc %o0, 0, %i0 40006360: 12 80 00 2a bne 40006408 40006364: 27 10 00 7c sethi %hi(0x4001f000), %l3 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 40006368: d0 04 e1 80 ld [ %l3 + 0x180 ], %o0 ! 4001f180 <_RTEMS_Allocator_Mutex> 4000636c: 40 00 06 79 call 40007d50 <_API_Mutex_Lock> 40006370: 2d 10 00 7c sethi %hi(0x4001f000), %l6 * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 40006374: 40 00 09 4c call 400088a4 <_Objects_Allocate> 40006378: 90 15 a3 20 or %l6, 0x320, %o0 ! 4001f320 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 4000637c: a4 92 20 00 orcc %o0, 0, %l2 40006380: 02 80 00 1f be 400063fc 40006384: 05 10 00 79 sethi %hi(0x4001e400), %g2 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 40006388: c2 06 60 08 ld [ %i1 + 8 ], %g1 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 4000638c: d6 00 a3 84 ld [ %g2 + 0x384 ], %o3 40006390: 97 2a e0 01 sll %o3, 1, %o3 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 40006394: 80 a2 c0 01 cmp %o3, %g1 40006398: 1a 80 00 03 bcc 400063a4 4000639c: d4 06 60 04 ld [ %i1 + 4 ], %o2 400063a0: 96 10 00 01 mov %g1, %o3 400063a4: c2 07 bf fc ld [ %fp + -4 ], %g1 400063a8: c0 27 bf d4 clr [ %fp + -44 ] 400063ac: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 400063b0: 82 10 20 01 mov 1, %g1 400063b4: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 400063b8: c2 07 bf f8 ld [ %fp + -8 ], %g1 400063bc: 9a 0d 60 ff and %l5, 0xff, %o5 400063c0: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 400063c4: 82 07 bf d4 add %fp, -44, %g1 400063c8: c0 23 a0 68 clr [ %sp + 0x68 ] 400063cc: 90 15 a3 20 or %l6, 0x320, %o0 400063d0: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 400063d4: 92 10 00 12 mov %l2, %o1 400063d8: 98 10 20 00 clr %o4 400063dc: 40 00 0d c9 call 40009b00 <_Thread_Initialize> 400063e0: 9a 23 40 14 sub %o5, %l4, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 400063e4: 80 8a 20 ff btst 0xff, %o0 400063e8: 12 80 00 1f bne 40006464 400063ec: 11 10 00 7c sethi %hi(0x4001f000), %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 400063f0: 92 10 00 12 mov %l2, %o1 400063f4: 40 00 0a 1b call 40008c60 <_Objects_Free> 400063f8: 90 12 23 20 or %o0, 0x320, %o0 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 400063fc: d0 04 e1 80 ld [ %l3 + 0x180 ], %o0 40006400: 40 00 06 6a call 40007da8 <_API_Mutex_Unlock> 40006404: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40006408: 81 c7 e0 08 ret 4000640c: 81 e8 00 00 restore int rc; if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 40006410: 10 bf ff a0 b 40006290 40006414: b2 16 62 04 or %i1, 0x204, %i1 * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40006418: 03 10 00 7d sethi %hi(0x4001f400), %g1 4000641c: c2 00 62 24 ld [ %g1 + 0x224 ], %g1 ! 4001f624 <_Per_CPU_Information+0xc> 40006420: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 schedpolicy = api->schedpolicy; schedparam = api->schedparam; 40006424: d4 00 60 88 ld [ %g1 + 0x88 ], %o2 40006428: d6 00 60 8c ld [ %g1 + 0x8c ], %o3 4000642c: d8 00 60 90 ld [ %g1 + 0x90 ], %o4 40006430: da 00 60 94 ld [ %g1 + 0x94 ], %o5 40006434: c8 00 60 98 ld [ %g1 + 0x98 ], %g4 40006438: c6 00 60 9c ld [ %g1 + 0x9c ], %g3 4000643c: c4 00 60 a0 ld [ %g1 + 0xa0 ], %g2 * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; schedpolicy = api->schedpolicy; 40006440: e2 00 60 84 ld [ %g1 + 0x84 ], %l1 schedparam = api->schedparam; 40006444: d4 27 bf dc st %o2, [ %fp + -36 ] 40006448: d6 27 bf e0 st %o3, [ %fp + -32 ] 4000644c: d8 27 bf e4 st %o4, [ %fp + -28 ] 40006450: da 27 bf e8 st %o5, [ %fp + -24 ] 40006454: c8 27 bf ec st %g4, [ %fp + -20 ] 40006458: c6 27 bf f0 st %g3, [ %fp + -16 ] break; 4000645c: 10 bf ff af b 40006318 40006460: c4 27 bf f4 st %g2, [ %fp + -12 ] } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40006464: e8 04 a1 58 ld [ %l2 + 0x158 ], %l4 api->Attributes = *the_attr; 40006468: 92 10 00 19 mov %i1, %o1 4000646c: 94 10 20 40 mov 0x40, %o2 40006470: 40 00 29 1d call 400108e4 40006474: 90 10 00 14 mov %l4, %o0 api->detachstate = the_attr->detachstate; 40006478: c2 06 60 3c ld [ %i1 + 0x3c ], %g1 api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 4000647c: 90 10 00 12 mov %l2, %o0 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; 40006480: c2 25 20 40 st %g1, [ %l4 + 0x40 ] api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006484: c2 07 bf dc ld [ %fp + -36 ], %g1 */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; 40006488: e2 25 20 84 st %l1, [ %l4 + 0x84 ] api->schedparam = schedparam; 4000648c: c2 25 20 88 st %g1, [ %l4 + 0x88 ] 40006490: c2 07 bf e0 ld [ %fp + -32 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40006494: 92 10 20 01 mov 1, %o1 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006498: c2 25 20 8c st %g1, [ %l4 + 0x8c ] 4000649c: c2 07 bf e4 ld [ %fp + -28 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 400064a0: 94 10 00 1a mov %i2, %o2 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 400064a4: c2 25 20 90 st %g1, [ %l4 + 0x90 ] 400064a8: c2 07 bf e8 ld [ %fp + -24 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 400064ac: 96 10 00 1b mov %i3, %o3 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 400064b0: c2 25 20 94 st %g1, [ %l4 + 0x94 ] 400064b4: c2 07 bf ec ld [ %fp + -20 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 400064b8: 98 10 20 00 clr %o4 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 400064bc: c2 25 20 98 st %g1, [ %l4 + 0x98 ] 400064c0: c2 07 bf f0 ld [ %fp + -16 ], %g1 400064c4: c2 25 20 9c st %g1, [ %l4 + 0x9c ] 400064c8: c2 07 bf f4 ld [ %fp + -12 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 400064cc: 40 00 10 2e call 4000a584 <_Thread_Start> 400064d0: c2 25 20 a0 st %g1, [ %l4 + 0xa0 ] _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 400064d4: 80 a4 60 04 cmp %l1, 4 400064d8: 02 80 00 08 be 400064f8 400064dc: 01 00 00 00 nop } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 400064e0: c2 04 a0 08 ld [ %l2 + 8 ], %g1 _RTEMS_Unlock_allocator(); 400064e4: d0 04 e1 80 ld [ %l3 + 0x180 ], %o0 400064e8: 40 00 06 30 call 40007da8 <_API_Mutex_Unlock> 400064ec: c2 24 00 00 st %g1, [ %l0 ] return 0; 400064f0: 81 c7 e0 08 ret 400064f4: 81 e8 00 00 restore return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { _Watchdog_Insert_ticks( 400064f8: 40 00 10 a7 call 4000a794 <_Timespec_To_ticks> 400064fc: 90 05 20 90 add %l4, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006500: 92 05 20 a8 add %l4, 0xa8, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006504: d0 25 20 b4 st %o0, [ %l4 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006508: 11 10 00 7c sethi %hi(0x4001f000), %o0 4000650c: 40 00 11 90 call 4000ab4c <_Watchdog_Insert> 40006510: 90 12 21 a0 or %o0, 0x1a0, %o0 ! 4001f1a0 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 40006514: 10 bf ff f4 b 400064e4 40006518: c2 04 a0 08 ld [ %l2 + 8 ], %g1 =============================================================================== 4000827c : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 4000827c: 9d e3 bf 98 save %sp, -104, %sp * * 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 ); 40008280: 90 10 00 19 mov %i1, %o0 40008284: 40 00 00 39 call 40008368 <_POSIX_Absolute_timeout_to_ticks> 40008288: 92 07 bf fc add %fp, -4, %o1 4000828c: a0 10 00 08 mov %o0, %l0 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 40008290: 80 a4 20 03 cmp %l0, 3 40008294: 02 80 00 10 be 400082d4 40008298: 90 10 00 18 mov %i0, %o0 do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 4000829c: d4 07 bf fc ld [ %fp + -4 ], %o2 400082a0: 7f ff ff bd call 40008194 <_POSIX_Mutex_Lock_support> 400082a4: 92 10 20 00 clr %o1 * This service only gives us the option to block. We used a polling * attempt to lock if the abstime was not in the future. If we did * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { 400082a8: 80 a2 20 10 cmp %o0, 0x10 400082ac: 02 80 00 04 be 400082bc <== ALWAYS TAKEN 400082b0: 80 a4 20 00 cmp %l0, 0 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } 400082b4: 81 c7 e0 08 ret 400082b8: 91 e8 00 08 restore %g0, %o0, %o0 * attempt to lock if the abstime was not in the future. If we did * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 400082bc: 02 80 00 0b be 400082e8 <== NEVER TAKEN 400082c0: a0 04 3f ff add %l0, -1, %l0 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 400082c4: 80 a4 20 01 cmp %l0, 1 400082c8: 28 bf ff fb bleu,a 400082b4 <== ALWAYS TAKEN 400082cc: 90 10 20 74 mov 0x74, %o0 400082d0: 30 bf ff f9 b,a 400082b4 <== NOT EXECUTED */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 400082d4: d4 07 bf fc ld [ %fp + -4 ], %o2 400082d8: 7f ff ff af call 40008194 <_POSIX_Mutex_Lock_support> 400082dc: 92 10 20 01 mov 1, %o1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } 400082e0: 81 c7 e0 08 ret 400082e4: 91 e8 00 08 restore %g0, %o0, %o0 * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) return EINVAL; 400082e8: 10 bf ff f3 b 400082b4 <== NOT EXECUTED 400082ec: 90 10 20 16 mov 0x16, %o0 <== NOT EXECUTED =============================================================================== 40005ba4 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 40005ba4: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40005ba8: 80 a0 60 00 cmp %g1, 0 40005bac: 02 80 00 0b be 40005bd8 40005bb0: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40005bb4: c4 00 40 00 ld [ %g1 ], %g2 40005bb8: 80 a0 a0 00 cmp %g2, 0 40005bbc: 02 80 00 07 be 40005bd8 40005bc0: 80 a2 60 00 cmp %o1, 0 return EINVAL; if ( !type ) 40005bc4: 02 80 00 05 be 40005bd8 <== NEVER TAKEN 40005bc8: 01 00 00 00 nop return EINVAL; *type = attr->type; 40005bcc: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 40005bd0: 90 10 20 00 clr %o0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 40005bd4: c2 22 40 00 st %g1, [ %o1 ] return 0; } 40005bd8: 81 c3 e0 08 retl =============================================================================== 40007e44 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 40007e44: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40007e48: 80 a0 60 00 cmp %g1, 0 40007e4c: 02 80 00 08 be 40007e6c 40007e50: 90 10 20 16 mov 0x16, %o0 40007e54: c4 00 40 00 ld [ %g1 ], %g2 40007e58: 80 a0 a0 00 cmp %g2, 0 40007e5c: 02 80 00 04 be 40007e6c 40007e60: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40007e64: 28 80 00 04 bleu,a 40007e74 <== ALWAYS TAKEN 40007e68: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; default: return EINVAL; } } 40007e6c: 81 c3 e0 08 retl 40007e70: 01 00 00 00 nop 40007e74: 81 c3 e0 08 retl 40007e78: 90 10 20 00 clr %o0 ! 0 =============================================================================== 40005c34 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 40005c34: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40005c38: 80 a0 60 00 cmp %g1, 0 40005c3c: 02 80 00 08 be 40005c5c 40005c40: 90 10 20 16 mov 0x16, %o0 40005c44: c4 00 40 00 ld [ %g1 ], %g2 40005c48: 80 a0 a0 00 cmp %g2, 0 40005c4c: 02 80 00 04 be 40005c5c <== NEVER TAKEN 40005c50: 80 a2 60 03 cmp %o1, 3 return EINVAL; switch ( type ) { 40005c54: 28 80 00 04 bleu,a 40005c64 40005c58: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; default: return EINVAL; } } 40005c5c: 81 c3 e0 08 retl 40005c60: 01 00 00 00 nop 40005c64: 81 c3 e0 08 retl 40005c68: 90 10 20 00 clr %o0 ! 0 =============================================================================== 40006958 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 40006958: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 4000695c: 80 a6 60 00 cmp %i1, 0 40006960: 02 80 00 0b be 4000698c 40006964: a0 10 00 18 mov %i0, %l0 40006968: 80 a6 20 00 cmp %i0, 0 4000696c: 02 80 00 08 be 4000698c 40006970: 01 00 00 00 nop return EINVAL; if ( !once_control->init_executed ) { 40006974: c2 06 20 04 ld [ %i0 + 4 ], %g1 40006978: 80 a0 60 00 cmp %g1, 0 4000697c: 02 80 00 06 be 40006994 40006980: b0 10 20 00 clr %i0 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 40006984: 81 c7 e0 08 ret 40006988: 81 e8 00 00 restore 4000698c: 81 c7 e0 08 ret 40006990: 91 e8 20 16 restore %g0, 0x16, %o0 if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 40006994: a2 07 bf fc add %fp, -4, %l1 40006998: 90 10 21 00 mov 0x100, %o0 4000699c: 92 10 21 00 mov 0x100, %o1 400069a0: 40 00 03 1c call 40007610 400069a4: 94 10 00 11 mov %l1, %o2 if ( !once_control->init_executed ) { 400069a8: c2 04 20 04 ld [ %l0 + 4 ], %g1 400069ac: 80 a0 60 00 cmp %g1, 0 400069b0: 02 80 00 09 be 400069d4 <== ALWAYS TAKEN 400069b4: 82 10 20 01 mov 1, %g1 once_control->is_initialized = true; once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 400069b8: d0 07 bf fc ld [ %fp + -4 ], %o0 <== NOT EXECUTED 400069bc: 92 10 21 00 mov 0x100, %o1 400069c0: 94 10 00 11 mov %l1, %o2 400069c4: 40 00 03 13 call 40007610 400069c8: b0 10 20 00 clr %i0 400069cc: 81 c7 e0 08 ret 400069d0: 81 e8 00 00 restore if ( !once_control->init_executed ) { rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); if ( !once_control->init_executed ) { once_control->is_initialized = true; 400069d4: c2 24 00 00 st %g1, [ %l0 ] once_control->init_executed = true; (*init_routine)(); 400069d8: 9f c6 40 00 call %i1 400069dc: c2 24 20 04 st %g1, [ %l0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 400069e0: 10 bf ff f7 b 400069bc 400069e4: d0 07 bf fc ld [ %fp + -4 ], %o0 =============================================================================== 40007140 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 40007140: 9d e3 bf 90 save %sp, -112, %sp 40007144: a0 10 00 18 mov %i0, %l0 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 40007148: 80 a4 20 00 cmp %l0, 0 4000714c: 02 80 00 23 be 400071d8 40007150: b0 10 20 16 mov 0x16, %i0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40007154: 80 a6 60 00 cmp %i1, 0 40007158: 22 80 00 26 be,a 400071f0 4000715c: b2 07 bf f4 add %fp, -12, %i1 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40007160: c2 06 40 00 ld [ %i1 ], %g1 40007164: 80 a0 60 00 cmp %g1, 0 40007168: 02 80 00 1c be 400071d8 <== NEVER TAKEN 4000716c: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40007170: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007174: 80 a0 60 00 cmp %g1, 0 40007178: 12 80 00 18 bne 400071d8 <== NEVER TAKEN 4000717c: 03 10 00 68 sethi %hi(0x4001a000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007180: c4 00 63 40 ld [ %g1 + 0x340 ], %g2 ! 4001a340 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 40007184: c0 27 bf fc clr [ %fp + -4 ] 40007188: 84 00 a0 01 inc %g2 4000718c: c4 20 63 40 st %g2, [ %g1 + 0x340 ] * the inactive chain of free RWLock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void ) { return (POSIX_RWLock_Control *) _Objects_Allocate( &_POSIX_RWLock_Information ); 40007190: 25 10 00 69 sethi %hi(0x4001a400), %l2 40007194: 40 00 0a 7a call 40009b7c <_Objects_Allocate> 40007198: 90 14 a1 60 or %l2, 0x160, %o0 ! 4001a560 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 4000719c: a2 92 20 00 orcc %o0, 0, %l1 400071a0: 02 80 00 10 be 400071e0 400071a4: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 400071a8: 40 00 08 0e call 400091e0 <_CORE_RWLock_Initialize> 400071ac: 92 07 bf fc add %fp, -4, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400071b0: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 400071b4: a4 14 a1 60 or %l2, 0x160, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400071b8: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400071bc: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400071c0: 85 28 a0 02 sll %g2, 2, %g2 400071c4: e2 20 c0 02 st %l1, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 400071c8: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 400071cc: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 400071d0: 40 00 0e ce call 4000ad08 <_Thread_Enable_dispatch> 400071d4: b0 10 20 00 clr %i0 return 0; } 400071d8: 81 c7 e0 08 ret 400071dc: 81 e8 00 00 restore _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { _Thread_Enable_dispatch(); 400071e0: 40 00 0e ca call 4000ad08 <_Thread_Enable_dispatch> 400071e4: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 400071e8: 81 c7 e0 08 ret 400071ec: 81 e8 00 00 restore * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 400071f0: 40 00 02 7c call 40007be0 400071f4: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 400071f8: 10 bf ff db b 40007164 400071fc: c2 06 40 00 ld [ %i1 ], %g1 =============================================================================== 40007270 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007270: 9d e3 bf 98 save %sp, -104, %sp Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 40007274: 80 a6 20 00 cmp %i0, 0 40007278: 02 80 00 24 be 40007308 4000727c: a0 10 20 16 mov 0x16, %l0 * * 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 ); 40007280: 92 07 bf f8 add %fp, -8, %o1 40007284: 40 00 1c 60 call 4000e404 <_POSIX_Absolute_timeout_to_ticks> 40007288: 90 10 00 19 mov %i1, %o0 4000728c: d2 06 00 00 ld [ %i0 ], %o1 40007290: a2 10 00 08 mov %o0, %l1 40007294: 94 07 bf fc add %fp, -4, %o2 40007298: 11 10 00 69 sethi %hi(0x4001a400), %o0 4000729c: 40 00 0b 8d call 4000a0d0 <_Objects_Get> 400072a0: 90 12 21 60 or %o0, 0x160, %o0 ! 4001a560 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 400072a4: c2 07 bf fc ld [ %fp + -4 ], %g1 400072a8: 80 a0 60 00 cmp %g1, 0 400072ac: 12 80 00 17 bne 40007308 400072b0: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 400072b4: d2 06 00 00 ld [ %i0 ], %o1 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, 400072b8: 82 1c 60 03 xor %l1, 3, %g1 400072bc: 90 02 20 10 add %o0, 0x10, %o0 400072c0: 80 a0 00 01 cmp %g0, %g1 400072c4: 98 10 20 00 clr %o4 400072c8: a4 60 3f ff subx %g0, -1, %l2 400072cc: 40 00 07 d0 call 4000920c <_CORE_RWLock_Obtain_for_reading> 400072d0: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 400072d4: 40 00 0e 8d call 4000ad08 <_Thread_Enable_dispatch> 400072d8: 01 00 00 00 nop if ( !do_wait ) { 400072dc: 80 a4 a0 00 cmp %l2, 0 400072e0: 12 80 00 12 bne 40007328 400072e4: 03 10 00 6a sethi %hi(0x4001a800), %g1 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 400072e8: c2 00 60 a4 ld [ %g1 + 0xa4 ], %g1 ! 4001a8a4 <_Per_CPU_Information+0xc> 400072ec: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 400072f0: 80 a2 20 02 cmp %o0, 2 400072f4: 02 80 00 07 be 40007310 400072f8: 80 a4 60 00 cmp %l1, 0 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 400072fc: 40 00 00 3f call 400073f8 <_POSIX_RWLock_Translate_core_RWLock_return_code> 40007300: 01 00 00 00 nop 40007304: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40007308: 81 c7 e0 08 ret 4000730c: 91 e8 00 10 restore %g0, %l0, %o0 ); _Thread_Enable_dispatch(); if ( !do_wait ) { if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40007310: 02 bf ff fe be 40007308 <== NEVER TAKEN 40007314: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40007318: 80 a4 60 01 cmp %l1, 1 4000731c: 18 bf ff f8 bgu 400072fc <== NEVER TAKEN 40007320: a0 10 20 74 mov 0x74, %l0 40007324: 30 bf ff f9 b,a 40007308 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait ) { 40007328: c2 00 60 a4 ld [ %g1 + 0xa4 ], %g1 4000732c: 10 bf ff f4 b 400072fc 40007330: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 =============================================================================== 40007334 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007334: 9d e3 bf 98 save %sp, -104, %sp Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 40007338: 80 a6 20 00 cmp %i0, 0 4000733c: 02 80 00 24 be 400073cc 40007340: a0 10 20 16 mov 0x16, %l0 * * 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 ); 40007344: 92 07 bf f8 add %fp, -8, %o1 40007348: 40 00 1c 2f call 4000e404 <_POSIX_Absolute_timeout_to_ticks> 4000734c: 90 10 00 19 mov %i1, %o0 40007350: d2 06 00 00 ld [ %i0 ], %o1 40007354: a2 10 00 08 mov %o0, %l1 40007358: 94 07 bf fc add %fp, -4, %o2 4000735c: 11 10 00 69 sethi %hi(0x4001a400), %o0 40007360: 40 00 0b 5c call 4000a0d0 <_Objects_Get> 40007364: 90 12 21 60 or %o0, 0x160, %o0 ! 4001a560 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007368: c2 07 bf fc ld [ %fp + -4 ], %g1 4000736c: 80 a0 60 00 cmp %g1, 0 40007370: 12 80 00 17 bne 400073cc 40007374: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 40007378: d2 06 00 00 ld [ %i0 ], %o1 (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, 4000737c: 82 1c 60 03 xor %l1, 3, %g1 40007380: 90 02 20 10 add %o0, 0x10, %o0 40007384: 80 a0 00 01 cmp %g0, %g1 40007388: 98 10 20 00 clr %o4 4000738c: a4 60 3f ff subx %g0, -1, %l2 40007390: 40 00 07 d5 call 400092e4 <_CORE_RWLock_Obtain_for_writing> 40007394: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40007398: 40 00 0e 5c call 4000ad08 <_Thread_Enable_dispatch> 4000739c: 01 00 00 00 nop if ( !do_wait && 400073a0: 80 a4 a0 00 cmp %l2, 0 400073a4: 12 80 00 12 bne 400073ec 400073a8: 03 10 00 6a sethi %hi(0x4001a800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 400073ac: c2 00 60 a4 ld [ %g1 + 0xa4 ], %g1 ! 4001a8a4 <_Per_CPU_Information+0xc> 400073b0: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 400073b4: 80 a2 20 02 cmp %o0, 2 400073b8: 02 80 00 07 be 400073d4 400073bc: 80 a4 60 00 cmp %l1, 0 if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( 400073c0: 40 00 00 0e call 400073f8 <_POSIX_RWLock_Translate_core_RWLock_return_code> 400073c4: 01 00 00 00 nop 400073c8: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 400073cc: 81 c7 e0 08 ret 400073d0: 91 e8 00 10 restore %g0, %l0, %o0 ); _Thread_Enable_dispatch(); if ( !do_wait && (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 400073d4: 02 bf ff fe be 400073cc <== NEVER TAKEN 400073d8: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 400073dc: 80 a4 60 01 cmp %l1, 1 400073e0: 18 bf ff f8 bgu 400073c0 <== NEVER TAKEN 400073e4: a0 10 20 74 mov 0x74, %l0 400073e8: 30 bf ff f9 b,a 400073cc ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 400073ec: c2 00 60 a4 ld [ %g1 + 0xa4 ], %g1 400073f0: 10 bf ff f4 b 400073c0 400073f4: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 =============================================================================== 40007c08 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 40007c08: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40007c0c: 80 a0 60 00 cmp %g1, 0 40007c10: 02 80 00 08 be 40007c30 40007c14: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40007c18: c4 00 40 00 ld [ %g1 ], %g2 40007c1c: 80 a0 a0 00 cmp %g2, 0 40007c20: 02 80 00 04 be 40007c30 40007c24: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40007c28: 28 80 00 04 bleu,a 40007c38 <== ALWAYS TAKEN 40007c2c: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; default: return EINVAL; } } 40007c30: 81 c3 e0 08 retl 40007c34: 01 00 00 00 nop 40007c38: 81 c3 e0 08 retl 40007c3c: 90 10 20 00 clr %o0 ! 0 =============================================================================== 40008bac : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 40008bac: 9d e3 bf 90 save %sp, -112, %sp 40008bb0: a0 10 00 18 mov %i0, %l0 int rc; /* * Check all the parameters */ if ( !param ) 40008bb4: 80 a6 a0 00 cmp %i2, 0 40008bb8: 02 80 00 3b be 40008ca4 40008bbc: b0 10 20 16 mov 0x16, %i0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 40008bc0: 90 10 00 19 mov %i1, %o0 40008bc4: 92 10 00 1a mov %i2, %o1 40008bc8: 94 07 bf fc add %fp, -4, %o2 40008bcc: 40 00 1a 54 call 4000f51c <_POSIX_Thread_Translate_sched_param> 40008bd0: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 40008bd4: b0 92 20 00 orcc %o0, 0, %i0 40008bd8: 12 80 00 33 bne 40008ca4 40008bdc: 92 10 00 10 mov %l0, %o1 40008be0: 11 10 00 6f sethi %hi(0x4001bc00), %o0 40008be4: 94 07 bf f4 add %fp, -12, %o2 40008be8: 40 00 08 c2 call 4000aef0 <_Objects_Get> 40008bec: 90 12 21 10 or %o0, 0x110, %o0 /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 40008bf0: c2 07 bf f4 ld [ %fp + -12 ], %g1 40008bf4: 80 a0 60 00 cmp %g1, 0 40008bf8: 12 80 00 2d bne 40008cac 40008bfc: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40008c00: e0 02 21 58 ld [ %o0 + 0x158 ], %l0 if ( api->schedpolicy == SCHED_SPORADIC ) 40008c04: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 40008c08: 80 a0 60 04 cmp %g1, 4 40008c0c: 02 80 00 33 be 40008cd8 40008c10: 01 00 00 00 nop (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; 40008c14: f2 24 20 84 st %i1, [ %l0 + 0x84 ] api->schedparam = *param; 40008c18: c2 06 80 00 ld [ %i2 ], %g1 the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40008c1c: 80 a6 60 00 cmp %i1, 0 if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; 40008c20: c2 24 20 88 st %g1, [ %l0 + 0x88 ] 40008c24: c4 06 a0 04 ld [ %i2 + 4 ], %g2 40008c28: c4 24 20 8c st %g2, [ %l0 + 0x8c ] 40008c2c: c4 06 a0 08 ld [ %i2 + 8 ], %g2 40008c30: c4 24 20 90 st %g2, [ %l0 + 0x90 ] 40008c34: c4 06 a0 0c ld [ %i2 + 0xc ], %g2 40008c38: c4 24 20 94 st %g2, [ %l0 + 0x94 ] 40008c3c: c4 06 a0 10 ld [ %i2 + 0x10 ], %g2 40008c40: c4 24 20 98 st %g2, [ %l0 + 0x98 ] 40008c44: c4 06 a0 14 ld [ %i2 + 0x14 ], %g2 40008c48: c4 24 20 9c st %g2, [ %l0 + 0x9c ] 40008c4c: c4 06 a0 18 ld [ %i2 + 0x18 ], %g2 40008c50: c4 24 20 a0 st %g2, [ %l0 + 0xa0 ] the_thread->budget_algorithm = budget_algorithm; 40008c54: c4 07 bf fc ld [ %fp + -4 ], %g2 40008c58: c4 24 60 7c st %g2, [ %l1 + 0x7c ] the_thread->budget_callout = budget_callout; 40008c5c: c4 07 bf f8 ld [ %fp + -8 ], %g2 switch ( api->schedpolicy ) { 40008c60: 06 80 00 0f bl 40008c9c <== NEVER TAKEN 40008c64: c4 24 60 80 st %g2, [ %l1 + 0x80 ] 40008c68: 80 a6 60 02 cmp %i1, 2 40008c6c: 14 80 00 12 bg 40008cb4 40008c70: 80 a6 60 04 cmp %i1, 4 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 40008c74: 05 10 00 6e sethi %hi(0x4001b800), %g2 40008c78: 07 10 00 6c sethi %hi(0x4001b000), %g3 40008c7c: c4 00 a2 14 ld [ %g2 + 0x214 ], %g2 40008c80: d2 08 e1 08 ldub [ %g3 + 0x108 ], %o1 40008c84: c4 24 60 78 st %g2, [ %l1 + 0x78 ] 40008c88: 92 22 40 01 sub %o1, %g1, %o1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40008c8c: 90 10 00 11 mov %l1, %o0 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; the_thread->real_priority = 40008c90: d2 24 60 18 st %o1, [ %l1 + 0x18 ] _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40008c94: 40 00 0a 67 call 4000b630 <_Thread_Change_priority> 40008c98: 94 10 20 01 mov 1, %o2 _Watchdog_Remove( &api->Sporadic_timer ); _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); break; } _Thread_Enable_dispatch(); 40008c9c: 40 00 0b a3 call 4000bb28 <_Thread_Enable_dispatch> 40008ca0: 01 00 00 00 nop return 0; 40008ca4: 81 c7 e0 08 ret 40008ca8: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return ESRCH; } 40008cac: 81 c7 e0 08 ret 40008cb0: 91 e8 20 03 restore %g0, 3, %o0 api->schedpolicy = policy; api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40008cb4: 12 bf ff fa bne 40008c9c <== NEVER TAKEN 40008cb8: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 40008cbc: c2 24 20 a4 st %g1, [ %l0 + 0xa4 ] _Watchdog_Remove( &api->Sporadic_timer ); 40008cc0: 40 00 10 8a call 4000cee8 <_Watchdog_Remove> 40008cc4: 90 04 20 a8 add %l0, 0xa8, %o0 _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 40008cc8: 90 10 20 00 clr %o0 40008ccc: 7f ff ff 6a call 40008a74 <_POSIX_Threads_Sporadic_budget_TSR> 40008cd0: 92 10 00 11 mov %l1, %o1 break; 40008cd4: 30 bf ff f2 b,a 40008c9c case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); 40008cd8: 40 00 10 84 call 4000cee8 <_Watchdog_Remove> 40008cdc: 90 04 20 a8 add %l0, 0xa8, %o0 api->schedpolicy = policy; 40008ce0: 10 bf ff ce b 40008c18 40008ce4: f2 24 20 84 st %i1, [ %l0 + 0x84 ] =============================================================================== 400065fc : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 400065fc: 9d e3 bf a0 save %sp, -96, %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() ) 40006600: 21 10 00 61 sethi %hi(0x40018400), %l0 40006604: a0 14 23 18 or %l0, 0x318, %l0 ! 40018718 <_Per_CPU_Information> 40006608: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000660c: 80 a0 60 00 cmp %g1, 0 40006610: 12 80 00 15 bne 40006664 <== NEVER TAKEN 40006614: 01 00 00 00 nop 40006618: 03 10 00 60 sethi %hi(0x40018000), %g1 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 4000661c: c4 04 20 0c ld [ %l0 + 0xc ], %g2 40006620: c6 00 61 c0 ld [ %g1 + 0x1c0 ], %g3 40006624: c4 00 a1 58 ld [ %g2 + 0x158 ], %g2 40006628: 86 00 e0 01 inc %g3 4000662c: c6 20 61 c0 st %g3, [ %g1 + 0x1c0 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 40006630: c2 00 a0 d8 ld [ %g2 + 0xd8 ], %g1 40006634: 80 a0 60 00 cmp %g1, 0 40006638: 12 80 00 0d bne 4000666c <== NEVER TAKEN 4000663c: 01 00 00 00 nop 40006640: c2 00 a0 e0 ld [ %g2 + 0xe0 ], %g1 40006644: 80 a0 60 00 cmp %g1, 0 40006648: 02 80 00 09 be 4000666c 4000664c: 01 00 00 00 nop thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 40006650: 40 00 0b 60 call 400093d0 <_Thread_Enable_dispatch> 40006654: b2 10 3f ff mov -1, %i1 ! ffffffff if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 40006658: f0 04 20 0c ld [ %l0 + 0xc ], %i0 4000665c: 40 00 1a 1b call 4000cec8 <_POSIX_Thread_Exit> 40006660: 81 e8 00 00 restore 40006664: 81 c7 e0 08 ret <== NOT EXECUTED 40006668: 81 e8 00 00 restore <== NOT EXECUTED _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 4000666c: 40 00 0b 59 call 400093d0 <_Thread_Enable_dispatch> 40006670: 81 e8 00 00 restore =============================================================================== 400071d4 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 400071d4: 9d e3 bf 78 save %sp, -136, %sp struct sched_param param; /* The queue should be initialized */ AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED); result = pthread_mutex_lock (&aio_request_queue.mutex); 400071d8: 21 10 00 65 sethi %hi(0x40019400), %l0 400071dc: 40 00 02 78 call 40007bbc 400071e0: 90 14 20 74 or %l0, 0x74, %o0 ! 40019474 if (result != 0) { 400071e4: a2 92 20 00 orcc %o0, 0, %l1 400071e8: 12 80 00 31 bne 400072ac <== NEVER TAKEN 400071ec: 90 10 00 18 mov %i0, %o0 return result; } /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); 400071f0: 40 00 04 bb call 400084dc 400071f4: a4 14 20 74 or %l0, 0x74, %l2 400071f8: 92 07 bf f8 add %fp, -8, %o1 400071fc: 40 00 03 a1 call 40008080 40007200: 94 07 bf dc add %fp, -36, %o2 req->caller_thread = pthread_self (); 40007204: 40 00 04 b6 call 400084dc 40007208: 01 00 00 00 nop req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 4000720c: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 req->policy = policy; 40007210: c6 07 bf f8 ld [ %fp + -8 ], %g3 /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40007214: c4 00 60 18 ld [ %g1 + 0x18 ], %g2 req->policy = policy; 40007218: c6 26 20 08 st %g3, [ %i0 + 8 ] /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 4000721c: c6 07 bf dc ld [ %fp + -36 ], %g3 /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); 40007220: d0 26 20 10 st %o0, [ %i0 + 0x10 ] req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40007224: 84 20 c0 02 sub %g3, %g2, %g2 40007228: c4 26 20 0c st %g2, [ %i0 + 0xc ] req->policy = policy; req->aiocbp->error_code = EINPROGRESS; req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 4000722c: c4 04 a0 68 ld [ %l2 + 0x68 ], %g2 pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; req->policy = policy; req->aiocbp->error_code = EINPROGRESS; 40007230: 86 10 20 77 mov 0x77, %g3 req->aiocbp->return_value = 0; 40007234: c0 20 60 38 clr [ %g1 + 0x38 ] if ((aio_request_queue.idle_threads == 0) && 40007238: 80 a0 a0 00 cmp %g2, 0 4000723c: 12 80 00 06 bne 40007254 40007240: c6 20 60 34 st %g3, [ %g1 + 0x34 ] 40007244: c4 04 a0 64 ld [ %l2 + 0x64 ], %g2 40007248: 80 a0 a0 04 cmp %g2, 4 4000724c: 24 80 00 1c ble,a 400072bc 40007250: d2 00 40 00 ld [ %g1 ], %o1 else { /* the maximum number of threads has been already created even though some of them might be idle. The request belongs to one of the active fd chain */ r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40007254: d2 00 40 00 ld [ %g1 ], %o1 40007258: 94 10 20 00 clr %o2 4000725c: 11 10 00 65 sethi %hi(0x40019400), %o0 40007260: 7f ff fe b8 call 40006d40 40007264: 90 12 20 bc or %o0, 0xbc, %o0 ! 400194bc req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 40007268: a6 92 20 00 orcc %o0, 0, %l3 4000726c: 22 80 00 32 be,a 40007334 40007270: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 { pthread_mutex_lock (&r_chain->mutex); 40007274: a4 04 e0 1c add %l3, 0x1c, %l2 40007278: 40 00 02 51 call 40007bbc 4000727c: 90 10 00 12 mov %l2, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40007280: 90 04 e0 08 add %l3, 8, %o0 40007284: 7f ff ff 84 call 40007094 40007288: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 4000728c: 40 00 01 24 call 4000771c 40007290: 90 04 e0 20 add %l3, 0x20, %o0 pthread_mutex_unlock (&r_chain->mutex); 40007294: 40 00 02 6b call 40007c40 40007298: 90 10 00 12 mov %l2, %o0 /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); } } pthread_mutex_unlock (&aio_request_queue.mutex); 4000729c: 40 00 02 69 call 40007c40 400072a0: 90 14 20 74 or %l0, 0x74, %o0 return 0; } 400072a4: 81 c7 e0 08 ret 400072a8: 91 e8 00 11 restore %g0, %l1, %o0 /* The queue should be initialized */ AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED); result = pthread_mutex_lock (&aio_request_queue.mutex); if (result != 0) { free (req); 400072ac: 7f ff f0 31 call 40003370 <== NOT EXECUTED 400072b0: b0 10 00 11 mov %l1, %i0 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); return 0; } 400072b4: 81 c7 e0 08 ret <== NOT EXECUTED 400072b8: 81 e8 00 00 restore <== NOT EXECUTED if ((aio_request_queue.idle_threads == 0) && aio_request_queue.active_threads < AIO_MAX_THREADS) /* we still have empty places on the active_threads chain */ { chain = &aio_request_queue.work_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 400072bc: 90 04 a0 48 add %l2, 0x48, %o0 400072c0: 7f ff fe a0 call 40006d40 400072c4: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 400072c8: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 400072cc: 80 a0 60 01 cmp %g1, 1 400072d0: 12 bf ff e9 bne 40007274 400072d4: a6 10 00 08 mov %o0, %l3 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); 400072d8: 90 02 20 08 add %o0, 8, %o0 400072dc: 40 00 09 40 call 400097dc <_Chain_Insert> 400072e0: 92 10 00 18 mov %i0, %o1 rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); 400072e4: 92 10 20 00 clr %o1 chain = &aio_request_queue.work_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); if (r_chain->new_fd == 1) { rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; 400072e8: c0 24 e0 18 clr [ %l3 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 400072ec: 40 00 01 da call 40007a54 400072f0: 90 04 e0 1c add %l3, 0x1c, %o0 pthread_cond_init (&r_chain->cond, NULL); 400072f4: 92 10 20 00 clr %o1 400072f8: 40 00 00 da call 40007660 400072fc: 90 04 e0 20 add %l3, 0x20, %o0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 40007300: 90 07 bf fc add %fp, -4, %o0 40007304: 92 04 a0 08 add %l2, 8, %o1 40007308: 96 10 00 13 mov %l3, %o3 4000730c: 15 10 00 1b sethi %hi(0x40006c00), %o2 40007310: 40 00 02 b1 call 40007dd4 40007314: 94 12 a2 08 or %o2, 0x208, %o2 ! 40006e08 rtems_aio_handle, (void *) r_chain); if (result != 0) { 40007318: 82 92 20 00 orcc %o0, 0, %g1 4000731c: 12 80 00 24 bne 400073ac <== NEVER TAKEN 40007320: 90 10 00 12 mov %l2, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); return result; } ++aio_request_queue.active_threads; 40007324: c2 04 a0 64 ld [ %l2 + 0x64 ], %g1 40007328: 82 00 60 01 inc %g1 4000732c: 10 bf ff dc b 4000729c 40007330: c2 24 a0 64 st %g1, [ %l2 + 0x64 ] } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 40007334: 11 10 00 65 sethi %hi(0x40019400), %o0 40007338: d2 00 40 00 ld [ %g1 ], %o1 4000733c: 90 12 20 c8 or %o0, 0xc8, %o0 40007340: 7f ff fe 80 call 40006d40 40007344: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40007348: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 4000734c: 80 a0 60 01 cmp %g1, 1 40007350: 02 80 00 06 be 40007368 40007354: a6 10 00 08 mov %o0, %l3 pthread_cond_init (&r_chain->cond, NULL); pthread_cond_signal (&aio_request_queue.new_req); ++aio_request_queue.idle_threads; } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); 40007358: 90 02 20 08 add %o0, 8, %o0 4000735c: 7f ff ff 4e call 40007094 40007360: 92 10 00 18 mov %i0, %o1 40007364: 30 bf ff ce b,a 4000729c 40007368: 90 02 20 08 add %o0, 8, %o0 4000736c: 40 00 09 1c call 400097dc <_Chain_Insert> 40007370: 92 10 00 18 mov %i0, %o1 /* If this is a new fd chain we signal the idle threads that might be waiting for requests */ AIO_printf (" New chain on waiting queue \n "); rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); 40007374: 92 10 20 00 clr %o1 if (r_chain->new_fd == 1) { /* If this is a new fd chain we signal the idle threads that might be waiting for requests */ AIO_printf (" New chain on waiting queue \n "); rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; 40007378: c0 24 e0 18 clr [ %l3 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 4000737c: 40 00 01 b6 call 40007a54 40007380: 90 04 e0 1c add %l3, 0x1c, %o0 pthread_cond_init (&r_chain->cond, NULL); 40007384: 92 10 20 00 clr %o1 40007388: 40 00 00 b6 call 40007660 4000738c: 90 04 e0 20 add %l3, 0x20, %o0 pthread_cond_signal (&aio_request_queue.new_req); 40007390: 11 10 00 65 sethi %hi(0x40019400), %o0 40007394: 40 00 00 e2 call 4000771c 40007398: 90 12 20 78 or %o0, 0x78, %o0 ! 40019478 ++aio_request_queue.idle_threads; 4000739c: c2 04 a0 68 ld [ %l2 + 0x68 ], %g1 400073a0: 82 00 60 01 inc %g1 400073a4: 10 bf ff be b 4000729c 400073a8: c2 24 a0 68 st %g1, [ %l2 + 0x68 ] AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, rtems_aio_handle, (void *) r_chain); if (result != 0) { pthread_mutex_unlock (&aio_request_queue.mutex); 400073ac: 40 00 02 25 call 40007c40 <== NOT EXECUTED 400073b0: a2 10 00 01 mov %g1, %l1 <== NOT EXECUTED return result; 400073b4: 30 bf ff bc b,a 400072a4 <== NOT EXECUTED =============================================================================== 40006e08 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 40006e08: 9d e3 bf 78 save %sp, -136, %sp <== NOT EXECUTED The fd chain is already unlocked */ struct timespec timeout; pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 40006e0c: 29 10 00 65 sethi %hi(0x40019400), %l4 <== NOT EXECUTED 40006e10: a2 06 20 1c add %i0, 0x1c, %l1 <== NOT EXECUTED 40006e14: a8 15 20 74 or %l4, 0x74, %l4 <== NOT EXECUTED if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 40006e18: ac 07 bf f4 add %fp, -12, %l6 <== NOT EXECUTED pthread_cond_destroy (&r_chain->cond); free (r_chain); /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40006e1c: ae 05 20 58 add %l4, 0x58, %l7 <== NOT EXECUTED ++aio_request_queue.idle_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40006e20: ba 05 20 04 add %l4, 4, %i5 <== NOT EXECUTED /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40006e24: b8 05 20 48 add %l4, 0x48, %i4 <== NOT EXECUTED node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 40006e28: a6 07 bf fc add %fp, -4, %l3 <== NOT EXECUTED 40006e2c: a4 07 bf d8 add %fp, -40, %l2 <== NOT EXECUTED default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 40006e30: aa 10 3f ff mov -1, %l5 <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); 40006e34: 40 00 03 62 call 40007bbc <== NOT EXECUTED 40006e38: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED if (result != 0) 40006e3c: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40006e40: 12 80 00 2a bne 40006ee8 <== NOT EXECUTED 40006e44: 01 00 00 00 nop <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40006e48: e0 06 20 08 ld [ %i0 + 8 ], %l0 <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40006e4c: 82 06 20 0c add %i0, 0xc, %g1 <== NOT EXECUTED /* If the locked chain is not empty, take the first request extract it, unlock the chain and process the request, in this way the user can supply more requests to this fd chain */ if (!rtems_chain_is_empty (chain)) { 40006e50: 80 a4 00 01 cmp %l0, %g1 <== NOT EXECUTED 40006e54: 02 80 00 40 be 40006f54 <== NOT EXECUTED 40006e58: 01 00 00 00 nop <== NOT EXECUTED node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 40006e5c: 40 00 05 a0 call 400084dc <== NOT EXECUTED 40006e60: 01 00 00 00 nop <== NOT EXECUTED 40006e64: 92 10 00 13 mov %l3, %o1 <== NOT EXECUTED 40006e68: 40 00 04 86 call 40008080 <== NOT EXECUTED 40006e6c: 94 10 00 12 mov %l2, %o2 <== NOT EXECUTED param.sched_priority = req->priority; 40006e70: c2 04 20 0c ld [ %l0 + 0xc ], %g1 <== NOT EXECUTED pthread_setschedparam (pthread_self(), req->policy, ¶m); 40006e74: 40 00 05 9a call 400084dc <== NOT EXECUTED 40006e78: c2 27 bf d8 st %g1, [ %fp + -40 ] <== NOT EXECUTED 40006e7c: d2 04 20 08 ld [ %l0 + 8 ], %o1 <== NOT EXECUTED 40006e80: 40 00 05 9b call 400084ec <== NOT EXECUTED 40006e84: 94 10 00 12 mov %l2, %o2 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40006e88: 40 00 0a 38 call 40009768 <_Chain_Extract> <== NOT EXECUTED 40006e8c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 40006e90: 40 00 03 6c call 40007c40 <== NOT EXECUTED 40006e94: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED switch (req->aiocbp->aio_lio_opcode) { 40006e98: f6 04 20 14 ld [ %l0 + 0x14 ], %i3 <== NOT EXECUTED 40006e9c: c2 06 e0 30 ld [ %i3 + 0x30 ], %g1 <== NOT EXECUTED 40006ea0: 80 a0 60 02 cmp %g1, 2 <== NOT EXECUTED 40006ea4: 22 80 00 24 be,a 40006f34 <== NOT EXECUTED 40006ea8: c4 1e e0 08 ldd [ %i3 + 8 ], %g2 <== NOT EXECUTED 40006eac: 80 a0 60 03 cmp %g1, 3 <== NOT EXECUTED 40006eb0: 02 80 00 1d be 40006f24 <== NOT EXECUTED 40006eb4: 01 00 00 00 nop <== NOT EXECUTED 40006eb8: 80 a0 60 01 cmp %g1, 1 <== NOT EXECUTED 40006ebc: 22 80 00 0d be,a 40006ef0 <== NOT EXECUTED 40006ec0: c4 1e e0 08 ldd [ %i3 + 8 ], %g2 <== NOT EXECUTED default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; 40006ec4: 40 00 2b b6 call 40011d9c <__errno> <== NOT EXECUTED 40006ec8: ea 26 e0 38 st %l5, [ %i3 + 0x38 ] <== NOT EXECUTED 40006ecc: c2 02 00 00 ld [ %o0 ], %g1 <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); 40006ed0: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED 40006ed4: 40 00 03 3a call 40007bbc <== NOT EXECUTED 40006ed8: c2 26 e0 34 st %g1, [ %i3 + 0x34 ] <== NOT EXECUTED if (result != 0) 40006edc: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40006ee0: 22 bf ff db be,a 40006e4c <== NOT EXECUTED 40006ee4: e0 06 20 08 ld [ %i0 + 8 ], %l0 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40006ee8: 81 c7 e0 08 ret <== NOT EXECUTED 40006eec: 91 e8 20 00 restore %g0, 0, %o0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); switch (req->aiocbp->aio_lio_opcode) { case LIO_READ: result = pread (req->aiocbp->aio_fildes, 40006ef0: d0 06 c0 00 ld [ %i3 ], %o0 <== NOT EXECUTED 40006ef4: d2 06 e0 10 ld [ %i3 + 0x10 ], %o1 <== NOT EXECUTED 40006ef8: d4 06 e0 14 ld [ %i3 + 0x14 ], %o2 <== NOT EXECUTED 40006efc: 96 10 00 02 mov %g2, %o3 <== NOT EXECUTED 40006f00: 40 00 2e db call 40012a6c <== NOT EXECUTED 40006f04: 98 10 00 03 mov %g3, %o4 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { 40006f08: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED 40006f0c: 22 bf ff ee be,a 40006ec4 <== NOT EXECUTED 40006f10: f6 04 20 14 ld [ %l0 + 0x14 ], %i3 <== NOT EXECUTED req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; 40006f14: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 <== NOT EXECUTED 40006f18: d0 20 60 38 st %o0, [ %g1 + 0x38 ] <== NOT EXECUTED req->aiocbp->error_code = 0; 40006f1c: 10 bf ff c6 b 40006e34 <== NOT EXECUTED 40006f20: c0 20 60 34 clr [ %g1 + 0x34 ] <== NOT EXECUTED (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_SYNC: result = fsync (req->aiocbp->aio_fildes); 40006f24: 40 00 1d 75 call 4000e4f8 <== NOT EXECUTED 40006f28: d0 06 c0 00 ld [ %i3 ], %o0 <== NOT EXECUTED break; 40006f2c: 10 bf ff f8 b 40006f0c <== NOT EXECUTED 40006f30: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_WRITE: result = pwrite (req->aiocbp->aio_fildes, 40006f34: d0 06 c0 00 ld [ %i3 ], %o0 <== NOT EXECUTED 40006f38: d2 06 e0 10 ld [ %i3 + 0x10 ], %o1 <== NOT EXECUTED 40006f3c: d4 06 e0 14 ld [ %i3 + 0x14 ], %o2 <== NOT EXECUTED 40006f40: 96 10 00 02 mov %g2, %o3 <== NOT EXECUTED 40006f44: 40 00 2f 06 call 40012b5c <== NOT EXECUTED 40006f48: 98 10 00 03 mov %g3, %o4 <== NOT EXECUTED (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 40006f4c: 10 bf ff f0 b 40006f0c <== NOT EXECUTED 40006f50: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED wait for a signal on chain, this will unlock the queue. The fd chain is already unlocked */ struct timespec timeout; pthread_mutex_unlock (&r_chain->mutex); 40006f54: 40 00 03 3b call 40007c40 <== NOT EXECUTED 40006f58: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_mutex_lock (&aio_request_queue.mutex); 40006f5c: 40 00 03 18 call 40007bbc <== NOT EXECUTED 40006f60: 90 10 00 14 mov %l4, %o0 <== NOT EXECUTED if (rtems_chain_is_empty (chain)) 40006f64: c2 06 20 08 ld [ %i0 + 8 ], %g1 <== NOT EXECUTED 40006f68: 80 a4 00 01 cmp %l0, %g1 <== NOT EXECUTED 40006f6c: 12 bf ff b2 bne 40006e34 <== NOT EXECUTED 40006f70: 92 10 00 16 mov %l6, %o1 <== NOT EXECUTED { clock_gettime (CLOCK_REALTIME, &timeout); 40006f74: 40 00 01 5d call 400074e8 <== NOT EXECUTED 40006f78: 90 10 20 01 mov 1, %o0 <== NOT EXECUTED timeout.tv_sec += 3; 40006f7c: c2 07 bf f4 ld [ %fp + -12 ], %g1 <== NOT EXECUTED timeout.tv_nsec = 0; 40006f80: c0 27 bf f8 clr [ %fp + -8 ] <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40006f84: 82 00 60 03 add %g1, 3, %g1 <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40006f88: a0 06 20 20 add %i0, 0x20, %l0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40006f8c: c2 27 bf f4 st %g1, [ %fp + -12 ] <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40006f90: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40006f94: 92 10 00 14 mov %l4, %o1 <== NOT EXECUTED 40006f98: 40 00 02 02 call 400077a0 <== NOT EXECUTED 40006f9c: 94 10 00 16 mov %l6, %o2 <== NOT EXECUTED &aio_request_queue.mutex, &timeout); /* If no requests were added to the chain we delete the fd chain from the queue and start working with idle fd chains */ if (result == ETIMEDOUT) { 40006fa0: 80 a2 20 74 cmp %o0, 0x74 <== NOT EXECUTED 40006fa4: 12 bf ff a4 bne 40006e34 <== NOT EXECUTED 40006fa8: 01 00 00 00 nop <== NOT EXECUTED 40006fac: 40 00 09 ef call 40009768 <_Chain_Extract> <== NOT EXECUTED 40006fb0: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 40006fb4: 40 00 02 55 call 40007908 <== NOT EXECUTED 40006fb8: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_cond_destroy (&r_chain->cond); 40006fbc: 40 00 01 73 call 40007588 <== NOT EXECUTED 40006fc0: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED free (r_chain); 40006fc4: 7f ff f0 eb call 40003370 <== NOT EXECUTED 40006fc8: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40006fcc: c2 05 20 54 ld [ %l4 + 0x54 ], %g1 <== NOT EXECUTED 40006fd0: 80 a0 40 17 cmp %g1, %l7 <== NOT EXECUTED 40006fd4: 22 80 00 05 be,a 40006fe8 <== NOT EXECUTED 40006fd8: c2 05 20 68 ld [ %l4 + 0x68 ], %g1 <== NOT EXECUTED r_chain->perfd = ((rtems_aio_request_chain *)node)->perfd; } else /* If there was a request added in the initial fd chain then release the mutex and process it */ pthread_mutex_unlock (&aio_request_queue.mutex); 40006fdc: 40 00 03 19 call 40007c40 <== NOT EXECUTED 40006fe0: 90 10 00 14 mov %l4, %o0 <== NOT EXECUTED 40006fe4: 30 bf ff 94 b,a 40006e34 <== NOT EXECUTED /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { ++aio_request_queue.idle_threads; clock_gettime (CLOCK_REALTIME, &timeout); 40006fe8: 92 10 00 16 mov %l6, %o1 <== NOT EXECUTED free (r_chain); /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { ++aio_request_queue.idle_threads; 40006fec: 82 00 60 01 inc %g1 <== NOT EXECUTED clock_gettime (CLOCK_REALTIME, &timeout); 40006ff0: 90 10 20 01 mov 1, %o0 <== NOT EXECUTED 40006ff4: 40 00 01 3d call 400074e8 <== NOT EXECUTED 40006ff8: c2 25 20 68 st %g1, [ %l4 + 0x68 ] <== NOT EXECUTED timeout.tv_sec += 3; 40006ffc: c2 07 bf f4 ld [ %fp + -12 ], %g1 <== NOT EXECUTED timeout.tv_nsec = 0; 40007000: c0 27 bf f8 clr [ %fp + -8 ] <== NOT EXECUTED /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { ++aio_request_queue.idle_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40007004: 82 00 60 03 add %g1, 3, %g1 <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40007008: 90 10 00 1d mov %i5, %o0 <== NOT EXECUTED /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { ++aio_request_queue.idle_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 4000700c: c2 27 bf f4 st %g1, [ %fp + -12 ] <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40007010: 92 10 00 14 mov %l4, %o1 <== NOT EXECUTED 40007014: 40 00 01 e3 call 400077a0 <== NOT EXECUTED 40007018: 94 10 00 16 mov %l6, %o2 <== NOT EXECUTED &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { 4000701c: 80 a2 20 74 cmp %o0, 0x74 <== NOT EXECUTED 40007020: 02 80 00 1a be 40007088 <== NOT EXECUTED 40007024: 01 00 00 00 nop <== NOT EXECUTED return NULL; } /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; 40007028: c2 05 20 68 ld [ %l4 + 0x68 ], %g1 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 4000702c: e0 05 20 54 ld [ %l4 + 0x54 ], %l0 <== NOT EXECUTED return NULL; } /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; 40007030: 82 00 7f ff add %g1, -1, %g1 <== NOT EXECUTED 40007034: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40007038: 40 00 09 cc call 40009768 <_Chain_Extract> <== NOT EXECUTED 4000703c: c2 25 20 68 st %g1, [ %l4 + 0x68 ] <== NOT EXECUTED node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40007040: d2 04 20 14 ld [ %l0 + 0x14 ], %o1 <== NOT EXECUTED 40007044: 94 10 20 01 mov 1, %o2 <== NOT EXECUTED 40007048: 7f ff ff 3e call 40006d40 <== NOT EXECUTED 4000704c: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED ((rtems_aio_request_chain *)node)->fildes, 1); r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); 40007050: 92 10 20 00 clr %o1 <== NOT EXECUTED /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40007054: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED ((rtems_aio_request_chain *)node)->fildes, 1); r_chain->new_fd = 0; 40007058: c0 22 20 18 clr [ %o0 + 0x18 ] <== NOT EXECUTED pthread_mutex_init (&r_chain->mutex, NULL); 4000705c: a2 02 20 1c add %o0, 0x1c, %l1 <== NOT EXECUTED 40007060: 40 00 02 7d call 40007a54 <== NOT EXECUTED 40007064: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_cond_init (&r_chain->cond, NULL); 40007068: 90 06 20 20 add %i0, 0x20, %o0 <== NOT EXECUTED 4000706c: 40 00 01 7d call 40007660 <== NOT EXECUTED 40007070: 92 10 20 00 clr %o1 <== NOT EXECUTED r_chain->perfd = ((rtems_aio_request_chain *)node)->perfd; 40007074: 90 06 20 08 add %i0, 8, %o0 <== NOT EXECUTED 40007078: 92 04 20 08 add %l0, 8, %o1 <== NOT EXECUTED 4000707c: 40 00 2d d1 call 400127c0 <== NOT EXECUTED 40007080: 94 10 20 0c mov 0xc, %o2 <== NOT EXECUTED 40007084: 30 bf ff 6c b,a 40006e34 <== NOT EXECUTED &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { pthread_mutex_unlock (&aio_request_queue.mutex); 40007088: 40 00 02 ee call 40007c40 <== NOT EXECUTED 4000708c: 90 10 00 14 mov %l4, %o0 <== NOT EXECUTED return NULL; 40007090: 30 bf ff 96 b,a 40006ee8 <== NOT EXECUTED =============================================================================== 40006c38 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 40006c38: 9d e3 bf a0 save %sp, -96, %sp int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 40006c3c: 21 10 00 65 sethi %hi(0x40019400), %l0 40006c40: 40 00 04 4b call 40007d6c 40006c44: 90 14 20 7c or %l0, 0x7c, %o0 ! 4001947c if (result != 0) 40006c48: b0 92 20 00 orcc %o0, 0, %i0 40006c4c: 12 80 00 23 bne 40006cd8 <== NEVER TAKEN 40006c50: 90 14 20 7c or %l0, 0x7c, %o0 return result; result = 40006c54: 40 00 04 52 call 40007d9c 40006c58: 92 10 20 00 clr %o1 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 40006c5c: 80 a2 20 00 cmp %o0, 0 40006c60: 12 80 00 20 bne 40006ce0 <== NEVER TAKEN 40006c64: 23 10 00 65 sethi %hi(0x40019400), %l1 pthread_attr_destroy (&aio_request_queue.attr); result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 40006c68: 92 10 20 00 clr %o1 40006c6c: 40 00 03 7a call 40007a54 40006c70: 90 14 60 74 or %l1, 0x74, %o0 if (result != 0) 40006c74: 80 a2 20 00 cmp %o0, 0 40006c78: 12 80 00 23 bne 40006d04 <== NEVER TAKEN 40006c7c: 92 10 20 00 clr %o1 pthread_attr_destroy (&aio_request_queue.attr); result = pthread_cond_init (&aio_request_queue.new_req, NULL); 40006c80: 11 10 00 65 sethi %hi(0x40019400), %o0 40006c84: 40 00 02 77 call 40007660 40006c88: 90 12 20 78 or %o0, 0x78, %o0 ! 40019478 if (result != 0) { 40006c8c: b0 92 20 00 orcc %o0, 0, %i0 40006c90: 12 80 00 26 bne 40006d28 <== NEVER TAKEN 40006c94: 01 00 00 00 nop ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006c98: a2 14 60 74 or %l1, 0x74, %l1 head->previous = NULL; tail->previous = head; 40006c9c: 82 04 60 54 add %l1, 0x54, %g1 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006ca0: 88 04 60 4c add %l1, 0x4c, %g4 head->previous = NULL; tail->previous = head; 40006ca4: 86 04 60 48 add %l1, 0x48, %g3 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006ca8: 84 04 60 58 add %l1, 0x58, %g2 head->previous = NULL; tail->previous = head; 40006cac: c2 24 60 5c st %g1, [ %l1 + 0x5c ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006cb0: c8 24 60 48 st %g4, [ %l1 + 0x48 ] head->previous = NULL; 40006cb4: c0 24 60 4c clr [ %l1 + 0x4c ] tail->previous = head; 40006cb8: c6 24 60 50 st %g3, [ %l1 + 0x50 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006cbc: c4 24 60 54 st %g2, [ %l1 + 0x54 ] head->previous = NULL; 40006cc0: c0 24 60 58 clr [ %l1 + 0x58 ] } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; 40006cc4: c0 24 60 64 clr [ %l1 + 0x64 ] aio_request_queue.idle_threads = 0; 40006cc8: c0 24 60 68 clr [ %l1 + 0x68 ] aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 40006ccc: 03 00 00 2c sethi %hi(0xb000), %g1 40006cd0: 82 10 60 0b or %g1, 0xb, %g1 ! b00b 40006cd4: c2 24 60 60 st %g1, [ %l1 + 0x60 ] return result; } 40006cd8: 81 c7 e0 08 ret 40006cdc: 81 e8 00 00 restore result = pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) pthread_attr_destroy (&aio_request_queue.attr); 40006ce0: 40 00 04 17 call 40007d3c <== NOT EXECUTED 40006ce4: 90 14 20 7c or %l0, 0x7c, %o0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 40006ce8: 23 10 00 65 sethi %hi(0x40019400), %l1 <== NOT EXECUTED 40006cec: 92 10 20 00 clr %o1 <== NOT EXECUTED 40006cf0: 40 00 03 59 call 40007a54 <== NOT EXECUTED 40006cf4: 90 14 60 74 or %l1, 0x74, %o0 <== NOT EXECUTED if (result != 0) 40006cf8: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40006cfc: 02 bf ff e1 be 40006c80 <== NOT EXECUTED 40006d00: 92 10 20 00 clr %o1 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40006d04: 40 00 04 0e call 40007d3c <== NOT EXECUTED 40006d08: 90 14 20 7c or %l0, 0x7c, %o0 <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 40006d0c: 92 10 20 00 clr %o1 <== NOT EXECUTED 40006d10: 11 10 00 65 sethi %hi(0x40019400), %o0 <== NOT EXECUTED 40006d14: 40 00 02 53 call 40007660 <== NOT EXECUTED 40006d18: 90 12 20 78 or %o0, 0x78, %o0 ! 40019478 <== NOT EXECUTED if (result != 0) { 40006d1c: b0 92 20 00 orcc %o0, 0, %i0 <== NOT EXECUTED 40006d20: 22 bf ff df be,a 40006c9c <== NOT EXECUTED 40006d24: a2 14 60 74 or %l1, 0x74, %l1 <== NOT EXECUTED pthread_mutex_destroy (&aio_request_queue.mutex); 40006d28: 40 00 02 f8 call 40007908 <== NOT EXECUTED 40006d2c: 90 14 60 74 or %l1, 0x74, %o0 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40006d30: 40 00 04 03 call 40007d3c <== NOT EXECUTED 40006d34: 90 14 20 7c or %l0, 0x7c, %o0 <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006d38: 10 bf ff d9 b 40006c9c <== NOT EXECUTED 40006d3c: a2 14 60 74 or %l1, 0x74, %l1 <== NOT EXECUTED =============================================================================== 40007094 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 40007094: 9d e3 bf a0 save %sp, -96, %sp } AIO_printf ("Thread finished\n"); return NULL; } 40007098: c4 06 00 00 ld [ %i0 ], %g2 4000709c: 82 06 20 04 add %i0, 4, %g1 rtems_chain_node *node; AIO_printf ("FD exists \n"); node = rtems_chain_first (chain); if (rtems_chain_is_empty (chain)) { 400070a0: 80 a0 80 01 cmp %g2, %g1 400070a4: 02 80 00 16 be 400070fc <== NEVER TAKEN 400070a8: 86 10 00 19 mov %i1, %g3 rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && 400070ac: da 06 60 14 ld [ %i1 + 0x14 ], %o5 if (rtems_chain_is_empty (chain)) { AIO_printf ("First in chain \n"); rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 400070b0: c8 00 a0 14 ld [ %g2 + 0x14 ], %g4 while (req->aiocbp->aio_reqprio > prio && 400070b4: d8 03 60 18 ld [ %o5 + 0x18 ], %o4 400070b8: da 01 20 18 ld [ %g4 + 0x18 ], %o5 400070bc: 80 a3 40 0c cmp %o5, %o4 400070c0: 06 80 00 07 bl 400070dc <== NEVER TAKEN 400070c4: 88 10 00 02 mov %g2, %g4 RTEMS_INLINE_ROUTINE void rtems_chain_insert( rtems_chain_node *after_node, rtems_chain_node *the_node ) { _Chain_Insert( after_node, the_node ); 400070c8: 10 80 00 0c b 400070f8 400070cc: f0 01 20 04 ld [ %g4 + 4 ], %i0 400070d0: 80 a1 00 01 cmp %g4, %g1 <== NOT EXECUTED 400070d4: 02 80 00 0c be 40007104 <== NOT EXECUTED 400070d8: 88 10 00 01 mov %g1, %g4 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 400070dc: c8 00 80 00 ld [ %g2 ], %g4 <== NOT EXECUTED int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && !rtems_chain_is_tail (chain, node)) { node = rtems_chain_next (node); prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 400070e0: da 01 20 14 ld [ %g4 + 0x14 ], %o5 <== NOT EXECUTED rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && 400070e4: da 03 60 18 ld [ %o5 + 0x18 ], %o5 <== NOT EXECUTED 400070e8: 80 a3 40 0c cmp %o5, %o4 <== NOT EXECUTED 400070ec: 06 bf ff f9 bl 400070d0 <== NOT EXECUTED 400070f0: 84 10 00 04 mov %g4, %g2 <== NOT EXECUTED 400070f4: f0 01 20 04 ld [ %g4 + 4 ], %i0 <== NOT EXECUTED 400070f8: b2 10 00 03 mov %g3, %i1 400070fc: 40 00 09 b8 call 400097dc <_Chain_Insert> 40007100: 81 e8 00 00 restore 40007104: b2 10 00 03 mov %g3, %i1 <== NOT EXECUTED 40007108: 10 bf ff fd b 400070fc <== NOT EXECUTED 4000710c: f0 01 20 04 ld [ %g4 + 4 ], %i0 <== NOT EXECUTED =============================================================================== 40007110 : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { 40007110: 9d e3 bf a0 save %sp, -96, %sp } AIO_printf ("Thread finished\n"); return NULL; } 40007114: e0 06 20 08 ld [ %i0 + 8 ], %l0 while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; 40007118: a6 10 20 8c mov 0x8c, %l3 RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Tail(the_chain)); 4000711c: b0 06 20 0c add %i0, 0xc, %i0 rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 40007120: 80 a4 00 18 cmp %l0, %i0 40007124: 02 80 00 0d be 40007158 <== NEVER TAKEN 40007128: a4 10 3f ff mov -1, %l2 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 4000712c: 40 00 09 8f call 40009768 <_Chain_Extract> 40007130: 90 10 00 10 mov %l0, %o0 { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; 40007134: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 } AIO_printf ("Thread finished\n"); return NULL; } 40007138: e2 04 00 00 ld [ %l0 ], %l1 rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); 4000713c: 90 10 00 10 mov %l0, %o0 while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; 40007140: e6 20 60 34 st %l3, [ %g1 + 0x34 ] req->aiocbp->return_value = -1; free (req); 40007144: 7f ff f0 8b call 40003370 40007148: e4 20 60 38 st %l2, [ %g1 + 0x38 ] rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 4000714c: 80 a4 40 18 cmp %l1, %i0 40007150: 12 bf ff f7 bne 4000712c 40007154: a0 10 00 11 mov %l1, %l0 40007158: 81 c7 e0 08 ret 4000715c: 81 e8 00 00 restore =============================================================================== 40007160 : * AIO_NOTCANCELED - if request was not canceled * AIO_CANCELED - if request was canceled */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { 40007160: 9d e3 bf a0 save %sp, -96, %sp } AIO_printf ("Thread finished\n"); return NULL; } 40007164: c4 06 00 00 ld [ %i0 ], %g2 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40007168: 82 06 20 04 add %i0, 4, %g1 * AIO_CANCELED - if request was canceled */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { if (rtems_chain_is_empty (chain)) 4000716c: 80 a0 80 01 cmp %g2, %g1 40007170: 12 80 00 07 bne 4000718c <== ALWAYS TAKEN 40007174: b0 10 20 02 mov 2, %i0 40007178: 30 80 00 15 b,a 400071cc <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 4000717c: c4 00 80 00 ld [ %g2 ], %g2 <== NOT EXECUTED rtems_chain_node *node = rtems_chain_first (chain); rtems_aio_request *current; current = (rtems_aio_request *) node; while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) { 40007180: 80 a0 80 01 cmp %g2, %g1 <== NOT EXECUTED 40007184: 02 80 00 10 be 400071c4 <== NOT EXECUTED 40007188: b0 10 20 01 mov 1, %i0 <== NOT EXECUTED 4000718c: c6 00 a0 14 ld [ %g2 + 0x14 ], %g3 40007190: 80 a0 c0 19 cmp %g3, %i1 40007194: 12 bf ff fa bne 4000717c <== NEVER TAKEN 40007198: a0 10 00 02 mov %g2, %l0 4000719c: 40 00 09 73 call 40009768 <_Chain_Extract> 400071a0: 90 10 00 02 mov %g2, %o0 if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 400071a4: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 400071a8: 84 10 20 8c mov 0x8c, %g2 400071ac: c4 20 60 34 st %g2, [ %g1 + 0x34 ] current->aiocbp->return_value = -1; 400071b0: 84 10 3f ff mov -1, %g2 free (current); 400071b4: 90 10 00 10 mov %l0, %o0 return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; current->aiocbp->return_value = -1; 400071b8: c4 20 60 38 st %g2, [ %g1 + 0x38 ] free (current); 400071bc: 7f ff f0 6d call 40003370 400071c0: b0 10 20 00 clr %i0 } return AIO_CANCELED; 400071c4: 81 c7 e0 08 ret 400071c8: 81 e8 00 00 restore } 400071cc: 81 c7 e0 08 ret <== NOT EXECUTED 400071d0: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 4000f29c : rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { 4000f29c: 9d e3 bf 98 save %sp, -104, %sp 4000f2a0: a0 10 00 18 mov %i0, %l0 Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) 4000f2a4: 80 a4 20 00 cmp %l0, 0 4000f2a8: 02 80 00 23 be 4000f334 4000f2ac: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !id ) 4000f2b0: 80 a6 e0 00 cmp %i3, 0 4000f2b4: 02 80 00 20 be 4000f334 4000f2b8: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { 4000f2bc: 80 8e 60 10 btst 0x10, %i1 4000f2c0: 02 80 00 1f be 4000f33c 4000f2c4: 80 a6 a0 00 cmp %i2, 0 the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 4000f2c8: c0 27 bf f8 clr [ %fp + -8 ] if ( maximum_waiters == 0 ) 4000f2cc: 02 80 00 1a be 4000f334 4000f2d0: b0 10 20 0a mov 0xa, %i0 4000f2d4: 03 10 00 8c sethi %hi(0x40023000), %g1 4000f2d8: c4 00 61 90 ld [ %g1 + 0x190 ], %g2 ! 40023190 <_Thread_Dispatch_disable_level> return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; the_attributes.maximum_count = maximum_waiters; 4000f2dc: f4 27 bf fc st %i2, [ %fp + -4 ] 4000f2e0: 84 00 a0 01 inc %g2 4000f2e4: c4 20 61 90 st %g2, [ %g1 + 0x190 ] * 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 ); 4000f2e8: 25 10 00 8e sethi %hi(0x40023800), %l2 4000f2ec: 7f ff e9 b4 call 400099bc <_Objects_Allocate> 4000f2f0: 90 14 a2 e0 or %l2, 0x2e0, %o0 ! 40023ae0 <_Barrier_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { 4000f2f4: a2 92 20 00 orcc %o0, 0, %l1 4000f2f8: 02 80 00 1e be 4000f370 <== NEVER TAKEN 4000f2fc: 90 04 60 14 add %l1, 0x14, %o0 return RTEMS_TOO_MANY; } the_barrier->attribute_set = attribute_set; _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 4000f300: 92 07 bf f8 add %fp, -8, %o1 4000f304: 40 00 02 43 call 4000fc10 <_CORE_barrier_Initialize> 4000f308: f2 24 60 10 st %i1, [ %l1 + 0x10 ] 4000f30c: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 4000f310: a4 14 a2 e0 or %l2, 0x2e0, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000f314: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 4000f318: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000f31c: 85 28 a0 02 sll %g2, 2, %g2 4000f320: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 4000f324: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Barrier_Information, &the_barrier->Object, (Objects_Name) name ); *id = the_barrier->Object.id; 4000f328: c2 26 c0 00 st %g1, [ %i3 ] _Thread_Enable_dispatch(); 4000f32c: 7f ff ee 13 call 4000ab78 <_Thread_Enable_dispatch> 4000f330: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; } 4000f334: 81 c7 e0 08 ret 4000f338: 81 e8 00 00 restore if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; 4000f33c: 82 10 20 01 mov 1, %g1 4000f340: c2 27 bf f8 st %g1, [ %fp + -8 ] 4000f344: 03 10 00 8c sethi %hi(0x40023000), %g1 4000f348: c4 00 61 90 ld [ %g1 + 0x190 ], %g2 ! 40023190 <_Thread_Dispatch_disable_level> the_attributes.maximum_count = maximum_waiters; 4000f34c: f4 27 bf fc st %i2, [ %fp + -4 ] 4000f350: 84 00 a0 01 inc %g2 4000f354: c4 20 61 90 st %g2, [ %g1 + 0x190 ] 4000f358: 25 10 00 8e sethi %hi(0x40023800), %l2 4000f35c: 7f ff e9 98 call 400099bc <_Objects_Allocate> 4000f360: 90 14 a2 e0 or %l2, 0x2e0, %o0 ! 40023ae0 <_Barrier_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { 4000f364: a2 92 20 00 orcc %o0, 0, %l1 4000f368: 12 bf ff e6 bne 4000f300 4000f36c: 90 04 60 14 add %l1, 0x14, %o0 _Thread_Enable_dispatch(); 4000f370: 7f ff ee 02 call 4000ab78 <_Thread_Enable_dispatch> 4000f374: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 4000f378: 81 c7 e0 08 ret 4000f37c: 81 e8 00 00 restore =============================================================================== 40006d54 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 40006d54: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE bool rtems_chain_append_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Append_with_empty_check( chain, node ); 40006d58: 90 10 00 18 mov %i0, %o0 40006d5c: 40 00 01 82 call 40007364 <_Chain_Append_with_empty_check> 40006d60: 92 10 00 19 mov %i1, %o1 rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { 40006d64: 80 8a 20 ff btst 0xff, %o0 40006d68: 12 80 00 04 bne 40006d78 <== ALWAYS TAKEN 40006d6c: b0 10 20 00 clr %i0 sc = rtems_event_send( task, events ); } return sc; } 40006d70: 81 c7 e0 08 ret 40006d74: 81 e8 00 00 restore { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { sc = rtems_event_send( task, events ); 40006d78: b0 10 00 1a mov %i2, %i0 40006d7c: 7f ff fd 61 call 40006300 40006d80: 93 e8 00 1b restore %g0, %i3, %o1 =============================================================================== 40006dbc : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 40006dbc: 9d e3 bf 98 save %sp, -104, %sp 40006dc0: a0 10 00 18 mov %i0, %l0 while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( 40006dc4: a4 07 bf fc add %fp, -4, %l2 */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); 40006dc8: 40 00 01 a6 call 40007460 <_Chain_Get> 40006dcc: 90 10 00 10 mov %l0, %o0 40006dd0: 92 10 20 00 clr %o1 40006dd4: a2 10 00 08 mov %o0, %l1 40006dd8: 94 10 00 1a mov %i2, %o2 40006ddc: 90 10 00 19 mov %i1, %o0 rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 40006de0: 80 a4 60 00 cmp %l1, 0 40006de4: 12 80 00 0a bne 40006e0c 40006de8: 96 10 00 12 mov %l2, %o3 ) { rtems_event_set out; sc = rtems_event_receive( 40006dec: 7f ff fc e2 call 40006174 40006df0: 01 00 00 00 nop ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 40006df4: 80 a2 20 00 cmp %o0, 0 40006df8: 02 bf ff f4 be 40006dc8 <== NEVER TAKEN 40006dfc: b0 10 00 08 mov %o0, %i0 timeout, &out ); } *node_ptr = node; 40006e00: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 40006e04: 81 c7 e0 08 ret 40006e08: 81 e8 00 00 restore rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 40006e0c: 90 10 20 00 clr %o0 timeout, &out ); } *node_ptr = node; 40006e10: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 40006e14: 81 c7 e0 08 ret 40006e18: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006e1c : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 40006e1c: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE bool rtems_chain_prepend_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Prepend_with_empty_check( chain, node ); 40006e20: 90 10 00 18 mov %i0, %o0 40006e24: 40 00 01 ad call 400074d8 <_Chain_Prepend_with_empty_check> 40006e28: 92 10 00 19 mov %i1, %o1 rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { 40006e2c: 80 8a 20 ff btst 0xff, %o0 40006e30: 12 80 00 04 bne 40006e40 <== ALWAYS TAKEN 40006e34: b0 10 20 00 clr %i0 sc = rtems_event_send( task, events ); } return sc; } 40006e38: 81 c7 e0 08 ret 40006e3c: 81 e8 00 00 restore { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { sc = rtems_event_send( task, events ); 40006e40: b0 10 00 1a mov %i2, %i0 40006e44: 7f ff fd 2f call 40006300 40006e48: 93 e8 00 1b restore %g0, %i3, %o1 =============================================================================== 40007b84 : 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 ) { 40007b84: 9d e3 bf a0 save %sp, -96, %sp rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) 40007b88: 03 10 00 6a sethi %hi(0x4001a800), %g1 40007b8c: c4 00 63 e0 ld [ %g1 + 0x3e0 ], %g2 ! 4001abe0 <_Per_CPU_Information+0x8> 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 ) { 40007b90: 86 10 00 19 mov %i1, %g3 rtems_device_major_number major_limit = _IO_Number_of_drivers; 40007b94: 03 10 00 6c sethi %hi(0x4001b000), %g1 if ( rtems_interrupt_is_in_progress() ) 40007b98: 80 a0 a0 00 cmp %g2, 0 40007b9c: 12 80 00 42 bne 40007ca4 40007ba0: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) 40007ba4: 80 a6 a0 00 cmp %i2, 0 40007ba8: 02 80 00 50 be 40007ce8 40007bac: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) 40007bb0: 80 a6 60 00 cmp %i1, 0 40007bb4: 02 80 00 4d be 40007ce8 40007bb8: c8 26 80 00 st %g4, [ %i2 ] static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40007bbc: c4 06 40 00 ld [ %i1 ], %g2 40007bc0: 80 a0 a0 00 cmp %g2, 0 40007bc4: 22 80 00 46 be,a 40007cdc 40007bc8: c4 06 60 04 ld [ %i1 + 4 ], %g2 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) 40007bcc: 80 a1 00 18 cmp %g4, %i0 40007bd0: 08 80 00 33 bleu 40007c9c 40007bd4: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007bd8: 05 10 00 69 sethi %hi(0x4001a400), %g2 40007bdc: c8 00 a2 80 ld [ %g2 + 0x280 ], %g4 ! 4001a680 <_Thread_Dispatch_disable_level> 40007be0: 88 01 20 01 inc %g4 40007be4: c8 20 a2 80 st %g4, [ %g2 + 0x280 ] return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { 40007be8: 80 a6 20 00 cmp %i0, 0 40007bec: 12 80 00 30 bne 40007cac 40007bf0: 1b 10 00 6c sethi %hi(0x4001b000), %o5 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; 40007bf4: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { 40007bf8: 80 a1 20 00 cmp %g4, 0 40007bfc: 22 80 00 3d be,a 40007cf0 <== NEVER TAKEN 40007c00: c0 26 80 00 clr [ %i2 ] <== NOT EXECUTED 40007c04: 10 80 00 05 b 40007c18 40007c08: c2 03 60 18 ld [ %o5 + 0x18 ], %g1 40007c0c: 80 a1 00 18 cmp %g4, %i0 40007c10: 08 80 00 0a bleu 40007c38 40007c14: 82 00 60 18 add %g1, 0x18, %g1 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40007c18: c4 00 40 00 ld [ %g1 ], %g2 40007c1c: 80 a0 a0 00 cmp %g2, 0 40007c20: 32 bf ff fb bne,a 40007c0c 40007c24: b0 06 20 01 inc %i0 40007c28: c4 00 60 04 ld [ %g1 + 4 ], %g2 40007c2c: 80 a0 a0 00 cmp %g2, 0 40007c30: 32 bf ff f7 bne,a 40007c0c 40007c34: b0 06 20 01 inc %i0 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) 40007c38: 80 a1 00 18 cmp %g4, %i0 40007c3c: 02 80 00 2d be 40007cf0 40007c40: f0 26 80 00 st %i0, [ %i2 ] 40007c44: 83 2e 20 03 sll %i0, 3, %g1 40007c48: 85 2e 20 05 sll %i0, 5, %g2 40007c4c: 84 20 80 01 sub %g2, %g1, %g2 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40007c50: c8 03 60 18 ld [ %o5 + 0x18 ], %g4 40007c54: da 00 c0 00 ld [ %g3 ], %o5 40007c58: 82 01 00 02 add %g4, %g2, %g1 40007c5c: da 21 00 02 st %o5, [ %g4 + %g2 ] 40007c60: c4 00 e0 04 ld [ %g3 + 4 ], %g2 _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 40007c64: b2 10 20 00 clr %i1 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40007c68: c4 20 60 04 st %g2, [ %g1 + 4 ] 40007c6c: c4 00 e0 08 ld [ %g3 + 8 ], %g2 _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 40007c70: b4 10 20 00 clr %i2 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40007c74: c4 20 60 08 st %g2, [ %g1 + 8 ] 40007c78: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 40007c7c: c4 20 60 0c st %g2, [ %g1 + 0xc ] 40007c80: c4 00 e0 10 ld [ %g3 + 0x10 ], %g2 40007c84: c4 20 60 10 st %g2, [ %g1 + 0x10 ] 40007c88: c4 00 e0 14 ld [ %g3 + 0x14 ], %g2 _Thread_Enable_dispatch(); 40007c8c: 40 00 07 f5 call 40009c60 <_Thread_Enable_dispatch> 40007c90: c4 20 60 14 st %g2, [ %g1 + 0x14 ] return rtems_io_initialize( major, 0, NULL ); 40007c94: 40 00 24 03 call 40010ca0 40007c98: 81 e8 00 00 restore } 40007c9c: 81 c7 e0 08 ret 40007ca0: 91 e8 20 0a restore %g0, 0xa, %o0 ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; 40007ca4: 81 c7 e0 08 ret 40007ca8: 91 e8 20 12 restore %g0, 0x12, %o0 _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 40007cac: c2 03 60 18 ld [ %o5 + 0x18 ], %g1 40007cb0: 89 2e 20 05 sll %i0, 5, %g4 40007cb4: 85 2e 20 03 sll %i0, 3, %g2 40007cb8: 84 21 00 02 sub %g4, %g2, %g2 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40007cbc: c8 00 40 02 ld [ %g1 + %g2 ], %g4 40007cc0: 80 a1 20 00 cmp %g4, 0 40007cc4: 02 80 00 0f be 40007d00 40007cc8: 82 00 40 02 add %g1, %g2, %g1 major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); 40007ccc: 40 00 07 e5 call 40009c60 <_Thread_Enable_dispatch> 40007cd0: b0 10 20 0c mov 0xc, %i0 return RTEMS_RESOURCE_IN_USE; 40007cd4: 81 c7 e0 08 ret 40007cd8: 81 e8 00 00 restore static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40007cdc: 80 a0 a0 00 cmp %g2, 0 40007ce0: 32 bf ff bc bne,a 40007bd0 40007ce4: 80 a1 00 18 cmp %g4, %i0 if ( driver_table == NULL ) return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; 40007ce8: 81 c7 e0 08 ret 40007cec: 91 e8 20 09 restore %g0, 9, %o0 if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); 40007cf0: 40 00 07 dc call 40009c60 <_Thread_Enable_dispatch> 40007cf4: b0 10 20 05 mov 5, %i0 return sc; 40007cf8: 81 c7 e0 08 ret 40007cfc: 81 e8 00 00 restore static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40007d00: c2 00 60 04 ld [ %g1 + 4 ], %g1 40007d04: 80 a0 60 00 cmp %g1, 0 40007d08: 12 bf ff f1 bne 40007ccc 40007d0c: 01 00 00 00 nop if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; 40007d10: 10 bf ff d0 b 40007c50 40007d14: f0 26 80 00 st %i0, [ %i2 ] =============================================================================== 40009244 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 40009244: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 40009248: 80 a6 20 00 cmp %i0, 0 4000924c: 02 80 00 20 be 400092cc <== NEVER TAKEN 40009250: 25 10 00 a2 sethi %hi(0x40028800), %l2 40009254: a4 14 a3 9c or %l2, 0x39c, %l2 ! 40028b9c <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 40009258: a6 04 a0 0c add %l2, 0xc, %l3 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; 4000925c: c2 04 80 00 ld [ %l2 ], %g1 40009260: e2 00 60 04 ld [ %g1 + 4 ], %l1 if ( !information ) 40009264: 80 a4 60 00 cmp %l1, 0 40009268: 22 80 00 16 be,a 400092c0 4000926c: a4 04 a0 04 add %l2, 4, %l2 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40009270: c2 14 60 10 lduh [ %l1 + 0x10 ], %g1 40009274: 84 90 60 00 orcc %g1, 0, %g2 40009278: 22 80 00 12 be,a 400092c0 4000927c: a4 04 a0 04 add %l2, 4, %l2 40009280: a0 10 20 01 mov 1, %l0 the_thread = (Thread_Control *)information->local_table[ i ]; 40009284: c6 04 60 1c ld [ %l1 + 0x1c ], %g3 40009288: 83 2c 20 02 sll %l0, 2, %g1 4000928c: c2 00 c0 01 ld [ %g3 + %g1 ], %g1 if ( !the_thread ) 40009290: 90 90 60 00 orcc %g1, 0, %o0 40009294: 02 80 00 05 be 400092a8 <== NEVER TAKEN 40009298: a0 04 20 01 inc %l0 continue; (*routine)(the_thread); 4000929c: 9f c6 00 00 call %i0 400092a0: 01 00 00 00 nop 400092a4: c4 14 60 10 lduh [ %l1 + 0x10 ], %g2 information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 400092a8: 83 28 a0 10 sll %g2, 0x10, %g1 400092ac: 83 30 60 10 srl %g1, 0x10, %g1 400092b0: 80 a0 40 10 cmp %g1, %l0 400092b4: 3a bf ff f5 bcc,a 40009288 400092b8: c6 04 60 1c ld [ %l1 + 0x1c ], %g3 400092bc: a4 04 a0 04 add %l2, 4, %l2 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 400092c0: 80 a4 80 13 cmp %l2, %l3 400092c4: 32 bf ff e7 bne,a 40009260 400092c8: c2 04 80 00 ld [ %l2 ], %g1 400092cc: 81 c7 e0 08 ret 400092d0: 81 e8 00 00 restore =============================================================================== 40007d5c : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { 40007d5c: 9d e3 bf a0 save %sp, -96, %sp 40007d60: 90 10 00 18 mov %i0, %o0 int i; /* * Validate parameters and look up information structure. */ if ( !info ) 40007d64: 80 a6 a0 00 cmp %i2, 0 40007d68: 02 80 00 21 be 40007dec 40007d6c: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 40007d70: 93 2e 60 10 sll %i1, 0x10, %o1 if ( !obj_info ) return RTEMS_INVALID_NUMBER; 40007d74: b0 10 20 0a mov 0xa, %i0 * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 40007d78: 40 00 07 96 call 40009bd0 <_Objects_Get_information> 40007d7c: 93 32 60 10 srl %o1, 0x10, %o1 if ( !obj_info ) 40007d80: 80 a2 20 00 cmp %o0, 0 40007d84: 02 80 00 1a be 40007dec 40007d88: 01 00 00 00 nop /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; 40007d8c: c4 02 20 0c ld [ %o0 + 0xc ], %g2 info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; 40007d90: c8 12 20 10 lduh [ %o0 + 0x10 ], %g4 return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; 40007d94: c6 02 20 08 ld [ %o0 + 8 ], %g3 info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; 40007d98: c2 0a 20 12 ldub [ %o0 + 0x12 ], %g1 /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; 40007d9c: c4 26 a0 04 st %g2, [ %i2 + 4 ] return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; 40007da0: c6 26 80 00 st %g3, [ %i2 ] info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; 40007da4: c2 2e a0 0c stb %g1, [ %i2 + 0xc ] info->maximum = obj_info->maximum; 40007da8: c8 26 a0 08 st %g4, [ %i2 + 8 ] for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 40007dac: 80 a1 20 00 cmp %g4, 0 40007db0: 02 80 00 0d be 40007de4 <== NEVER TAKEN 40007db4: 84 10 20 00 clr %g2 40007db8: da 02 20 1c ld [ %o0 + 0x1c ], %o5 40007dbc: 86 10 20 01 mov 1, %g3 40007dc0: 82 10 20 01 mov 1, %g1 if ( !obj_info->local_table[i] ) 40007dc4: 87 28 e0 02 sll %g3, 2, %g3 40007dc8: c6 03 40 03 ld [ %o5 + %g3 ], %g3 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++ ) 40007dcc: 82 00 60 01 inc %g1 if ( !obj_info->local_table[i] ) unallocated++; 40007dd0: 80 a0 00 03 cmp %g0, %g3 40007dd4: 84 60 bf ff subx %g2, -1, %g2 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++ ) 40007dd8: 80 a1 00 01 cmp %g4, %g1 40007ddc: 1a bf ff fa bcc 40007dc4 40007de0: 86 10 00 01 mov %g1, %g3 if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; 40007de4: c4 26 a0 10 st %g2, [ %i2 + 0x10 ] return RTEMS_SUCCESSFUL; 40007de8: b0 10 20 00 clr %i0 } 40007dec: 81 c7 e0 08 ret 40007df0: 81 e8 00 00 restore =============================================================================== 40013bd4 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 40013bd4: 9d e3 bf a0 save %sp, -96, %sp 40013bd8: a0 10 00 18 mov %i0, %l0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 40013bdc: 80 a4 20 00 cmp %l0, 0 40013be0: 02 80 00 34 be 40013cb0 40013be4: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !starting_address ) 40013be8: 80 a6 60 00 cmp %i1, 0 40013bec: 02 80 00 31 be 40013cb0 40013bf0: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !id ) 40013bf4: 80 a7 60 00 cmp %i5, 0 40013bf8: 02 80 00 2e be 40013cb0 <== NEVER TAKEN 40013bfc: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 40013c00: 02 80 00 2e be 40013cb8 40013c04: 80 a6 a0 00 cmp %i2, 0 40013c08: 02 80 00 2c be 40013cb8 40013c0c: 80 a6 80 1b cmp %i2, %i3 40013c10: 0a 80 00 28 bcs 40013cb0 40013c14: b0 10 20 08 mov 8, %i0 40013c18: 80 8e e0 07 btst 7, %i3 40013c1c: 12 80 00 25 bne 40013cb0 40013c20: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 40013c24: 12 80 00 23 bne 40013cb0 40013c28: b0 10 20 09 mov 9, %i0 40013c2c: 03 10 00 fa sethi %hi(0x4003e800), %g1 40013c30: c4 00 62 30 ld [ %g1 + 0x230 ], %g2 ! 4003ea30 <_Thread_Dispatch_disable_level> 40013c34: 84 00 a0 01 inc %g2 40013c38: c4 20 62 30 st %g2, [ %g1 + 0x230 ] * This function allocates a partition control block from * the inactive chain of free partition control blocks. */ RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Allocate ( void ) { return (Partition_Control *) _Objects_Allocate( &_Partition_Information ); 40013c3c: 25 10 00 fa sethi %hi(0x4003e800), %l2 40013c40: 40 00 13 59 call 400189a4 <_Objects_Allocate> 40013c44: 90 14 a0 44 or %l2, 0x44, %o0 ! 4003e844 <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 40013c48: a2 92 20 00 orcc %o0, 0, %l1 40013c4c: 02 80 00 1d be 40013cc0 40013c50: 92 10 00 1b mov %i3, %o1 #endif the_partition->starting_address = starting_address; the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; 40013c54: f8 24 60 1c st %i4, [ %l1 + 0x1c ] _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 40013c58: f2 24 60 10 st %i1, [ %l1 + 0x10 ] the_partition->length = length; 40013c5c: f4 24 60 14 st %i2, [ %l1 + 0x14 ] the_partition->buffer_size = buffer_size; 40013c60: f6 24 60 18 st %i3, [ %l1 + 0x18 ] the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; 40013c64: c0 24 60 20 clr [ %l1 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 40013c68: 40 00 65 9a call 4002d2d0 <.udiv> 40013c6c: 90 10 00 1a mov %i2, %o0 the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; _Chain_Initialize( &the_partition->Memory, starting_address, 40013c70: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 40013c74: 94 10 00 08 mov %o0, %o2 the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; _Chain_Initialize( &the_partition->Memory, starting_address, 40013c78: 96 10 00 1b mov %i3, %o3 40013c7c: b8 04 60 24 add %l1, 0x24, %i4 40013c80: 40 00 0c ec call 40017030 <_Chain_Initialize> 40013c84: 90 10 00 1c mov %i4, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40013c88: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40013c8c: a4 14 a0 44 or %l2, 0x44, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40013c90: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40013c94: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40013c98: 85 28 a0 02 sll %g2, 2, %g2 40013c9c: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40013ca0: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 40013ca4: c2 27 40 00 st %g1, [ %i5 ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 40013ca8: 40 00 17 e0 call 40019c28 <_Thread_Enable_dispatch> 40013cac: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40013cb0: 81 c7 e0 08 ret 40013cb4: 81 e8 00 00 restore } 40013cb8: 81 c7 e0 08 ret 40013cbc: 91 e8 20 08 restore %g0, 8, %o0 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); 40013cc0: 40 00 17 da call 40019c28 <_Thread_Enable_dispatch> 40013cc4: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 40013cc8: 81 c7 e0 08 ret 40013ccc: 81 e8 00 00 restore =============================================================================== 400072f4 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 400072f4: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); 400072f8: 11 10 00 81 sethi %hi(0x40020400), %o0 400072fc: 92 10 00 18 mov %i0, %o1 40007300: 90 12 20 dc or %o0, 0xdc, %o0 40007304: 40 00 09 99 call 40009968 <_Objects_Get> 40007308: 94 07 bf fc add %fp, -4, %o2 rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 4000730c: c2 07 bf fc ld [ %fp + -4 ], %g1 40007310: 80 a0 60 00 cmp %g1, 0 40007314: 02 80 00 04 be 40007324 40007318: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4000731c: 81 c7 e0 08 ret 40007320: 91 e8 20 04 restore %g0, 4, %o0 the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 40007324: c4 02 20 40 ld [ %o0 + 0x40 ], %g2 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40007328: 23 10 00 82 sethi %hi(0x40020800), %l1 4000732c: a2 14 63 98 or %l1, 0x398, %l1 ! 40020b98 <_Per_CPU_Information> 40007330: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40007334: 80 a0 80 01 cmp %g2, %g1 40007338: 02 80 00 06 be 40007350 4000733c: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 40007340: 40 00 0c c4 call 4000a650 <_Thread_Enable_dispatch> 40007344: b0 10 20 17 mov 0x17, %i0 return RTEMS_NOT_OWNER_OF_RESOURCE; 40007348: 81 c7 e0 08 ret 4000734c: 81 e8 00 00 restore } if ( length == RTEMS_PERIOD_STATUS ) { 40007350: 12 80 00 0f bne 4000738c 40007354: 01 00 00 00 nop switch ( the_period->state ) { 40007358: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 4000735c: 80 a0 60 04 cmp %g1, 4 40007360: 08 80 00 06 bleu 40007378 <== ALWAYS TAKEN 40007364: b0 10 20 00 clr %i0 the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 40007368: 40 00 0c ba call 4000a650 <_Thread_Enable_dispatch> 4000736c: 01 00 00 00 nop return RTEMS_TIMEOUT; 40007370: 81 c7 e0 08 ret 40007374: 81 e8 00 00 restore _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { switch ( the_period->state ) { 40007378: 83 28 60 02 sll %g1, 2, %g1 4000737c: 05 10 00 79 sethi %hi(0x4001e400), %g2 40007380: 84 10 a2 3c or %g2, 0x23c, %g2 ! 4001e63c 40007384: 10 bf ff f9 b 40007368 40007388: f0 00 80 01 ld [ %g2 + %g1 ], %i0 } _Thread_Enable_dispatch(); return( return_value ); } _ISR_Disable( level ); 4000738c: 7f ff ed fb call 40002b78 40007390: 01 00 00 00 nop 40007394: a6 10 00 08 mov %o0, %l3 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 40007398: e4 04 20 38 ld [ %l0 + 0x38 ], %l2 4000739c: 80 a4 a0 00 cmp %l2, 0 400073a0: 02 80 00 14 be 400073f0 400073a4: 80 a4 a0 02 cmp %l2, 2 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 400073a8: 02 80 00 29 be 4000744c 400073ac: 80 a4 a0 04 cmp %l2, 4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 400073b0: 12 bf ff e6 bne 40007348 <== NEVER TAKEN 400073b4: b0 10 20 04 mov 4, %i0 /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 400073b8: 7f ff ff 8f call 400071f4 <_Rate_monotonic_Update_statistics> 400073bc: 90 10 00 10 mov %l0, %o0 _ISR_Enable( level ); 400073c0: 7f ff ed f2 call 40002b88 400073c4: 90 10 00 13 mov %l3, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 400073c8: 82 10 20 02 mov 2, %g1 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400073cc: 92 04 20 10 add %l0, 0x10, %o1 400073d0: 11 10 00 81 sethi %hi(0x40020400), %o0 the_period->next_length = length; 400073d4: f2 24 20 3c st %i1, [ %l0 + 0x3c ] 400073d8: 90 12 23 20 or %o0, 0x320, %o0 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; 400073dc: c2 24 20 38 st %g1, [ %l0 + 0x38 ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400073e0: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400073e4: 40 00 11 1a call 4000b84c <_Watchdog_Insert> 400073e8: b0 10 20 06 mov 6, %i0 400073ec: 30 bf ff df b,a 40007368 return( return_value ); } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { _ISR_Enable( level ); 400073f0: 7f ff ed e6 call 40002b88 400073f4: 01 00 00 00 nop /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 400073f8: 7f ff ff 63 call 40007184 <_Rate_monotonic_Initiate_statistics> 400073fc: 90 10 00 10 mov %l0, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40007400: 82 10 20 02 mov 2, %g1 40007404: 92 04 20 10 add %l0, 0x10, %o1 40007408: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 4000740c: 11 10 00 81 sethi %hi(0x40020400), %o0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40007410: 03 10 00 1d sethi %hi(0x40007400), %g1 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007414: 90 12 23 20 or %o0, 0x320, %o0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40007418: 82 10 63 c8 or %g1, 0x3c8, %g1 the_watchdog->id = id; 4000741c: f0 24 20 30 st %i0, [ %l0 + 0x30 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40007420: c2 24 20 2c st %g1, [ %l0 + 0x2c ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40007424: c0 24 20 18 clr [ %l0 + 0x18 ] the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 40007428: c0 24 20 34 clr [ %l0 + 0x34 ] _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 4000742c: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007430: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007434: 40 00 11 06 call 4000b84c <_Watchdog_Insert> 40007438: b0 10 20 00 clr %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 4000743c: 40 00 0c 85 call 4000a650 <_Thread_Enable_dispatch> 40007440: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40007444: 81 c7 e0 08 ret 40007448: 81 e8 00 00 restore if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 4000744c: 7f ff ff 6a call 400071f4 <_Rate_monotonic_Update_statistics> 40007450: 90 10 00 10 mov %l0, %o0 /* * 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; 40007454: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 40007458: f2 24 20 3c st %i1, [ %l0 + 0x3c ] /* * 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; 4000745c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 40007460: 7f ff ed ca call 40002b88 40007464: 90 10 00 13 mov %l3, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 40007468: c2 04 60 0c ld [ %l1 + 0xc ], %g1 4000746c: c4 04 20 08 ld [ %l0 + 8 ], %g2 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40007470: 90 10 00 01 mov %g1, %o0 40007474: 13 00 00 10 sethi %hi(0x4000), %o1 40007478: 40 00 0e d3 call 4000afc4 <_Thread_Set_state> 4000747c: c4 20 60 20 st %g2, [ %g1 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 40007480: 7f ff ed be call 40002b78 40007484: 01 00 00 00 nop local_state = the_period->state; 40007488: e6 04 20 38 ld [ %l0 + 0x38 ], %l3 the_period->state = RATE_MONOTONIC_ACTIVE; 4000748c: e4 24 20 38 st %l2, [ %l0 + 0x38 ] _ISR_Enable( level ); 40007490: 7f ff ed be call 40002b88 40007494: 01 00 00 00 nop /* * 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 ) 40007498: 80 a4 e0 03 cmp %l3, 3 4000749c: 22 80 00 06 be,a 400074b4 400074a0: d0 04 60 0c ld [ %l1 + 0xc ], %o0 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); 400074a4: 40 00 0c 6b call 4000a650 <_Thread_Enable_dispatch> 400074a8: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 400074ac: 81 c7 e0 08 ret 400074b0: 81 e8 00 00 restore /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 400074b4: 40 00 0b 90 call 4000a2f4 <_Thread_Clear_state> 400074b8: 13 00 00 10 sethi %hi(0x4000), %o1 400074bc: 30 bf ff fa b,a 400074a4 =============================================================================== 400074c0 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 400074c0: 9d e3 bf 30 save %sp, -208, %sp rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) 400074c4: 80 a6 60 00 cmp %i1, 0 400074c8: 02 80 00 4c be 400075f8 <== NEVER TAKEN 400074cc: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 400074d0: 13 10 00 79 sethi %hi(0x4001e400), %o1 400074d4: 9f c6 40 00 call %i1 400074d8: 92 12 62 50 or %o1, 0x250, %o1 ! 4001e650 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 400074dc: 90 10 00 18 mov %i0, %o0 400074e0: 13 10 00 79 sethi %hi(0x4001e400), %o1 400074e4: 9f c6 40 00 call %i1 400074e8: 92 12 62 70 or %o1, 0x270, %o1 ! 4001e670 (*print)( context, "--- Wall times are in seconds ---\n" ); 400074ec: 90 10 00 18 mov %i0, %o0 400074f0: 13 10 00 79 sethi %hi(0x4001e400), %o1 400074f4: 9f c6 40 00 call %i1 400074f8: 92 12 62 98 or %o1, 0x298, %o1 ! 4001e698 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 400074fc: 90 10 00 18 mov %i0, %o0 40007500: 13 10 00 79 sethi %hi(0x4001e400), %o1 40007504: 9f c6 40 00 call %i1 40007508: 92 12 62 c0 or %o1, 0x2c0, %o1 ! 4001e6c0 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 4000750c: 90 10 00 18 mov %i0, %o0 40007510: 13 10 00 79 sethi %hi(0x4001e400), %o1 40007514: 9f c6 40 00 call %i1 40007518: 92 12 63 10 or %o1, 0x310, %o1 ! 4001e710 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 4000751c: 23 10 00 81 sethi %hi(0x40020400), %l1 40007520: a2 14 60 dc or %l1, 0xdc, %l1 ! 400204dc <_Rate_monotonic_Information> 40007524: e0 04 60 08 ld [ %l1 + 8 ], %l0 40007528: c2 04 60 0c ld [ %l1 + 0xc ], %g1 4000752c: 80 a4 00 01 cmp %l0, %g1 40007530: 18 80 00 32 bgu 400075f8 <== NEVER TAKEN 40007534: 2f 10 00 79 sethi %hi(0x4001e400), %l7 struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); (*print)( context, 40007538: 39 10 00 79 sethi %hi(0x4001e400), %i4 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 4000753c: 2b 10 00 76 sethi %hi(0x4001d800), %l5 40007540: a4 07 bf a0 add %fp, -96, %l2 #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 40007544: ba 07 bf d8 add %fp, -40, %i5 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007548: a6 07 bf f8 add %fp, -8, %l3 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 4000754c: ae 15 e3 60 or %l7, 0x360, %l7 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; 40007550: ac 07 bf b8 add %fp, -72, %l6 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 40007554: a8 07 bf f0 add %fp, -16, %l4 (*print)( context, 40007558: b8 17 23 78 or %i4, 0x378, %i4 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; 4000755c: b4 07 bf d0 add %fp, -48, %i2 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 40007560: 10 80 00 06 b 40007578 40007564: aa 15 60 e8 or %l5, 0xe8, %l5 * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 40007568: a0 04 20 01 inc %l0 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 4000756c: 80 a0 40 10 cmp %g1, %l0 40007570: 0a 80 00 22 bcs 400075f8 40007574: 01 00 00 00 nop id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 40007578: 90 10 00 10 mov %l0, %o0 4000757c: 40 00 1b cd call 4000e4b0 40007580: 92 10 00 12 mov %l2, %o1 if ( status != RTEMS_SUCCESSFUL ) 40007584: 80 a2 20 00 cmp %o0, 0 40007588: 32 bf ff f8 bne,a 40007568 4000758c: c2 04 60 0c ld [ %l1 + 0xc ], %g1 #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 40007590: 92 10 00 1d mov %i5, %o1 40007594: 40 00 1b f6 call 4000e56c 40007598: 90 10 00 10 mov %l0, %o0 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 4000759c: d0 07 bf d8 ld [ %fp + -40 ], %o0 400075a0: 94 10 00 13 mov %l3, %o2 400075a4: 40 00 00 b9 call 40007888 400075a8: 92 10 20 05 mov 5, %o1 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 400075ac: d8 1f bf a0 ldd [ %fp + -96 ], %o4 400075b0: 92 10 00 17 mov %l7, %o1 400075b4: 94 10 00 10 mov %l0, %o2 400075b8: 90 10 00 18 mov %i0, %o0 400075bc: 9f c6 40 00 call %i1 400075c0: 96 10 00 13 mov %l3, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 400075c4: c2 07 bf a0 ld [ %fp + -96 ], %g1 struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 400075c8: 94 10 00 14 mov %l4, %o2 400075cc: 90 10 00 16 mov %l6, %o0 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 400075d0: 80 a0 60 00 cmp %g1, 0 400075d4: 12 80 00 0b bne 40007600 400075d8: 92 10 00 15 mov %l5, %o1 (*print)( context, "\n" ); 400075dc: 9f c6 40 00 call %i1 400075e0: 90 10 00 18 mov %i0, %o0 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 400075e4: c2 04 60 0c ld [ %l1 + 0xc ], %g1 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 400075e8: a0 04 20 01 inc %l0 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 400075ec: 80 a0 40 10 cmp %g1, %l0 400075f0: 1a bf ff e3 bcc 4000757c <== ALWAYS TAKEN 400075f4: 90 10 00 10 mov %l0, %o0 400075f8: 81 c7 e0 08 ret 400075fc: 81 e8 00 00 restore struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 40007600: 40 00 0f 57 call 4000b35c <_Timespec_Divide_by_integer> 40007604: 92 10 00 01 mov %g1, %o1 (*print)( context, 40007608: d0 07 bf ac ld [ %fp + -84 ], %o0 4000760c: 40 00 4a 42 call 40019f14 <.div> 40007610: 92 10 23 e8 mov 0x3e8, %o1 40007614: 96 10 00 08 mov %o0, %o3 40007618: d0 07 bf b4 ld [ %fp + -76 ], %o0 4000761c: d6 27 bf 9c st %o3, [ %fp + -100 ] 40007620: 40 00 4a 3d call 40019f14 <.div> 40007624: 92 10 23 e8 mov 0x3e8, %o1 40007628: c2 07 bf f0 ld [ %fp + -16 ], %g1 4000762c: b6 10 00 08 mov %o0, %i3 40007630: d0 07 bf f4 ld [ %fp + -12 ], %o0 40007634: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007638: 40 00 4a 37 call 40019f14 <.div> 4000763c: 92 10 23 e8 mov 0x3e8, %o1 40007640: d8 07 bf b0 ld [ %fp + -80 ], %o4 40007644: d6 07 bf 9c ld [ %fp + -100 ], %o3 40007648: d4 07 bf a8 ld [ %fp + -88 ], %o2 4000764c: 9a 10 00 1b mov %i3, %o5 40007650: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40007654: 92 10 00 1c mov %i4, %o1 40007658: 9f c6 40 00 call %i1 4000765c: 90 10 00 18 mov %i0, %o0 struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); 40007660: d2 07 bf a0 ld [ %fp + -96 ], %o1 40007664: 94 10 00 14 mov %l4, %o2 40007668: 40 00 0f 3d call 4000b35c <_Timespec_Divide_by_integer> 4000766c: 90 10 00 1a mov %i2, %o0 (*print)( context, 40007670: d0 07 bf c4 ld [ %fp + -60 ], %o0 40007674: 40 00 4a 28 call 40019f14 <.div> 40007678: 92 10 23 e8 mov 0x3e8, %o1 4000767c: 96 10 00 08 mov %o0, %o3 40007680: d0 07 bf cc ld [ %fp + -52 ], %o0 40007684: d6 27 bf 9c st %o3, [ %fp + -100 ] 40007688: 40 00 4a 23 call 40019f14 <.div> 4000768c: 92 10 23 e8 mov 0x3e8, %o1 40007690: c2 07 bf f0 ld [ %fp + -16 ], %g1 40007694: b6 10 00 08 mov %o0, %i3 40007698: d0 07 bf f4 ld [ %fp + -12 ], %o0 4000769c: 92 10 23 e8 mov 0x3e8, %o1 400076a0: 40 00 4a 1d call 40019f14 <.div> 400076a4: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 400076a8: d4 07 bf c0 ld [ %fp + -64 ], %o2 400076ac: d6 07 bf 9c ld [ %fp + -100 ], %o3 400076b0: d8 07 bf c8 ld [ %fp + -56 ], %o4 400076b4: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 400076b8: 13 10 00 79 sethi %hi(0x4001e400), %o1 400076bc: 90 10 00 18 mov %i0, %o0 400076c0: 92 12 63 98 or %o1, 0x398, %o1 400076c4: 9f c6 40 00 call %i1 400076c8: 9a 10 00 1b mov %i3, %o5 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 400076cc: 10 bf ff a7 b 40007568 400076d0: c2 04 60 0c ld [ %l1 + 0xc ], %g1 =============================================================================== 400076f0 : /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { 400076f0: 9d e3 bf a0 save %sp, -96, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400076f4: 03 10 00 81 sethi %hi(0x40020400), %g1 400076f8: c4 00 62 40 ld [ %g1 + 0x240 ], %g2 ! 40020640 <_Thread_Dispatch_disable_level> 400076fc: 84 00 a0 01 inc %g2 40007700: c4 20 62 40 st %g2, [ %g1 + 0x240 ] /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 40007704: 23 10 00 81 sethi %hi(0x40020400), %l1 40007708: a2 14 60 dc or %l1, 0xdc, %l1 ! 400204dc <_Rate_monotonic_Information> 4000770c: e0 04 60 08 ld [ %l1 + 8 ], %l0 40007710: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40007714: 80 a4 00 01 cmp %l0, %g1 40007718: 18 80 00 09 bgu 4000773c <== NEVER TAKEN 4000771c: 01 00 00 00 nop id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); 40007720: 40 00 00 0a call 40007748 40007724: 90 10 00 10 mov %l0, %o0 /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 40007728: c2 04 60 0c ld [ %l1 + 0xc ], %g1 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 4000772c: a0 04 20 01 inc %l0 /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 40007730: 80 a0 40 10 cmp %g1, %l0 40007734: 1a bf ff fb bcc 40007720 40007738: 01 00 00 00 nop } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); 4000773c: 40 00 0b c5 call 4000a650 <_Thread_Enable_dispatch> 40007740: 81 e8 00 00 restore =============================================================================== 400151f4 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 400151f4: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 400151f8: 80 a6 60 00 cmp %i1, 0 400151fc: 12 80 00 04 bne 4001520c 40015200: 82 10 20 0a mov 0xa, %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40015204: 81 c7 e0 08 ret 40015208: 91 e8 00 01 restore %g0, %g1, %o0 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 4001520c: 90 10 00 18 mov %i0, %o0 40015210: 40 00 12 94 call 40019c60 <_Thread_Get> 40015214: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40015218: c2 07 bf fc ld [ %fp + -4 ], %g1 4001521c: 80 a0 60 00 cmp %g1, 0 40015220: 02 80 00 05 be 40015234 40015224: a2 10 00 08 mov %o0, %l1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 40015228: 82 10 20 04 mov 4, %g1 } 4001522c: 81 c7 e0 08 ret 40015230: 91 e8 00 01 restore %g0, %g1, %o0 the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 40015234: e0 02 21 54 ld [ %o0 + 0x154 ], %l0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 40015238: c2 04 20 0c ld [ %l0 + 0xc ], %g1 4001523c: 80 a0 60 00 cmp %g1, 0 40015240: 02 80 00 25 be 400152d4 40015244: 01 00 00 00 nop if ( asr->is_enabled ) { 40015248: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 4001524c: 80 a0 60 00 cmp %g1, 0 40015250: 02 80 00 15 be 400152a4 40015254: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 40015258: 7f ff e6 96 call 4000ecb0 4001525c: 01 00 00 00 nop *signal_set |= signals; 40015260: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40015264: b2 10 40 19 or %g1, %i1, %i1 40015268: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _ISR_Enable( _level ); 4001526c: 7f ff e6 95 call 4000ecc0 40015270: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40015274: 03 10 00 fb sethi %hi(0x4003ec00), %g1 40015278: 82 10 63 90 or %g1, 0x390, %g1 ! 4003ef90 <_Per_CPU_Information> 4001527c: c4 00 60 08 ld [ %g1 + 8 ], %g2 40015280: 80 a0 a0 00 cmp %g2, 0 40015284: 02 80 00 0f be 400152c0 40015288: 01 00 00 00 nop 4001528c: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40015290: 80 a4 40 02 cmp %l1, %g2 40015294: 12 80 00 0b bne 400152c0 <== NEVER TAKEN 40015298: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 4001529c: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 400152a0: 30 80 00 08 b,a 400152c0 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 400152a4: 7f ff e6 83 call 4000ecb0 400152a8: 01 00 00 00 nop *signal_set |= signals; 400152ac: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 400152b0: b2 10 40 19 or %g1, %i1, %i1 400152b4: f2 24 20 18 st %i1, [ %l0 + 0x18 ] _ISR_Enable( _level ); 400152b8: 7f ff e6 82 call 4000ecc0 400152bc: 01 00 00 00 nop } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 400152c0: 40 00 12 5a call 40019c28 <_Thread_Enable_dispatch> 400152c4: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 400152c8: 82 10 20 00 clr %g1 ! 0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400152cc: 81 c7 e0 08 ret 400152d0: 91 e8 00 01 restore %g0, %g1, %o0 _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 400152d4: 40 00 12 55 call 40019c28 <_Thread_Enable_dispatch> 400152d8: 01 00 00 00 nop return RTEMS_NOT_DEFINED; 400152dc: 10 bf ff ca b 40015204 400152e0: 82 10 20 0b mov 0xb, %g1 ! b =============================================================================== 4000ead0 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4000ead0: 9d e3 bf a0 save %sp, -96, %sp ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) 4000ead4: 80 a6 a0 00 cmp %i2, 0 4000ead8: 02 80 00 43 be 4000ebe4 4000eadc: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4000eae0: 27 10 00 5a sethi %hi(0x40016800), %l3 4000eae4: a6 14 e1 28 or %l3, 0x128, %l3 ! 40016928 <_Per_CPU_Information> 4000eae8: e0 04 e0 0c ld [ %l3 + 0xc ], %l0 api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000eaec: c4 0c 20 74 ldub [ %l0 + 0x74 ], %g2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000eaf0: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000eaf4: 80 a0 00 02 cmp %g0, %g2 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 4000eaf8: e2 04 21 54 ld [ %l0 + 0x154 ], %l1 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000eafc: a4 60 3f ff subx %g0, -1, %l2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000eb00: 80 a0 60 00 cmp %g1, 0 4000eb04: 12 80 00 3a bne 4000ebec 4000eb08: a5 2c a0 08 sll %l2, 8, %l2 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000eb0c: c2 0c 60 08 ldub [ %l1 + 8 ], %g1 4000eb10: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000eb14: 7f ff ed 62 call 4000a09c <_CPU_ISR_Get_level> 4000eb18: a8 60 3f ff subx %g0, -1, %l4 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; 4000eb1c: a9 2d 20 0a sll %l4, 0xa, %l4 4000eb20: a8 15 00 08 or %l4, %o0, %l4 old_mode |= _ISR_Get_level(); 4000eb24: a4 15 00 12 or %l4, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000eb28: 80 8e 61 00 btst 0x100, %i1 4000eb2c: 02 80 00 06 be 4000eb44 4000eb30: e4 26 80 00 st %l2, [ %i2 ] */ RTEMS_INLINE_ROUTINE bool _Modes_Is_preempt ( Modes_Control mode_set ) { return (mode_set & RTEMS_PREEMPT_MASK) == RTEMS_PREEMPT; 4000eb34: 82 0e 21 00 and %i0, 0x100, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4000eb38: 80 a0 00 01 cmp %g0, %g1 4000eb3c: 82 60 3f ff subx %g0, -1, %g1 4000eb40: c2 2c 20 74 stb %g1, [ %l0 + 0x74 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 4000eb44: 80 8e 62 00 btst 0x200, %i1 4000eb48: 02 80 00 0b be 4000eb74 4000eb4c: 80 8e 60 0f btst 0xf, %i1 if ( _Modes_Is_timeslice(mode_set) ) { 4000eb50: 80 8e 22 00 btst 0x200, %i0 4000eb54: 22 80 00 07 be,a 4000eb70 4000eb58: c0 24 20 7c clr [ %l0 + 0x7c ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000eb5c: 03 10 00 58 sethi %hi(0x40016000), %g1 4000eb60: c2 00 63 34 ld [ %g1 + 0x334 ], %g1 ! 40016334 <_Thread_Ticks_per_timeslice> 4000eb64: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 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; 4000eb68: 82 10 20 01 mov 1, %g1 4000eb6c: c2 24 20 7c st %g1, [ %l0 + 0x7c ] } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4000eb70: 80 8e 60 0f btst 0xf, %i1 4000eb74: 12 80 00 3d bne 4000ec68 4000eb78: 01 00 00 00 nop * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 4000eb7c: 80 8e 64 00 btst 0x400, %i1 4000eb80: 02 80 00 14 be 4000ebd0 4000eb84: 86 10 20 00 clr %g3 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4000eb88: c4 0c 60 08 ldub [ %l1 + 8 ], %g2 */ RTEMS_INLINE_ROUTINE bool _Modes_Is_asr_disabled ( Modes_Control mode_set ) { return (mode_set & RTEMS_ASR_MASK) == RTEMS_NO_ASR; 4000eb8c: b0 0e 24 00 and %i0, 0x400, %i0 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 4000eb90: 80 a0 00 18 cmp %g0, %i0 4000eb94: 82 60 3f ff subx %g0, -1, %g1 is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4000eb98: 80 a0 80 01 cmp %g2, %g1 4000eb9c: 22 80 00 0e be,a 4000ebd4 4000eba0: 03 10 00 59 sethi %hi(0x40016400), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4000eba4: 7f ff cc 4d call 40001cd8 4000eba8: c2 2c 60 08 stb %g1, [ %l1 + 8 ] _signals = information->signals_pending; 4000ebac: c4 04 60 18 ld [ %l1 + 0x18 ], %g2 information->signals_pending = information->signals_posted; 4000ebb0: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 information->signals_posted = _signals; 4000ebb4: c4 24 60 14 st %g2, [ %l1 + 0x14 ] rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; 4000ebb8: c2 24 60 18 st %g1, [ %l1 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 4000ebbc: 7f ff cc 4b call 40001ce8 4000ebc0: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 4000ebc4: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4000ebc8: 80 a0 00 01 cmp %g0, %g1 4000ebcc: 86 40 20 00 addx %g0, 0, %g3 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4000ebd0: 03 10 00 59 sethi %hi(0x40016400), %g1 4000ebd4: c4 00 61 48 ld [ %g1 + 0x148 ], %g2 ! 40016548 <_System_state_Current> 4000ebd8: 80 a0 a0 03 cmp %g2, 3 4000ebdc: 02 80 00 11 be 4000ec20 <== ALWAYS TAKEN 4000ebe0: 82 10 20 00 clr %g1 if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; } 4000ebe4: 81 c7 e0 08 ret 4000ebe8: 91 e8 00 01 restore %g0, %g1, %o0 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; 4000ebec: c2 0c 60 08 ldub [ %l1 + 8 ], %g1 old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4000ebf0: a4 14 a2 00 or %l2, 0x200, %l2 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000ebf4: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000ebf8: 7f ff ed 29 call 4000a09c <_CPU_ISR_Get_level> 4000ebfc: a8 60 3f ff subx %g0, -1, %l4 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; 4000ec00: a9 2d 20 0a sll %l4, 0xa, %l4 4000ec04: a8 15 00 08 or %l4, %o0, %l4 old_mode |= _ISR_Get_level(); 4000ec08: a4 15 00 12 or %l4, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000ec0c: 80 8e 61 00 btst 0x100, %i1 4000ec10: 02 bf ff cd be 4000eb44 4000ec14: e4 26 80 00 st %l2, [ %i2 ] */ RTEMS_INLINE_ROUTINE bool _Modes_Is_preempt ( Modes_Control mode_set ) { return (mode_set & RTEMS_PREEMPT_MASK) == RTEMS_PREEMPT; 4000ec18: 10 bf ff c8 b 4000eb38 4000ec1c: 82 0e 21 00 and %i0, 0x100, %g1 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || 4000ec20: 80 88 e0 ff btst 0xff, %g3 4000ec24: 12 80 00 0a bne 4000ec4c 4000ec28: c4 04 e0 0c ld [ %l3 + 0xc ], %g2 4000ec2c: c6 04 e0 10 ld [ %l3 + 0x10 ], %g3 4000ec30: 80 a0 80 03 cmp %g2, %g3 4000ec34: 02 bf ff ec be 4000ebe4 4000ec38: 01 00 00 00 nop (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 4000ec3c: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 4000ec40: 80 a0 a0 00 cmp %g2, 0 4000ec44: 02 bf ff e8 be 4000ebe4 <== NEVER TAKEN 4000ec48: 01 00 00 00 nop _Thread_Dispatch_necessary = true; 4000ec4c: 82 10 20 01 mov 1, %g1 ! 1 4000ec50: c2 2c e0 18 stb %g1, [ %l3 + 0x18 ] } } if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 4000ec54: 7f ff e6 b4 call 40008724 <_Thread_Dispatch> 4000ec58: 01 00 00 00 nop } return RTEMS_SUCCESSFUL; 4000ec5c: 82 10 20 00 clr %g1 ! 0 } 4000ec60: 81 c7 e0 08 ret 4000ec64: 91 e8 00 01 restore %g0, %g1, %o0 */ RTEMS_INLINE_ROUTINE ISR_Level _Modes_Get_interrupt_level ( Modes_Control mode_set ) { return ( mode_set & RTEMS_INTERRUPT_MASK ); 4000ec68: 90 0e 20 0f and %i0, 0xf, %o0 */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); 4000ec6c: 7f ff cc 1f call 40001ce8 4000ec70: 91 2a 20 08 sll %o0, 8, %o0 * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 4000ec74: 10 bf ff c3 b 4000eb80 4000ec78: 80 8e 64 00 btst 0x400, %i1 =============================================================================== 4000af84 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4000af84: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4000af88: 80 a6 60 00 cmp %i1, 0 4000af8c: 02 80 00 07 be 4000afa8 4000af90: 90 10 00 18 mov %i0, %o0 RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && ( the_priority <= RTEMS_MAXIMUM_PRIORITY ) ); 4000af94: 03 10 00 69 sethi %hi(0x4001a400), %g1 4000af98: c2 08 61 f4 ldub [ %g1 + 0x1f4 ], %g1 ! 4001a5f4 */ RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && 4000af9c: 80 a6 40 01 cmp %i1, %g1 4000afa0: 18 80 00 1c bgu 4000b010 4000afa4: b0 10 20 13 mov 0x13, %i0 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4000afa8: 80 a6 a0 00 cmp %i2, 0 4000afac: 02 80 00 19 be 4000b010 4000afb0: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4000afb4: 40 00 09 69 call 4000d558 <_Thread_Get> 4000afb8: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000afbc: c2 07 bf fc ld [ %fp + -4 ], %g1 4000afc0: 80 a0 60 00 cmp %g1, 0 4000afc4: 12 80 00 13 bne 4000b010 4000afc8: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4000afcc: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4000afd0: 80 a6 60 00 cmp %i1, 0 4000afd4: 02 80 00 0d be 4000b008 4000afd8: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 4000afdc: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4000afe0: 80 a0 60 00 cmp %g1, 0 4000afe4: 02 80 00 06 be 4000affc 4000afe8: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 4000afec: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000aff0: 80 a6 40 01 cmp %i1, %g1 4000aff4: 1a 80 00 05 bcc 4000b008 <== ALWAYS TAKEN 4000aff8: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4000affc: 92 10 00 19 mov %i1, %o1 4000b000: 40 00 08 0a call 4000d028 <_Thread_Change_priority> 4000b004: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 4000b008: 40 00 09 46 call 4000d520 <_Thread_Enable_dispatch> 4000b00c: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 4000b010: 81 c7 e0 08 ret 4000b014: 81 e8 00 00 restore =============================================================================== 40007338 : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { 40007338: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) 4000733c: 80 a6 60 00 cmp %i1, 0 40007340: 02 80 00 1e be 400073b8 40007344: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); 40007348: 90 10 00 18 mov %i0, %o0 4000734c: 40 00 08 f1 call 40009710 <_Thread_Get> 40007350: 92 07 bf fc add %fp, -4, %o1 switch (location) { 40007354: c2 07 bf fc ld [ %fp + -4 ], %g1 40007358: 80 a0 60 00 cmp %g1, 0 4000735c: 12 80 00 19 bne 400073c0 40007360: 82 10 20 04 mov 4, %g1 case OBJECTS_LOCAL: tvp = the_thread->task_variables; 40007364: c2 02 21 60 ld [ %o0 + 0x160 ], %g1 while (tvp) { 40007368: 80 a0 60 00 cmp %g1, 0 4000736c: 02 80 00 10 be 400073ac 40007370: 01 00 00 00 nop if (tvp->ptr == ptr) { 40007374: c4 00 60 04 ld [ %g1 + 4 ], %g2 40007378: 80 a0 80 19 cmp %g2, %i1 4000737c: 32 80 00 09 bne,a 400073a0 40007380: d2 00 40 00 ld [ %g1 ], %o1 if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 40007384: 10 80 00 19 b 400073e8 40007388: c4 00 40 00 ld [ %g1 ], %g2 switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { 4000738c: 80 a0 80 19 cmp %g2, %i1 40007390: 22 80 00 0e be,a 400073c8 40007394: c4 02 40 00 ld [ %o1 ], %g2 40007398: 82 10 00 09 mov %o1, %g1 _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; 4000739c: d2 00 40 00 ld [ %g1 ], %o1 the_thread = _Thread_Get (tid, &location); switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { 400073a0: 80 a2 60 00 cmp %o1, 0 400073a4: 32 bf ff fa bne,a 4000738c <== ALWAYS TAKEN 400073a8: c4 02 60 04 ld [ %o1 + 4 ], %g2 return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 400073ac: 40 00 08 cb call 400096d8 <_Thread_Enable_dispatch> 400073b0: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; 400073b4: 82 10 20 09 mov 9, %g1 ! 9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400073b8: 81 c7 e0 08 ret 400073bc: 91 e8 00 01 restore %g0, %g1, %o0 400073c0: 81 c7 e0 08 ret 400073c4: 91 e8 00 01 restore %g0, %g1, %o0 case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; 400073c8: c4 20 40 00 st %g2, [ %g1 ] else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); 400073cc: 40 00 00 2e call 40007484 <_RTEMS_Tasks_Invoke_task_variable_dtor> 400073d0: 01 00 00 00 nop _Thread_Enable_dispatch(); 400073d4: 40 00 08 c1 call 400096d8 <_Thread_Enable_dispatch> 400073d8: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 400073dc: 82 10 20 00 clr %g1 ! 0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400073e0: 81 c7 e0 08 ret 400073e4: 91 e8 00 01 restore %g0, %g1, %o0 while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 400073e8: 92 10 00 01 mov %g1, %o1 400073ec: 10 bf ff f8 b 400073cc 400073f0: c4 22 21 60 st %g2, [ %o0 + 0x160 ] =============================================================================== 400073f4 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { 400073f4: 9d e3 bf 98 save %sp, -104, %sp 400073f8: 90 10 00 18 mov %i0, %o0 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) 400073fc: 80 a6 60 00 cmp %i1, 0 40007400: 02 80 00 1b be 4000746c 40007404: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !result ) 40007408: 80 a6 a0 00 cmp %i2, 0 4000740c: 02 80 00 1c be 4000747c 40007410: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); 40007414: 40 00 08 bf call 40009710 <_Thread_Get> 40007418: 92 07 bf fc add %fp, -4, %o1 switch (location) { 4000741c: c2 07 bf fc ld [ %fp + -4 ], %g1 40007420: 80 a0 60 00 cmp %g1, 0 40007424: 12 80 00 12 bne 4000746c 40007428: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; 4000742c: c2 02 21 60 ld [ %o0 + 0x160 ], %g1 while (tvp) { 40007430: 80 a0 60 00 cmp %g1, 0 40007434: 32 80 00 07 bne,a 40007450 40007438: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000743c: 30 80 00 0e b,a 40007474 40007440: 80 a0 60 00 cmp %g1, 0 40007444: 02 80 00 0c be 40007474 <== NEVER TAKEN 40007448: 01 00 00 00 nop if (tvp->ptr == ptr) { 4000744c: c4 00 60 04 ld [ %g1 + 4 ], %g2 40007450: 80 a0 80 19 cmp %g2, %i1 40007454: 32 bf ff fb bne,a 40007440 40007458: c2 00 40 00 ld [ %g1 ], %g1 /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; 4000745c: c2 00 60 0c ld [ %g1 + 0xc ], %g1 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 40007460: b0 10 20 00 clr %i0 /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; _Thread_Enable_dispatch(); 40007464: 40 00 08 9d call 400096d8 <_Thread_Enable_dispatch> 40007468: c2 26 80 00 st %g1, [ %i2 ] return RTEMS_SUCCESSFUL; 4000746c: 81 c7 e0 08 ret 40007470: 81 e8 00 00 restore } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 40007474: 40 00 08 99 call 400096d8 <_Thread_Enable_dispatch> 40007478: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; 4000747c: 81 c7 e0 08 ret 40007480: 81 e8 00 00 restore =============================================================================== 40015c54 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 40015c54: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 40015c58: 11 10 00 fc sethi %hi(0x4003f000), %o0 40015c5c: 92 10 00 18 mov %i0, %o1 40015c60: 90 12 23 c4 or %o0, 0x3c4, %o0 40015c64: 40 00 0c b7 call 40018f40 <_Objects_Get> 40015c68: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40015c6c: c2 07 bf fc ld [ %fp + -4 ], %g1 40015c70: 80 a0 60 00 cmp %g1, 0 40015c74: 22 80 00 04 be,a 40015c84 40015c78: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40015c7c: 81 c7 e0 08 ret 40015c80: 91 e8 20 04 restore %g0, 4, %o0 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 40015c84: 80 a0 60 04 cmp %g1, 4 40015c88: 02 80 00 04 be 40015c98 <== NEVER TAKEN 40015c8c: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 40015c90: 40 00 15 36 call 4001b168 <_Watchdog_Remove> 40015c94: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 40015c98: 40 00 0f e4 call 40019c28 <_Thread_Enable_dispatch> 40015c9c: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40015ca0: 81 c7 e0 08 ret 40015ca4: 81 e8 00 00 restore =============================================================================== 4001616c : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 4001616c: 9d e3 bf 98 save %sp, -104, %sp Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; 40016170: 03 10 00 fd sethi %hi(0x4003f400), %g1 40016174: e0 00 60 04 ld [ %g1 + 4 ], %l0 ! 4003f404 <_Timer_server> rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 40016178: a2 10 00 18 mov %i0, %l1 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) 4001617c: 80 a4 20 00 cmp %l0, 0 40016180: 02 80 00 10 be 400161c0 40016184: b0 10 20 0e mov 0xe, %i0 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 40016188: 03 10 00 fa sethi %hi(0x4003e800), %g1 4001618c: c2 08 62 40 ldub [ %g1 + 0x240 ], %g1 ! 4003ea40 <_TOD_Is_set> 40016190: 80 a0 60 00 cmp %g1, 0 40016194: 02 80 00 0b be 400161c0 <== NEVER TAKEN 40016198: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; if ( !routine ) 4001619c: 80 a6 a0 00 cmp %i2, 0 400161a0: 02 80 00 08 be 400161c0 400161a4: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 400161a8: 90 10 00 19 mov %i1, %o0 400161ac: 7f ff f3 b2 call 40013074 <_TOD_Validate> 400161b0: b0 10 20 14 mov 0x14, %i0 400161b4: 80 8a 20 ff btst 0xff, %o0 400161b8: 12 80 00 04 bne 400161c8 400161bc: 01 00 00 00 nop case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400161c0: 81 c7 e0 08 ret 400161c4: 81 e8 00 00 restore return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 400161c8: 7f ff f3 75 call 40012f9c <_TOD_To_seconds> 400161cc: 90 10 00 19 mov %i1, %o0 if ( seconds <= _TOD_Seconds_since_epoch() ) 400161d0: 25 10 00 fa sethi %hi(0x4003e800), %l2 400161d4: c2 04 a2 d8 ld [ %l2 + 0x2d8 ], %g1 ! 4003ead8 <_TOD_Now> 400161d8: 80 a2 00 01 cmp %o0, %g1 400161dc: 08 bf ff f9 bleu 400161c0 400161e0: b2 10 00 08 mov %o0, %i1 400161e4: 92 10 00 11 mov %l1, %o1 400161e8: 11 10 00 fc sethi %hi(0x4003f000), %o0 400161ec: 94 07 bf fc add %fp, -4, %o2 400161f0: 40 00 0b 54 call 40018f40 <_Objects_Get> 400161f4: 90 12 23 c4 or %o0, 0x3c4, %o0 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 400161f8: c2 07 bf fc ld [ %fp + -4 ], %g1 400161fc: 80 a0 60 00 cmp %g1, 0 40016200: 12 80 00 16 bne 40016258 40016204: b0 10 00 08 mov %o0, %i0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 40016208: 40 00 13 d8 call 4001b168 <_Watchdog_Remove> 4001620c: 90 02 20 10 add %o0, 0x10, %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 40016210: c4 04 a2 d8 ld [ %l2 + 0x2d8 ], %g2 (*timer_server->schedule_operation)( timer_server, the_timer ); 40016214: c2 04 20 04 ld [ %l0 + 4 ], %g1 40016218: 92 10 00 18 mov %i0, %o1 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 4001621c: b2 26 40 02 sub %i1, %g2, %i1 (*timer_server->schedule_operation)( timer_server, the_timer ); 40016220: 90 10 00 10 mov %l0, %o0 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; 40016224: 84 10 20 03 mov 3, %g2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40016228: f4 26 20 2c st %i2, [ %i0 + 0x2c ] 4001622c: c4 26 20 38 st %g2, [ %i0 + 0x38 ] the_watchdog->id = id; 40016230: e2 26 20 30 st %l1, [ %i0 + 0x30 ] the_watchdog->user_data = user_data; 40016234: f6 26 20 34 st %i3, [ %i0 + 0x34 ] _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 40016238: f2 26 20 1c st %i1, [ %i0 + 0x1c ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 4001623c: c0 26 20 18 clr [ %i0 + 0x18 ] (*timer_server->schedule_operation)( timer_server, the_timer ); 40016240: 9f c0 40 00 call %g1 40016244: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40016248: 40 00 0e 78 call 40019c28 <_Thread_Enable_dispatch> 4001624c: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40016250: 81 c7 e0 08 ret 40016254: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40016258: 81 c7 e0 08 ret 4001625c: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 400069f8 : #include int sched_get_priority_max( int policy ) { 400069f8: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 400069fc: 80 a6 20 04 cmp %i0, 4 40006a00: 08 80 00 08 bleu 40006a20 40006a04: 82 10 20 01 mov 1, %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40006a08: 40 00 25 5d call 4000ff7c <__errno> 40006a0c: b0 10 3f ff mov -1, %i0 40006a10: 82 10 20 16 mov 0x16, %g1 40006a14: c2 22 00 00 st %g1, [ %o0 ] 40006a18: 81 c7 e0 08 ret 40006a1c: 81 e8 00 00 restore int sched_get_priority_max( int policy ) { switch ( policy ) { 40006a20: b1 28 40 18 sll %g1, %i0, %i0 40006a24: 80 8e 20 17 btst 0x17, %i0 40006a28: 02 bf ff f8 be 40006a08 <== NEVER TAKEN 40006a2c: 03 10 00 79 sethi %hi(0x4001e400), %g1 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 40006a30: f0 08 63 88 ldub [ %g1 + 0x388 ], %i0 ! 4001e788 } 40006a34: 81 c7 e0 08 ret 40006a38: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 40006a3c : #include int sched_get_priority_min( int policy ) { 40006a3c: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 40006a40: 80 a6 20 04 cmp %i0, 4 40006a44: 08 80 00 09 bleu 40006a68 40006a48: 84 10 20 01 mov 1, %g2 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40006a4c: 40 00 25 4c call 4000ff7c <__errno> 40006a50: 01 00 00 00 nop 40006a54: 82 10 3f ff mov -1, %g1 ! ffffffff 40006a58: 84 10 20 16 mov 0x16, %g2 40006a5c: c4 22 00 00 st %g2, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40006a60: 81 c7 e0 08 ret 40006a64: 91 e8 00 01 restore %g0, %g1, %o0 int sched_get_priority_min( int policy ) { switch ( policy ) { 40006a68: b1 28 80 18 sll %g2, %i0, %i0 40006a6c: 80 8e 20 17 btst 0x17, %i0 40006a70: 02 bf ff f7 be 40006a4c <== NEVER TAKEN 40006a74: 82 10 20 01 mov 1, %g1 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40006a78: 81 c7 e0 08 ret 40006a7c: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 40006a80 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 40006a80: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 40006a84: 80 a6 20 00 cmp %i0, 0 40006a88: 12 80 00 0a bne 40006ab0 <== ALWAYS TAKEN 40006a8c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); if ( !interval ) 40006a90: 02 80 00 13 be 40006adc 40006a94: 03 10 00 7c sethi %hi(0x4001f000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 40006a98: d0 00 60 24 ld [ %g1 + 0x24 ], %o0 ! 4001f024 <_Thread_Ticks_per_timeslice> 40006a9c: 92 10 00 19 mov %i1, %o1 40006aa0: 40 00 0f 12 call 4000a6e8 <_Timespec_From_ticks> 40006aa4: b0 10 20 00 clr %i0 return 0; } 40006aa8: 81 c7 e0 08 ret 40006aac: 81 e8 00 00 restore { /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 40006ab0: 7f ff f1 49 call 40002fd4 40006ab4: 01 00 00 00 nop 40006ab8: 80 a2 00 18 cmp %o0, %i0 40006abc: 02 bf ff f5 be 40006a90 40006ac0: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40006ac4: 40 00 25 2e call 4000ff7c <__errno> 40006ac8: b0 10 3f ff mov -1, %i0 40006acc: 82 10 20 03 mov 3, %g1 40006ad0: c2 22 00 00 st %g1, [ %o0 ] 40006ad4: 81 c7 e0 08 ret 40006ad8: 81 e8 00 00 restore if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); 40006adc: 40 00 25 28 call 4000ff7c <__errno> 40006ae0: b0 10 3f ff mov -1, %i0 40006ae4: 82 10 20 16 mov 0x16, %g1 40006ae8: c2 22 00 00 st %g1, [ %o0 ] 40006aec: 81 c7 e0 08 ret 40006af0: 81 e8 00 00 restore =============================================================================== 40009314 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 40009314: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40009318: 03 10 00 90 sethi %hi(0x40024000), %g1 4000931c: c4 00 60 b0 ld [ %g1 + 0xb0 ], %g2 ! 400240b0 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40009320: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 40009324: 84 00 a0 01 inc %g2 40009328: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 4000932c: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40009330: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 40009334: c4 20 60 b0 st %g2, [ %g1 + 0xb0 ] POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 40009338: a2 8e 62 00 andcc %i1, 0x200, %l1 4000933c: 12 80 00 25 bne 400093d0 40009340: a0 10 20 00 clr %l0 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 40009344: 90 10 00 18 mov %i0, %o0 40009348: 40 00 1c 07 call 40010364 <_POSIX_Semaphore_Name_to_id> 4000934c: 92 07 bf f8 add %fp, -8, %o1 * and we can just return a pointer to the id. Otherwise we may * need to check to see if this is a "semaphore does not exist" * or some other miscellaneous error on the name. */ if ( status ) { 40009350: a4 92 20 00 orcc %o0, 0, %l2 40009354: 22 80 00 0e be,a 4000938c 40009358: b2 0e 6a 00 and %i1, 0xa00, %i1 /* * 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) ) ) { 4000935c: 80 a4 a0 02 cmp %l2, 2 40009360: 12 80 00 04 bne 40009370 <== NEVER TAKEN 40009364: 80 a4 60 00 cmp %l1, 0 40009368: 12 80 00 1e bne 400093e0 4000936c: 94 10 00 10 mov %l0, %o2 _Thread_Enable_dispatch(); 40009370: 40 00 0c 1f call 4000c3ec <_Thread_Enable_dispatch> 40009374: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 40009378: 40 00 28 b4 call 40013648 <__errno> 4000937c: 01 00 00 00 nop 40009380: e4 22 00 00 st %l2, [ %o0 ] 40009384: 81 c7 e0 08 ret 40009388: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 4000938c: 80 a6 6a 00 cmp %i1, 0xa00 40009390: 02 80 00 20 be 40009410 40009394: d2 07 bf f8 ld [ %fp + -8 ], %o1 40009398: 94 07 bf f0 add %fp, -16, %o2 4000939c: 11 10 00 90 sethi %hi(0x40024000), %o0 400093a0: 40 00 08 e7 call 4000b73c <_Objects_Get> 400093a4: 90 12 23 90 or %o0, 0x390, %o0 ! 40024390 <_POSIX_Semaphore_Information> _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 400093a8: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); 400093ac: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 400093b0: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 400093b4: 40 00 0c 0e call 4000c3ec <_Thread_Enable_dispatch> 400093b8: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 400093bc: 40 00 0c 0c call 4000c3ec <_Thread_Enable_dispatch> 400093c0: 01 00 00 00 nop return_id: #if defined(RTEMS_USE_16_BIT_OBJECT) the_semaphore->Semaphore_id = the_semaphore->Object.id; id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; 400093c4: f0 07 bf f4 ld [ %fp + -12 ], %i0 #endif return id; } 400093c8: 81 c7 e0 08 ret 400093cc: 91 ee 20 08 restore %i0, 8, %o0 _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 400093d0: 82 07 a0 54 add %fp, 0x54, %g1 400093d4: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 400093d8: 10 bf ff db b 40009344 400093dc: c2 27 bf fc st %g1, [ %fp + -4 ] /* * At this point, the semaphore does not exist and everything has been * checked. We should go ahead and create a semaphore. */ status =_POSIX_Semaphore_Create_support( 400093e0: 92 10 20 00 clr %o1 400093e4: 96 07 bf f4 add %fp, -12, %o3 400093e8: 40 00 1b 83 call 400101f4 <_POSIX_Semaphore_Create_support> 400093ec: 90 10 00 18 mov %i0, %o0 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 400093f0: 40 00 0b ff call 4000c3ec <_Thread_Enable_dispatch> 400093f4: a0 10 00 08 mov %o0, %l0 if ( status == -1 ) 400093f8: 80 a4 3f ff cmp %l0, -1 400093fc: 02 bf ff e2 be 40009384 40009400: b0 10 3f ff mov -1, %i0 return_id: #if defined(RTEMS_USE_16_BIT_OBJECT) the_semaphore->Semaphore_id = the_semaphore->Object.id; id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; 40009404: f0 07 bf f4 ld [ %fp + -12 ], %i0 40009408: 81 c7 e0 08 ret 4000940c: 91 ee 20 08 restore %i0, 8, %o0 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); 40009410: 40 00 0b f7 call 4000c3ec <_Thread_Enable_dispatch> 40009414: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 40009418: 40 00 28 8c call 40013648 <__errno> 4000941c: 01 00 00 00 nop 40009420: 82 10 20 11 mov 0x11, %g1 ! 11 40009424: c2 22 00 00 st %g1, [ %o0 ] 40009428: 81 c7 e0 08 ret 4000942c: 81 e8 00 00 restore =============================================================================== 4000948c : int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { 4000948c: 9d e3 bf 98 save %sp, -104, %sp * * 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 ); 40009490: 90 10 00 19 mov %i1, %o0 40009494: 40 00 18 9d call 4000f708 <_POSIX_Absolute_timeout_to_ticks> 40009498: 92 07 bf fc add %fp, -4, %o1 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 4000949c: 80 a2 20 03 cmp %o0, 3 400094a0: 02 80 00 07 be 400094bc <== ALWAYS TAKEN 400094a4: d4 07 bf fc ld [ %fp + -4 ], %o2 do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 400094a8: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED 400094ac: 40 00 1b d0 call 400103ec <_POSIX_Semaphore_Wait_support> <== NOT EXECUTED 400094b0: 92 10 20 00 clr %o1 <== NOT EXECUTED lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } 400094b4: 81 c7 e0 08 ret <== NOT EXECUTED 400094b8: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 400094bc: 90 10 00 18 mov %i0, %o0 400094c0: 40 00 1b cb call 400103ec <_POSIX_Semaphore_Wait_support> 400094c4: 92 10 20 01 mov 1, %o1 lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } 400094c8: 81 c7 e0 08 ret 400094cc: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006980 : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 40006980: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 40006984: 80 a6 a0 00 cmp %i2, 0 40006988: 02 80 00 0d be 400069bc 4000698c: 87 2e 20 02 sll %i0, 2, %g3 *oact = _POSIX_signals_Vectors[ sig ]; 40006990: 05 10 00 81 sethi %hi(0x40020400), %g2 40006994: 83 2e 20 04 sll %i0, 4, %g1 40006998: 84 10 a3 10 or %g2, 0x310, %g2 4000699c: 82 20 40 03 sub %g1, %g3, %g1 400069a0: c6 00 80 01 ld [ %g2 + %g1 ], %g3 400069a4: 82 00 80 01 add %g2, %g1, %g1 400069a8: c6 26 80 00 st %g3, [ %i2 ] 400069ac: c4 00 60 04 ld [ %g1 + 4 ], %g2 400069b0: c4 26 a0 04 st %g2, [ %i2 + 4 ] 400069b4: c2 00 60 08 ld [ %g1 + 8 ], %g1 400069b8: c2 26 a0 08 st %g1, [ %i2 + 8 ] if ( !sig ) 400069bc: 80 a6 20 00 cmp %i0, 0 400069c0: 02 80 00 33 be 40006a8c 400069c4: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 400069c8: 82 06 3f ff add %i0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 400069cc: 80 a0 60 1f cmp %g1, 0x1f 400069d0: 18 80 00 2f bgu 40006a8c 400069d4: 80 a6 20 09 cmp %i0, 9 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 400069d8: 02 80 00 2d be 40006a8c 400069dc: 80 a6 60 00 cmp %i1, 0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 400069e0: 02 80 00 1a be 40006a48 <== NEVER TAKEN 400069e4: 82 10 20 00 clr %g1 /* * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); 400069e8: 7f ff ee 46 call 40002300 400069ec: 01 00 00 00 nop 400069f0: b4 10 00 08 mov %o0, %i2 if ( act->sa_handler == SIG_DFL ) { 400069f4: c2 06 60 08 ld [ %i1 + 8 ], %g1 400069f8: 80 a0 60 00 cmp %g1, 0 400069fc: 02 80 00 15 be 40006a50 40006a00: 83 2e 20 02 sll %i0, 2, %g1 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); 40006a04: 40 00 19 8b call 4000d030 <_POSIX_signals_Clear_process_signals> 40006a08: 90 10 00 18 mov %i0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 40006a0c: c4 06 40 00 ld [ %i1 ], %g2 40006a10: 87 2e 20 02 sll %i0, 2, %g3 40006a14: 03 10 00 81 sethi %hi(0x40020400), %g1 40006a18: b1 2e 20 04 sll %i0, 4, %i0 40006a1c: 82 10 63 10 or %g1, 0x310, %g1 40006a20: b0 26 00 03 sub %i0, %g3, %i0 40006a24: c4 20 40 18 st %g2, [ %g1 + %i0 ] 40006a28: c4 06 60 04 ld [ %i1 + 4 ], %g2 40006a2c: b0 00 40 18 add %g1, %i0, %i0 40006a30: c4 26 20 04 st %g2, [ %i0 + 4 ] 40006a34: c2 06 60 08 ld [ %i1 + 8 ], %g1 40006a38: c2 26 20 08 st %g1, [ %i0 + 8 ] } _ISR_Enable( level ); 40006a3c: 7f ff ee 35 call 40002310 40006a40: 90 10 00 1a mov %i2, %o0 * now (signals not posted when SIG_IGN). * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; 40006a44: 82 10 20 00 clr %g1 } 40006a48: 81 c7 e0 08 ret 40006a4c: 91 e8 00 01 restore %g0, %g1, %o0 * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 40006a50: b1 2e 20 04 sll %i0, 4, %i0 40006a54: b0 26 00 01 sub %i0, %g1, %i0 40006a58: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40006a5c: 82 10 61 08 or %g1, 0x108, %g1 ! 4001ed08 <_POSIX_signals_Default_vectors> 40006a60: c8 00 40 18 ld [ %g1 + %i0 ], %g4 40006a64: 82 00 40 18 add %g1, %i0, %g1 40006a68: c6 00 60 04 ld [ %g1 + 4 ], %g3 40006a6c: c4 00 60 08 ld [ %g1 + 8 ], %g2 40006a70: 03 10 00 81 sethi %hi(0x40020400), %g1 40006a74: 82 10 63 10 or %g1, 0x310, %g1 ! 40020710 <_POSIX_signals_Vectors> 40006a78: c8 20 40 18 st %g4, [ %g1 + %i0 ] 40006a7c: b0 00 40 18 add %g1, %i0, %i0 40006a80: c6 26 20 04 st %g3, [ %i0 + 4 ] 40006a84: 10 bf ff ee b 40006a3c 40006a88: c4 26 20 08 st %g2, [ %i0 + 8 ] * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) rtems_set_errno_and_return_minus_one( EINVAL ); 40006a8c: 40 00 26 69 call 40010430 <__errno> 40006a90: 01 00 00 00 nop 40006a94: 84 10 20 16 mov 0x16, %g2 ! 16 40006a98: 82 10 3f ff mov -1, %g1 40006a9c: 10 bf ff eb b 40006a48 40006aa0: c4 22 00 00 st %g2, [ %o0 ] =============================================================================== 40006e68 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 40006e68: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 40006e6c: a0 96 20 00 orcc %i0, 0, %l0 40006e70: 02 80 00 83 be 4000707c 40006e74: 80 a6 a0 00 cmp %i2, 0 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 40006e78: 02 80 00 5b be 40006fe4 40006e7c: 80 a6 60 00 cmp %i1, 0 if ( !_Timespec_Is_valid( timeout ) ) 40006e80: 40 00 0f 3b call 4000ab6c <_Timespec_Is_valid> 40006e84: 90 10 00 1a mov %i2, %o0 40006e88: 80 8a 20 ff btst 0xff, %o0 40006e8c: 02 80 00 7c be 4000707c 40006e90: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 40006e94: 40 00 0f 5d call 4000ac08 <_Timespec_To_ticks> 40006e98: 90 10 00 1a mov %i2, %o0 if ( !interval ) 40006e9c: b4 92 20 00 orcc %o0, 0, %i2 40006ea0: 02 80 00 77 be 4000707c <== NEVER TAKEN 40006ea4: 80 a6 60 00 cmp %i1, 0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40006ea8: 02 80 00 52 be 40006ff0 <== NEVER TAKEN 40006eac: 23 10 00 83 sethi %hi(0x40020c00), %l1 the_thread = _Thread_Executing; 40006eb0: 23 10 00 83 sethi %hi(0x40020c00), %l1 40006eb4: a2 14 63 18 or %l1, 0x318, %l1 ! 40020f18 <_Per_CPU_Information> 40006eb8: f0 04 60 0c ld [ %l1 + 0xc ], %i0 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40006ebc: 7f ff ed eb call 40002668 40006ec0: e6 06 21 58 ld [ %i0 + 0x158 ], %l3 40006ec4: a4 10 00 08 mov %o0, %l2 if ( *set & api->signals_pending ) { 40006ec8: c2 04 00 00 ld [ %l0 ], %g1 40006ecc: c4 04 e0 d4 ld [ %l3 + 0xd4 ], %g2 40006ed0: 80 88 40 02 btst %g1, %g2 40006ed4: 12 80 00 52 bne 4000701c 40006ed8: 01 00 00 00 nop return the_info->si_signo; } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 40006edc: 05 10 00 84 sethi %hi(0x40021000), %g2 40006ee0: c4 00 a1 64 ld [ %g2 + 0x164 ], %g2 ! 40021164 <_POSIX_signals_Pending> 40006ee4: 80 88 40 02 btst %g1, %g2 40006ee8: 12 80 00 2e bne 40006fa0 40006eec: 03 10 00 82 sethi %hi(0x40020800), %g1 40006ef0: c4 00 61 c0 ld [ %g1 + 0x1c0 ], %g2 ! 400209c0 <_Thread_Dispatch_disable_level> the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; return signo; } the_info->si_signo = -1; 40006ef4: 86 10 3f ff mov -1, %g3 40006ef8: c6 26 40 00 st %g3, [ %i1 ] 40006efc: 84 00 a0 01 inc %g2 40006f00: c4 20 61 c0 st %g2, [ %g1 + 0x1c0 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 40006f04: 82 10 20 04 mov 4, %g1 40006f08: c2 26 20 34 st %g1, [ %i0 + 0x34 ] the_thread->Wait.option = *set; 40006f0c: c2 04 00 00 ld [ %l0 ], %g1 the_thread->Wait.return_argument = the_info; 40006f10: f2 26 20 28 st %i1, [ %i0 + 0x28 ] the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; 40006f14: c2 26 20 30 st %g1, [ %i0 + 0x30 ] 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; 40006f18: a4 10 20 01 mov 1, %l2 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 40006f1c: 29 10 00 84 sethi %hi(0x40021000), %l4 40006f20: a8 15 20 fc or %l4, 0xfc, %l4 ! 400210fc <_POSIX_signals_Wait_queue> 40006f24: e8 26 20 44 st %l4, [ %i0 + 0x44 ] 40006f28: e4 25 20 30 st %l2, [ %l4 + 0x30 ] the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; the_thread->Wait.return_argument = the_info; _Thread_queue_Enter_critical_section( &_POSIX_signals_Wait_queue ); _ISR_Enable( level ); 40006f2c: 7f ff ed d3 call 40002678 40006f30: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 40006f34: 90 10 00 14 mov %l4, %o0 40006f38: 92 10 00 1a mov %i2, %o1 40006f3c: 15 10 00 29 sethi %hi(0x4000a400), %o2 40006f40: 40 00 0d 25 call 4000a3d4 <_Thread_queue_Enqueue_with_handler> 40006f44: 94 12 a3 c4 or %o2, 0x3c4, %o2 ! 4000a7c4 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 40006f48: 40 00 0b db call 40009eb4 <_Thread_Enable_dispatch> 40006f4c: 01 00 00 00 nop /* * When the thread is set free by a signal, it is need to eliminate * the signal. */ _POSIX_signals_Clear_signals( api, the_info->si_signo, the_info, false, false ); 40006f50: d2 06 40 00 ld [ %i1 ], %o1 40006f54: 90 10 00 13 mov %l3, %o0 40006f58: 94 10 00 19 mov %i1, %o2 40006f5c: 96 10 20 00 clr %o3 40006f60: 40 00 1a 4b call 4000d88c <_POSIX_signals_Clear_signals> 40006f64: 98 10 20 00 clr %o4 /* Set errno only if return code is not EINTR or * if EINTR was caused by a signal being caught, which * was not in our set. */ if ( (_Thread_Executing->Wait.return_code != EINTR) 40006f68: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40006f6c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40006f70: 80 a0 60 04 cmp %g1, 4 40006f74: 12 80 00 3b bne 40007060 40006f78: 01 00 00 00 nop || !(*set & signo_to_mask( the_info->si_signo )) ) { 40006f7c: f0 06 40 00 ld [ %i1 ], %i0 40006f80: c2 04 00 00 ld [ %l0 ], %g1 40006f84: 84 06 3f ff add %i0, -1, %g2 40006f88: a5 2c 80 02 sll %l2, %g2, %l2 40006f8c: 80 8c 80 01 btst %l2, %g1 40006f90: 02 80 00 34 be 40007060 40006f94: 01 00 00 00 nop errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } 40006f98: 81 c7 e0 08 ret 40006f9c: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40006fa0: 7f ff ff 9a call 40006e08 <_POSIX_signals_Get_lowest> 40006fa4: 90 10 00 02 mov %g2, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40006fa8: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40006fac: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40006fb0: 96 10 20 01 mov 1, %o3 40006fb4: 90 10 00 13 mov %l3, %o0 40006fb8: 92 10 00 18 mov %i0, %o1 40006fbc: 40 00 1a 34 call 4000d88c <_POSIX_signals_Clear_signals> 40006fc0: 98 10 20 00 clr %o4 _ISR_Enable( level ); 40006fc4: 7f ff ed ad call 40002678 40006fc8: 90 10 00 12 mov %l2, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 40006fcc: 82 10 20 01 mov 1, %g1 if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); _ISR_Enable( level ); the_info->si_signo = signo; 40006fd0: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 40006fd4: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 40006fd8: c0 26 60 08 clr [ %i1 + 8 ] return signo; 40006fdc: 81 c7 e0 08 ret 40006fe0: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40006fe4: 12 bf ff b3 bne 40006eb0 40006fe8: b4 10 20 00 clr %i2 the_thread = _Thread_Executing; 40006fec: 23 10 00 83 sethi %hi(0x40020c00), %l1 40006ff0: a2 14 63 18 or %l1, 0x318, %l1 ! 40020f18 <_Per_CPU_Information> 40006ff4: f0 04 60 0c ld [ %l1 + 0xc ], %i0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40006ff8: b2 07 bf f4 add %fp, -12, %i1 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40006ffc: 7f ff ed 9b call 40002668 40007000: e6 06 21 58 ld [ %i0 + 0x158 ], %l3 40007004: a4 10 00 08 mov %o0, %l2 if ( *set & api->signals_pending ) { 40007008: c2 04 00 00 ld [ %l0 ], %g1 4000700c: c4 04 e0 d4 ld [ %l3 + 0xd4 ], %g2 40007010: 80 88 40 02 btst %g1, %g2 40007014: 22 bf ff b3 be,a 40006ee0 40007018: 05 10 00 84 sethi %hi(0x40021000), %g2 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 4000701c: 7f ff ff 7b call 40006e08 <_POSIX_signals_Get_lowest> 40007020: 90 10 00 02 mov %g2, %o0 _POSIX_signals_Clear_signals( 40007024: 94 10 00 19 mov %i1, %o2 /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 40007028: 92 10 00 08 mov %o0, %o1 4000702c: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 40007030: 96 10 20 00 clr %o3 40007034: 90 10 00 13 mov %l3, %o0 40007038: 40 00 1a 15 call 4000d88c <_POSIX_signals_Clear_signals> 4000703c: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 40007040: 7f ff ed 8e call 40002678 40007044: 90 10 00 12 mov %l2, %o0 the_info->si_code = SI_USER; 40007048: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 4000704c: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 40007050: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 40007054: f0 06 40 00 ld [ %i1 ], %i0 40007058: 81 c7 e0 08 ret 4000705c: 81 e8 00 00 restore * was not in our set. */ if ( (_Thread_Executing->Wait.return_code != EINTR) || !(*set & signo_to_mask( the_info->si_signo )) ) { errno = _Thread_Executing->Wait.return_code; 40007060: 40 00 26 d7 call 40010bbc <__errno> 40007064: b0 10 3f ff mov -1, %i0 40007068: c2 04 60 0c ld [ %l1 + 0xc ], %g1 4000706c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007070: c2 22 00 00 st %g1, [ %o0 ] return -1; } return the_info->si_signo; } 40007074: 81 c7 e0 08 ret 40007078: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); 4000707c: 40 00 26 d0 call 40010bbc <__errno> 40007080: b0 10 3f ff mov -1, %i0 40007084: 82 10 20 16 mov 0x16, %g1 40007088: c2 22 00 00 st %g1, [ %o0 ] 4000708c: 81 c7 e0 08 ret 40007090: 81 e8 00 00 restore =============================================================================== 40008e50 : int sigwait( const sigset_t *set, int *sig ) { 40008e50: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 40008e54: 92 10 20 00 clr %o1 40008e58: 90 10 00 18 mov %i0, %o0 40008e5c: 7f ff ff 6d call 40008c10 40008e60: 94 10 20 00 clr %o2 if ( status != -1 ) { 40008e64: 80 a2 3f ff cmp %o0, -1 40008e68: 02 80 00 07 be 40008e84 40008e6c: 80 a6 60 00 cmp %i1, 0 if ( sig ) 40008e70: 02 80 00 03 be 40008e7c <== NEVER TAKEN 40008e74: b0 10 20 00 clr %i0 *sig = status; 40008e78: d0 26 40 00 st %o0, [ %i1 ] 40008e7c: 81 c7 e0 08 ret 40008e80: 81 e8 00 00 restore return 0; } return errno; 40008e84: 40 00 25 b7 call 40012560 <__errno> 40008e88: 01 00 00 00 nop 40008e8c: f0 02 00 00 ld [ %o0 ], %i0 } 40008e90: 81 c7 e0 08 ret 40008e94: 81 e8 00 00 restore =============================================================================== 40005c04 : */ long sysconf( int name ) { 40005c04: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 40005c08: 80 a6 20 02 cmp %i0, 2 40005c0c: 02 80 00 0e be 40005c44 40005c10: 80 a6 20 04 cmp %i0, 4 return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 40005c14: 02 80 00 14 be 40005c64 40005c18: 80 a6 20 33 cmp %i0, 0x33 return rtems_libio_number_iops; if ( name == _SC_GETPW_R_SIZE_MAX ) 40005c1c: 02 80 00 08 be 40005c3c 40005c20: 82 10 24 00 mov 0x400, %g1 return 1024; if ( name == _SC_PAGESIZE ) 40005c24: 80 a6 20 08 cmp %i0, 8 40005c28: 02 80 00 05 be 40005c3c 40005c2c: 82 00 6c 00 add %g1, 0xc00, %g1 return PAGE_SIZE; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 40005c30: 80 a6 22 03 cmp %i0, 0x203 40005c34: 12 80 00 10 bne 40005c74 <== ALWAYS TAKEN 40005c38: 82 10 20 00 clr %g1 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); } 40005c3c: 81 c7 e0 08 ret 40005c40: 91 e8 00 01 restore %g0, %g1, %o0 int name ) { if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); 40005c44: 03 10 00 5b sethi %hi(0x40016c00), %g1 long sysconf( int name ) { if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / 40005c48: d2 00 62 28 ld [ %g1 + 0x228 ], %o1 ! 40016e28 40005c4c: 11 00 03 d0 sethi %hi(0xf4000), %o0 40005c50: 40 00 35 fd call 40013444 <.udiv> 40005c54: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 40005c58: 82 10 00 08 mov %o0, %g1 if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); } 40005c5c: 81 c7 e0 08 ret 40005c60: 91 e8 00 01 restore %g0, %g1, %o0 if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) return rtems_libio_number_iops; 40005c64: 03 10 00 5b sethi %hi(0x40016c00), %g1 40005c68: c2 00 61 44 ld [ %g1 + 0x144 ], %g1 ! 40016d44 if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); } 40005c6c: 81 c7 e0 08 ret 40005c70: 91 e8 00 01 restore %g0, %g1, %o0 #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40005c74: 40 00 26 96 call 4000f6cc <__errno> 40005c78: 01 00 00 00 nop 40005c7c: 84 10 20 16 mov 0x16, %g2 ! 16 40005c80: 82 10 3f ff mov -1, %g1 40005c84: 10 bf ff ee b 40005c3c 40005c88: c4 22 00 00 st %g2, [ %o0 ] =============================================================================== 40005fac : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 40005fac: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 40005fb0: 80 a6 20 01 cmp %i0, 1 40005fb4: 12 80 00 3d bne 400060a8 40005fb8: 80 a6 a0 00 cmp %i2, 0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 40005fbc: 02 80 00 3b be 400060a8 40005fc0: 80 a6 60 00 cmp %i1, 0 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 40005fc4: 02 80 00 0e be 40005ffc 40005fc8: 03 10 00 7c sethi %hi(0x4001f000), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 40005fcc: c2 06 40 00 ld [ %i1 ], %g1 40005fd0: 82 00 7f ff add %g1, -1, %g1 40005fd4: 80 a0 60 01 cmp %g1, 1 40005fd8: 18 80 00 34 bgu 400060a8 <== NEVER TAKEN 40005fdc: 01 00 00 00 nop ( 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 ) 40005fe0: c2 06 60 04 ld [ %i1 + 4 ], %g1 40005fe4: 80 a0 60 00 cmp %g1, 0 40005fe8: 02 80 00 30 be 400060a8 <== NEVER TAKEN 40005fec: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 40005ff0: 80 a0 60 1f cmp %g1, 0x1f 40005ff4: 18 80 00 2d bgu 400060a8 <== NEVER TAKEN 40005ff8: 03 10 00 7c sethi %hi(0x4001f000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40005ffc: c4 00 61 80 ld [ %g1 + 0x180 ], %g2 ! 4001f180 <_Thread_Dispatch_disable_level> 40006000: 84 00 a0 01 inc %g2 40006004: c4 20 61 80 st %g2, [ %g1 + 0x180 ] * 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 ); 40006008: 21 10 00 7d sethi %hi(0x4001f400), %l0 4000600c: 40 00 08 6b call 400081b8 <_Objects_Allocate> 40006010: 90 14 20 a0 or %l0, 0xa0, %o0 ! 4001f4a0 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 40006014: 80 a2 20 00 cmp %o0, 0 40006018: 02 80 00 2a be 400060c0 4000601c: 82 10 20 02 mov 2, %g1 rtems_set_errno_and_return_minus_one( EAGAIN ); } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 40006020: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 40006024: 03 10 00 7d sethi %hi(0x4001f400), %g1 40006028: c2 00 62 e4 ld [ %g1 + 0x2e4 ], %g1 ! 4001f6e4 <_Per_CPU_Information+0xc> if ( evp != NULL ) { 4000602c: 80 a6 60 00 cmp %i1, 0 } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; 40006030: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 40006034: 02 80 00 08 be 40006054 40006038: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 4000603c: c6 06 40 00 ld [ %i1 ], %g3 ptimer->inf.sigev_signo = evp->sigev_signo; 40006040: c4 06 60 04 ld [ %i1 + 4 ], %g2 ptimer->inf.sigev_value = evp->sigev_value; 40006044: c2 06 60 08 ld [ %i1 + 8 ], %g1 ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; if ( evp != NULL ) { ptimer->inf.sigev_notify = evp->sigev_notify; 40006048: c6 22 20 40 st %g3, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 4000604c: c4 22 20 44 st %g2, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 40006050: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006054: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; _Thread_Enable_dispatch(); return 0; } 40006058: a0 14 20 a0 or %l0, 0xa0, %l0 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000605c: c6 04 20 1c ld [ %l0 + 0x1c ], %g3 ptimer->inf.sigev_notify = evp->sigev_notify; ptimer->inf.sigev_signo = evp->sigev_signo; ptimer->inf.sigev_value = evp->sigev_value; } ptimer->overrun = 0; 40006060: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 40006064: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 40006068: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 4000606c: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 40006070: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40006074: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 40006078: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 4000607c: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 40006080: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006084: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006088: 85 28 a0 02 sll %g2, 2, %g2 4000608c: d0 20 c0 02 st %o0, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 40006090: c0 22 20 0c clr [ %o0 + 0xc ] _Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL ); _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; 40006094: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 40006098: 40 00 0c ab call 40009344 <_Thread_Enable_dispatch> 4000609c: b0 10 20 00 clr %i0 return 0; } 400060a0: 81 c7 e0 08 ret 400060a4: 81 e8 00 00 restore if ( !evp->sigev_signo ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) rtems_set_errno_and_return_minus_one( EINVAL ); 400060a8: 40 00 27 c1 call 4000ffac <__errno> 400060ac: b0 10 3f ff mov -1, %i0 400060b0: 82 10 20 16 mov 0x16, %g1 400060b4: c2 22 00 00 st %g1, [ %o0 ] 400060b8: 81 c7 e0 08 ret 400060bc: 81 e8 00 00 restore /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { _Thread_Enable_dispatch(); 400060c0: 40 00 0c a1 call 40009344 <_Thread_Enable_dispatch> 400060c4: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EAGAIN ); 400060c8: 40 00 27 b9 call 4000ffac <__errno> 400060cc: 01 00 00 00 nop 400060d0: 82 10 20 0b mov 0xb, %g1 ! b 400060d4: c2 22 00 00 st %g1, [ %o0 ] 400060d8: 81 c7 e0 08 ret 400060dc: 81 e8 00 00 restore =============================================================================== 400060e0 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 400060e0: 9d e3 bf 80 save %sp, -128, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 400060e4: 80 a6 a0 00 cmp %i2, 0 400060e8: 02 80 00 8a be 40006310 <== NEVER TAKEN 400060ec: 01 00 00 00 nop /* * First, it verifies if the structure "value" is correct * if the number of nanoseconds is not correct return EINVAL */ if ( !_Timespec_Is_valid( &(value->it_value) ) ) { 400060f0: 40 00 0f d5 call 4000a044 <_Timespec_Is_valid> 400060f4: 90 06 a0 08 add %i2, 8, %o0 400060f8: 80 8a 20 ff btst 0xff, %o0 400060fc: 02 80 00 85 be 40006310 40006100: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 40006104: 40 00 0f d0 call 4000a044 <_Timespec_Is_valid> 40006108: 90 10 00 1a mov %i2, %o0 4000610c: 80 8a 20 ff btst 0xff, %o0 40006110: 02 80 00 80 be 40006310 <== NEVER TAKEN 40006114: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40006118: 12 80 00 7c bne 40006308 4000611c: 80 a6 60 04 cmp %i1, 4 rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 40006120: c8 06 80 00 ld [ %i2 ], %g4 40006124: c6 06 a0 04 ld [ %i2 + 4 ], %g3 40006128: c4 06 a0 08 ld [ %i2 + 8 ], %g2 4000612c: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 40006130: c8 27 bf e4 st %g4, [ %fp + -28 ] 40006134: c6 27 bf e8 st %g3, [ %fp + -24 ] 40006138: c4 27 bf ec st %g2, [ %fp + -20 ] /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 4000613c: 80 a6 60 04 cmp %i1, 4 40006140: 02 80 00 3b be 4000622c 40006144: c2 27 bf f0 st %g1, [ %fp + -16 ] timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) _Objects_Get( &_POSIX_Timer_Information, (Objects_Id) id, location ); 40006148: 92 10 00 18 mov %i0, %o1 4000614c: 11 10 00 7d sethi %hi(0x4001f400), %o0 40006150: 94 07 bf fc add %fp, -4, %o2 40006154: 40 00 09 6e call 4000870c <_Objects_Get> 40006158: 90 12 20 a0 or %o0, 0xa0, %o0 * something with the structure of times of the timer: to stop, start * or start it again */ ptimer = _POSIX_Timer_Get( timerid, &location ); switch ( location ) { 4000615c: c2 07 bf fc ld [ %fp + -4 ], %g1 40006160: 80 a0 60 00 cmp %g1, 0 40006164: 12 80 00 48 bne 40006284 <== NEVER TAKEN 40006168: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: /* First, it verifies if the timer must be stopped */ if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) { 4000616c: c2 07 bf ec ld [ %fp + -20 ], %g1 40006170: 80 a0 60 00 cmp %g1, 0 40006174: 12 80 00 05 bne 40006188 40006178: c2 07 bf f0 ld [ %fp + -16 ], %g1 4000617c: 80 a0 60 00 cmp %g1, 0 40006180: 02 80 00 47 be 4000629c 40006184: 01 00 00 00 nop _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); 40006188: 40 00 0f d6 call 4000a0e0 <_Timespec_To_ticks> 4000618c: 90 10 00 1a mov %i2, %o0 40006190: d0 24 20 64 st %o0, [ %l0 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 40006194: 40 00 0f d3 call 4000a0e0 <_Timespec_To_ticks> 40006198: 90 07 bf ec add %fp, -20, %o0 activated = _POSIX_Timer_Insert_helper( 4000619c: d4 04 20 08 ld [ %l0 + 8 ], %o2 return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); initial_period = _Timespec_To_ticks( &normalize.it_value ); 400061a0: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 400061a4: 98 10 00 10 mov %l0, %o4 400061a8: 90 04 20 10 add %l0, 0x10, %o0 400061ac: 17 10 00 18 sethi %hi(0x40006000), %o3 400061b0: 40 00 1b b8 call 4000d090 <_POSIX_Timer_Insert_helper> 400061b4: 96 12 e3 28 or %o3, 0x328, %o3 ! 40006328 <_POSIX_Timer_TSR> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 400061b8: 80 8a 20 ff btst 0xff, %o0 400061bc: 02 80 00 18 be 4000621c 400061c0: 80 a6 e0 00 cmp %i3, 0 /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 400061c4: 02 80 00 0b be 400061f0 400061c8: c2 07 bf e4 ld [ %fp + -28 ], %g1 *ovalue = ptimer->timer_data; 400061cc: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 400061d0: c2 26 c0 00 st %g1, [ %i3 ] 400061d4: c2 04 20 58 ld [ %l0 + 0x58 ], %g1 400061d8: c2 26 e0 04 st %g1, [ %i3 + 4 ] 400061dc: c2 04 20 5c ld [ %l0 + 0x5c ], %g1 400061e0: c2 26 e0 08 st %g1, [ %i3 + 8 ] 400061e4: c2 04 20 60 ld [ %l0 + 0x60 ], %g1 400061e8: c2 26 e0 0c st %g1, [ %i3 + 0xc ] ptimer->timer_data = normalize; 400061ec: c2 07 bf e4 ld [ %fp + -28 ], %g1 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; _TOD_Get( &ptimer->time ); 400061f0: 90 04 20 6c add %l0, 0x6c, %o0 * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) *ovalue = ptimer->timer_data; ptimer->timer_data = normalize; 400061f4: c2 24 20 54 st %g1, [ %l0 + 0x54 ] 400061f8: c2 07 bf e8 ld [ %fp + -24 ], %g1 400061fc: c2 24 20 58 st %g1, [ %l0 + 0x58 ] 40006200: c2 07 bf ec ld [ %fp + -20 ], %g1 40006204: c2 24 20 5c st %g1, [ %l0 + 0x5c ] 40006208: c2 07 bf f0 ld [ %fp + -16 ], %g1 4000620c: c2 24 20 60 st %g1, [ %l0 + 0x60 ] /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40006210: 82 10 20 03 mov 3, %g1 _TOD_Get( &ptimer->time ); 40006214: 40 00 06 65 call 40007ba8 <_TOD_Get> 40006218: c2 2c 20 3c stb %g1, [ %l0 + 0x3c ] _Thread_Enable_dispatch(); 4000621c: 40 00 0c 4a call 40009344 <_Thread_Enable_dispatch> 40006220: b0 10 20 00 clr %i0 return 0; 40006224: 81 c7 e0 08 ret 40006228: 81 e8 00 00 restore normalize = *value; /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); 4000622c: a0 07 bf f4 add %fp, -12, %l0 40006230: 40 00 06 5e call 40007ba8 <_TOD_Get> 40006234: 90 10 00 10 mov %l0, %o0 /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 40006238: b2 07 bf ec add %fp, -20, %i1 4000623c: 90 10 00 10 mov %l0, %o0 40006240: 40 00 0f 6f call 40009ffc <_Timespec_Greater_than> 40006244: 92 10 00 19 mov %i1, %o1 40006248: 80 8a 20 ff btst 0xff, %o0 4000624c: 12 80 00 31 bne 40006310 40006250: 90 10 00 10 mov %l0, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 40006254: 92 10 00 19 mov %i1, %o1 40006258: 40 00 0f 8c call 4000a088 <_Timespec_Subtract> 4000625c: 94 10 00 19 mov %i1, %o2 40006260: 92 10 00 18 mov %i0, %o1 40006264: 11 10 00 7d sethi %hi(0x4001f400), %o0 40006268: 94 07 bf fc add %fp, -4, %o2 4000626c: 40 00 09 28 call 4000870c <_Objects_Get> 40006270: 90 12 20 a0 or %o0, 0xa0, %o0 * something with the structure of times of the timer: to stop, start * or start it again */ ptimer = _POSIX_Timer_Get( timerid, &location ); switch ( location ) { 40006274: c2 07 bf fc ld [ %fp + -4 ], %g1 40006278: 80 a0 60 00 cmp %g1, 0 4000627c: 02 bf ff bc be 4000616c 40006280: a0 10 00 08 mov %o0, %l0 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 40006284: 40 00 27 4a call 4000ffac <__errno> 40006288: b0 10 3f ff mov -1, %i0 4000628c: 82 10 20 16 mov 0x16, %g1 40006290: c2 22 00 00 st %g1, [ %o0 ] } 40006294: 81 c7 e0 08 ret 40006298: 81 e8 00 00 restore case OBJECTS_LOCAL: /* First, it verifies if the timer must be stopped */ if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) { /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 4000629c: 40 00 10 da call 4000a604 <_Watchdog_Remove> 400062a0: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 400062a4: 80 a6 e0 00 cmp %i3, 0 400062a8: 02 80 00 0b be 400062d4 400062ac: c2 07 bf e4 ld [ %fp + -28 ], %g1 *ovalue = ptimer->timer_data; 400062b0: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 400062b4: c2 26 c0 00 st %g1, [ %i3 ] 400062b8: c2 04 20 58 ld [ %l0 + 0x58 ], %g1 400062bc: c2 26 e0 04 st %g1, [ %i3 + 4 ] 400062c0: c2 04 20 5c ld [ %l0 + 0x5c ], %g1 400062c4: c2 26 e0 08 st %g1, [ %i3 + 8 ] 400062c8: c2 04 20 60 ld [ %l0 + 0x60 ], %g1 400062cc: c2 26 e0 0c st %g1, [ %i3 + 0xc ] /* The new data are set */ ptimer->timer_data = normalize; 400062d0: c2 07 bf e4 ld [ %fp + -28 ], %g1 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; /* Returns with success */ _Thread_Enable_dispatch(); return 0; 400062d4: b0 10 20 00 clr %i0 (void) _Watchdog_Remove( &ptimer->Timer ); /* The old data of the timer are returned */ if ( ovalue ) *ovalue = ptimer->timer_data; /* The new data are set */ ptimer->timer_data = normalize; 400062d8: c2 24 20 54 st %g1, [ %l0 + 0x54 ] 400062dc: c2 07 bf e8 ld [ %fp + -24 ], %g1 400062e0: c2 24 20 58 st %g1, [ %l0 + 0x58 ] 400062e4: c2 07 bf ec ld [ %fp + -20 ], %g1 400062e8: c2 24 20 5c st %g1, [ %l0 + 0x5c ] 400062ec: c2 07 bf f0 ld [ %fp + -16 ], %g1 400062f0: c2 24 20 60 st %g1, [ %l0 + 0x60 ] /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 400062f4: 82 10 20 04 mov 4, %g1 /* Returns with success */ _Thread_Enable_dispatch(); 400062f8: 40 00 0c 13 call 40009344 <_Thread_Enable_dispatch> 400062fc: c2 2c 20 3c stb %g1, [ %l0 + 0x3c ] return 0; 40006300: 81 c7 e0 08 ret 40006304: 81 e8 00 00 restore } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40006308: 22 bf ff 87 be,a 40006124 4000630c: c8 06 80 00 ld [ %i2 ], %g4 if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) rtems_set_errno_and_return_minus_one( EINVAL ); 40006310: 40 00 27 27 call 4000ffac <__errno> 40006314: b0 10 3f ff mov -1, %i0 40006318: 82 10 20 16 mov 0x16, %g1 4000631c: c2 22 00 00 st %g1, [ %o0 ] 40006320: 81 c7 e0 08 ret 40006324: 81 e8 00 00 restore =============================================================================== 40005ef0 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 40005ef0: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 40005ef4: 21 10 00 63 sethi %hi(0x40018c00), %l0 40005ef8: a0 14 23 f8 or %l0, 0x3f8, %l0 ! 40018ff8 <_POSIX_signals_Ualarm_timer> 40005efc: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40005f00: 80 a0 60 00 cmp %g1, 0 40005f04: 02 80 00 25 be 40005f98 40005f08: a2 10 00 18 mov %i0, %l1 _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 40005f0c: 40 00 10 90 call 4000a14c <_Watchdog_Remove> 40005f10: 90 10 00 10 mov %l0, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 40005f14: 90 02 3f fe add %o0, -2, %o0 40005f18: 80 a2 20 01 cmp %o0, 1 40005f1c: 08 80 00 27 bleu 40005fb8 <== ALWAYS TAKEN 40005f20: b0 10 20 00 clr %i0 /* * 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 ) { 40005f24: 80 a4 60 00 cmp %l1, 0 40005f28: 02 80 00 1a be 40005f90 40005f2c: 25 00 03 d0 sethi %hi(0xf4000), %l2 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40005f30: 90 10 00 11 mov %l1, %o0 40005f34: 40 00 3a 66 call 400148cc <.udiv> 40005f38: 92 14 a2 40 or %l2, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005f3c: 92 14 a2 40 or %l2, 0x240, %o1 * 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; 40005f40: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005f44: 40 00 3b 0e call 40014b7c <.urem> 40005f48: 90 10 00 11 mov %l1, %o0 40005f4c: 87 2a 20 07 sll %o0, 7, %g3 40005f50: 82 10 00 08 mov %o0, %g1 40005f54: 85 2a 20 02 sll %o0, 2, %g2 40005f58: 84 20 c0 02 sub %g3, %g2, %g2 40005f5c: 82 00 80 01 add %g2, %g1, %g1 40005f60: 83 28 60 03 sll %g1, 3, %g1 ticks = _Timespec_To_ticks( &tp ); 40005f64: a2 07 bf f8 add %fp, -8, %l1 */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005f68: c2 27 bf fc st %g1, [ %fp + -4 ] ticks = _Timespec_To_ticks( &tp ); 40005f6c: 40 00 0e ff call 40009b68 <_Timespec_To_ticks> 40005f70: 90 10 00 11 mov %l1, %o0 if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 40005f74: 40 00 0e fd call 40009b68 <_Timespec_To_ticks> 40005f78: 90 10 00 11 mov %l1, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40005f7c: 92 10 00 10 mov %l0, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40005f80: d0 24 20 0c st %o0, [ %l0 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40005f84: 11 10 00 61 sethi %hi(0x40018400), %o0 40005f88: 40 00 10 06 call 40009fa0 <_Watchdog_Insert> 40005f8c: 90 12 23 b0 or %o0, 0x3b0, %o0 ! 400187b0 <_Watchdog_Ticks_chain> } return remaining; } 40005f90: 81 c7 e0 08 ret 40005f94: 81 e8 00 00 restore Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40005f98: 03 10 00 17 sethi %hi(0x40005c00), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40005f9c: c0 24 20 08 clr [ %l0 + 8 ] the_watchdog->routine = routine; 40005fa0: 82 10 62 c0 or %g1, 0x2c0, %g1 the_watchdog->id = id; 40005fa4: c0 24 20 20 clr [ %l0 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40005fa8: c2 24 20 1c st %g1, [ %l0 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 40005fac: c0 24 20 24 clr [ %l0 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 40005fb0: 10 bf ff dd b 40005f24 40005fb4: b0 10 20 00 clr %i0 * 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); 40005fb8: c4 04 20 0c ld [ %l0 + 0xc ], %g2 40005fbc: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40005fc0: d0 04 20 14 ld [ %l0 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40005fc4: 92 07 bf f8 add %fp, -8, %o1 * 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); 40005fc8: 90 02 00 02 add %o0, %g2, %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40005fcc: 40 00 0e bc call 40009abc <_Timespec_From_ticks> 40005fd0: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40005fd4: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 40005fd8: d0 07 bf fc ld [ %fp + -4 ], %o0 ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40005fdc: 85 28 60 03 sll %g1, 3, %g2 40005fe0: 87 28 60 08 sll %g1, 8, %g3 40005fe4: 84 20 c0 02 sub %g3, %g2, %g2 remaining += tp.tv_nsec / 1000; 40005fe8: 92 10 23 e8 mov 0x3e8, %o1 ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40005fec: b1 28 a0 06 sll %g2, 6, %i0 40005ff0: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 40005ff4: 40 00 3a 38 call 400148d4 <.div> 40005ff8: b0 06 00 01 add %i0, %g1, %i0 ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40005ffc: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 40006000: 10 bf ff c9 b 40005f24 40006004: b0 02 00 18 add %o0, %i0, %i0