=============================================================================== 40008f58 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 40008f58: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 40008f5c: 03 10 00 66 sethi %hi(0x40019800), %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 ); 40008f60: 7f ff e9 91 call 400035a4 40008f64: e0 00 63 64 ld [ %g1 + 0x364 ], %l0 ! 40019b64 <_Per_CPU_Information+0xc> 40008f68: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 40008f6c: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 40008f70: 80 a0 60 00 cmp %g1, 0 40008f74: 12 80 00 08 bne 40008f94 <_CORE_RWLock_Release+0x3c> 40008f78: 80 a0 60 01 cmp %g1, 1 _ISR_Enable( level ); 40008f7c: 7f ff e9 8e call 400035b4 40008f80: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 40008f84: 82 10 20 02 mov 2, %g1 40008f88: c2 24 20 34 st %g1, [ %l0 + 0x34 ] 40008f8c: 81 c7 e0 08 ret 40008f90: 81 e8 00 00 restore return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 40008f94: 32 80 00 0b bne,a 40008fc0 <_CORE_RWLock_Release+0x68> 40008f98: c0 24 20 34 clr [ %l0 + 0x34 ] the_rwlock->number_of_readers -= 1; 40008f9c: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40008fa0: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 40008fa4: 80 a0 60 00 cmp %g1, 0 40008fa8: 02 80 00 05 be 40008fbc <_CORE_RWLock_Release+0x64> 40008fac: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 40008fb0: 7f ff e9 81 call 400035b4 40008fb4: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 40008fb8: 30 80 00 24 b,a 40009048 <_CORE_RWLock_Release+0xf0> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 40008fbc: 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; 40008fc0: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 40008fc4: 7f ff e9 7c call 400035b4 40008fc8: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 40008fcc: 40 00 06 d5 call 4000ab20 <_Thread_queue_Dequeue> 40008fd0: 90 10 00 18 mov %i0, %o0 if ( next ) { 40008fd4: 80 a2 20 00 cmp %o0, 0 40008fd8: 22 80 00 1c be,a 40009048 <_CORE_RWLock_Release+0xf0> 40008fdc: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 40008fe0: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 40008fe4: 80 a0 60 01 cmp %g1, 1 40008fe8: 32 80 00 05 bne,a 40008ffc <_CORE_RWLock_Release+0xa4> 40008fec: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 40008ff0: 82 10 20 02 mov 2, %g1 return CORE_RWLOCK_SUCCESSFUL; 40008ff4: 10 80 00 14 b 40009044 <_CORE_RWLock_Release+0xec> 40008ff8: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 40008ffc: 82 00 60 01 inc %g1 40009000: c2 26 20 48 st %g1, [ %i0 + 0x48 ] the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 40009004: 82 10 20 01 mov 1, %g1 40009008: c2 26 20 44 st %g1, [ %i0 + 0x44 ] /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); 4000900c: 40 00 08 0d call 4000b040 <_Thread_queue_First> 40009010: 90 10 00 18 mov %i0, %o0 if ( !next || 40009014: 92 92 20 00 orcc %o0, 0, %o1 40009018: 22 80 00 0c be,a 40009048 <_CORE_RWLock_Release+0xf0> 4000901c: b0 10 20 00 clr %i0 40009020: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 40009024: 80 a0 60 01 cmp %g1, 1 40009028: 02 80 00 07 be 40009044 <_CORE_RWLock_Release+0xec> <== NEVER TAKEN 4000902c: 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; 40009030: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40009034: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 40009038: 40 00 07 b2 call 4000af00 <_Thread_queue_Extract> 4000903c: c2 26 20 48 st %g1, [ %i0 + 0x48 ] } 40009040: 30 bf ff f3 b,a 4000900c <_CORE_RWLock_Release+0xb4> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 40009044: b0 10 20 00 clr %i0 40009048: 81 c7 e0 08 ret 4000904c: 81 e8 00 00 restore =============================================================================== 40009050 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 40009050: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009054: 90 10 00 18 mov %i0, %o0 40009058: 40 00 05 e4 call 4000a7e8 <_Thread_Get> 4000905c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009060: c2 07 bf fc ld [ %fp + -4 ], %g1 40009064: 80 a0 60 00 cmp %g1, 0 40009068: 12 80 00 08 bne 40009088 <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 4000906c: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40009070: 40 00 08 37 call 4000b14c <_Thread_queue_Process_timeout> 40009074: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40009078: 03 10 00 65 sethi %hi(0x40019400), %g1 4000907c: c4 00 62 00 ld [ %g1 + 0x200 ], %g2 ! 40019600 <_Thread_Dispatch_disable_level> 40009080: 84 00 bf ff add %g2, -1, %g2 40009084: c4 20 62 00 st %g2, [ %g1 + 0x200 ] 40009088: 81 c7 e0 08 ret 4000908c: 81 e8 00 00 restore =============================================================================== 40017088 <_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 ) { 40017088: 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 ) { 4001708c: 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 ) { 40017090: 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 ) { 40017094: 80 a6 80 01 cmp %i2, %g1 40017098: 18 80 00 16 bgu 400170f0 <_CORE_message_queue_Broadcast+0x68><== NEVER TAKEN 4001709c: 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 ) { 400170a0: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 400170a4: 80 a0 60 00 cmp %g1, 0 400170a8: 02 80 00 0b be 400170d4 <_CORE_message_queue_Broadcast+0x4c> 400170ac: a2 10 20 00 clr %l1 *count = 0; 400170b0: c0 27 40 00 clr [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 400170b4: 81 c7 e0 08 ret 400170b8: 91 e8 20 00 restore %g0, 0, %o0 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 400170bc: 92 10 00 19 mov %i1, %o1 400170c0: 40 00 24 a9 call 40020364 400170c4: 94 10 00 1a mov %i2, %o2 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 400170c8: c2 04 a0 28 ld [ %l2 + 0x28 ], %g1 */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 400170cc: a2 04 60 01 inc %l1 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 400170d0: 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 = 400170d4: 40 00 0b 23 call 40019d60 <_Thread_queue_Dequeue> 400170d8: 90 10 00 10 mov %l0, %o0 400170dc: a4 92 20 00 orcc %o0, 0, %l2 400170e0: 32 bf ff f7 bne,a 400170bc <_CORE_message_queue_Broadcast+0x34> 400170e4: d0 04 a0 2c ld [ %l2 + 0x2c ], %o0 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 400170e8: e2 27 40 00 st %l1, [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 400170ec: b0 10 20 00 clr %i0 } 400170f0: 81 c7 e0 08 ret 400170f4: 81 e8 00 00 restore =============================================================================== 4000f96c <_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 ) { 4000f96c: 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; 4000f970: f4 26 20 44 st %i2, [ %i0 + 0x44 ] the_message_queue->number_of_pending_messages = 0; 4000f974: c0 26 20 48 clr [ %i0 + 0x48 ] the_message_queue->maximum_message_size = maximum_message_size; 4000f978: 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; 4000f97c: c0 26 20 60 clr [ %i0 + 0x60 ] the_message_queue->notify_argument = the_argument; 4000f980: 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 ) { 4000f984: 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)) { 4000f988: 80 8e e0 03 btst 3, %i3 4000f98c: 02 80 00 07 be 4000f9a8 <_CORE_message_queue_Initialize+0x3c> 4000f990: a4 10 00 1b mov %i3, %l2 allocated_message_size += sizeof(uint32_t); 4000f994: a4 06 e0 04 add %i3, 4, %l2 allocated_message_size &= ~(sizeof(uint32_t) - 1); 4000f998: a4 0c bf fc and %l2, -4, %l2 } if (allocated_message_size < maximum_message_size) 4000f99c: 80 a4 80 1b cmp %l2, %i3 4000f9a0: 0a 80 00 22 bcs 4000fa28 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 4000f9a4: 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)); 4000f9a8: 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 * 4000f9ac: 92 10 00 1a mov %i2, %o1 4000f9b0: 90 10 00 11 mov %l1, %o0 4000f9b4: 40 00 41 5c call 4001ff24 <.umul> 4000f9b8: b0 10 20 00 clr %i0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 4000f9bc: 80 a2 00 12 cmp %o0, %l2 4000f9c0: 0a 80 00 1a bcs 4000fa28 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 4000f9c4: 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 ); 4000f9c8: 40 00 0b ff call 400129c4 <_Workspace_Allocate> 4000f9cc: 01 00 00 00 nop return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 4000f9d0: d0 24 20 5c st %o0, [ %l0 + 0x5c ] _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 4000f9d4: 80 a2 20 00 cmp %o0, 0 4000f9d8: 02 80 00 14 be 4000fa28 <_CORE_message_queue_Initialize+0xbc> 4000f9dc: 92 10 00 08 mov %o0, %o1 /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 4000f9e0: 90 04 20 68 add %l0, 0x68, %o0 4000f9e4: 94 10 00 1a mov %i2, %o2 4000f9e8: 40 00 16 38 call 400152c8 <_Chain_Initialize> 4000f9ec: 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 ); Chain_Node *tail = _Chain_Tail( the_chain ); 4000f9f0: 82 04 20 54 add %l0, 0x54, %g1 head->next = tail; 4000f9f4: c2 24 20 50 st %g1, [ %l0 + 0x50 ] */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 4000f9f8: 82 04 20 50 add %l0, 0x50, %g1 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 4000f9fc: c0 24 20 54 clr [ %l0 + 0x54 ] tail->previous = head; 4000fa00: c2 24 20 58 st %g1, [ %l0 + 0x58 ] allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 4000fa04: c2 06 40 00 ld [ %i1 ], %g1 4000fa08: 90 10 00 10 mov %l0, %o0 4000fa0c: 82 18 60 01 xor %g1, 1, %g1 4000fa10: 80 a0 00 01 cmp %g0, %g1 4000fa14: 94 10 20 80 mov 0x80, %o2 4000fa18: 92 60 3f ff subx %g0, -1, %o1 4000fa1c: 96 10 20 06 mov 6, %o3 4000fa20: 40 00 09 48 call 40011f40 <_Thread_queue_Initialize> 4000fa24: b0 10 20 01 mov 1, %i0 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 4000fa28: 81 c7 e0 08 ret 4000fa2c: 81 e8 00 00 restore =============================================================================== 4000fa30 <_CORE_message_queue_Seize>: void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4000fa30: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 4000fa34: 27 10 00 98 sethi %hi(0x40026000), %l3 4000fa38: a6 14 e1 48 or %l3, 0x148, %l3 ! 40026148 <_Per_CPU_Information> 4000fa3c: e4 04 e0 0c ld [ %l3 + 0xc ], %l2 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4000fa40: a0 10 00 18 mov %i0, %l0 ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 4000fa44: c0 24 a0 34 clr [ %l2 + 0x34 ] _ISR_Disable( level ); 4000fa48: 7f ff de 19 call 400072ac 4000fa4c: a2 10 00 19 mov %i1, %l1 4000fa50: 82 10 00 08 mov %o0, %g1 executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4000fa54: f2 06 20 50 ld [ %i0 + 0x50 ], %i1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000fa58: 84 06 20 54 add %i0, 0x54, %g2 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 4000fa5c: 80 a6 40 02 cmp %i1, %g2 4000fa60: 02 80 00 24 be 4000faf0 <_CORE_message_queue_Seize+0xc0> 4000fa64: 86 06 20 50 add %i0, 0x50, %g3 Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; 4000fa68: c4 06 40 00 ld [ %i1 ], %g2 head->next = new_first; 4000fa6c: c4 26 20 50 st %g2, [ %i0 + 0x50 ] executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; _ISR_Disable( level ); the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { 4000fa70: 80 a6 60 00 cmp %i1, 0 4000fa74: 02 80 00 1f be 4000faf0 <_CORE_message_queue_Seize+0xc0> <== NEVER TAKEN 4000fa78: c6 20 a0 04 st %g3, [ %g2 + 4 ] the_message_queue->number_of_pending_messages -= 1; 4000fa7c: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 4000fa80: 82 00 7f ff add %g1, -1, %g1 4000fa84: c2 26 20 48 st %g1, [ %i0 + 0x48 ] _ISR_Enable( level ); 4000fa88: 7f ff de 0d call 400072bc 4000fa8c: a2 06 60 10 add %i1, 0x10, %l1 *size_p = the_message->Contents.size; 4000fa90: d4 06 60 0c ld [ %i1 + 0xc ], %o2 _Thread_Executing->Wait.count = 4000fa94: c2 04 e0 0c ld [ %l3 + 0xc ], %g1 the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; _ISR_Enable( level ); *size_p = the_message->Contents.size; 4000fa98: d4 26 c0 00 st %o2, [ %i3 ] _Thread_Executing->Wait.count = 4000fa9c: c4 06 60 08 ld [ %i1 + 8 ], %g2 4000faa0: c4 20 60 24 st %g2, [ %g1 + 0x24 ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4000faa4: 92 10 00 11 mov %l1, %o1 4000faa8: 40 00 22 06 call 400182c0 4000faac: 90 10 00 1a mov %i2, %o0 * is not, then we can go ahead and free the buffer. * * NOTE: If we note that the queue was not full before this receive, * then we can avoid this dequeue. */ the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 4000fab0: 40 00 08 17 call 40011b0c <_Thread_queue_Dequeue> 4000fab4: 90 10 00 18 mov %i0, %o0 if ( !the_thread ) { 4000fab8: 82 92 20 00 orcc %o0, 0, %g1 4000fabc: 32 80 00 04 bne,a 4000facc <_CORE_message_queue_Seize+0x9c> 4000fac0: c4 00 60 24 ld [ %g1 + 0x24 ], %g2 RTEMS_INLINE_ROUTINE void _CORE_message_queue_Free_message_buffer ( CORE_message_queue_Control *the_message_queue, CORE_message_queue_Buffer_control *the_message ) { _Chain_Append( &the_message_queue->Inactive_messages, &the_message->Node ); 4000fac4: 7f ff ff 7a call 4000f8ac <_Chain_Append> 4000fac8: 91 ee 20 68 restore %i0, 0x68, %o0 */ _CORE_message_queue_Set_message_priority( the_message, the_thread->Wait.count ); the_message->Contents.size = (size_t) the_thread->Wait.option; 4000facc: d4 00 60 30 ld [ %g1 + 0x30 ], %o2 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4000fad0: d2 00 60 2c ld [ %g1 + 0x2c ], %o1 CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 4000fad4: c4 26 60 08 st %g2, [ %i1 + 8 ] 4000fad8: d4 26 60 0c st %o2, [ %i1 + 0xc ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4000fadc: 40 00 21 f9 call 400182c0 4000fae0: 90 10 00 11 mov %l1, %o0 the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 4000fae4: f4 06 60 08 ld [ %i1 + 8 ], %i2 4000fae8: 40 00 16 06 call 40015300 <_CORE_message_queue_Insert_message> 4000faec: 81 e8 00 00 restore return; } #endif } if ( !wait ) { 4000faf0: 80 8f 20 ff btst 0xff, %i4 4000faf4: 32 80 00 08 bne,a 4000fb14 <_CORE_message_queue_Seize+0xe4> 4000faf8: 84 10 20 01 mov 1, %g2 _ISR_Enable( level ); 4000fafc: 7f ff dd f0 call 400072bc 4000fb00: 90 10 00 01 mov %g1, %o0 executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 4000fb04: 82 10 20 04 mov 4, %g1 4000fb08: c2 24 a0 34 st %g1, [ %l2 + 0x34 ] executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 4000fb0c: 81 c7 e0 08 ret 4000fb10: 81 e8 00 00 restore 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; 4000fb14: c4 24 20 30 st %g2, [ %l0 + 0x30 ] executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; 4000fb18: e0 24 a0 44 st %l0, [ %l2 + 0x44 ] executing->Wait.id = id; 4000fb1c: e2 24 a0 20 st %l1, [ %l2 + 0x20 ] executing->Wait.return_argument_second.mutable_object = buffer; 4000fb20: f4 24 a0 2c st %i2, [ %l2 + 0x2c ] executing->Wait.return_argument = size_p; 4000fb24: f6 24 a0 28 st %i3, [ %l2 + 0x28 ] /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 4000fb28: 90 10 00 01 mov %g1, %o0 4000fb2c: 7f ff dd e4 call 400072bc 4000fb30: 35 10 00 48 sethi %hi(0x40012000), %i2 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 4000fb34: b0 10 00 10 mov %l0, %i0 4000fb38: b2 10 00 1d mov %i5, %i1 4000fb3c: 40 00 08 57 call 40011c98 <_Thread_queue_Enqueue_with_handler> 4000fb40: 95 ee a0 20 restore %i2, 0x20, %o2 =============================================================================== 400067e8 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 400067e8: 9d e3 bf a0 save %sp, -96, %sp _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 400067ec: 03 10 00 55 sethi %hi(0x40015400), %g1 400067f0: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 ! 400154e0 <_Thread_Dispatch_disable_level> 400067f4: 80 a0 60 00 cmp %g1, 0 400067f8: 02 80 00 0d be 4000682c <_CORE_mutex_Seize+0x44> 400067fc: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40006800: 80 8e a0 ff btst 0xff, %i2 40006804: 02 80 00 0b be 40006830 <_CORE_mutex_Seize+0x48> <== NEVER TAKEN 40006808: 90 10 00 18 mov %i0, %o0 4000680c: 03 10 00 55 sethi %hi(0x40015400), %g1 40006810: c2 00 62 58 ld [ %g1 + 0x258 ], %g1 ! 40015658 <_System_state_Current> 40006814: 80 a0 60 01 cmp %g1, 1 40006818: 08 80 00 05 bleu 4000682c <_CORE_mutex_Seize+0x44> 4000681c: 90 10 20 00 clr %o0 40006820: 92 10 20 00 clr %o1 40006824: 40 00 01 dd call 40006f98 <_Internal_error_Occurred> 40006828: 94 10 20 12 mov 0x12, %o2 4000682c: 90 10 00 18 mov %i0, %o0 40006830: 40 00 15 29 call 4000bcd4 <_CORE_mutex_Seize_interrupt_trylock> 40006834: 92 07 a0 54 add %fp, 0x54, %o1 40006838: 80 a2 20 00 cmp %o0, 0 4000683c: 02 80 00 0a be 40006864 <_CORE_mutex_Seize+0x7c> 40006840: 80 8e a0 ff btst 0xff, %i2 40006844: 35 10 00 56 sethi %hi(0x40015800), %i2 40006848: 12 80 00 09 bne 4000686c <_CORE_mutex_Seize+0x84> 4000684c: b4 16 a2 38 or %i2, 0x238, %i2 ! 40015a38 <_Per_CPU_Information> 40006850: 7f ff ed 16 call 40001ca8 40006854: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40006858: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 4000685c: 84 10 20 01 mov 1, %g2 40006860: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 40006864: 81 c7 e0 08 ret 40006868: 81 e8 00 00 restore 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; 4000686c: 82 10 20 01 mov 1, %g1 40006870: c2 26 20 30 st %g1, [ %i0 + 0x30 ] 40006874: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 40006878: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 4000687c: f2 20 60 20 st %i1, [ %g1 + 0x20 ] 40006880: 03 10 00 55 sethi %hi(0x40015400), %g1 40006884: c4 00 60 e0 ld [ %g1 + 0xe0 ], %g2 ! 400154e0 <_Thread_Dispatch_disable_level> 40006888: 84 00 a0 01 inc %g2 4000688c: c4 20 60 e0 st %g2, [ %g1 + 0xe0 ] 40006890: 7f ff ed 06 call 40001ca8 40006894: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40006898: 90 10 00 18 mov %i0, %o0 4000689c: 7f ff ff ba call 40006784 <_CORE_mutex_Seize_interrupt_blocking> 400068a0: 92 10 00 1b mov %i3, %o1 400068a4: 81 c7 e0 08 ret 400068a8: 81 e8 00 00 restore =============================================================================== 40006a28 <_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 ) { 40006a28: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 40006a2c: 90 10 00 18 mov %i0, %o0 40006a30: 40 00 06 b2 call 400084f8 <_Thread_queue_Dequeue> 40006a34: a0 10 00 18 mov %i0, %l0 40006a38: 80 a2 20 00 cmp %o0, 0 40006a3c: 12 80 00 0e bne 40006a74 <_CORE_semaphore_Surrender+0x4c> 40006a40: b0 10 20 00 clr %i0 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 40006a44: 7f ff ec 95 call 40001c98 40006a48: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 40006a4c: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40006a50: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 40006a54: 80 a0 40 02 cmp %g1, %g2 40006a58: 1a 80 00 05 bcc 40006a6c <_CORE_semaphore_Surrender+0x44> <== NEVER TAKEN 40006a5c: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 40006a60: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 40006a64: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 40006a68: c2 24 20 48 st %g1, [ %l0 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 40006a6c: 7f ff ec 8f call 40001ca8 40006a70: 01 00 00 00 nop } return status; } 40006a74: 81 c7 e0 08 ret 40006a78: 81 e8 00 00 restore =============================================================================== 40005768 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 40005768: 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 ]; 4000576c: e2 06 21 54 ld [ %i0 + 0x154 ], %l1 option_set = (rtems_option) the_thread->Wait.option; 40005770: e4 06 20 30 ld [ %i0 + 0x30 ], %l2 _ISR_Disable( level ); 40005774: 7f ff f1 49 call 40001c98 40005778: a0 10 00 18 mov %i0, %l0 4000577c: b0 10 00 08 mov %o0, %i0 pending_events = api->pending_events; 40005780: c4 04 40 00 ld [ %l1 ], %g2 event_condition = (rtems_event_set) the_thread->Wait.count; 40005784: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { 40005788: 82 88 c0 02 andcc %g3, %g2, %g1 4000578c: 12 80 00 03 bne 40005798 <_Event_Surrender+0x30> 40005790: 09 10 00 56 sethi %hi(0x40015800), %g4 _ISR_Enable( level ); 40005794: 30 80 00 42 b,a 4000589c <_Event_Surrender+0x134> /* * 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() && 40005798: 88 11 22 38 or %g4, 0x238, %g4 ! 40015a38 <_Per_CPU_Information> 4000579c: da 01 20 08 ld [ %g4 + 8 ], %o5 400057a0: 80 a3 60 00 cmp %o5, 0 400057a4: 22 80 00 1d be,a 40005818 <_Event_Surrender+0xb0> 400057a8: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 400057ac: c8 01 20 0c ld [ %g4 + 0xc ], %g4 400057b0: 80 a4 00 04 cmp %l0, %g4 400057b4: 32 80 00 19 bne,a 40005818 <_Event_Surrender+0xb0> 400057b8: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 400057bc: 09 10 00 57 sethi %hi(0x40015c00), %g4 400057c0: da 01 22 30 ld [ %g4 + 0x230 ], %o5 ! 40015e30 <_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 ) && 400057c4: 80 a3 60 02 cmp %o5, 2 400057c8: 02 80 00 07 be 400057e4 <_Event_Surrender+0x7c> <== NEVER TAKEN 400057cc: 80 a0 40 03 cmp %g1, %g3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 400057d0: c8 01 22 30 ld [ %g4 + 0x230 ], %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() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 400057d4: 80 a1 20 01 cmp %g4, 1 400057d8: 32 80 00 10 bne,a 40005818 <_Event_Surrender+0xb0> 400057dc: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { 400057e0: 80 a0 40 03 cmp %g1, %g3 400057e4: 02 80 00 04 be 400057f4 <_Event_Surrender+0x8c> 400057e8: 80 8c a0 02 btst 2, %l2 400057ec: 02 80 00 0a be 40005814 <_Event_Surrender+0xac> <== NEVER TAKEN 400057f0: 01 00 00 00 nop 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) ); 400057f4: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 400057f8: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 400057fc: c4 04 20 28 ld [ %l0 + 0x28 ], %g2 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; 40005800: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005804: c2 20 80 00 st %g1, [ %g2 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 40005808: 84 10 20 03 mov 3, %g2 4000580c: 03 10 00 57 sethi %hi(0x40015c00), %g1 40005810: c4 20 62 30 st %g2, [ %g1 + 0x230 ] ! 40015e30 <_Event_Sync_state> } _ISR_Enable( level ); 40005814: 30 80 00 22 b,a 4000589c <_Event_Surrender+0x134> } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 40005818: 80 89 21 00 btst 0x100, %g4 4000581c: 02 80 00 20 be 4000589c <_Event_Surrender+0x134> 40005820: 80 a0 40 03 cmp %g1, %g3 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 40005824: 02 80 00 04 be 40005834 <_Event_Surrender+0xcc> 40005828: 80 8c a0 02 btst 2, %l2 4000582c: 02 80 00 1c be 4000589c <_Event_Surrender+0x134> <== NEVER TAKEN 40005830: 01 00 00 00 nop 40005834: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 40005838: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 4000583c: c4 04 20 28 ld [ %l0 + 0x28 ], %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 ); the_thread->Wait.count = 0; 40005840: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005844: c2 20 80 00 st %g1, [ %g2 ] _ISR_Flash( level ); 40005848: 7f ff f1 18 call 40001ca8 4000584c: 90 10 00 18 mov %i0, %o0 40005850: 7f ff f1 12 call 40001c98 40005854: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 40005858: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 4000585c: 80 a0 60 02 cmp %g1, 2 40005860: 02 80 00 06 be 40005878 <_Event_Surrender+0x110> 40005864: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 40005868: 7f ff f1 10 call 40001ca8 4000586c: 90 10 00 18 mov %i0, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40005870: 10 80 00 08 b 40005890 <_Event_Surrender+0x128> 40005874: 33 04 00 ff sethi %hi(0x1003fc00), %i1 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 40005878: c2 24 20 50 st %g1, [ %l0 + 0x50 ] _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 4000587c: 7f ff f1 0b call 40001ca8 40005880: 90 10 00 18 mov %i0, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 40005884: 40 00 0e 60 call 40009204 <_Watchdog_Remove> 40005888: 90 04 20 48 add %l0, 0x48, %o0 4000588c: 33 04 00 ff sethi %hi(0x1003fc00), %i1 40005890: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 40005894: 40 00 09 72 call 40007e5c <_Thread_Clear_state> 40005898: 91 e8 00 10 restore %g0, %l0, %o0 _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 4000589c: 7f ff f1 03 call 40001ca8 400058a0: 81 e8 00 00 restore =============================================================================== 400058a8 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 400058a8: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 400058ac: 90 10 00 18 mov %i0, %o0 400058b0: 40 00 0a 44 call 400081c0 <_Thread_Get> 400058b4: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 400058b8: c2 07 bf fc ld [ %fp + -4 ], %g1 400058bc: 80 a0 60 00 cmp %g1, 0 400058c0: 12 80 00 1c bne 40005930 <_Event_Timeout+0x88> <== NEVER TAKEN 400058c4: 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 ); 400058c8: 7f ff f0 f4 call 40001c98 400058cc: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 400058d0: 03 10 00 56 sethi %hi(0x40015800), %g1 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 400058d4: c2 00 62 44 ld [ %g1 + 0x244 ], %g1 ! 40015a44 <_Per_CPU_Information+0xc> 400058d8: 80 a4 00 01 cmp %l0, %g1 400058dc: 12 80 00 09 bne 40005900 <_Event_Timeout+0x58> 400058e0: c0 24 20 24 clr [ %l0 + 0x24 ] if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 400058e4: 03 10 00 57 sethi %hi(0x40015c00), %g1 400058e8: c4 00 62 30 ld [ %g1 + 0x230 ], %g2 ! 40015e30 <_Event_Sync_state> 400058ec: 80 a0 a0 01 cmp %g2, 1 400058f0: 32 80 00 05 bne,a 40005904 <_Event_Timeout+0x5c> 400058f4: 82 10 20 06 mov 6, %g1 _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 400058f8: 84 10 20 02 mov 2, %g2 400058fc: c4 20 62 30 st %g2, [ %g1 + 0x230 ] } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40005900: 82 10 20 06 mov 6, %g1 40005904: c2 24 20 34 st %g1, [ %l0 + 0x34 ] _ISR_Enable( level ); 40005908: 7f ff f0 e8 call 40001ca8 4000590c: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40005910: 90 10 00 10 mov %l0, %o0 40005914: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40005918: 40 00 09 51 call 40007e5c <_Thread_Clear_state> 4000591c: 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; 40005920: 03 10 00 55 sethi %hi(0x40015400), %g1 40005924: c4 00 60 e0 ld [ %g1 + 0xe0 ], %g2 ! 400154e0 <_Thread_Dispatch_disable_level> 40005928: 84 00 bf ff add %g2, -1, %g2 4000592c: c4 20 60 e0 st %g2, [ %g1 + 0xe0 ] 40005930: 81 c7 e0 08 ret 40005934: 81 e8 00 00 restore =============================================================================== 4000c350 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000c350: 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; 4000c354: c0 27 bf fc clr [ %fp + -4 ] Heap_Block *extend_last_block = NULL; 4000c358: 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 ) { 4000c35c: a0 10 00 18 mov %i0, %l0 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4000c360: 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; 4000c364: e6 06 20 10 ld [ %i0 + 0x10 ], %l3 uintptr_t const min_block_size = heap->min_block_size; 4000c368: 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; 4000c36c: a2 06 40 1a add %i1, %i2, %l1 uintptr_t const free_size = stats->free_size; 4000c370: e8 06 20 30 ld [ %i0 + 0x30 ], %l4 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000c374: 92 10 00 1a mov %i2, %o1 uintptr_t const free_size = stats->free_size; uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { 4000c378: 80 a4 40 19 cmp %l1, %i1 4000c37c: 0a 80 00 9f bcs 4000c5f8 <_Heap_Extend+0x2a8> 4000c380: b0 10 20 00 clr %i0 return false; } extend_area_ok = _Heap_Get_first_and_last_block( 4000c384: 90 10 00 19 mov %i1, %o0 4000c388: 94 10 00 13 mov %l3, %o2 4000c38c: 98 07 bf fc add %fp, -4, %o4 4000c390: 7f ff eb 1e call 40007008 <_Heap_Get_first_and_last_block> 4000c394: 9a 07 bf f8 add %fp, -8, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4000c398: 80 8a 20 ff btst 0xff, %o0 4000c39c: 02 80 00 97 be 4000c5f8 <_Heap_Extend+0x2a8> 4000c3a0: aa 10 00 12 mov %l2, %l5 4000c3a4: ba 10 20 00 clr %i5 4000c3a8: b8 10 20 00 clr %i4 4000c3ac: b0 10 20 00 clr %i0 4000c3b0: ae 10 20 00 clr %l7 4000c3b4: c2 04 20 18 ld [ %l0 + 0x18 ], %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 ( 4000c3b8: 80 a0 40 11 cmp %g1, %l1 4000c3bc: 1a 80 00 05 bcc 4000c3d0 <_Heap_Extend+0x80> 4000c3c0: ec 05 40 00 ld [ %l5 ], %l6 4000c3c4: 80 a6 40 16 cmp %i1, %l6 4000c3c8: 2a 80 00 8c bcs,a 4000c5f8 <_Heap_Extend+0x2a8> 4000c3cc: b0 10 20 00 clr %i0 sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { 4000c3d0: 80 a4 40 01 cmp %l1, %g1 4000c3d4: 02 80 00 06 be 4000c3ec <_Heap_Extend+0x9c> 4000c3d8: 80 a4 40 16 cmp %l1, %l6 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4000c3dc: 2a 80 00 05 bcs,a 4000c3f0 <_Heap_Extend+0xa0> 4000c3e0: b8 10 00 15 mov %l5, %i4 4000c3e4: 10 80 00 04 b 4000c3f4 <_Heap_Extend+0xa4> 4000c3e8: 90 10 00 16 mov %l6, %o0 4000c3ec: ae 10 00 15 mov %l5, %l7 4000c3f0: 90 10 00 16 mov %l6, %o0 4000c3f4: 40 00 17 88 call 40012214 <.urem> 4000c3f8: 92 10 00 13 mov %l3, %o1 4000c3fc: b4 05 bf f8 add %l6, -8, %i2 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000c400: 80 a5 80 19 cmp %l6, %i1 4000c404: 12 80 00 05 bne 4000c418 <_Heap_Extend+0xc8> 4000c408: 90 26 80 08 sub %i2, %o0, %o0 start_block->prev_size = extend_area_end; 4000c40c: e2 25 40 00 st %l1, [ %l5 ] RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_of_alloc_area( uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) 4000c410: 10 80 00 04 b 4000c420 <_Heap_Extend+0xd0> 4000c414: b0 10 00 08 mov %o0, %i0 merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4000c418: 2a 80 00 02 bcs,a 4000c420 <_Heap_Extend+0xd0> 4000c41c: ba 10 00 08 mov %o0, %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; 4000c420: ea 02 20 04 ld [ %o0 + 4 ], %l5 4000c424: aa 0d 7f fe and %l5, -2, %l5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000c428: aa 02 00 15 add %o0, %l5, %l5 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4000c42c: 80 a5 40 12 cmp %l5, %l2 4000c430: 12 bf ff e2 bne 4000c3b8 <_Heap_Extend+0x68> 4000c434: 82 10 00 15 mov %l5, %g1 if ( extend_area_begin < heap->area_begin ) { 4000c438: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000c43c: 80 a6 40 01 cmp %i1, %g1 4000c440: 3a 80 00 04 bcc,a 4000c450 <_Heap_Extend+0x100> 4000c444: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 4000c448: 10 80 00 05 b 4000c45c <_Heap_Extend+0x10c> 4000c44c: f2 24 20 18 st %i1, [ %l0 + 0x18 ] } else if ( heap->area_end < extend_area_end ) { 4000c450: 80 a0 40 11 cmp %g1, %l1 4000c454: 2a 80 00 02 bcs,a 4000c45c <_Heap_Extend+0x10c> 4000c458: 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; 4000c45c: c4 07 bf fc ld [ %fp + -4 ], %g2 4000c460: c2 07 bf f8 ld [ %fp + -8 ], %g1 extend_first_block->prev_size = extend_area_end; 4000c464: e2 20 80 00 st %l1, [ %g2 ] heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 4000c468: 86 20 40 02 sub %g1, %g2, %g3 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4000c46c: 88 10 e0 01 or %g3, 1, %g4 _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; 4000c470: c6 20 40 00 st %g3, [ %g1 ] 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 = 4000c474: c8 20 a0 04 st %g4, [ %g2 + 4 ] 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 ) { 4000c478: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 4000c47c: 80 a0 c0 02 cmp %g3, %g2 4000c480: 08 80 00 04 bleu 4000c490 <_Heap_Extend+0x140> 4000c484: c0 20 60 04 clr [ %g1 + 4 ] heap->first_block = extend_first_block; 4000c488: 10 80 00 06 b 4000c4a0 <_Heap_Extend+0x150> 4000c48c: c4 24 20 20 st %g2, [ %l0 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 4000c490: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 4000c494: 80 a0 80 01 cmp %g2, %g1 4000c498: 2a 80 00 02 bcs,a 4000c4a0 <_Heap_Extend+0x150> 4000c49c: c2 24 20 24 st %g1, [ %l0 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000c4a0: 80 a5 e0 00 cmp %l7, 0 4000c4a4: 02 80 00 14 be 4000c4f4 <_Heap_Extend+0x1a4> 4000c4a8: 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; 4000c4ac: 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; 4000c4b0: 92 10 00 12 mov %l2, %o1 4000c4b4: 40 00 17 58 call 40012214 <.urem> 4000c4b8: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 4000c4bc: 80 a2 20 00 cmp %o0, 0 4000c4c0: 02 80 00 04 be 4000c4d0 <_Heap_Extend+0x180> <== ALWAYS TAKEN 4000c4c4: c2 05 c0 00 ld [ %l7 ], %g1 return value - remainder + alignment; 4000c4c8: b2 06 40 12 add %i1, %l2, %i1 <== NOT EXECUTED 4000c4cc: 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 = 4000c4d0: 92 06 7f f8 add %i1, -8, %o1 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; 4000c4d4: c2 26 7f f8 st %g1, [ %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 = 4000c4d8: 82 25 c0 09 sub %l7, %o1, %g1 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; 4000c4dc: 82 10 60 01 or %g1, 1, %g1 _Heap_Free_block( heap, new_first_block ); 4000c4e0: 90 10 00 10 mov %l0, %o0 4000c4e4: 7f ff ff 90 call 4000c324 <_Heap_Free_block> 4000c4e8: c2 22 60 04 st %g1, [ %o1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000c4ec: 10 80 00 09 b 4000c510 <_Heap_Extend+0x1c0> 4000c4f0: 80 a6 20 00 cmp %i0, 0 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 ) { 4000c4f4: 80 a7 20 00 cmp %i4, 0 4000c4f8: 02 80 00 05 be 4000c50c <_Heap_Extend+0x1bc> 4000c4fc: c2 07 bf f8 ld [ %fp + -8 ], %g1 { 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; 4000c500: b8 27 00 01 sub %i4, %g1, %i4 4000c504: 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 = 4000c508: f8 20 60 04 st %i4, [ %g1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000c50c: 80 a6 20 00 cmp %i0, 0 4000c510: 02 80 00 15 be 4000c564 <_Heap_Extend+0x214> 4000c514: 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); 4000c518: 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( 4000c51c: a2 24 40 18 sub %l1, %i0, %l1 4000c520: 40 00 17 3d call 40012214 <.urem> 4000c524: 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) 4000c528: c4 06 20 04 ld [ %i0 + 4 ], %g2 4000c52c: a2 24 40 08 sub %l1, %o0, %l1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 4000c530: 82 04 40 18 add %l1, %i0, %g1 (last_block->size_and_flag - last_block_new_size) 4000c534: 84 20 80 11 sub %g2, %l1, %g2 | HEAP_PREV_BLOCK_USED; 4000c538: 84 10 a0 01 or %g2, 1, %g2 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 4000c53c: c4 20 60 04 st %g2, [ %g1 + 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; 4000c540: c2 06 20 04 ld [ %i0 + 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 ); 4000c544: 90 10 00 10 mov %l0, %o0 4000c548: 82 08 60 01 and %g1, 1, %g1 4000c54c: 92 10 00 18 mov %i0, %o1 block->size_and_flag = size | flag; 4000c550: a2 14 40 01 or %l1, %g1, %l1 4000c554: 7f ff ff 74 call 4000c324 <_Heap_Free_block> 4000c558: e2 26 20 04 st %l1, [ %i0 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000c55c: 10 80 00 0f b 4000c598 <_Heap_Extend+0x248> 4000c560: 80 a6 20 00 cmp %i0, 0 ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { 4000c564: 80 a7 60 00 cmp %i5, 0 4000c568: 02 80 00 0b be 4000c594 <_Heap_Extend+0x244> 4000c56c: c6 07 bf fc ld [ %fp + -4 ], %g3 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; 4000c570: c4 07 60 04 ld [ %i5 + 4 ], %g2 _Heap_Link_above( 4000c574: c2 07 bf f8 ld [ %fp + -8 ], %g1 ) { 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 ); 4000c578: 86 20 c0 1d sub %g3, %i5, %g3 4000c57c: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000c580: 84 10 c0 02 or %g3, %g2, %g2 4000c584: c4 27 60 04 st %g2, [ %i5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4000c588: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000c58c: 84 10 a0 01 or %g2, 1, %g2 4000c590: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000c594: 80 a6 20 00 cmp %i0, 0 4000c598: 32 80 00 09 bne,a 4000c5bc <_Heap_Extend+0x26c> 4000c59c: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000c5a0: 80 a5 e0 00 cmp %l7, 0 4000c5a4: 32 80 00 06 bne,a 4000c5bc <_Heap_Extend+0x26c> 4000c5a8: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 4000c5ac: d2 07 bf fc ld [ %fp + -4 ], %o1 4000c5b0: 7f ff ff 5d call 4000c324 <_Heap_Free_block> 4000c5b4: 90 10 00 10 mov %l0, %o0 */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( heap->last_block, (uintptr_t) heap->first_block - (uintptr_t) heap->last_block 4000c5b8: 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( 4000c5bc: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 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; 4000c5c0: c4 00 60 04 ld [ %g1 + 4 ], %g2 * 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( 4000c5c4: 86 20 c0 01 sub %g3, %g1, %g3 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; 4000c5c8: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000c5cc: 84 10 c0 02 or %g3, %g2, %g2 4000c5d0: c4 20 60 04 st %g2, [ %g1 + 4 ] } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000c5d4: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 4000c5d8: b0 10 20 01 mov 1, %i0 _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000c5dc: a8 20 40 14 sub %g1, %l4, %l4 /* Statistics */ stats->size += extended_size; 4000c5e0: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 if ( extended_size_ptr != NULL ) 4000c5e4: 80 a6 e0 00 cmp %i3, 0 _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; 4000c5e8: 82 00 40 14 add %g1, %l4, %g1 if ( extended_size_ptr != NULL ) 4000c5ec: 02 80 00 03 be 4000c5f8 <_Heap_Extend+0x2a8> <== NEVER TAKEN 4000c5f0: c2 24 20 2c st %g1, [ %l0 + 0x2c ] *extended_size_ptr = extended_size; 4000c5f4: e8 26 c0 00 st %l4, [ %i3 ] 4000c5f8: 81 c7 e0 08 ret 4000c5fc: 81 e8 00 00 restore =============================================================================== 4000c050 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4000c050: 9d e3 bf a0 save %sp, -96, %sp 4000c054: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 4000c058: 40 00 17 31 call 40011d1c <.urem> 4000c05c: 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 4000c060: d8 06 20 20 ld [ %i0 + 0x20 ], %o4 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000c064: a2 06 7f f8 add %i1, -8, %l1 4000c068: a0 10 00 18 mov %i0, %l0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4000c06c: 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; 4000c070: 80 a2 00 0c cmp %o0, %o4 4000c074: 0a 80 00 05 bcs 4000c088 <_Heap_Free+0x38> 4000c078: 82 10 20 00 clr %g1 4000c07c: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 4000c080: 80 a0 40 08 cmp %g1, %o0 4000c084: 82 60 3f ff subx %g0, -1, %g1 uintptr_t next_block_size = 0; bool next_is_free = false; _Heap_Protection_block_check( heap, block ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { 4000c088: 80 a0 60 00 cmp %g1, 0 4000c08c: 02 80 00 6a be 4000c234 <_Heap_Free+0x1e4> 4000c090: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000c094: 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; 4000c098: 84 0b 7f fe and %o5, -2, %g2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000c09c: 82 02 00 02 add %o0, %g2, %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; 4000c0a0: 80 a0 40 0c cmp %g1, %o4 4000c0a4: 0a 80 00 05 bcs 4000c0b8 <_Heap_Free+0x68> <== NEVER TAKEN 4000c0a8: 86 10 20 00 clr %g3 4000c0ac: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 4000c0b0: 80 a0 c0 01 cmp %g3, %g1 4000c0b4: 86 60 3f ff subx %g0, -1, %g3 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 4000c0b8: 80 a0 e0 00 cmp %g3, 0 4000c0bc: 02 80 00 5e be 4000c234 <_Heap_Free+0x1e4> <== NEVER TAKEN 4000c0c0: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000c0c4: c8 00 60 04 ld [ %g1 + 4 ], %g4 if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 4000c0c8: 80 89 20 01 btst 1, %g4 4000c0cc: 02 80 00 5a be 4000c234 <_Heap_Free+0x1e4> <== NEVER TAKEN 4000c0d0: 88 09 3f fe and %g4, -2, %g4 if ( !_Heap_Protection_determine_block_free( heap, block ) ) { return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 4000c0d4: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4000c0d8: 80 a0 40 09 cmp %g1, %o1 4000c0dc: 02 80 00 07 be 4000c0f8 <_Heap_Free+0xa8> 4000c0e0: 96 10 20 00 clr %o3 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000c0e4: 86 00 40 04 add %g1, %g4, %g3 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; 4000c0e8: c6 00 e0 04 ld [ %g3 + 4 ], %g3 4000c0ec: 86 08 e0 01 and %g3, 1, %g3 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 )); 4000c0f0: 80 a0 00 03 cmp %g0, %g3 4000c0f4: 96 60 3f ff subx %g0, -1, %o3 if ( !_Heap_Is_prev_used( block ) ) { 4000c0f8: 80 8b 60 01 btst 1, %o5 4000c0fc: 12 80 00 26 bne 4000c194 <_Heap_Free+0x144> 4000c100: 80 8a e0 ff btst 0xff, %o3 uintptr_t const prev_size = block->prev_size; 4000c104: da 02 00 00 ld [ %o0 ], %o5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000c108: 86 22 00 0d sub %o0, %o5, %g3 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; 4000c10c: 80 a0 c0 0c cmp %g3, %o4 4000c110: 0a 80 00 04 bcs 4000c120 <_Heap_Free+0xd0> <== NEVER TAKEN 4000c114: 94 10 20 00 clr %o2 4000c118: 80 a2 40 03 cmp %o1, %g3 4000c11c: 94 60 3f ff subx %g0, -1, %o2 Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { 4000c120: 80 a2 a0 00 cmp %o2, 0 4000c124: 02 80 00 44 be 4000c234 <_Heap_Free+0x1e4> <== NEVER TAKEN 4000c128: b0 10 20 00 clr %i0 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; 4000c12c: d8 00 e0 04 ld [ %g3 + 4 ], %o4 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) ) { 4000c130: 80 8b 20 01 btst 1, %o4 4000c134: 02 80 00 40 be 4000c234 <_Heap_Free+0x1e4> <== NEVER TAKEN 4000c138: 80 8a e0 ff btst 0xff, %o3 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4000c13c: 22 80 00 0f be,a 4000c178 <_Heap_Free+0x128> 4000c140: 9a 00 80 0d add %g2, %o5, %o5 uintptr_t const size = block_size + prev_size + next_block_size; 4000c144: 88 00 80 04 add %g2, %g4, %g4 4000c148: 9a 01 00 0d add %g4, %o5, %o5 return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 4000c14c: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = block->prev; 4000c150: c2 00 60 0c ld [ %g1 + 0xc ], %g1 prev->next = next; 4000c154: c8 20 60 08 st %g4, [ %g1 + 8 ] next->prev = prev; 4000c158: c2 21 20 0c st %g1, [ %g4 + 0xc ] _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4000c15c: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 4000c160: 82 00 7f ff add %g1, -1, %g1 4000c164: c2 24 20 38 st %g1, [ %l0 + 0x38 ] prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 4000c168: da 20 c0 0d st %o5, [ %g3 + %o5 ] 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; 4000c16c: 82 13 60 01 or %o5, 1, %g1 4000c170: 10 80 00 27 b 4000c20c <_Heap_Free+0x1bc> 4000c174: c2 20 e0 04 st %g1, [ %g3 + 4 ] 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; 4000c178: 88 13 60 01 or %o5, 1, %g4 4000c17c: c8 20 e0 04 st %g4, [ %g3 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000c180: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = size; 4000c184: da 22 00 02 st %o5, [ %o0 + %g2 ] _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; 4000c188: 86 08 ff fe and %g3, -2, %g3 4000c18c: 10 80 00 20 b 4000c20c <_Heap_Free+0x1bc> 4000c190: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4000c194: 22 80 00 0d be,a 4000c1c8 <_Heap_Free+0x178> 4000c198: c6 04 20 08 ld [ %l0 + 8 ], %g3 uintptr_t const size = block_size + next_block_size; 4000c19c: 86 01 00 02 add %g4, %g2, %g3 RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace( Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; 4000c1a0: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = old_block->prev; 4000c1a4: c2 00 60 0c ld [ %g1 + 0xc ], %g1 new_block->next = next; 4000c1a8: c8 22 20 08 st %g4, [ %o0 + 8 ] new_block->prev = prev; 4000c1ac: c2 22 20 0c st %g1, [ %o0 + 0xc ] next->prev = new_block; prev->next = new_block; 4000c1b0: d0 20 60 08 st %o0, [ %g1 + 8 ] Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; 4000c1b4: d0 21 20 0c st %o0, [ %g4 + 0xc ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000c1b8: 82 10 e0 01 or %g3, 1, %g1 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4000c1bc: c6 22 00 03 st %g3, [ %o0 + %g3 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000c1c0: 10 80 00 13 b 4000c20c <_Heap_Free+0x1bc> 4000c1c4: c2 22 20 04 st %g1, [ %o0 + 4 ] ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 4000c1c8: e0 22 20 0c st %l0, [ %o0 + 0xc ] Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4000c1cc: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4000c1d0: d0 20 e0 0c st %o0, [ %g3 + 0xc ] 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; 4000c1d4: 86 10 a0 01 or %g2, 1, %g3 4000c1d8: c6 22 20 04 st %g3, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000c1dc: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = block_size; 4000c1e0: c4 22 00 02 st %g2, [ %o0 + %g2 ] } 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; 4000c1e4: 86 08 ff fe and %g3, -2, %g3 4000c1e8: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000c1ec: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 if ( stats->max_free_blocks < stats->free_blocks ) { 4000c1f0: c6 04 20 3c ld [ %l0 + 0x3c ], %g3 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; 4000c1f4: 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; 4000c1f8: d0 24 20 08 st %o0, [ %l0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 4000c1fc: 80 a0 c0 01 cmp %g3, %g1 4000c200: 1a 80 00 03 bcc 4000c20c <_Heap_Free+0x1bc> 4000c204: c2 24 20 38 st %g1, [ %l0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 4000c208: c2 24 20 3c st %g1, [ %l0 + 0x3c ] } } /* Statistics */ --stats->used_blocks; 4000c20c: c2 04 20 40 ld [ %l0 + 0x40 ], %g1 ++stats->frees; stats->free_size += block_size; return( true ); 4000c210: b0 10 20 01 mov 1, %i0 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000c214: 82 00 7f ff add %g1, -1, %g1 4000c218: c2 24 20 40 st %g1, [ %l0 + 0x40 ] ++stats->frees; 4000c21c: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 4000c220: 82 00 60 01 inc %g1 4000c224: c2 24 20 50 st %g1, [ %l0 + 0x50 ] stats->free_size += block_size; 4000c228: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 4000c22c: 84 00 40 02 add %g1, %g2, %g2 4000c230: c4 24 20 30 st %g2, [ %l0 + 0x30 ] return( true ); } 4000c234: 81 c7 e0 08 ret 4000c238: 81 e8 00 00 restore =============================================================================== 40013660 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 40013660: 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); 40013664: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 40013668: 7f ff f9 ad call 40011d1c <.urem> 4001366c: 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 40013670: c4 06 20 20 ld [ %i0 + 0x20 ], %g2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 40013674: a2 06 7f f8 add %i1, -8, %l1 40013678: a0 10 00 18 mov %i0, %l0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4001367c: 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; 40013680: 80 a2 00 02 cmp %o0, %g2 40013684: 0a 80 00 05 bcs 40013698 <_Heap_Size_of_alloc_area+0x38> 40013688: 82 10 20 00 clr %g1 4001368c: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 40013690: 80 a0 40 08 cmp %g1, %o0 40013694: 82 60 3f ff subx %g0, -1, %g1 uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr; Heap_Block *block = _Heap_Block_of_alloc_area( alloc_begin, page_size ); Heap_Block *next_block = NULL; uintptr_t block_size = 0; if ( !_Heap_Is_block_in_heap( heap, block ) ) { 40013698: 80 a0 60 00 cmp %g1, 0 4001369c: 02 80 00 15 be 400136f0 <_Heap_Size_of_alloc_area+0x90> 400136a0: b0 10 20 00 clr %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; 400136a4: e2 02 20 04 ld [ %o0 + 4 ], %l1 400136a8: a2 0c 7f fe and %l1, -2, %l1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 400136ac: a2 02 00 11 add %o0, %l1, %l1 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; 400136b0: 80 a4 40 02 cmp %l1, %g2 400136b4: 0a 80 00 05 bcs 400136c8 <_Heap_Size_of_alloc_area+0x68> <== NEVER TAKEN 400136b8: 82 10 20 00 clr %g1 400136bc: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 400136c0: 80 a0 40 11 cmp %g1, %l1 400136c4: 82 60 3f ff subx %g0, -1, %g1 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 400136c8: 80 a0 60 00 cmp %g1, 0 400136cc: 02 80 00 09 be 400136f0 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 400136d0: b0 10 20 00 clr %i0 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; 400136d4: c2 04 60 04 ld [ %l1 + 4 ], %g1 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 400136d8: 80 88 60 01 btst 1, %g1 400136dc: 02 80 00 05 be 400136f0 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 400136e0: a2 24 40 19 sub %l1, %i1, %l1 return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; 400136e4: 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; 400136e8: a2 04 60 04 add %l1, 4, %l1 400136ec: e2 26 80 00 st %l1, [ %i2 ] return true; } 400136f0: 81 c7 e0 08 ret 400136f4: 81 e8 00 00 restore =============================================================================== 40007e10 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40007e10: 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; 40007e14: 23 10 00 1f sethi %hi(0x40007c00), %l1 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40007e18: a0 10 00 18 mov %i0, %l0 uintptr_t const page_size = heap->page_size; 40007e1c: e4 06 20 10 ld [ %i0 + 0x10 ], %l2 uintptr_t const min_block_size = heap->min_block_size; 40007e20: e8 06 20 14 ld [ %i0 + 0x14 ], %l4 Heap_Block *const first_block = heap->first_block; 40007e24: e6 06 20 20 ld [ %i0 + 0x20 ], %l3 Heap_Block *const last_block = heap->last_block; 40007e28: 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; 40007e2c: 80 8e a0 ff btst 0xff, %i2 40007e30: 02 80 00 04 be 40007e40 <_Heap_Walk+0x30> 40007e34: a2 14 61 bc or %l1, 0x1bc, %l1 40007e38: 23 10 00 1f sethi %hi(0x40007c00), %l1 40007e3c: a2 14 61 c4 or %l1, 0x1c4, %l1 ! 40007dc4 <_Heap_Walk_print> if ( !_System_state_Is_up( _System_state_Get() ) ) { 40007e40: 03 10 00 5f sethi %hi(0x40017c00), %g1 40007e44: c2 00 60 d8 ld [ %g1 + 0xd8 ], %g1 ! 40017cd8 <_System_state_Current> 40007e48: 80 a0 60 03 cmp %g1, 3 40007e4c: 12 80 01 2d bne 40008300 <_Heap_Walk+0x4f0> 40007e50: 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)( 40007e54: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40007e58: da 04 20 18 ld [ %l0 + 0x18 ], %o5 40007e5c: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007e60: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007e64: e6 23 a0 60 st %l3, [ %sp + 0x60 ] 40007e68: c2 23 a0 68 st %g1, [ %sp + 0x68 ] 40007e6c: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40007e70: ea 23 a0 64 st %l5, [ %sp + 0x64 ] 40007e74: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40007e78: 90 10 00 19 mov %i1, %o0 40007e7c: 92 10 20 00 clr %o1 40007e80: 15 10 00 54 sethi %hi(0x40015000), %o2 40007e84: 96 10 00 12 mov %l2, %o3 40007e88: 94 12 a3 a8 or %o2, 0x3a8, %o2 40007e8c: 9f c4 40 00 call %l1 40007e90: 98 10 00 14 mov %l4, %o4 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 40007e94: 80 a4 a0 00 cmp %l2, 0 40007e98: 12 80 00 07 bne 40007eb4 <_Heap_Walk+0xa4> 40007e9c: 80 8c a0 07 btst 7, %l2 (*printer)( source, true, "page size is zero\n" ); 40007ea0: 15 10 00 55 sethi %hi(0x40015400), %o2 40007ea4: 90 10 00 19 mov %i1, %o0 40007ea8: 92 10 20 01 mov 1, %o1 40007eac: 10 80 00 38 b 40007f8c <_Heap_Walk+0x17c> 40007eb0: 94 12 a0 40 or %o2, 0x40, %o2 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 40007eb4: 22 80 00 08 be,a 40007ed4 <_Heap_Walk+0xc4> 40007eb8: 90 10 00 14 mov %l4, %o0 (*printer)( 40007ebc: 15 10 00 55 sethi %hi(0x40015400), %o2 40007ec0: 90 10 00 19 mov %i1, %o0 40007ec4: 92 10 20 01 mov 1, %o1 40007ec8: 94 12 a0 58 or %o2, 0x58, %o2 40007ecc: 10 80 01 0b b 400082f8 <_Heap_Walk+0x4e8> 40007ed0: 96 10 00 12 mov %l2, %o3 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40007ed4: 7f ff e6 fc call 40001ac4 <.urem> 40007ed8: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 40007edc: 80 a2 20 00 cmp %o0, 0 40007ee0: 22 80 00 08 be,a 40007f00 <_Heap_Walk+0xf0> 40007ee4: 90 04 e0 08 add %l3, 8, %o0 (*printer)( 40007ee8: 15 10 00 55 sethi %hi(0x40015400), %o2 40007eec: 90 10 00 19 mov %i1, %o0 40007ef0: 92 10 20 01 mov 1, %o1 40007ef4: 94 12 a0 78 or %o2, 0x78, %o2 40007ef8: 10 80 01 00 b 400082f8 <_Heap_Walk+0x4e8> 40007efc: 96 10 00 14 mov %l4, %o3 40007f00: 7f ff e6 f1 call 40001ac4 <.urem> 40007f04: 92 10 00 12 mov %l2, %o1 ); return false; } if ( 40007f08: 80 a2 20 00 cmp %o0, 0 40007f0c: 22 80 00 08 be,a 40007f2c <_Heap_Walk+0x11c> 40007f10: c2 04 e0 04 ld [ %l3 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 40007f14: 15 10 00 55 sethi %hi(0x40015400), %o2 40007f18: 90 10 00 19 mov %i1, %o0 40007f1c: 92 10 20 01 mov 1, %o1 40007f20: 94 12 a0 a0 or %o2, 0xa0, %o2 40007f24: 10 80 00 f5 b 400082f8 <_Heap_Walk+0x4e8> 40007f28: 96 10 00 13 mov %l3, %o3 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 40007f2c: 80 88 60 01 btst 1, %g1 40007f30: 32 80 00 07 bne,a 40007f4c <_Heap_Walk+0x13c> 40007f34: ec 05 60 04 ld [ %l5 + 4 ], %l6 (*printer)( 40007f38: 15 10 00 55 sethi %hi(0x40015400), %o2 40007f3c: 90 10 00 19 mov %i1, %o0 40007f40: 92 10 20 01 mov 1, %o1 40007f44: 10 80 00 12 b 40007f8c <_Heap_Walk+0x17c> 40007f48: 94 12 a0 d8 or %o2, 0xd8, %o2 - 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; 40007f4c: ac 0d bf fe and %l6, -2, %l6 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 40007f50: ac 05 40 16 add %l5, %l6, %l6 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; 40007f54: c2 05 a0 04 ld [ %l6 + 4 ], %g1 ); return false; } if ( _Heap_Is_free( last_block ) ) { 40007f58: 80 88 60 01 btst 1, %g1 40007f5c: 12 80 00 07 bne 40007f78 <_Heap_Walk+0x168> 40007f60: 80 a5 80 13 cmp %l6, %l3 (*printer)( 40007f64: 15 10 00 55 sethi %hi(0x40015400), %o2 40007f68: 90 10 00 19 mov %i1, %o0 40007f6c: 92 10 20 01 mov 1, %o1 40007f70: 10 80 00 07 b 40007f8c <_Heap_Walk+0x17c> 40007f74: 94 12 a1 08 or %o2, 0x108, %o2 ); return false; } if ( 40007f78: 02 80 00 08 be 40007f98 <_Heap_Walk+0x188> <== ALWAYS TAKEN 40007f7c: 15 10 00 55 sethi %hi(0x40015400), %o2 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40007f80: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 40007f84: 92 10 20 01 mov 1, %o1 <== NOT EXECUTED 40007f88: 94 12 a1 20 or %o2, 0x120, %o2 <== NOT EXECUTED 40007f8c: 9f c4 40 00 call %l1 40007f90: b0 10 20 00 clr %i0 40007f94: 30 80 00 db b,a 40008300 <_Heap_Walk+0x4f0> block = next_block; } while ( block != first_block ); return true; } 40007f98: d6 04 20 08 ld [ %l0 + 8 ], %o3 int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 40007f9c: fa 04 20 10 ld [ %l0 + 0x10 ], %i5 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); 40007fa0: ae 10 00 10 mov %l0, %l7 40007fa4: 10 80 00 32 b 4000806c <_Heap_Walk+0x25c> 40007fa8: b8 10 00 0b mov %o3, %i4 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; 40007fac: 80 a0 80 1c cmp %g2, %i4 40007fb0: 18 80 00 05 bgu 40007fc4 <_Heap_Walk+0x1b4> 40007fb4: 82 10 20 00 clr %g1 40007fb8: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 40007fbc: 80 a0 40 1c cmp %g1, %i4 40007fc0: 82 60 3f ff subx %g0, -1, %g1 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 ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { 40007fc4: 80 a0 60 00 cmp %g1, 0 40007fc8: 32 80 00 08 bne,a 40007fe8 <_Heap_Walk+0x1d8> 40007fcc: 90 07 20 08 add %i4, 8, %o0 (*printer)( 40007fd0: 15 10 00 55 sethi %hi(0x40015400), %o2 40007fd4: 96 10 00 1c mov %i4, %o3 40007fd8: 90 10 00 19 mov %i1, %o0 40007fdc: 92 10 20 01 mov 1, %o1 40007fe0: 10 80 00 c6 b 400082f8 <_Heap_Walk+0x4e8> 40007fe4: 94 12 a1 50 or %o2, 0x150, %o2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40007fe8: 7f ff e6 b7 call 40001ac4 <.urem> 40007fec: 92 10 00 1d mov %i5, %o1 ); return false; } if ( 40007ff0: 80 a2 20 00 cmp %o0, 0 40007ff4: 22 80 00 08 be,a 40008014 <_Heap_Walk+0x204> 40007ff8: c2 07 20 04 ld [ %i4 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 40007ffc: 15 10 00 55 sethi %hi(0x40015400), %o2 40008000: 96 10 00 1c mov %i4, %o3 40008004: 90 10 00 19 mov %i1, %o0 40008008: 92 10 20 01 mov 1, %o1 4000800c: 10 80 00 bb b 400082f8 <_Heap_Walk+0x4e8> 40008010: 94 12 a1 70 or %o2, 0x170, %o2 - 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; 40008014: 82 08 7f fe and %g1, -2, %g1 block = next_block; } while ( block != first_block ); return true; } 40008018: 82 07 00 01 add %i4, %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; 4000801c: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 40008020: 80 88 60 01 btst 1, %g1 40008024: 22 80 00 08 be,a 40008044 <_Heap_Walk+0x234> 40008028: d8 07 20 0c ld [ %i4 + 0xc ], %o4 (*printer)( 4000802c: 15 10 00 55 sethi %hi(0x40015400), %o2 40008030: 96 10 00 1c mov %i4, %o3 40008034: 90 10 00 19 mov %i1, %o0 40008038: 92 10 20 01 mov 1, %o1 4000803c: 10 80 00 af b 400082f8 <_Heap_Walk+0x4e8> 40008040: 94 12 a1 a0 or %o2, 0x1a0, %o2 ); return false; } if ( free_block->prev != prev_block ) { 40008044: 80 a3 00 17 cmp %o4, %l7 40008048: 22 80 00 08 be,a 40008068 <_Heap_Walk+0x258> 4000804c: ae 10 00 1c mov %i4, %l7 (*printer)( 40008050: 15 10 00 55 sethi %hi(0x40015400), %o2 40008054: 96 10 00 1c mov %i4, %o3 40008058: 90 10 00 19 mov %i1, %o0 4000805c: 92 10 20 01 mov 1, %o1 40008060: 10 80 00 49 b 40008184 <_Heap_Walk+0x374> 40008064: 94 12 a1 c0 or %o2, 0x1c0, %o2 return false; } prev_block = free_block; free_block = free_block->next; 40008068: f8 07 20 08 ld [ %i4 + 8 ], %i4 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 ) { 4000806c: 80 a7 00 10 cmp %i4, %l0 40008070: 32 bf ff cf bne,a 40007fac <_Heap_Walk+0x19c> 40008074: c4 04 20 20 ld [ %l0 + 0x20 ], %g2 40008078: 35 10 00 55 sethi %hi(0x40015400), %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)( 4000807c: 31 10 00 55 sethi %hi(0x40015400), %i0 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40008080: b4 16 a3 80 or %i2, 0x380, %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)( 40008084: b0 16 23 68 or %i0, 0x368, %i0 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40008088: 37 10 00 55 sethi %hi(0x40015400), %i3 block = next_block; } while ( block != first_block ); return true; } 4000808c: c2 05 a0 04 ld [ %l6 + 4 ], %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; 40008090: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 - 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; 40008094: ae 08 7f fe and %g1, -2, %l7 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 40008098: ba 05 80 17 add %l6, %l7, %i5 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; 4000809c: 80 a0 c0 1d cmp %g3, %i5 400080a0: 18 80 00 05 bgu 400080b4 <_Heap_Walk+0x2a4> <== NEVER TAKEN 400080a4: 84 10 20 00 clr %g2 400080a8: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 400080ac: 80 a0 80 1d cmp %g2, %i5 400080b0: 84 60 3f ff subx %g0, -1, %g2 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; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 400080b4: 80 a0 a0 00 cmp %g2, 0 400080b8: 12 80 00 07 bne 400080d4 <_Heap_Walk+0x2c4> 400080bc: 84 1d 80 15 xor %l6, %l5, %g2 (*printer)( 400080c0: 15 10 00 55 sethi %hi(0x40015400), %o2 400080c4: 90 10 00 19 mov %i1, %o0 400080c8: 92 10 20 01 mov 1, %o1 400080cc: 10 80 00 2c b 4000817c <_Heap_Walk+0x36c> 400080d0: 94 12 a1 f8 or %o2, 0x1f8, %o2 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; 400080d4: 80 a0 00 02 cmp %g0, %g2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 400080d8: c2 27 bf fc st %g1, [ %fp + -4 ] 400080dc: b8 40 20 00 addx %g0, 0, %i4 400080e0: 90 10 00 17 mov %l7, %o0 400080e4: 7f ff e6 78 call 40001ac4 <.urem> 400080e8: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 400080ec: 80 a2 20 00 cmp %o0, 0 400080f0: 02 80 00 0c be 40008120 <_Heap_Walk+0x310> 400080f4: c2 07 bf fc ld [ %fp + -4 ], %g1 400080f8: 80 8f 20 ff btst 0xff, %i4 400080fc: 02 80 00 0a be 40008124 <_Heap_Walk+0x314> 40008100: 80 a5 c0 14 cmp %l7, %l4 (*printer)( 40008104: 15 10 00 55 sethi %hi(0x40015400), %o2 40008108: 90 10 00 19 mov %i1, %o0 4000810c: 92 10 20 01 mov 1, %o1 40008110: 94 12 a2 28 or %o2, 0x228, %o2 40008114: 96 10 00 16 mov %l6, %o3 40008118: 10 80 00 1b b 40008184 <_Heap_Walk+0x374> 4000811c: 98 10 00 17 mov %l7, %o4 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 40008120: 80 a5 c0 14 cmp %l7, %l4 40008124: 1a 80 00 0d bcc 40008158 <_Heap_Walk+0x348> 40008128: 80 a7 40 16 cmp %i5, %l6 4000812c: 80 8f 20 ff btst 0xff, %i4 40008130: 02 80 00 0a be 40008158 <_Heap_Walk+0x348> <== NEVER TAKEN 40008134: 80 a7 40 16 cmp %i5, %l6 (*printer)( 40008138: 15 10 00 55 sethi %hi(0x40015400), %o2 4000813c: 90 10 00 19 mov %i1, %o0 40008140: 92 10 20 01 mov 1, %o1 40008144: 94 12 a2 58 or %o2, 0x258, %o2 40008148: 96 10 00 16 mov %l6, %o3 4000814c: 98 10 00 17 mov %l7, %o4 40008150: 10 80 00 3f b 4000824c <_Heap_Walk+0x43c> 40008154: 9a 10 00 14 mov %l4, %o5 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 40008158: 38 80 00 0e bgu,a 40008190 <_Heap_Walk+0x380> 4000815c: b8 08 60 01 and %g1, 1, %i4 40008160: 80 8f 20 ff btst 0xff, %i4 40008164: 02 80 00 0b be 40008190 <_Heap_Walk+0x380> 40008168: b8 08 60 01 and %g1, 1, %i4 (*printer)( 4000816c: 15 10 00 55 sethi %hi(0x40015400), %o2 40008170: 90 10 00 19 mov %i1, %o0 40008174: 92 10 20 01 mov 1, %o1 40008178: 94 12 a2 88 or %o2, 0x288, %o2 4000817c: 96 10 00 16 mov %l6, %o3 40008180: 98 10 00 1d mov %i5, %o4 40008184: 9f c4 40 00 call %l1 40008188: b0 10 20 00 clr %i0 4000818c: 30 80 00 5d b,a 40008300 <_Heap_Walk+0x4f0> 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; 40008190: c2 07 60 04 ld [ %i5 + 4 ], %g1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 40008194: 80 88 60 01 btst 1, %g1 40008198: 12 80 00 3f bne 40008294 <_Heap_Walk+0x484> 4000819c: 80 a7 20 00 cmp %i4, 0 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 ? 400081a0: da 05 a0 0c ld [ %l6 + 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)( 400081a4: c2 04 20 08 ld [ %l0 + 8 ], %g1 400081a8: 05 10 00 54 sethi %hi(0x40015000), %g2 block = next_block; } while ( block != first_block ); return true; } 400081ac: 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)( 400081b0: 80 a3 40 01 cmp %o5, %g1 400081b4: 02 80 00 07 be 400081d0 <_Heap_Walk+0x3c0> 400081b8: 86 10 a3 68 or %g2, 0x368, %g3 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 400081bc: 80 a3 40 10 cmp %o5, %l0 400081c0: 12 80 00 04 bne 400081d0 <_Heap_Walk+0x3c0> 400081c4: 86 16 e3 30 or %i3, 0x330, %g3 400081c8: 19 10 00 54 sethi %hi(0x40015000), %o4 400081cc: 86 13 23 78 or %o4, 0x378, %g3 ! 40015378 block->next, block->next == last_free_block ? 400081d0: c4 05 a0 08 ld [ %l6 + 8 ], %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)( 400081d4: 19 10 00 54 sethi %hi(0x40015000), %o4 400081d8: 80 a0 80 04 cmp %g2, %g4 400081dc: 02 80 00 07 be 400081f8 <_Heap_Walk+0x3e8> 400081e0: 82 13 23 88 or %o4, 0x388, %g1 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 400081e4: 80 a0 80 10 cmp %g2, %l0 400081e8: 12 80 00 04 bne 400081f8 <_Heap_Walk+0x3e8> 400081ec: 82 16 e3 30 or %i3, 0x330, %g1 400081f0: 09 10 00 54 sethi %hi(0x40015000), %g4 400081f4: 82 11 23 98 or %g4, 0x398, %g1 ! 40015398 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)( 400081f8: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 400081fc: c4 23 a0 60 st %g2, [ %sp + 0x60 ] 40008200: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40008204: 90 10 00 19 mov %i1, %o0 40008208: 92 10 20 00 clr %o1 4000820c: 15 10 00 55 sethi %hi(0x40015400), %o2 40008210: 96 10 00 16 mov %l6, %o3 40008214: 94 12 a2 c0 or %o2, 0x2c0, %o2 40008218: 9f c4 40 00 call %l1 4000821c: 98 10 00 17 mov %l7, %o4 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 40008220: da 07 40 00 ld [ %i5 ], %o5 40008224: 80 a5 c0 0d cmp %l7, %o5 40008228: 02 80 00 0c be 40008258 <_Heap_Walk+0x448> 4000822c: 80 a7 20 00 cmp %i4, 0 (*printer)( 40008230: 15 10 00 55 sethi %hi(0x40015400), %o2 40008234: fa 23 a0 5c st %i5, [ %sp + 0x5c ] 40008238: 90 10 00 19 mov %i1, %o0 4000823c: 92 10 20 01 mov 1, %o1 40008240: 94 12 a2 f8 or %o2, 0x2f8, %o2 40008244: 96 10 00 16 mov %l6, %o3 40008248: 98 10 00 17 mov %l7, %o4 4000824c: 9f c4 40 00 call %l1 40008250: b0 10 20 00 clr %i0 40008254: 30 80 00 2b b,a 40008300 <_Heap_Walk+0x4f0> ); return false; } if ( !prev_used ) { 40008258: 32 80 00 0a bne,a 40008280 <_Heap_Walk+0x470> 4000825c: c2 04 20 08 ld [ %l0 + 8 ], %g1 (*printer)( 40008260: 15 10 00 55 sethi %hi(0x40015400), %o2 40008264: 90 10 00 19 mov %i1, %o0 40008268: 92 10 20 01 mov 1, %o1 4000826c: 10 80 00 22 b 400082f4 <_Heap_Walk+0x4e4> 40008270: 94 12 a3 38 or %o2, 0x338, %o2 { 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 ) { if ( free_block == block ) { 40008274: 02 80 00 19 be 400082d8 <_Heap_Walk+0x4c8> 40008278: 80 a7 40 13 cmp %i5, %l3 return true; } free_block = free_block->next; 4000827c: 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 ) { 40008280: 80 a0 40 10 cmp %g1, %l0 40008284: 12 bf ff fc bne 40008274 <_Heap_Walk+0x464> 40008288: 80 a0 40 16 cmp %g1, %l6 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 4000828c: 10 80 00 17 b 400082e8 <_Heap_Walk+0x4d8> 40008290: 15 10 00 55 sethi %hi(0x40015400), %o2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 40008294: 22 80 00 0a be,a 400082bc <_Heap_Walk+0x4ac> 40008298: da 05 80 00 ld [ %l6 ], %o5 (*printer)( 4000829c: 90 10 00 19 mov %i1, %o0 400082a0: 92 10 20 00 clr %o1 400082a4: 94 10 00 18 mov %i0, %o2 400082a8: 96 10 00 16 mov %l6, %o3 400082ac: 9f c4 40 00 call %l1 400082b0: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 400082b4: 10 80 00 09 b 400082d8 <_Heap_Walk+0x4c8> 400082b8: 80 a7 40 13 cmp %i5, %l3 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 400082bc: 90 10 00 19 mov %i1, %o0 400082c0: 92 10 20 00 clr %o1 400082c4: 94 10 00 1a mov %i2, %o2 400082c8: 96 10 00 16 mov %l6, %o3 400082cc: 9f c4 40 00 call %l1 400082d0: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 400082d4: 80 a7 40 13 cmp %i5, %l3 400082d8: 32 bf ff 6d bne,a 4000808c <_Heap_Walk+0x27c> 400082dc: ac 10 00 1d mov %i5, %l6 return true; } 400082e0: 81 c7 e0 08 ret 400082e4: 91 e8 20 01 restore %g0, 1, %o0 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 400082e8: 90 10 00 19 mov %i1, %o0 400082ec: 92 10 20 01 mov 1, %o1 400082f0: 94 12 a3 a8 or %o2, 0x3a8, %o2 400082f4: 96 10 00 16 mov %l6, %o3 400082f8: 9f c4 40 00 call %l1 400082fc: b0 10 20 00 clr %i0 40008300: 81 c7 e0 08 ret 40008304: 81 e8 00 00 restore =============================================================================== 40006f98 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40006f98: 9d e3 bf a0 save %sp, -96, %sp _Internal_errors_What_happened.the_source = the_source; 40006f9c: 05 10 00 55 sethi %hi(0x40015400), %g2 40006fa0: 82 10 a1 94 or %g2, 0x194, %g1 ! 40015594 <_Internal_errors_What_happened> void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40006fa4: 90 10 00 18 mov %i0, %o0 40006fa8: 94 10 00 1a mov %i2, %o2 _Internal_errors_What_happened.the_source = the_source; 40006fac: f0 20 a1 94 st %i0, [ %g2 + 0x194 ] _Internal_errors_What_happened.is_internal = is_internal; 40006fb0: f2 28 60 04 stb %i1, [ %g1 + 4 ] _Internal_errors_What_happened.the_error = the_error; 40006fb4: f4 20 60 08 st %i2, [ %g1 + 8 ] _User_extensions_Fatal( the_source, is_internal, the_error ); 40006fb8: 40 00 07 db call 40008f24 <_User_extensions_Fatal> 40006fbc: 92 0e 60 ff and %i1, 0xff, %o1 RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 40006fc0: 84 10 20 05 mov 5, %g2 <== NOT EXECUTED 40006fc4: 03 10 00 55 sethi %hi(0x40015400), %g1 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 40006fc8: 7f ff eb 34 call 40001c98 <== NOT EXECUTED 40006fcc: c4 20 62 58 st %g2, [ %g1 + 0x258 ] ! 40015658 <_System_state_Current><== NOT EXECUTED 40006fd0: 82 10 00 08 mov %o0, %g1 <== NOT EXECUTED 40006fd4: 30 80 00 00 b,a 40006fd4 <_Internal_error_Occurred+0x3c> <== NOT EXECUTED =============================================================================== 40007048 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007048: 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 ) 4000704c: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007050: 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 ) 40007054: 80 a0 60 00 cmp %g1, 0 40007058: 02 80 00 20 be 400070d8 <_Objects_Allocate+0x90> <== NEVER TAKEN 4000705c: 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 ); 40007060: a2 04 20 20 add %l0, 0x20, %l1 40007064: 7f ff fd 88 call 40006684 <_Chain_Get> 40007068: 90 10 00 11 mov %l1, %o0 if ( information->auto_extend ) { 4000706c: c2 0c 20 12 ldub [ %l0 + 0x12 ], %g1 40007070: 80 a0 60 00 cmp %g1, 0 40007074: 02 80 00 19 be 400070d8 <_Objects_Allocate+0x90> 40007078: 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 ) { 4000707c: 80 a2 20 00 cmp %o0, 0 40007080: 32 80 00 0a bne,a 400070a8 <_Objects_Allocate+0x60> 40007084: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 _Objects_Extend_information( information ); 40007088: 40 00 00 1e call 40007100 <_Objects_Extend_information> 4000708c: 90 10 00 10 mov %l0, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 40007090: 7f ff fd 7d call 40006684 <_Chain_Get> 40007094: 90 10 00 11 mov %l1, %o0 } if ( the_object ) { 40007098: b0 92 20 00 orcc %o0, 0, %i0 4000709c: 02 80 00 0f be 400070d8 <_Objects_Allocate+0x90> 400070a0: 01 00 00 00 nop uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 400070a4: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 400070a8: d0 16 20 0a lduh [ %i0 + 0xa ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 400070ac: d2 14 20 14 lduh [ %l0 + 0x14 ], %o1 400070b0: 40 00 2a 6f call 40011a6c <.udiv> 400070b4: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 400070b8: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 400070bc: 91 2a 20 02 sll %o0, 2, %o0 400070c0: c4 00 40 08 ld [ %g1 + %o0 ], %g2 400070c4: 84 00 bf ff add %g2, -1, %g2 400070c8: c4 20 40 08 st %g2, [ %g1 + %o0 ] information->inactive--; 400070cc: c2 14 20 2c lduh [ %l0 + 0x2c ], %g1 400070d0: 82 00 7f ff add %g1, -1, %g1 400070d4: c2 34 20 2c sth %g1, [ %l0 + 0x2c ] ); } #endif return the_object; } 400070d8: 81 c7 e0 08 ret 400070dc: 81 e8 00 00 restore =============================================================================== 4000745c <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 4000745c: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 40007460: b3 2e 60 10 sll %i1, 0x10, %i1 40007464: b3 36 60 10 srl %i1, 0x10, %i1 40007468: 80 a6 60 00 cmp %i1, 0 4000746c: 02 80 00 17 be 400074c8 <_Objects_Get_information+0x6c> 40007470: a0 10 20 00 clr %l0 /* * 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 ); 40007474: 40 00 13 72 call 4000c23c <_Objects_API_maximum_class> 40007478: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 4000747c: 80 a2 20 00 cmp %o0, 0 40007480: 02 80 00 12 be 400074c8 <_Objects_Get_information+0x6c> 40007484: 80 a6 40 08 cmp %i1, %o0 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 40007488: 18 80 00 10 bgu 400074c8 <_Objects_Get_information+0x6c> 4000748c: 03 10 00 55 sethi %hi(0x40015400), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 40007490: b1 2e 20 02 sll %i0, 2, %i0 40007494: 82 10 60 48 or %g1, 0x48, %g1 40007498: c2 00 40 18 ld [ %g1 + %i0 ], %g1 4000749c: 80 a0 60 00 cmp %g1, 0 400074a0: 02 80 00 0a be 400074c8 <_Objects_Get_information+0x6c> <== NEVER TAKEN 400074a4: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 400074a8: e0 00 40 19 ld [ %g1 + %i1 ], %l0 if ( !info ) 400074ac: 80 a4 20 00 cmp %l0, 0 400074b0: 02 80 00 06 be 400074c8 <_Objects_Get_information+0x6c> <== NEVER TAKEN 400074b4: 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 ) 400074b8: c2 14 20 10 lduh [ %l0 + 0x10 ], %g1 return NULL; 400074bc: 80 a0 00 01 cmp %g0, %g1 400074c0: 82 60 20 00 subx %g0, 0, %g1 400074c4: a0 0c 00 01 and %l0, %g1, %l0 #endif return info; } 400074c8: 81 c7 e0 08 ret 400074cc: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40018d64 <_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; 40018d64: c2 02 20 08 ld [ %o0 + 8 ], %g1 if ( information->maximum >= index ) { 40018d68: c4 12 20 10 lduh [ %o0 + 0x10 ], %g2 /* * 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; 40018d6c: 82 22 40 01 sub %o1, %g1, %g1 40018d70: 82 00 60 01 inc %g1 if ( information->maximum >= index ) { 40018d74: 80 a0 80 01 cmp %g2, %g1 40018d78: 0a 80 00 09 bcs 40018d9c <_Objects_Get_no_protection+0x38> 40018d7c: 83 28 60 02 sll %g1, 2, %g1 if ( (the_object = information->local_table[ index ]) != NULL ) { 40018d80: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 40018d84: d0 00 80 01 ld [ %g2 + %g1 ], %o0 40018d88: 80 a2 20 00 cmp %o0, 0 40018d8c: 02 80 00 05 be 40018da0 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 40018d90: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 40018d94: 81 c3 e0 08 retl 40018d98: 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; 40018d9c: 82 10 20 01 mov 1, %g1 return NULL; 40018da0: 90 10 20 00 clr %o0 } 40018da4: 81 c3 e0 08 retl 40018da8: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 40008d38 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 40008d38: 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; 40008d3c: 92 96 20 00 orcc %i0, 0, %o1 40008d40: 12 80 00 06 bne 40008d58 <_Objects_Id_to_name+0x20> 40008d44: 83 32 60 18 srl %o1, 0x18, %g1 40008d48: 03 10 00 7d sethi %hi(0x4001f400), %g1 40008d4c: c2 00 61 94 ld [ %g1 + 0x194 ], %g1 ! 4001f594 <_Per_CPU_Information+0xc> 40008d50: d2 00 60 08 ld [ %g1 + 8 ], %o1 40008d54: 83 32 60 18 srl %o1, 0x18, %g1 40008d58: 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 ) 40008d5c: 84 00 7f ff add %g1, -1, %g2 40008d60: 80 a0 a0 02 cmp %g2, 2 40008d64: 18 80 00 16 bgu 40008dbc <_Objects_Id_to_name+0x84> 40008d68: 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 ] ) 40008d6c: 10 80 00 16 b 40008dc4 <_Objects_Id_to_name+0x8c> 40008d70: 83 28 60 02 sll %g1, 2, %g1 return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 40008d74: 85 28 a0 02 sll %g2, 2, %g2 40008d78: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 40008d7c: 80 a2 20 00 cmp %o0, 0 40008d80: 02 80 00 0f be 40008dbc <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40008d84: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 40008d88: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 40008d8c: 80 a0 60 00 cmp %g1, 0 40008d90: 12 80 00 0b bne 40008dbc <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40008d94: 01 00 00 00 nop return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 40008d98: 7f ff ff cb call 40008cc4 <_Objects_Get> 40008d9c: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 40008da0: 80 a2 20 00 cmp %o0, 0 40008da4: 02 80 00 06 be 40008dbc <_Objects_Id_to_name+0x84> 40008da8: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 40008dac: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 40008db0: 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; _Thread_Enable_dispatch(); 40008db4: 40 00 03 00 call 400099b4 <_Thread_Enable_dispatch> 40008db8: c2 26 40 00 st %g1, [ %i1 ] return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 40008dbc: 81 c7 e0 08 ret 40008dc0: 91 e8 00 10 restore %g0, %l0, %o0 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 40008dc4: 05 10 00 7b sethi %hi(0x4001ec00), %g2 40008dc8: 84 10 a3 98 or %g2, 0x398, %g2 ! 4001ef98 <_Objects_Information_table> 40008dcc: c2 00 80 01 ld [ %g2 + %g1 ], %g1 40008dd0: 80 a0 60 00 cmp %g1, 0 40008dd4: 12 bf ff e8 bne 40008d74 <_Objects_Id_to_name+0x3c> 40008dd8: 85 32 60 1b srl %o1, 0x1b, %g2 40008ddc: 30 bf ff f8 b,a 40008dbc <_Objects_Id_to_name+0x84> =============================================================================== 4000acf0 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4000acf0: 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( 4000acf4: 11 10 00 9d sethi %hi(0x40027400), %o0 4000acf8: 92 10 00 18 mov %i0, %o1 4000acfc: 90 12 23 6c or %o0, 0x36c, %o0 4000ad00: 40 00 0c 9c call 4000df70 <_Objects_Get> 4000ad04: 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 ) { 4000ad08: c2 07 bf fc ld [ %fp + -4 ], %g1 4000ad0c: 80 a0 60 00 cmp %g1, 0 4000ad10: 12 80 00 3f bne 4000ae0c <_POSIX_Message_queue_Receive_support+0x11c> 4000ad14: 01 00 00 00 nop case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 4000ad18: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000ad1c: 84 08 60 03 and %g1, 3, %g2 4000ad20: 80 a0 a0 01 cmp %g2, 1 4000ad24: 32 80 00 08 bne,a 4000ad44 <_POSIX_Message_queue_Receive_support+0x54> 4000ad28: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 _Thread_Enable_dispatch(); 4000ad2c: 40 00 0f 95 call 4000eb80 <_Thread_Enable_dispatch> 4000ad30: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EBADF ); 4000ad34: 40 00 2a 26 call 400155cc <__errno> 4000ad38: 01 00 00 00 nop 4000ad3c: 10 80 00 0b b 4000ad68 <_POSIX_Message_queue_Receive_support+0x78> 4000ad40: 82 10 20 09 mov 9, %g1 ! 9 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 4000ad44: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 4000ad48: 80 a6 80 02 cmp %i2, %g2 4000ad4c: 1a 80 00 09 bcc 4000ad70 <_POSIX_Message_queue_Receive_support+0x80> 4000ad50: 84 10 3f ff mov -1, %g2 _Thread_Enable_dispatch(); 4000ad54: 40 00 0f 8b call 4000eb80 <_Thread_Enable_dispatch> 4000ad58: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EMSGSIZE ); 4000ad5c: 40 00 2a 1c call 400155cc <__errno> 4000ad60: 01 00 00 00 nop 4000ad64: 82 10 20 7a mov 0x7a, %g1 ! 7a 4000ad68: 10 80 00 27 b 4000ae04 <_POSIX_Message_queue_Receive_support+0x114> 4000ad6c: c2 22 00 00 st %g1, [ %o0 ] /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 4000ad70: c4 27 bf f8 st %g2, [ %fp + -8 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000ad74: 80 8f 20 ff btst 0xff, %i4 4000ad78: 02 80 00 06 be 4000ad90 <_POSIX_Message_queue_Receive_support+0xa0><== NEVER TAKEN 4000ad7c: 98 10 20 00 clr %o4 do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000ad80: 05 00 00 10 sethi %hi(0x4000), %g2 4000ad84: 82 08 40 02 and %g1, %g2, %g1 4000ad88: 80 a0 00 01 cmp %g0, %g1 4000ad8c: 98 60 3f ff subx %g0, -1, %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4000ad90: 9a 10 00 1d mov %i5, %o5 4000ad94: 90 02 20 1c add %o0, 0x1c, %o0 4000ad98: 92 10 00 18 mov %i0, %o1 4000ad9c: 94 10 00 19 mov %i1, %o2 4000ada0: 96 07 bf f8 add %fp, -8, %o3 4000ada4: 40 00 08 3e call 4000ce9c <_CORE_message_queue_Seize> 4000ada8: 98 0b 20 01 and %o4, 1, %o4 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 4000adac: 40 00 0f 75 call 4000eb80 <_Thread_Enable_dispatch> 4000adb0: 3b 10 00 9d sethi %hi(0x40027400), %i5 *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4000adb4: ba 17 63 d8 or %i5, 0x3d8, %i5 ! 400277d8 <_Per_CPU_Information> 4000adb8: 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); 4000adbc: c6 00 60 24 ld [ %g1 + 0x24 ], %g3 if ( !_Thread_Executing->Wait.return_code ) 4000adc0: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 4000adc4: 85 38 e0 1f sra %g3, 0x1f, %g2 4000adc8: 86 18 80 03 xor %g2, %g3, %g3 4000adcc: 84 20 c0 02 sub %g3, %g2, %g2 4000add0: 80 a0 60 00 cmp %g1, 0 4000add4: 12 80 00 05 bne 4000ade8 <_POSIX_Message_queue_Receive_support+0xf8> 4000add8: c4 26 c0 00 st %g2, [ %i3 ] return length_out; 4000addc: f0 07 bf f8 ld [ %fp + -8 ], %i0 4000ade0: 81 c7 e0 08 ret 4000ade4: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one( 4000ade8: 40 00 29 f9 call 400155cc <__errno> 4000adec: 01 00 00 00 nop 4000adf0: c2 07 60 0c ld [ %i5 + 0xc ], %g1 4000adf4: b8 10 00 08 mov %o0, %i4 4000adf8: 40 00 00 9c call 4000b068 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000adfc: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000ae00: d0 27 00 00 st %o0, [ %i4 ] 4000ae04: 81 c7 e0 08 ret 4000ae08: 91 e8 3f ff restore %g0, -1, %o0 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000ae0c: 40 00 29 f0 call 400155cc <__errno> 4000ae10: b0 10 3f ff mov -1, %i0 4000ae14: 82 10 20 09 mov 9, %g1 4000ae18: c2 22 00 00 st %g1, [ %o0 ] } 4000ae1c: 81 c7 e0 08 ret 4000ae20: 81 e8 00 00 restore =============================================================================== 4000b2b8 <_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 ]; 4000b2b8: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000b2bc: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 4000b2c0: 80 a0 a0 00 cmp %g2, 0 4000b2c4: 12 80 00 12 bne 4000b30c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54><== NEVER TAKEN 4000b2c8: 01 00 00 00 nop 4000b2cc: c4 00 60 dc ld [ %g1 + 0xdc ], %g2 4000b2d0: 80 a0 a0 01 cmp %g2, 1 4000b2d4: 12 80 00 0e bne 4000b30c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000b2d8: 01 00 00 00 nop thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 4000b2dc: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 4000b2e0: 80 a0 60 00 cmp %g1, 0 4000b2e4: 02 80 00 0a be 4000b30c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000b2e8: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000b2ec: 03 10 00 5a sethi %hi(0x40016800), %g1 4000b2f0: c4 00 61 30 ld [ %g1 + 0x130 ], %g2 ! 40016930 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 4000b2f4: 92 10 3f ff mov -1, %o1 4000b2f8: 84 00 bf ff add %g2, -1, %g2 4000b2fc: c4 20 61 30 st %g2, [ %g1 + 0x130 ] 4000b300: 82 13 c0 00 mov %o7, %g1 4000b304: 40 00 01 f8 call 4000bae4 <_POSIX_Thread_Exit> 4000b308: 9e 10 40 00 mov %g1, %o7 } else _Thread_Enable_dispatch(); 4000b30c: 82 13 c0 00 mov %o7, %g1 4000b310: 7f ff f4 76 call 400084e8 <_Thread_Enable_dispatch> 4000b314: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000c74c <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4000c74c: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4000c750: d0 06 40 00 ld [ %i1 ], %o0 4000c754: 7f ff ff f3 call 4000c720 <_POSIX_Priority_Is_valid> 4000c758: a0 10 00 18 mov %i0, %l0 4000c75c: 80 8a 20 ff btst 0xff, %o0 4000c760: 02 80 00 11 be 4000c7a4 <_POSIX_Thread_Translate_sched_param+0x58><== NEVER TAKEN 4000c764: b0 10 20 16 mov 0x16, %i0 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4000c768: c0 26 80 00 clr [ %i2 ] *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 4000c76c: 80 a4 20 00 cmp %l0, 0 4000c770: 12 80 00 06 bne 4000c788 <_POSIX_Thread_Translate_sched_param+0x3c> 4000c774: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000c778: 82 10 20 01 mov 1, %g1 4000c77c: c2 26 80 00 st %g1, [ %i2 ] return 0; 4000c780: 81 c7 e0 08 ret 4000c784: 91 e8 20 00 restore %g0, 0, %o0 } if ( policy == SCHED_FIFO ) { 4000c788: 80 a4 20 01 cmp %l0, 1 4000c78c: 02 80 00 06 be 4000c7a4 <_POSIX_Thread_Translate_sched_param+0x58> 4000c790: b0 10 20 00 clr %i0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 4000c794: 80 a4 20 02 cmp %l0, 2 4000c798: 32 80 00 05 bne,a 4000c7ac <_POSIX_Thread_Translate_sched_param+0x60> 4000c79c: 80 a4 20 04 cmp %l0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 4000c7a0: e0 26 80 00 st %l0, [ %i2 ] return 0; 4000c7a4: 81 c7 e0 08 ret 4000c7a8: 81 e8 00 00 restore } if ( policy == SCHED_SPORADIC ) { 4000c7ac: 12 bf ff fe bne 4000c7a4 <_POSIX_Thread_Translate_sched_param+0x58> 4000c7b0: b0 10 20 16 mov 0x16, %i0 if ( (param->sched_ss_repl_period.tv_sec == 0) && 4000c7b4: c2 06 60 08 ld [ %i1 + 8 ], %g1 4000c7b8: 80 a0 60 00 cmp %g1, 0 4000c7bc: 32 80 00 07 bne,a 4000c7d8 <_POSIX_Thread_Translate_sched_param+0x8c> 4000c7c0: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000c7c4: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000c7c8: 80 a0 60 00 cmp %g1, 0 4000c7cc: 02 80 00 1d be 4000c840 <_POSIX_Thread_Translate_sched_param+0xf4> 4000c7d0: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4000c7d4: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000c7d8: 80 a0 60 00 cmp %g1, 0 4000c7dc: 12 80 00 06 bne 4000c7f4 <_POSIX_Thread_Translate_sched_param+0xa8> 4000c7e0: 01 00 00 00 nop 4000c7e4: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000c7e8: 80 a0 60 00 cmp %g1, 0 4000c7ec: 02 bf ff ee be 4000c7a4 <_POSIX_Thread_Translate_sched_param+0x58> 4000c7f0: 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 ) < 4000c7f4: 7f ff f5 c9 call 40009f18 <_Timespec_To_ticks> 4000c7f8: 90 06 60 08 add %i1, 8, %o0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; 4000c7fc: 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 ) < 4000c800: a0 10 00 08 mov %o0, %l0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 4000c804: 7f ff f5 c5 call 40009f18 <_Timespec_To_ticks> 4000c808: 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 ) < 4000c80c: 80 a4 00 08 cmp %l0, %o0 4000c810: 0a 80 00 0c bcs 4000c840 <_POSIX_Thread_Translate_sched_param+0xf4> 4000c814: 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 ) ) 4000c818: 7f ff ff c2 call 4000c720 <_POSIX_Priority_Is_valid> 4000c81c: d0 06 60 04 ld [ %i1 + 4 ], %o0 4000c820: 80 8a 20 ff btst 0xff, %o0 4000c824: 02 bf ff e0 be 4000c7a4 <_POSIX_Thread_Translate_sched_param+0x58> 4000c828: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4000c82c: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; 4000c830: b0 10 20 00 clr %i0 if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 4000c834: 03 10 00 18 sethi %hi(0x40006000), %g1 4000c838: 82 10 63 8c or %g1, 0x38c, %g1 ! 4000638c <_POSIX_Threads_Sporadic_budget_callout> 4000c83c: c2 26 c0 00 st %g1, [ %i3 ] return 0; } return EINVAL; } 4000c840: 81 c7 e0 08 ret 4000c844: 81 e8 00 00 restore =============================================================================== 400060cc <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 400060cc: 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; 400060d0: 03 10 00 75 sethi %hi(0x4001d400), %g1 400060d4: 82 10 63 ec or %g1, 0x3ec, %g1 ! 4001d7ec maximum = Configuration_POSIX_API.number_of_initialization_threads; 400060d8: e6 00 60 30 ld [ %g1 + 0x30 ], %l3 if ( !user_threads || maximum == 0 ) 400060dc: 80 a4 e0 00 cmp %l3, 0 400060e0: 02 80 00 1d be 40006154 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 400060e4: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 400060e8: 80 a4 60 00 cmp %l1, 0 400060ec: 02 80 00 1a be 40006154 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 400060f0: a4 10 20 00 clr %l2 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); 400060f4: a0 07 bf bc add %fp, -68, %l0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); status = pthread_create( 400060f8: 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 ); 400060fc: 40 00 19 d3 call 4000c848 40006100: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 40006104: 92 10 20 02 mov 2, %o1 40006108: 40 00 19 dc call 4000c878 4000610c: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 40006110: d2 04 60 04 ld [ %l1 + 4 ], %o1 40006114: 40 00 19 e8 call 4000c8b4 40006118: 90 10 00 10 mov %l0, %o0 status = pthread_create( 4000611c: d4 04 40 00 ld [ %l1 ], %o2 40006120: 90 10 00 14 mov %l4, %o0 40006124: 92 10 00 10 mov %l0, %o1 40006128: 7f ff ff 36 call 40005e00 4000612c: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 40006130: 94 92 20 00 orcc %o0, 0, %o2 40006134: 22 80 00 05 be,a 40006148 <_POSIX_Threads_Initialize_user_threads_body+0x7c> 40006138: a4 04 a0 01 inc %l2 _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 4000613c: 90 10 20 02 mov 2, %o0 40006140: 40 00 07 f9 call 40008124 <_Internal_error_Occurred> 40006144: 92 10 20 01 mov 1, %o1 * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { 40006148: 80 a4 80 13 cmp %l2, %l3 4000614c: 0a bf ff ec bcs 400060fc <_POSIX_Threads_Initialize_user_threads_body+0x30><== NEVER TAKEN 40006150: a2 04 60 08 add %l1, 8, %l1 40006154: 81 c7 e0 08 ret 40006158: 81 e8 00 00 restore =============================================================================== 4000b5f0 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 4000b5f0: 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 ]; 4000b5f4: 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 ); 4000b5f8: 40 00 04 2c call 4000c6a8 <_Timespec_To_ticks> 4000b5fc: 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); 4000b600: 03 10 00 52 sethi %hi(0x40014800), %g1 4000b604: d2 08 63 74 ldub [ %g1 + 0x374 ], %o1 ! 40014b74 4000b608: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->cpu_time_budget = ticks; 4000b60c: d0 26 60 78 st %o0, [ %i1 + 0x78 ] 4000b610: 92 22 40 01 sub %o1, %g1, %o1 */ #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 ) { 4000b614: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 4000b618: 80 a0 60 00 cmp %g1, 0 4000b61c: 12 80 00 08 bne 4000b63c <_POSIX_Threads_Sporadic_budget_TSR+0x4c><== NEVER TAKEN 4000b620: 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 ) { 4000b624: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000b628: 80 a0 40 09 cmp %g1, %o1 4000b62c: 08 80 00 04 bleu 4000b63c <_POSIX_Threads_Sporadic_budget_TSR+0x4c> 4000b630: 90 10 00 19 mov %i1, %o0 _Thread_Change_priority( the_thread, new_priority, true ); 4000b634: 7f ff f1 a9 call 40007cd8 <_Thread_Change_priority> 4000b638: 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 ); 4000b63c: 40 00 04 1b call 4000c6a8 <_Timespec_To_ticks> 4000b640: 90 04 20 90 add %l0, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000b644: 31 10 00 55 sethi %hi(0x40015400), %i0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000b648: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000b64c: b0 16 21 c0 or %i0, 0x1c0, %i0 4000b650: 7f ff f6 93 call 4000909c <_Watchdog_Insert> 4000b654: 93 ec 20 a8 restore %l0, 0xa8, %o1 =============================================================================== 4000b65c <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000b65c: c4 02 21 58 ld [ %o0 + 0x158 ], %g2 /* * 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 */ 4000b660: 86 10 3f ff mov -1, %g3 4000b664: c4 00 a0 8c ld [ %g2 + 0x8c ], %g2 4000b668: c6 22 20 78 st %g3, [ %o0 + 0x78 ] 4000b66c: 07 10 00 52 sethi %hi(0x40014800), %g3 4000b670: d2 08 e3 74 ldub [ %g3 + 0x374 ], %o1 ! 40014b74 4000b674: 92 22 40 02 sub %o1, %g2, %o1 */ #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 ) { 4000b678: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 4000b67c: 80 a0 a0 00 cmp %g2, 0 4000b680: 12 80 00 09 bne 4000b6a4 <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000b684: d2 22 20 18 st %o1, [ %o0 + 0x18 ] /* * 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 ) { 4000b688: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000b68c: 80 a0 40 09 cmp %g1, %o1 4000b690: 1a 80 00 05 bcc 4000b6a4 <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000b694: 94 10 20 01 mov 1, %o2 _Thread_Change_priority( the_thread, new_priority, true ); 4000b698: 82 13 c0 00 mov %o7, %g1 4000b69c: 7f ff f1 8f call 40007cd8 <_Thread_Change_priority> 4000b6a0: 9e 10 40 00 mov %g1, %o7 4000b6a4: 81 c3 e0 08 retl <== NOT EXECUTED =============================================================================== 40005e0c <_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) { 40005e0c: 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; 40005e10: c2 06 60 68 ld [ %i1 + 0x68 ], %g1 40005e14: 82 00 60 01 inc %g1 40005e18: c2 26 60 68 st %g1, [ %i1 + 0x68 ] /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 40005e1c: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 40005e20: 80 a0 60 00 cmp %g1, 0 40005e24: 32 80 00 07 bne,a 40005e40 <_POSIX_Timer_TSR+0x34> 40005e28: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40005e2c: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 40005e30: 80 a0 60 00 cmp %g1, 0 40005e34: 02 80 00 0f be 40005e70 <_POSIX_Timer_TSR+0x64> <== NEVER TAKEN 40005e38: 82 10 20 04 mov 4, %g1 ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 40005e3c: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40005e40: d4 06 60 08 ld [ %i1 + 8 ], %o2 40005e44: 90 06 60 10 add %i1, 0x10, %o0 40005e48: 17 10 00 17 sethi %hi(0x40005c00), %o3 40005e4c: 98 10 00 19 mov %i1, %o4 40005e50: 40 00 19 80 call 4000c450 <_POSIX_Timer_Insert_helper> 40005e54: 96 12 e2 0c or %o3, 0x20c, %o3 ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 40005e58: 80 8a 20 ff btst 0xff, %o0 40005e5c: 02 80 00 0a be 40005e84 <_POSIX_Timer_TSR+0x78> <== NEVER TAKEN 40005e60: 01 00 00 00 nop return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 40005e64: 40 00 05 c2 call 4000756c <_TOD_Get> 40005e68: 90 06 60 6c add %i1, 0x6c, %o0 40005e6c: 82 10 20 03 mov 3, %g1 /* * 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 ) ) { 40005e70: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 40005e74: d2 06 60 44 ld [ %i1 + 0x44 ], %o1 40005e78: 40 00 18 60 call 4000bff8 40005e7c: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 40005e80: c0 26 60 68 clr [ %i1 + 0x68 ] 40005e84: 81 c7 e0 08 ret 40005e88: 81 e8 00 00 restore =============================================================================== 4000da6c <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000da6c: 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, 4000da70: 98 10 20 01 mov 1, %o4 4000da74: 90 10 00 18 mov %i0, %o0 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000da78: 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, 4000da7c: a2 07 bf f4 add %fp, -12, %l1 4000da80: 92 10 00 19 mov %i1, %o1 4000da84: 94 10 00 11 mov %l1, %o2 4000da88: 96 0e a0 ff and %i2, 0xff, %o3 4000da8c: 40 00 00 2c call 4000db3c <_POSIX_signals_Clear_signals> 4000da90: b0 10 20 00 clr %i0 4000da94: 80 8a 20 ff btst 0xff, %o0 4000da98: 02 80 00 27 be 4000db34 <_POSIX_signals_Check_signal+0xc8> 4000da9c: 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 ) 4000daa0: 2b 10 00 56 sethi %hi(0x40015800), %l5 4000daa4: a9 2e 60 04 sll %i1, 4, %l4 4000daa8: aa 15 62 90 or %l5, 0x290, %l5 4000daac: a8 25 00 01 sub %l4, %g1, %l4 4000dab0: 82 05 40 14 add %l5, %l4, %g1 4000dab4: e4 00 60 08 ld [ %g1 + 8 ], %l2 4000dab8: 80 a4 a0 01 cmp %l2, 1 4000dabc: 02 80 00 1e be 4000db34 <_POSIX_signals_Check_signal+0xc8><== NEVER TAKEN 4000dac0: 90 07 bf cc add %fp, -52, %o0 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 4000dac4: e6 04 20 d0 ld [ %l0 + 0xd0 ], %l3 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000dac8: c2 00 60 04 ld [ %g1 + 4 ], %g1 4000dacc: 82 10 40 13 or %g1, %l3, %g1 4000dad0: 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, 4000dad4: 03 10 00 56 sethi %hi(0x40015800), %g1 4000dad8: d2 00 62 44 ld [ %g1 + 0x244 ], %o1 ! 40015a44 <_Per_CPU_Information+0xc> 4000dadc: 94 10 20 28 mov 0x28, %o2 4000dae0: 40 00 04 2e call 4000eb98 4000dae4: 92 02 60 20 add %o1, 0x20, %o1 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 4000dae8: c2 05 40 14 ld [ %l5 + %l4 ], %g1 4000daec: 80 a0 60 02 cmp %g1, 2 4000daf0: 12 80 00 07 bne 4000db0c <_POSIX_signals_Check_signal+0xa0> 4000daf4: 90 10 00 19 mov %i1, %o0 case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 4000daf8: 92 10 00 11 mov %l1, %o1 4000dafc: 9f c4 80 00 call %l2 4000db00: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 4000db04: 10 80 00 05 b 4000db18 <_POSIX_signals_Check_signal+0xac> 4000db08: 03 10 00 56 sethi %hi(0x40015800), %g1 default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 4000db0c: 9f c4 80 00 call %l2 4000db10: 90 10 00 19 mov %i1, %o0 } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 4000db14: 03 10 00 56 sethi %hi(0x40015800), %g1 4000db18: d0 00 62 44 ld [ %g1 + 0x244 ], %o0 ! 40015a44 <_Per_CPU_Information+0xc> 4000db1c: 92 07 bf cc add %fp, -52, %o1 4000db20: 90 02 20 20 add %o0, 0x20, %o0 4000db24: 94 10 20 28 mov 0x28, %o2 4000db28: 40 00 04 1c call 4000eb98 4000db2c: b0 10 20 01 mov 1, %i0 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 4000db30: e6 24 20 d0 st %l3, [ %l0 + 0xd0 ] return true; } 4000db34: 81 c7 e0 08 ret 4000db38: 81 e8 00 00 restore =============================================================================== 4000e19c <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 4000e19c: 9d e3 bf a0 save %sp, -96, %sp clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4000e1a0: 7f ff ce be call 40001c98 4000e1a4: 01 00 00 00 nop if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4000e1a8: 85 2e 20 04 sll %i0, 4, %g2 4000e1ac: 83 2e 20 02 sll %i0, 2, %g1 4000e1b0: 82 20 80 01 sub %g2, %g1, %g1 4000e1b4: 05 10 00 56 sethi %hi(0x40015800), %g2 4000e1b8: 84 10 a2 90 or %g2, 0x290, %g2 ! 40015a90 <_POSIX_signals_Vectors> 4000e1bc: c4 00 80 01 ld [ %g2 + %g1 ], %g2 4000e1c0: 80 a0 a0 02 cmp %g2, 2 4000e1c4: 12 80 00 0a bne 4000e1ec <_POSIX_signals_Clear_process_signals+0x50> 4000e1c8: 84 10 20 01 mov 1, %g2 } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } 4000e1cc: 05 10 00 57 sethi %hi(0x40015c00), %g2 4000e1d0: 84 10 a0 88 or %g2, 0x88, %g2 ! 40015c88 <_POSIX_signals_Siginfo> RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000e1d4: 86 00 40 02 add %g1, %g2, %g3 ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 4000e1d8: c2 00 80 01 ld [ %g2 + %g1 ], %g1 4000e1dc: 86 00 e0 04 add %g3, 4, %g3 4000e1e0: 80 a0 40 03 cmp %g1, %g3 4000e1e4: 12 80 00 08 bne 4000e204 <_POSIX_signals_Clear_process_signals+0x68><== NEVER TAKEN 4000e1e8: 84 10 20 01 mov 1, %g2 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 4000e1ec: 03 10 00 57 sethi %hi(0x40015c00), %g1 4000e1f0: b0 06 3f ff add %i0, -1, %i0 4000e1f4: b1 28 80 18 sll %g2, %i0, %i0 4000e1f8: c4 00 60 84 ld [ %g1 + 0x84 ], %g2 4000e1fc: b0 28 80 18 andn %g2, %i0, %i0 4000e200: f0 20 60 84 st %i0, [ %g1 + 0x84 ] } _ISR_Enable( level ); 4000e204: 7f ff ce a9 call 40001ca8 4000e208: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006884 <_POSIX_signals_Get_lowest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40006884: 82 10 20 1b mov 0x1b, %g1 ! 1b 40006888: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 4000688c: 86 00 7f ff add %g1, -1, %g3 40006890: 87 28 80 03 sll %g2, %g3, %g3 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 40006894: 80 88 c0 08 btst %g3, %o0 40006898: 12 80 00 11 bne 400068dc <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 4000689c: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 400068a0: 82 00 60 01 inc %g1 400068a4: 80 a0 60 20 cmp %g1, 0x20 400068a8: 12 bf ff fa bne 40006890 <_POSIX_signals_Get_lowest+0xc> 400068ac: 86 00 7f ff add %g1, -1, %g3 400068b0: 82 10 20 01 mov 1, %g1 400068b4: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 400068b8: 86 00 7f ff add %g1, -1, %g3 400068bc: 87 28 80 03 sll %g2, %g3, %g3 #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 400068c0: 80 88 c0 08 btst %g3, %o0 400068c4: 12 80 00 06 bne 400068dc <_POSIX_signals_Get_lowest+0x58> 400068c8: 01 00 00 00 nop */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 400068cc: 82 00 60 01 inc %g1 400068d0: 80 a0 60 1b cmp %g1, 0x1b 400068d4: 12 bf ff fa bne 400068bc <_POSIX_signals_Get_lowest+0x38> <== ALWAYS TAKEN 400068d8: 86 00 7f ff add %g1, -1, %g3 * a return 0. This routine will NOT be called unless a signal * is pending in the set passed in. */ found_it: return signo; } 400068dc: 81 c3 e0 08 retl 400068e0: 90 10 00 01 mov %g1, %o0 =============================================================================== 4002347c <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 4002347c: 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 ) ) { 40023480: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 40023484: 1b 04 00 20 sethi %hi(0x10008000), %o5 40023488: 84 06 7f ff add %i1, -1, %g2 4002348c: 86 10 20 01 mov 1, %g3 40023490: 98 08 40 0d and %g1, %o5, %o4 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 40023494: a0 10 00 18 mov %i0, %l0 40023498: 92 10 00 1a mov %i2, %o1 POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4002349c: c8 06 21 58 ld [ %i0 + 0x158 ], %g4 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 400234a0: 80 a3 00 0d cmp %o4, %o5 400234a4: 12 80 00 1b bne 40023510 <_POSIX_signals_Unblock_thread+0x94> 400234a8: 85 28 c0 02 sll %g3, %g2, %g2 if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 400234ac: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 400234b0: 80 88 80 01 btst %g2, %g1 400234b4: 12 80 00 07 bne 400234d0 <_POSIX_signals_Unblock_thread+0x54> 400234b8: 82 10 20 04 mov 4, %g1 400234bc: c2 01 20 d0 ld [ %g4 + 0xd0 ], %g1 400234c0: 80 a8 80 01 andncc %g2, %g1, %g0 400234c4: 02 80 00 11 be 40023508 <_POSIX_signals_Unblock_thread+0x8c> 400234c8: b0 10 20 00 clr %i0 the_thread->Wait.return_code = EINTR; 400234cc: 82 10 20 04 mov 4, %g1 400234d0: c2 24 20 34 st %g1, [ %l0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 400234d4: 80 a2 60 00 cmp %o1, 0 400234d8: 12 80 00 07 bne 400234f4 <_POSIX_signals_Unblock_thread+0x78> 400234dc: d0 04 20 28 ld [ %l0 + 0x28 ], %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 400234e0: 82 10 20 01 mov 1, %g1 the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; 400234e4: f2 22 00 00 st %i1, [ %o0 ] the_info->si_code = SI_USER; 400234e8: c2 22 20 04 st %g1, [ %o0 + 4 ] the_info->si_value.sival_int = 0; 400234ec: 10 80 00 04 b 400234fc <_POSIX_signals_Unblock_thread+0x80> 400234f0: c0 22 20 08 clr [ %o0 + 8 ] } else { *the_info = *info; 400234f4: 7f ff c3 ad call 400143a8 400234f8: 94 10 20 0c mov 0xc, %o2 } _Thread_queue_Extract_with_proxy( the_thread ); 400234fc: 90 10 00 10 mov %l0, %o0 40023500: 7f ff aa bc call 4000dff0 <_Thread_queue_Extract_with_proxy> 40023504: b0 10 20 01 mov 1, %i0 return true; 40023508: 81 c7 e0 08 ret 4002350c: 81 e8 00 00 restore } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 40023510: c8 01 20 d0 ld [ %g4 + 0xd0 ], %g4 40023514: 80 a8 80 04 andncc %g2, %g4, %g0 40023518: 02 bf ff fc be 40023508 <_POSIX_signals_Unblock_thread+0x8c> 4002351c: b0 10 20 00 clr %i0 * 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 ) ) { 40023520: 05 04 00 00 sethi %hi(0x10000000), %g2 40023524: 80 88 40 02 btst %g1, %g2 40023528: 02 80 00 17 be 40023584 <_POSIX_signals_Unblock_thread+0x108> 4002352c: 80 a0 60 00 cmp %g1, 0 the_thread->Wait.return_code = EINTR; 40023530: 84 10 20 04 mov 4, %g2 40023534: c4 24 20 34 st %g2, [ %l0 + 0x34 ] /* * 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) ) 40023538: 05 00 00 ef sethi %hi(0x3bc00), %g2 4002353c: 84 10 a2 e0 or %g2, 0x2e0, %g2 ! 3bee0 40023540: 80 88 40 02 btst %g1, %g2 40023544: 02 80 00 06 be 4002355c <_POSIX_signals_Unblock_thread+0xe0> 40023548: 80 88 60 08 btst 8, %g1 _Thread_queue_Extract_with_proxy( the_thread ); 4002354c: 7f ff aa a9 call 4000dff0 <_Thread_queue_Extract_with_proxy> 40023550: 90 10 00 10 mov %l0, %o0 40023554: 81 c7 e0 08 ret 40023558: 81 e8 00 00 restore else if ( _States_Is_delaying(the_thread->current_state) ) { 4002355c: 02 80 00 15 be 400235b0 <_POSIX_signals_Unblock_thread+0x134><== NEVER TAKEN 40023560: 01 00 00 00 nop (void) _Watchdog_Remove( &the_thread->Timer ); 40023564: 7f ff ac ee call 4000e91c <_Watchdog_Remove> 40023568: 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 ); 4002356c: 90 10 00 10 mov %l0, %o0 40023570: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40023574: 7f ff a8 00 call 4000d574 <_Thread_Clear_state> 40023578: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 4002357c: 81 c7 e0 08 ret 40023580: 81 e8 00 00 restore _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 40023584: 12 bf ff e1 bne 40023508 <_POSIX_signals_Unblock_thread+0x8c><== NEVER TAKEN 40023588: 03 10 00 9c sethi %hi(0x40027000), %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 4002358c: 82 10 60 18 or %g1, 0x18, %g1 ! 40027018 <_Per_CPU_Information> 40023590: c4 00 60 08 ld [ %g1 + 8 ], %g2 40023594: 80 a0 a0 00 cmp %g2, 0 40023598: 02 80 00 06 be 400235b0 <_POSIX_signals_Unblock_thread+0x134> 4002359c: 01 00 00 00 nop 400235a0: c4 00 60 0c ld [ %g1 + 0xc ], %g2 400235a4: 80 a4 00 02 cmp %l0, %g2 400235a8: 22 bf ff d8 be,a 40023508 <_POSIX_signals_Unblock_thread+0x8c><== ALWAYS TAKEN 400235ac: c6 28 60 18 stb %g3, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } } return false; } 400235b0: 81 c7 e0 08 ret 400235b4: 81 e8 00 00 restore =============================================================================== 40007318 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 40007318: 9d e3 bf 98 save %sp, -104, %sp 4000731c: 11 10 00 7d sethi %hi(0x4001f400), %o0 40007320: 92 10 00 18 mov %i0, %o1 40007324: 90 12 21 2c or %o0, 0x12c, %o0 40007328: 40 00 07 f3 call 400092f4 <_Objects_Get> 4000732c: 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 ) { 40007330: c2 07 bf fc ld [ %fp + -4 ], %g1 40007334: 80 a0 60 00 cmp %g1, 0 40007338: 12 80 00 24 bne 400073c8 <_Rate_monotonic_Timeout+0xb0> <== NEVER TAKEN 4000733c: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: the_thread = the_period->owner; 40007340: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 40007344: 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); 40007348: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 4000734c: 80 88 80 01 btst %g2, %g1 40007350: 22 80 00 0b be,a 4000737c <_Rate_monotonic_Timeout+0x64> 40007354: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 40007358: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 4000735c: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007360: 80 a0 80 01 cmp %g2, %g1 40007364: 32 80 00 06 bne,a 4000737c <_Rate_monotonic_Timeout+0x64> 40007368: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 4000736c: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40007370: 40 00 0a 27 call 40009c0c <_Thread_Clear_state> 40007374: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 40007378: 30 80 00 06 b,a 40007390 <_Rate_monotonic_Timeout+0x78> _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 ) { 4000737c: 80 a0 60 01 cmp %g1, 1 40007380: 12 80 00 0d bne 400073b4 <_Rate_monotonic_Timeout+0x9c> 40007384: 82 10 20 04 mov 4, %g1 the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 40007388: 82 10 20 03 mov 3, %g1 4000738c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 40007390: 7f ff fe 66 call 40006d28 <_Rate_monotonic_Initiate_statistics> 40007394: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007398: c2 04 20 3c ld [ %l0 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000739c: 11 10 00 7d sethi %hi(0x4001f400), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400073a0: c2 24 20 1c st %g1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400073a4: 90 12 23 70 or %o0, 0x370, %o0 400073a8: 40 00 0f 21 call 4000b02c <_Watchdog_Insert> 400073ac: 92 04 20 10 add %l0, 0x10, %o1 400073b0: 30 80 00 02 b,a 400073b8 <_Rate_monotonic_Timeout+0xa0> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 400073b4: 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; 400073b8: 03 10 00 7d sethi %hi(0x4001f400), %g1 400073bc: c4 00 62 90 ld [ %g1 + 0x290 ], %g2 ! 4001f690 <_Thread_Dispatch_disable_level> 400073c0: 84 00 bf ff add %g2, -1, %g2 400073c4: c4 20 62 90 st %g2, [ %g1 + 0x290 ] 400073c8: 81 c7 e0 08 ret 400073cc: 81 e8 00 00 restore =============================================================================== 4000c264 <_Scheduler_priority_Block>: void _Scheduler_priority_Block( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { 4000c264: 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; 4000c268: c2 06 60 8c ld [ %i1 + 0x8c ], %g1 4000c26c: c2 00 40 00 ld [ %g1 ], %g1 if ( _Chain_Has_only_one_node( ready ) ) { 4000c270: c6 00 40 00 ld [ %g1 ], %g3 4000c274: c4 00 60 08 ld [ %g1 + 8 ], %g2 4000c278: 80 a0 c0 02 cmp %g3, %g2 4000c27c: 32 80 00 17 bne,a 4000c2d8 <_Scheduler_priority_Block+0x74> 4000c280: c4 06 40 00 ld [ %i1 ], %g2 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 4000c284: c0 20 60 04 clr [ %g1 + 4 ] RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4000c288: 84 00 60 04 add %g1, 4, %g2 head->next = tail; head->previous = NULL; tail->previous = head; 4000c28c: c2 20 60 08 st %g1, [ %g1 + 8 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 4000c290: c4 20 40 00 st %g2, [ %g1 ] _Chain_Initialize_empty( ready ); _Priority_bit_map_Remove( &the_thread->scheduler.priority->Priority_map ); 4000c294: 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; 4000c298: c6 00 60 04 ld [ %g1 + 4 ], %g3 4000c29c: c4 10 60 0e lduh [ %g1 + 0xe ], %g2 4000c2a0: c8 10 c0 00 lduh [ %g3 ], %g4 4000c2a4: 84 09 00 02 and %g4, %g2, %g2 4000c2a8: c4 30 c0 00 sth %g2, [ %g3 ] if ( *the_priority_map->minor == 0 ) 4000c2ac: 85 28 a0 10 sll %g2, 0x10, %g2 4000c2b0: 80 a0 a0 00 cmp %g2, 0 4000c2b4: 32 80 00 0d bne,a 4000c2e8 <_Scheduler_priority_Block+0x84> 4000c2b8: 03 10 00 56 sethi %hi(0x40015800), %g1 _Priority_Major_bit_map &= the_priority_map->block_major; 4000c2bc: 05 10 00 56 sethi %hi(0x40015800), %g2 4000c2c0: c2 10 60 0c lduh [ %g1 + 0xc ], %g1 4000c2c4: c6 10 a2 60 lduh [ %g2 + 0x260 ], %g3 4000c2c8: 82 08 40 03 and %g1, %g3, %g1 4000c2cc: c2 30 a2 60 sth %g1, [ %g2 + 0x260 ] RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); 4000c2d0: 10 80 00 06 b 4000c2e8 <_Scheduler_priority_Block+0x84> 4000c2d4: 03 10 00 56 sethi %hi(0x40015800), %g1 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4000c2d8: c2 06 60 04 ld [ %i1 + 4 ], %g1 next->previous = previous; 4000c2dc: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000c2e0: c4 20 40 00 st %g2, [ %g1 ] 4000c2e4: 03 10 00 56 sethi %hi(0x40015800), %g1 { _Scheduler_priority_Ready_queue_extract(the_thread); /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) 4000c2e8: c2 00 62 48 ld [ %g1 + 0x248 ], %g1 ! 40015a48 <_Per_CPU_Information+0x10> 4000c2ec: 80 a6 40 01 cmp %i1, %g1 4000c2f0: 32 80 00 32 bne,a 4000c3b8 <_Scheduler_priority_Block+0x154> 4000c2f4: 03 10 00 56 sethi %hi(0x40015800), %g1 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 ); 4000c2f8: 03 10 00 56 sethi %hi(0x40015800), %g1 4000c2fc: c4 10 62 60 lduh [ %g1 + 0x260 ], %g2 ! 40015a60 <_Priority_Major_bit_map> _Scheduler_priority_Block_body(the_scheduler, the_thread); } 4000c300: c6 06 00 00 ld [ %i0 ], %g3 4000c304: 85 28 a0 10 sll %g2, 0x10, %g2 4000c308: 03 10 00 50 sethi %hi(0x40014000), %g1 4000c30c: 89 30 a0 10 srl %g2, 0x10, %g4 4000c310: 80 a1 20 ff cmp %g4, 0xff 4000c314: 18 80 00 05 bgu 4000c328 <_Scheduler_priority_Block+0xc4> 4000c318: 82 10 60 50 or %g1, 0x50, %g1 4000c31c: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 4000c320: 10 80 00 04 b 4000c330 <_Scheduler_priority_Block+0xcc> 4000c324: 84 00 a0 08 add %g2, 8, %g2 4000c328: 85 30 a0 18 srl %g2, 0x18, %g2 4000c32c: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4000c330: 83 28 a0 10 sll %g2, 0x10, %g1 4000c334: 09 10 00 56 sethi %hi(0x40015800), %g4 4000c338: 83 30 60 0f srl %g1, 0xf, %g1 4000c33c: 88 11 22 70 or %g4, 0x270, %g4 4000c340: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 4000c344: 03 10 00 50 sethi %hi(0x40014000), %g1 4000c348: 89 29 20 10 sll %g4, 0x10, %g4 4000c34c: 9b 31 20 10 srl %g4, 0x10, %o5 4000c350: 80 a3 60 ff cmp %o5, 0xff 4000c354: 18 80 00 05 bgu 4000c368 <_Scheduler_priority_Block+0x104> 4000c358: 82 10 60 50 or %g1, 0x50, %g1 4000c35c: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 4000c360: 10 80 00 04 b 4000c370 <_Scheduler_priority_Block+0x10c> 4000c364: 82 00 60 08 add %g1, 8, %g1 4000c368: 89 31 20 18 srl %g4, 0x18, %g4 4000c36c: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 4000c370: 83 28 60 10 sll %g1, 0x10, %g1 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) + 4000c374: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 4000c378: 83 30 60 10 srl %g1, 0x10, %g1 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) + 4000c37c: 85 30 a0 0c srl %g2, 0xc, %g2 4000c380: 84 00 40 02 add %g1, %g2, %g2 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 4000c384: 89 28 a0 02 sll %g2, 2, %g4 4000c388: 83 28 a0 04 sll %g2, 4, %g1 4000c38c: 82 20 40 04 sub %g1, %g4, %g1 4000c390: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 4000c394: 88 00 c0 01 add %g3, %g1, %g4 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000c398: 86 01 20 04 add %g4, 4, %g3 4000c39c: 80 a0 80 03 cmp %g2, %g3 4000c3a0: 02 80 00 03 be 4000c3ac <_Scheduler_priority_Block+0x148> <== NEVER TAKEN 4000c3a4: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 4000c3a8: 82 10 00 02 mov %g2, %g1 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 4000c3ac: 05 10 00 56 sethi %hi(0x40015800), %g2 4000c3b0: c2 20 a2 48 st %g1, [ %g2 + 0x248 ] ! 40015a48 <_Per_CPU_Information+0x10> RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 4000c3b4: 03 10 00 56 sethi %hi(0x40015800), %g1 4000c3b8: 82 10 62 38 or %g1, 0x238, %g1 ! 40015a38 <_Per_CPU_Information> /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(the_scheduler); if ( _Thread_Is_executing( the_thread ) ) 4000c3bc: c4 00 60 0c ld [ %g1 + 0xc ], %g2 4000c3c0: 80 a6 40 02 cmp %i1, %g2 4000c3c4: 12 80 00 03 bne 4000c3d0 <_Scheduler_priority_Block+0x16c> 4000c3c8: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 4000c3cc: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 4000c3d0: 81 c7 e0 08 ret 4000c3d4: 81 e8 00 00 restore =============================================================================== 400079d0 <_Scheduler_priority_Schedule>: */ void _Scheduler_priority_Schedule( Scheduler_Control *the_scheduler ) { 400079d0: 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 ); 400079d4: 03 10 00 56 sethi %hi(0x40015800), %g1 400079d8: c4 10 62 60 lduh [ %g1 + 0x260 ], %g2 ! 40015a60 <_Priority_Major_bit_map> _Scheduler_priority_Schedule_body( the_scheduler ); } 400079dc: c6 06 00 00 ld [ %i0 ], %g3 400079e0: 85 28 a0 10 sll %g2, 0x10, %g2 400079e4: 03 10 00 50 sethi %hi(0x40014000), %g1 400079e8: 89 30 a0 10 srl %g2, 0x10, %g4 400079ec: 80 a1 20 ff cmp %g4, 0xff 400079f0: 18 80 00 05 bgu 40007a04 <_Scheduler_priority_Schedule+0x34> 400079f4: 82 10 60 50 or %g1, 0x50, %g1 400079f8: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 400079fc: 10 80 00 04 b 40007a0c <_Scheduler_priority_Schedule+0x3c> 40007a00: 84 00 a0 08 add %g2, 8, %g2 40007a04: 85 30 a0 18 srl %g2, 0x18, %g2 40007a08: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40007a0c: 83 28 a0 10 sll %g2, 0x10, %g1 40007a10: 09 10 00 56 sethi %hi(0x40015800), %g4 40007a14: 83 30 60 0f srl %g1, 0xf, %g1 40007a18: 88 11 22 70 or %g4, 0x270, %g4 40007a1c: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 40007a20: 03 10 00 50 sethi %hi(0x40014000), %g1 40007a24: 89 29 20 10 sll %g4, 0x10, %g4 40007a28: 9b 31 20 10 srl %g4, 0x10, %o5 40007a2c: 80 a3 60 ff cmp %o5, 0xff 40007a30: 18 80 00 05 bgu 40007a44 <_Scheduler_priority_Schedule+0x74> 40007a34: 82 10 60 50 or %g1, 0x50, %g1 40007a38: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 40007a3c: 10 80 00 04 b 40007a4c <_Scheduler_priority_Schedule+0x7c> 40007a40: 82 00 60 08 add %g1, 8, %g1 40007a44: 89 31 20 18 srl %g4, 0x18, %g4 40007a48: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 40007a4c: 83 28 60 10 sll %g1, 0x10, %g1 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) + 40007a50: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 40007a54: 83 30 60 10 srl %g1, 0x10, %g1 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) + 40007a58: 85 30 a0 0c srl %g2, 0xc, %g2 40007a5c: 84 00 40 02 add %g1, %g2, %g2 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 40007a60: 89 28 a0 02 sll %g2, 2, %g4 40007a64: 83 28 a0 04 sll %g2, 4, %g1 40007a68: 82 20 40 04 sub %g1, %g4, %g1 40007a6c: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 40007a70: 88 00 c0 01 add %g3, %g1, %g4 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40007a74: 86 01 20 04 add %g4, 4, %g3 40007a78: 80 a0 80 03 cmp %g2, %g3 40007a7c: 02 80 00 03 be 40007a88 <_Scheduler_priority_Schedule+0xb8><== NEVER TAKEN 40007a80: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 40007a84: 82 10 00 02 mov %g2, %g1 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 40007a88: 05 10 00 56 sethi %hi(0x40015800), %g2 40007a8c: c2 20 a2 48 st %g1, [ %g2 + 0x248 ] ! 40015a48 <_Per_CPU_Information+0x10> 40007a90: 81 c7 e0 08 ret 40007a94: 81 e8 00 00 restore =============================================================================== 40006d20 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40006d20: 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(); 40006d24: 03 10 00 7d sethi %hi(0x4001f400), %g1 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40006d28: 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(); 40006d2c: d2 00 61 34 ld [ %g1 + 0x134 ], %o1 if ((!the_tod) || 40006d30: 80 a4 20 00 cmp %l0, 0 40006d34: 02 80 00 2b be 40006de0 <_TOD_Validate+0xc0> <== NEVER TAKEN 40006d38: b0 10 20 00 clr %i0 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 40006d3c: 11 00 03 d0 sethi %hi(0xf4000), %o0 40006d40: 40 00 4a 62 call 400196c8 <.udiv> 40006d44: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 40006d48: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40006d4c: 80 a0 40 08 cmp %g1, %o0 40006d50: 1a 80 00 24 bcc 40006de0 <_TOD_Validate+0xc0> 40006d54: 01 00 00 00 nop (the_tod->ticks >= ticks_per_second) || 40006d58: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40006d5c: 80 a0 60 3b cmp %g1, 0x3b 40006d60: 18 80 00 20 bgu 40006de0 <_TOD_Validate+0xc0> 40006d64: 01 00 00 00 nop (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 40006d68: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40006d6c: 80 a0 60 3b cmp %g1, 0x3b 40006d70: 18 80 00 1c bgu 40006de0 <_TOD_Validate+0xc0> 40006d74: 01 00 00 00 nop (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 40006d78: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40006d7c: 80 a0 60 17 cmp %g1, 0x17 40006d80: 18 80 00 18 bgu 40006de0 <_TOD_Validate+0xc0> 40006d84: 01 00 00 00 nop (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 40006d88: 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) || 40006d8c: 80 a0 60 00 cmp %g1, 0 40006d90: 02 80 00 14 be 40006de0 <_TOD_Validate+0xc0> <== NEVER TAKEN 40006d94: 80 a0 60 0c cmp %g1, 0xc (the_tod->month == 0) || 40006d98: 18 80 00 12 bgu 40006de0 <_TOD_Validate+0xc0> 40006d9c: 01 00 00 00 nop (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 40006da0: c6 04 00 00 ld [ %l0 ], %g3 (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) || 40006da4: 80 a0 e7 c3 cmp %g3, 0x7c3 40006da8: 08 80 00 0e bleu 40006de0 <_TOD_Validate+0xc0> 40006dac: 01 00 00 00 nop (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 40006db0: c4 04 20 08 ld [ %l0 + 8 ], %g2 (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) || 40006db4: 80 a0 a0 00 cmp %g2, 0 40006db8: 02 80 00 0a be 40006de0 <_TOD_Validate+0xc0> <== NEVER TAKEN 40006dbc: 80 88 e0 03 btst 3, %g3 40006dc0: 07 10 00 78 sethi %hi(0x4001e000), %g3 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 40006dc4: 12 80 00 03 bne 40006dd0 <_TOD_Validate+0xb0> 40006dc8: 86 10 e0 30 or %g3, 0x30, %g3 ! 4001e030 <_TOD_Days_per_month> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 40006dcc: 82 00 60 0d add %g1, 0xd, %g1 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 40006dd0: 83 28 60 02 sll %g1, 2, %g1 40006dd4: c2 00 c0 01 ld [ %g3 + %g1 ], %g1 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 40006dd8: 80 a0 40 02 cmp %g1, %g2 40006ddc: b0 60 3f ff subx %g0, -1, %i0 if ( the_tod->day > days_in_month ) return false; return true; } 40006de0: 81 c7 e0 08 ret 40006de4: 81 e8 00 00 restore =============================================================================== 40007cd8 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 40007cd8: 9d e3 bf a0 save %sp, -96, %sp */ /* * Save original state */ original_state = the_thread->current_state; 40007cdc: 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 ); 40007ce0: 40 00 03 77 call 40008abc <_Thread_Set_transient> 40007ce4: 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 ) 40007ce8: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40007cec: 80 a0 40 19 cmp %g1, %i1 40007cf0: 02 80 00 05 be 40007d04 <_Thread_Change_priority+0x2c> 40007cf4: a0 10 00 18 mov %i0, %l0 _Thread_Set_priority( the_thread, new_priority ); 40007cf8: 90 10 00 18 mov %i0, %o0 40007cfc: 40 00 03 54 call 40008a4c <_Thread_Set_priority> 40007d00: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 40007d04: 7f ff e7 e5 call 40001c98 40007d08: 01 00 00 00 nop 40007d0c: 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; 40007d10: f2 04 20 10 ld [ %l0 + 0x10 ], %i1 if ( state != STATES_TRANSIENT ) { 40007d14: 80 a6 60 04 cmp %i1, 4 40007d18: 02 80 00 10 be 40007d58 <_Thread_Change_priority+0x80> 40007d1c: a2 0c 60 04 and %l1, 4, %l1 /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 40007d20: 80 a4 60 00 cmp %l1, 0 40007d24: 12 80 00 03 bne 40007d30 <_Thread_Change_priority+0x58> <== NEVER TAKEN 40007d28: 82 0e 7f fb and %i1, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 40007d2c: c2 24 20 10 st %g1, [ %l0 + 0x10 ] _ISR_Enable( level ); 40007d30: 7f ff e7 de call 40001ca8 40007d34: 90 10 00 18 mov %i0, %o0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 40007d38: 03 00 00 ef sethi %hi(0x3bc00), %g1 40007d3c: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 40007d40: 80 8e 40 01 btst %i1, %g1 40007d44: 02 80 00 44 be 40007e54 <_Thread_Change_priority+0x17c> 40007d48: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 40007d4c: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 40007d50: 40 00 03 12 call 40008998 <_Thread_queue_Requeue> 40007d54: 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 ) ) { 40007d58: 80 a4 60 00 cmp %l1, 0 40007d5c: 12 80 00 26 bne 40007df4 <_Thread_Change_priority+0x11c> <== NEVER TAKEN 40007d60: 80 8e a0 ff btst 0xff, %i2 * Ready Queue with interrupts off. * * 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 ); 40007d64: c0 24 20 10 clr [ %l0 + 0x10 ] 40007d68: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 if ( prepend_it ) 40007d6c: 02 80 00 12 be 40007db4 <_Thread_Change_priority+0xdc> 40007d70: 05 10 00 56 sethi %hi(0x40015800), %g2 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 40007d74: c6 00 60 04 ld [ %g1 + 4 ], %g3 40007d78: c8 10 60 0a lduh [ %g1 + 0xa ], %g4 40007d7c: da 10 c0 00 lduh [ %g3 ], %o5 40007d80: 88 13 40 04 or %o5, %g4, %g4 40007d84: c8 30 c0 00 sth %g4, [ %g3 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 40007d88: c6 10 a2 60 lduh [ %g2 + 0x260 ], %g3 40007d8c: c8 10 60 08 lduh [ %g1 + 8 ], %g4 Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); _Chain_Prepend_unprotected( the_thread->scheduler.priority->ready_chain, 40007d90: c2 00 40 00 ld [ %g1 ], %g1 40007d94: 86 11 00 03 or %g4, %g3, %g3 40007d98: c6 30 a2 60 sth %g3, [ %g2 + 0x260 ] ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 40007d9c: c4 00 40 00 ld [ %g1 ], %g2 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 40007da0: c2 24 20 04 st %g1, [ %l0 + 4 ] before_node = after_node->next; after_node->next = the_node; 40007da4: e0 20 40 00 st %l0, [ %g1 ] the_node->next = before_node; 40007da8: c4 24 00 00 st %g2, [ %l0 ] before_node->previous = the_node; 40007dac: 10 80 00 12 b 40007df4 <_Thread_Change_priority+0x11c> 40007db0: e0 20 a0 04 st %l0, [ %g2 + 4 ] RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 40007db4: c6 00 60 04 ld [ %g1 + 4 ], %g3 40007db8: c8 10 60 0a lduh [ %g1 + 0xa ], %g4 40007dbc: da 10 c0 00 lduh [ %g3 ], %o5 40007dc0: 88 13 40 04 or %o5, %g4, %g4 40007dc4: c8 30 c0 00 sth %g4, [ %g3 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 40007dc8: c8 10 60 08 lduh [ %g1 + 8 ], %g4 40007dcc: c6 10 a2 60 lduh [ %g2 + 0x260 ], %g3 Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); _Chain_Append_unprotected( the_thread->scheduler.priority->ready_chain, 40007dd0: c2 00 40 00 ld [ %g1 ], %g1 40007dd4: 86 11 00 03 or %g4, %g3, %g3 40007dd8: c6 30 a2 60 sth %g3, [ %g2 + 0x260 ] Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 40007ddc: c4 00 60 08 ld [ %g1 + 8 ], %g2 RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 40007de0: 86 00 60 04 add %g1, 4, %g3 Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; 40007de4: e0 20 60 08 st %l0, [ %g1 + 8 ] ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; 40007de8: c6 24 00 00 st %g3, [ %l0 ] tail->previous = the_node; old_last->next = the_node; 40007dec: e0 20 80 00 st %l0, [ %g2 ] the_node->previous = old_last; 40007df0: c4 24 20 04 st %g2, [ %l0 + 4 ] _Scheduler_priority_Ready_queue_enqueue_first( the_thread ); else _Scheduler_priority_Ready_queue_enqueue( the_thread ); } _ISR_Flash( level ); 40007df4: 7f ff e7 ad call 40001ca8 40007df8: 90 10 00 18 mov %i0, %o0 40007dfc: 7f ff e7 a7 call 40001c98 40007e00: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( Scheduler_Control *the_scheduler ) { the_scheduler->Operations.schedule( the_scheduler ); 40007e04: 11 10 00 55 sethi %hi(0x40015400), %o0 40007e08: 90 12 21 64 or %o0, 0x164, %o0 ! 40015564 <_Scheduler> 40007e0c: c2 02 20 04 ld [ %o0 + 4 ], %g1 40007e10: 9f c0 40 00 call %g1 40007e14: 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 ); 40007e18: 03 10 00 56 sethi %hi(0x40015800), %g1 40007e1c: 82 10 62 38 or %g1, 0x238, %g1 ! 40015a38 <_Per_CPU_Information> 40007e20: 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() && 40007e24: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40007e28: 80 a0 80 03 cmp %g2, %g3 40007e2c: 02 80 00 08 be 40007e4c <_Thread_Change_priority+0x174> 40007e30: 01 00 00 00 nop 40007e34: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 40007e38: 80 a0 a0 00 cmp %g2, 0 40007e3c: 02 80 00 04 be 40007e4c <_Thread_Change_priority+0x174> 40007e40: 01 00 00 00 nop _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 40007e44: 84 10 20 01 mov 1, %g2 ! 1 40007e48: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] _ISR_Enable( level ); 40007e4c: 7f ff e7 97 call 40001ca8 40007e50: 81 e8 00 00 restore 40007e54: 81 c7 e0 08 ret 40007e58: 81 e8 00 00 restore =============================================================================== 4000803c <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 4000803c: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40008040: 90 10 00 18 mov %i0, %o0 40008044: 40 00 00 5f call 400081c0 <_Thread_Get> 40008048: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000804c: c2 07 bf fc ld [ %fp + -4 ], %g1 40008050: 80 a0 60 00 cmp %g1, 0 40008054: 12 80 00 08 bne 40008074 <_Thread_Delay_ended+0x38> <== NEVER TAKEN 40008058: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 4000805c: 7f ff ff 80 call 40007e5c <_Thread_Clear_state> 40008060: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 40008064: 03 10 00 55 sethi %hi(0x40015400), %g1 40008068: c4 00 60 e0 ld [ %g1 + 0xe0 ], %g2 ! 400154e0 <_Thread_Dispatch_disable_level> 4000806c: 84 00 bf ff add %g2, -1, %g2 40008070: c4 20 60 e0 st %g2, [ %g1 + 0xe0 ] 40008074: 81 c7 e0 08 ret 40008078: 81 e8 00 00 restore =============================================================================== 4000807c <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 4000807c: 9d e3 bf 90 save %sp, -112, %sp Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 40008080: 2b 10 00 56 sethi %hi(0x40015800), %l5 40008084: 82 15 62 38 or %l5, 0x238, %g1 ! 40015a38 <_Per_CPU_Information> _ISR_Disable( level ); 40008088: 7f ff e7 04 call 40001c98 4000808c: e2 00 60 0c ld [ %g1 + 0xc ], %l1 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 40008090: 25 10 00 55 sethi %hi(0x40015400), %l2 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 40008094: 39 10 00 55 sethi %hi(0x40015400), %i4 40008098: ba 10 20 01 mov 1, %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; 4000809c: 2f 10 00 55 sethi %hi(0x40015400), %l7 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 400080a0: a8 07 bf f8 add %fp, -8, %l4 _Timestamp_Subtract( 400080a4: a6 07 bf f0 add %fp, -16, %l3 400080a8: a4 14 a1 ac or %l2, 0x1ac, %l2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 400080ac: 10 80 00 2b b 40008158 <_Thread_Dispatch+0xdc> 400080b0: 2d 10 00 55 sethi %hi(0x40015400), %l6 heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 400080b4: fa 27 20 e0 st %i5, [ %i4 + 0xe0 ] _Thread_Dispatch_necessary = false; 400080b8: c0 28 60 18 clrb [ %g1 + 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 ) 400080bc: 80 a4 00 11 cmp %l0, %l1 400080c0: 02 80 00 2b be 4000816c <_Thread_Dispatch+0xf0> 400080c4: e0 20 60 0c st %l0, [ %g1 + 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 ) 400080c8: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 400080cc: 80 a0 60 01 cmp %g1, 1 400080d0: 12 80 00 03 bne 400080dc <_Thread_Dispatch+0x60> 400080d4: c2 05 e0 44 ld [ %l7 + 0x44 ], %g1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 400080d8: c2 24 20 78 st %g1, [ %l0 + 0x78 ] _ISR_Enable( level ); 400080dc: 7f ff e6 f3 call 40001ca8 400080e0: 01 00 00 00 nop #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 400080e4: 40 00 0f 49 call 4000be08 <_TOD_Get_uptime> 400080e8: 90 10 00 14 mov %l4, %o0 _Timestamp_Subtract( 400080ec: 90 10 00 12 mov %l2, %o0 400080f0: 92 10 00 14 mov %l4, %o1 400080f4: 40 00 03 2b call 40008da0 <_Timespec_Subtract> 400080f8: 94 10 00 13 mov %l3, %o2 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 400080fc: 90 04 60 84 add %l1, 0x84, %o0 40008100: 40 00 03 0f call 40008d3c <_Timespec_Add_to> 40008104: 92 10 00 13 mov %l3, %o1 _Thread_Time_of_last_context_switch = uptime; 40008108: c2 07 bf f8 ld [ %fp + -8 ], %g1 4000810c: c2 24 80 00 st %g1, [ %l2 ] 40008110: c2 07 bf fc ld [ %fp + -4 ], %g1 40008114: c2 24 a0 04 st %g1, [ %l2 + 4 ] #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 40008118: c2 05 a1 84 ld [ %l6 + 0x184 ], %g1 4000811c: 80 a0 60 00 cmp %g1, 0 40008120: 02 80 00 06 be 40008138 <_Thread_Dispatch+0xbc> <== NEVER TAKEN 40008124: 90 10 00 11 mov %l1, %o0 executing->libc_reent = *_Thread_libc_reent; 40008128: c4 00 40 00 ld [ %g1 ], %g2 4000812c: c4 24 61 50 st %g2, [ %l1 + 0x150 ] *_Thread_libc_reent = heir->libc_reent; 40008130: c4 04 21 50 ld [ %l0 + 0x150 ], %g2 40008134: c4 20 40 00 st %g2, [ %g1 ] } _User_extensions_Thread_switch( executing, heir ); 40008138: 40 00 03 ca call 40009060 <_User_extensions_Thread_switch> 4000813c: 92 10 00 10 mov %l0, %o1 if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 40008140: 90 04 60 c8 add %l1, 0xc8, %o0 40008144: 40 00 04 b9 call 40009428 <_CPU_Context_switch> 40008148: 92 04 20 c8 add %l0, 0xc8, %o1 if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; 4000814c: 82 15 62 38 or %l5, 0x238, %g1 _ISR_Disable( level ); 40008150: 7f ff e6 d2 call 40001c98 40008154: e2 00 60 0c ld [ %g1 + 0xc ], %l1 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 40008158: 82 15 62 38 or %l5, 0x238, %g1 4000815c: c4 08 60 18 ldub [ %g1 + 0x18 ], %g2 40008160: 80 a0 a0 00 cmp %g2, 0 40008164: 32 bf ff d4 bne,a 400080b4 <_Thread_Dispatch+0x38> 40008168: e0 00 60 10 ld [ %g1 + 0x10 ], %l0 _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 4000816c: 03 10 00 55 sethi %hi(0x40015400), %g1 40008170: c0 20 60 e0 clr [ %g1 + 0xe0 ] ! 400154e0 <_Thread_Dispatch_disable_level> _ISR_Enable( level ); 40008174: 7f ff e6 cd call 40001ca8 40008178: 01 00 00 00 nop _API_extensions_Run_postswitch(); 4000817c: 7f ff f8 e1 call 40006500 <_API_extensions_Run_postswitch> 40008180: 01 00 00 00 nop } 40008184: 81 c7 e0 08 ret 40008188: 81 e8 00 00 restore =============================================================================== 4000e028 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 4000e028: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 4000e02c: 03 10 00 56 sethi %hi(0x40015800), %g1 4000e030: e0 00 62 44 ld [ %g1 + 0x244 ], %l0 ! 40015a44 <_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(); 4000e034: 3f 10 00 38 sethi %hi(0x4000e000), %i7 4000e038: be 17 e0 28 or %i7, 0x28, %i7 ! 4000e028 <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4000e03c: d0 04 20 ac ld [ %l0 + 0xac ], %o0 _ISR_Set_level(level); 4000e040: 7f ff cf 1a call 40001ca8 4000e044: 91 2a 20 08 sll %o0, 8, %o0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000e048: 03 10 00 54 sethi %hi(0x40015000), %g1 doneConstructors = 1; 4000e04c: 84 10 20 01 mov 1, %g2 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000e050: e2 08 62 a4 ldub [ %g1 + 0x2a4 ], %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 ); 4000e054: 90 10 00 10 mov %l0, %o0 4000e058: 7f ff eb 92 call 40008ea0 <_User_extensions_Thread_begin> 4000e05c: c4 28 62 a4 stb %g2, [ %g1 + 0x2a4 ] /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4000e060: 7f ff e8 4b call 4000818c <_Thread_Enable_dispatch> 4000e064: 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) */ { 4000e068: 80 a4 60 00 cmp %l1, 0 4000e06c: 32 80 00 05 bne,a 4000e080 <_Thread_Handler+0x58> 4000e070: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 INIT_NAME (); 4000e074: 40 00 1a 81 call 40014a78 <_init> 4000e078: 01 00 00 00 nop } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000e07c: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000e080: 80 a0 60 00 cmp %g1, 0 4000e084: 12 80 00 05 bne 4000e098 <_Thread_Handler+0x70> 4000e088: 80 a0 60 01 cmp %g1, 1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4000e08c: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000e090: 10 80 00 06 b 4000e0a8 <_Thread_Handler+0x80> 4000e094: d0 04 20 9c ld [ %l0 + 0x9c ], %o0 executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { 4000e098: 12 80 00 07 bne 4000e0b4 <_Thread_Handler+0x8c> <== NEVER TAKEN 4000e09c: 01 00 00 00 nop executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 4000e0a0: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000e0a4: d0 04 20 98 ld [ %l0 + 0x98 ], %o0 4000e0a8: 9f c0 40 00 call %g1 4000e0ac: 01 00 00 00 nop executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = 4000e0b0: d0 24 20 28 st %o0, [ %l0 + 0x28 ] * 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 ); 4000e0b4: 7f ff eb 8c call 40008ee4 <_User_extensions_Thread_exitted> 4000e0b8: 90 10 00 10 mov %l0, %o0 _Internal_error_Occurred( 4000e0bc: 90 10 20 00 clr %o0 4000e0c0: 92 10 20 01 mov 1, %o1 4000e0c4: 7f ff e3 b5 call 40006f98 <_Internal_error_Occurred> 4000e0c8: 94 10 20 05 mov 5, %o2 =============================================================================== 4000825c <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 4000825c: 9d e3 bf a0 save %sp, -96, %sp 40008260: 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; 40008264: c0 26 61 54 clr [ %i1 + 0x154 ] 40008268: c0 26 61 58 clr [ %i1 + 0x158 ] extensions_area = NULL; the_thread->libc_reent = NULL; 4000826c: 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 ) { 40008270: e0 07 a0 60 ld [ %fp + 0x60 ], %l0 40008274: e2 00 40 00 ld [ %g1 ], %l1 if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { 40008278: 80 a6 a0 00 cmp %i2, 0 4000827c: 12 80 00 0d bne 400082b0 <_Thread_Initialize+0x54> 40008280: e4 0f a0 5f ldub [ %fp + 0x5f ], %l2 actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 40008284: 90 10 00 19 mov %i1, %o0 40008288: 40 00 02 35 call 40008b5c <_Thread_Stack_Allocate> 4000828c: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 40008290: 80 a2 00 1b cmp %o0, %i3 40008294: 0a 80 00 71 bcs 40008458 <_Thread_Initialize+0x1fc> 40008298: 80 a2 20 00 cmp %o0, 0 4000829c: 02 80 00 6f be 40008458 <_Thread_Initialize+0x1fc> <== NEVER TAKEN 400082a0: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 400082a4: f4 06 60 c0 ld [ %i1 + 0xc0 ], %i2 the_thread->Start.core_allocated_stack = true; 400082a8: 10 80 00 04 b 400082b8 <_Thread_Initialize+0x5c> 400082ac: c2 2e 60 b4 stb %g1, [ %i1 + 0xb4 ] } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 400082b0: c0 2e 60 b4 clrb [ %i1 + 0xb4 ] 400082b4: 90 10 00 1b mov %i3, %o0 void *starting_address, size_t size ) { the_stack->area = starting_address; the_stack->size = size; 400082b8: d0 26 60 b8 st %o0, [ %i1 + 0xb8 ] #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 400082bc: 03 10 00 55 sethi %hi(0x40015400), %g1 400082c0: d0 00 61 90 ld [ %g1 + 0x190 ], %o0 ! 40015590 <_Thread_Maximum_extensions> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 400082c4: f4 26 60 bc st %i2, [ %i1 + 0xbc ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 400082c8: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 400082cc: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 400082d0: c0 26 60 68 clr [ %i1 + 0x68 ] the_watchdog->user_data = user_data; 400082d4: c0 26 60 6c clr [ %i1 + 0x6c ] 400082d8: 80 a2 20 00 cmp %o0, 0 400082dc: 02 80 00 08 be 400082fc <_Thread_Initialize+0xa0> 400082e0: b6 10 20 00 clr %i3 extensions_area = _Workspace_Allocate( 400082e4: 90 02 20 01 inc %o0 400082e8: 40 00 04 32 call 400093b0 <_Workspace_Allocate> 400082ec: 91 2a 20 02 sll %o0, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 400082f0: b6 92 20 00 orcc %o0, 0, %i3 400082f4: 22 80 00 38 be,a 400083d4 <_Thread_Initialize+0x178> 400082f8: a0 10 20 00 clr %l0 * if they are linked to the thread. An extension user may * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { 400082fc: 80 a6 e0 00 cmp %i3, 0 40008300: 02 80 00 0b be 4000832c <_Thread_Initialize+0xd0> 40008304: f6 26 61 5c st %i3, [ %i1 + 0x15c ] for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 40008308: 03 10 00 55 sethi %hi(0x40015400), %g1 4000830c: c4 00 61 90 ld [ %g1 + 0x190 ], %g2 ! 40015590 <_Thread_Maximum_extensions> 40008310: 10 80 00 04 b 40008320 <_Thread_Initialize+0xc4> 40008314: 82 10 20 00 clr %g1 40008318: 82 00 60 01 inc %g1 the_thread->extensions[i] = NULL; 4000831c: c0 26 c0 03 clr [ %i3 + %g3 ] * 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++ ) 40008320: 80 a0 40 02 cmp %g1, %g2 40008324: 08 bf ff fd bleu 40008318 <_Thread_Initialize+0xbc> 40008328: 87 28 60 02 sll %g1, 2, %g3 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 4000832c: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 40008330: e4 2e 60 a0 stb %l2, [ %i1 + 0xa0 ] the_thread->Start.budget_algorithm = budget_algorithm; 40008334: e0 26 60 a4 st %l0, [ %i1 + 0xa4 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 40008338: 80 a4 20 02 cmp %l0, 2 4000833c: 12 80 00 05 bne 40008350 <_Thread_Initialize+0xf4> 40008340: 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; 40008344: 03 10 00 55 sethi %hi(0x40015400), %g1 40008348: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 40015444 <_Thread_Ticks_per_timeslice> 4000834c: c2 26 60 78 st %g1, [ %i1 + 0x78 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 40008350: c2 07 a0 68 ld [ %fp + 0x68 ], %g1 Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_allocate( the_scheduler, the_thread ); 40008354: 11 10 00 55 sethi %hi(0x40015400), %o0 40008358: c2 26 60 ac st %g1, [ %i1 + 0xac ] the_thread->current_state = STATES_DORMANT; 4000835c: 82 10 20 01 mov 1, %g1 40008360: 90 12 21 64 or %o0, 0x164, %o0 40008364: c2 26 60 10 st %g1, [ %i1 + 0x10 ] RTEMS_INLINE_ROUTINE void* _Scheduler_Thread_scheduler_allocate( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return 40008368: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 the_thread->Wait.queue = NULL; 4000836c: c0 26 60 44 clr [ %i1 + 0x44 ] the_thread->resource_count = 0; 40008370: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 40008374: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; 40008378: fa 26 60 b0 st %i5, [ %i1 + 0xb0 ] 4000837c: 9f c0 40 00 call %g1 40008380: 92 10 00 19 mov %i1, %o1 sched =_Scheduler_Thread_scheduler_allocate( &_Scheduler, the_thread ); if ( !sched ) 40008384: a0 92 20 00 orcc %o0, 0, %l0 40008388: 02 80 00 13 be 400083d4 <_Thread_Initialize+0x178> 4000838c: 90 10 00 19 mov %i1, %o0 goto failed; _Thread_Set_priority( the_thread, priority ); 40008390: 40 00 01 af call 40008a4c <_Thread_Set_priority> 40008394: 92 10 00 1d mov %i5, %o1 _Thread_Stack_Free( the_thread ); return false; } 40008398: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 4000839c: 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 ); 400083a0: c0 26 60 84 clr [ %i1 + 0x84 ] 400083a4: c0 26 60 88 clr [ %i1 + 0x88 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400083a8: 83 28 60 02 sll %g1, 2, %g1 400083ac: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 400083b0: e2 26 60 0c st %l1, [ %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 ); 400083b4: 90 10 00 19 mov %i1, %o0 400083b8: 40 00 02 ed call 40008f6c <_User_extensions_Thread_create> 400083bc: b0 10 20 01 mov 1, %i0 if ( extension_status ) 400083c0: 80 8a 20 ff btst 0xff, %o0 400083c4: 22 80 00 05 be,a 400083d8 <_Thread_Initialize+0x17c> 400083c8: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 400083cc: 81 c7 e0 08 ret 400083d0: 81 e8 00 00 restore return true; failed: if ( the_thread->libc_reent ) 400083d4: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 400083d8: 80 a2 20 00 cmp %o0, 0 400083dc: 22 80 00 05 be,a 400083f0 <_Thread_Initialize+0x194> 400083e0: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 _Workspace_Free( the_thread->libc_reent ); 400083e4: 40 00 03 fc call 400093d4 <_Workspace_Free> 400083e8: 01 00 00 00 nop for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 400083ec: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 400083f0: 80 a2 20 00 cmp %o0, 0 400083f4: 22 80 00 05 be,a 40008408 <_Thread_Initialize+0x1ac> 400083f8: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 _Workspace_Free( the_thread->API_Extensions[i] ); 400083fc: 40 00 03 f6 call 400093d4 <_Workspace_Free> 40008400: 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] ) 40008404: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 40008408: 80 a2 20 00 cmp %o0, 0 4000840c: 02 80 00 05 be 40008420 <_Thread_Initialize+0x1c4> 40008410: 80 a6 e0 00 cmp %i3, 0 _Workspace_Free( the_thread->API_Extensions[i] ); 40008414: 40 00 03 f0 call 400093d4 <_Workspace_Free> 40008418: 01 00 00 00 nop if ( extensions_area ) 4000841c: 80 a6 e0 00 cmp %i3, 0 40008420: 02 80 00 05 be 40008434 <_Thread_Initialize+0x1d8> 40008424: 80 a4 20 00 cmp %l0, 0 (void) _Workspace_Free( extensions_area ); 40008428: 40 00 03 eb call 400093d4 <_Workspace_Free> 4000842c: 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 ) 40008430: 80 a4 20 00 cmp %l0, 0 40008434: 02 80 00 05 be 40008448 <_Thread_Initialize+0x1ec> 40008438: 90 10 00 19 mov %i1, %o0 (void) _Workspace_Free( sched ); 4000843c: 40 00 03 e6 call 400093d4 <_Workspace_Free> 40008440: 90 10 00 10 mov %l0, %o0 _Thread_Stack_Free( the_thread ); 40008444: 90 10 00 19 mov %i1, %o0 40008448: 40 00 01 dc call 40008bb8 <_Thread_Stack_Free> 4000844c: b0 10 20 00 clr %i0 return false; 40008450: 81 c7 e0 08 ret 40008454: 81 e8 00 00 restore } 40008458: 81 c7 e0 08 ret 4000845c: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000c0d4 <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { 4000c0d4: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 4000c0d8: 7f ff d7 6c call 40001e88 4000c0dc: 01 00 00 00 nop 4000c0e0: a0 10 00 08 mov %o0, %l0 current_state = the_thread->current_state; 4000c0e4: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 if ( current_state & STATES_SUSPENDED ) { 4000c0e8: 80 88 60 02 btst 2, %g1 4000c0ec: 02 80 00 0a be 4000c114 <_Thread_Resume+0x40> <== NEVER TAKEN 4000c0f0: 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 ) ) { 4000c0f4: 80 a0 60 00 cmp %g1, 0 4000c0f8: 12 80 00 07 bne 4000c114 <_Thread_Resume+0x40> 4000c0fc: c2 26 20 10 st %g1, [ %i0 + 0x10 ] RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { the_scheduler->Operations.unblock( the_scheduler, the_thread ); 4000c100: 11 10 00 64 sethi %hi(0x40019000), %o0 4000c104: 90 12 20 84 or %o0, 0x84, %o0 ! 40019084 <_Scheduler> 4000c108: c2 02 20 10 ld [ %o0 + 0x10 ], %g1 4000c10c: 9f c0 40 00 call %g1 4000c110: 92 10 00 18 mov %i0, %o1 _Scheduler_Unblock( &_Scheduler, the_thread ); } } _ISR_Enable( level ); 4000c114: 7f ff d7 61 call 40001e98 4000c118: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40008c88 <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 40008c88: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing; executing = _Thread_Executing; 40008c8c: 03 10 00 56 sethi %hi(0x40015800), %g1 40008c90: e0 00 62 44 ld [ %g1 + 0x244 ], %l0 ! 40015a44 <_Per_CPU_Information+0xc> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 40008c94: c2 0c 20 74 ldub [ %l0 + 0x74 ], %g1 40008c98: 80 a0 60 00 cmp %g1, 0 40008c9c: 02 80 00 26 be 40008d34 <_Thread_Tickle_timeslice+0xac> 40008ca0: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 40008ca4: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40008ca8: 80 a0 60 00 cmp %g1, 0 40008cac: 12 80 00 22 bne 40008d34 <_Thread_Tickle_timeslice+0xac> 40008cb0: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 40008cb4: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40008cb8: 80 a0 60 01 cmp %g1, 1 40008cbc: 0a 80 00 15 bcs 40008d10 <_Thread_Tickle_timeslice+0x88> 40008cc0: 80 a0 60 02 cmp %g1, 2 40008cc4: 28 80 00 07 bleu,a 40008ce0 <_Thread_Tickle_timeslice+0x58> 40008cc8: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 40008ccc: 80 a0 60 03 cmp %g1, 3 40008cd0: 12 80 00 19 bne 40008d34 <_Thread_Tickle_timeslice+0xac> <== NEVER TAKEN 40008cd4: 01 00 00 00 nop } break; #if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: if ( --executing->cpu_time_budget == 0 ) 40008cd8: 10 80 00 10 b 40008d18 <_Thread_Tickle_timeslice+0x90> 40008cdc: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 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 ) { 40008ce0: 82 00 7f ff add %g1, -1, %g1 40008ce4: 80 a0 60 00 cmp %g1, 0 40008ce8: 14 80 00 0a bg 40008d10 <_Thread_Tickle_timeslice+0x88> 40008cec: 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 ); 40008cf0: 11 10 00 55 sethi %hi(0x40015400), %o0 40008cf4: 90 12 21 64 or %o0, 0x164, %o0 ! 40015564 <_Scheduler> 40008cf8: c2 02 20 08 ld [ %o0 + 8 ], %g1 40008cfc: 9f c0 40 00 call %g1 40008d00: 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; 40008d04: 03 10 00 55 sethi %hi(0x40015400), %g1 40008d08: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 40015444 <_Thread_Ticks_per_timeslice> 40008d0c: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 40008d10: 81 c7 e0 08 ret 40008d14: 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 ) 40008d18: 82 00 7f ff add %g1, -1, %g1 40008d1c: 80 a0 60 00 cmp %g1, 0 40008d20: 12 bf ff fc bne 40008d10 <_Thread_Tickle_timeslice+0x88> 40008d24: c2 24 20 78 st %g1, [ %l0 + 0x78 ] (*executing->budget_callout)( executing ); 40008d28: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 40008d2c: 9f c0 40 00 call %g1 40008d30: 90 10 00 10 mov %l0, %o0 40008d34: 81 c7 e0 08 ret 40008d38: 81 e8 00 00 restore =============================================================================== 40008998 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 40008998: 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 ) 4000899c: 80 a6 20 00 cmp %i0, 0 400089a0: 02 80 00 19 be 40008a04 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 400089a4: 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 ) { 400089a8: e2 06 20 34 ld [ %i0 + 0x34 ], %l1 400089ac: 80 a4 60 01 cmp %l1, 1 400089b0: 12 80 00 15 bne 40008a04 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 400089b4: 01 00 00 00 nop Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 400089b8: 7f ff e4 b8 call 40001c98 400089bc: 01 00 00 00 nop 400089c0: a0 10 00 08 mov %o0, %l0 400089c4: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 400089c8: 03 00 00 ef sethi %hi(0x3bc00), %g1 400089cc: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 400089d0: 80 88 80 01 btst %g2, %g1 400089d4: 02 80 00 0a be 400089fc <_Thread_queue_Requeue+0x64> <== NEVER TAKEN 400089d8: 90 10 00 18 mov %i0, %o0 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 400089dc: 92 10 00 19 mov %i1, %o1 400089e0: 94 10 20 01 mov 1, %o2 400089e4: 40 00 0e d3 call 4000c530 <_Thread_queue_Extract_priority_helper> 400089e8: e2 26 20 30 st %l1, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 400089ec: 90 10 00 18 mov %i0, %o0 400089f0: 92 10 00 19 mov %i1, %o1 400089f4: 7f ff ff 49 call 40008718 <_Thread_queue_Enqueue_priority> 400089f8: 94 07 bf fc add %fp, -4, %o2 } _ISR_Enable( level ); 400089fc: 7f ff e4 ab call 40001ca8 40008a00: 90 10 00 10 mov %l0, %o0 40008a04: 81 c7 e0 08 ret 40008a08: 81 e8 00 00 restore =============================================================================== 40008a0c <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 40008a0c: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40008a10: 90 10 00 18 mov %i0, %o0 40008a14: 7f ff fd eb call 400081c0 <_Thread_Get> 40008a18: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40008a1c: c2 07 bf fc ld [ %fp + -4 ], %g1 40008a20: 80 a0 60 00 cmp %g1, 0 40008a24: 12 80 00 08 bne 40008a44 <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 40008a28: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40008a2c: 40 00 0e f9 call 4000c610 <_Thread_queue_Process_timeout> 40008a30: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40008a34: 03 10 00 55 sethi %hi(0x40015400), %g1 40008a38: c4 00 60 e0 ld [ %g1 + 0xe0 ], %g2 ! 400154e0 <_Thread_Dispatch_disable_level> 40008a3c: 84 00 bf ff add %g2, -1, %g2 40008a40: c4 20 60 e0 st %g2, [ %g1 + 0xe0 ] 40008a44: 81 c7 e0 08 ret 40008a48: 81 e8 00 00 restore =============================================================================== 400163f8 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 400163f8: 9d e3 bf 88 save %sp, -120, %sp static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 400163fc: 39 10 00 f8 sethi %hi(0x4003e000), %i4 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40016400: b6 07 bf f4 add %fp, -12, %i3 40016404: ae 07 bf f8 add %fp, -8, %l7 40016408: a4 07 bf e8 add %fp, -24, %l2 4001640c: a6 07 bf ec add %fp, -20, %l3 40016410: ee 27 bf f4 st %l7, [ %fp + -12 ] head->previous = NULL; 40016414: c0 27 bf f8 clr [ %fp + -8 ] tail->previous = head; 40016418: f6 27 bf fc st %i3, [ %fp + -4 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 4001641c: e6 27 bf e8 st %l3, [ %fp + -24 ] head->previous = NULL; 40016420: c0 27 bf ec clr [ %fp + -20 ] tail->previous = head; 40016424: e4 27 bf f0 st %l2, [ %fp + -16 ] */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40016428: a8 06 20 30 add %i0, 0x30, %l4 static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 4001642c: 3b 10 00 f8 sethi %hi(0x4003e000), %i5 /* * 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 ); 40016430: a2 06 20 68 add %i0, 0x68, %l1 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 40016434: ac 06 20 08 add %i0, 8, %l6 static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 40016438: aa 06 20 40 add %i0, 0x40, %l5 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; 4001643c: f6 26 20 78 st %i3, [ %i0 + 0x78 ] static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 40016440: c2 07 20 a0 ld [ %i4 + 0xa0 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 40016444: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40016448: 94 10 00 12 mov %l2, %o2 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 4001644c: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40016450: 90 10 00 14 mov %l4, %o0 40016454: 40 00 11 cb call 4001ab80 <_Watchdog_Adjust_to_chain> 40016458: 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; 4001645c: 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(); 40016460: e0 07 60 18 ld [ %i5 + 0x18 ], %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 ) { 40016464: 80 a4 00 0a cmp %l0, %o2 40016468: 08 80 00 06 bleu 40016480 <_Timer_server_Body+0x88> 4001646c: 92 24 00 0a sub %l0, %o2, %o1 /* * 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 ); 40016470: 90 10 00 11 mov %l1, %o0 40016474: 40 00 11 c3 call 4001ab80 <_Watchdog_Adjust_to_chain> 40016478: 94 10 00 12 mov %l2, %o2 4001647c: 30 80 00 06 b,a 40016494 <_Timer_server_Body+0x9c> } else if ( snapshot < last_snapshot ) { 40016480: 1a 80 00 05 bcc 40016494 <_Timer_server_Body+0x9c> 40016484: 90 10 00 11 mov %l1, %o0 /* * 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 ); 40016488: 92 10 20 01 mov 1, %o1 4001648c: 40 00 11 95 call 4001aae0 <_Watchdog_Adjust> 40016490: 94 22 80 10 sub %o2, %l0, %o2 } watchdogs->last_snapshot = snapshot; 40016494: 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 ); 40016498: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 4001649c: 40 00 02 de call 40017014 <_Chain_Get> 400164a0: 01 00 00 00 nop if ( timer == NULL ) { 400164a4: 92 92 20 00 orcc %o0, 0, %o1 400164a8: 02 80 00 0c be 400164d8 <_Timer_server_Body+0xe0> 400164ac: 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 ) { 400164b0: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 400164b4: 80 a0 60 01 cmp %g1, 1 400164b8: 02 80 00 05 be 400164cc <_Timer_server_Body+0xd4> 400164bc: 90 10 00 14 mov %l4, %o0 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 400164c0: 80 a0 60 03 cmp %g1, 3 400164c4: 12 bf ff f5 bne 40016498 <_Timer_server_Body+0xa0> <== NEVER TAKEN 400164c8: 90 10 00 11 mov %l1, %o0 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 400164cc: 40 00 11 e1 call 4001ac50 <_Watchdog_Insert> 400164d0: 92 02 60 10 add %o1, 0x10, %o1 400164d4: 30 bf ff f1 b,a 40016498 <_Timer_server_Body+0xa0> * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 400164d8: 7f ff e3 a4 call 4000f368 400164dc: 01 00 00 00 nop tmp = ts->insert_chain; 400164e0: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 if ( _Chain_Is_empty( insert_chain ) ) { 400164e4: c2 07 bf f4 ld [ %fp + -12 ], %g1 400164e8: 80 a0 40 17 cmp %g1, %l7 400164ec: 12 80 00 04 bne 400164fc <_Timer_server_Body+0x104> <== NEVER TAKEN 400164f0: a0 10 20 01 mov 1, %l0 ts->insert_chain = NULL; 400164f4: c0 26 20 78 clr [ %i0 + 0x78 ] do_loop = false; 400164f8: a0 10 20 00 clr %l0 } _ISR_Enable( level ); 400164fc: 7f ff e3 9f call 4000f378 40016500: 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 ) { 40016504: 80 8c 20 ff btst 0xff, %l0 40016508: 12 bf ff ce bne 40016440 <_Timer_server_Body+0x48> <== NEVER TAKEN 4001650c: 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 ) ) { 40016510: 80 a0 40 13 cmp %g1, %l3 40016514: 02 80 00 18 be 40016574 <_Timer_server_Body+0x17c> 40016518: 01 00 00 00 nop /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 4001651c: 7f ff e3 93 call 4000f368 40016520: 01 00 00 00 nop 40016524: 84 10 00 08 mov %o0, %g2 initialized = false; } #endif return status; } 40016528: 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)) 4001652c: 80 a4 00 13 cmp %l0, %l3 40016530: 02 80 00 0e be 40016568 <_Timer_server_Body+0x170> 40016534: 80 a4 20 00 cmp %l0, 0 Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; 40016538: c2 04 00 00 ld [ %l0 ], %g1 head->next = new_first; 4001653c: c2 27 bf e8 st %g1, [ %fp + -24 ] * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { 40016540: 02 80 00 0a be 40016568 <_Timer_server_Body+0x170> <== NEVER TAKEN 40016544: e4 20 60 04 st %l2, [ %g1 + 4 ] watchdog->state = WATCHDOG_INACTIVE; 40016548: c0 24 20 08 clr [ %l0 + 8 ] _ISR_Enable( level ); 4001654c: 7f ff e3 8b call 4000f378 40016550: 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 ); 40016554: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40016558: d0 04 20 20 ld [ %l0 + 0x20 ], %o0 4001655c: 9f c0 40 00 call %g1 40016560: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 } 40016564: 30 bf ff ee b,a 4001651c <_Timer_server_Body+0x124> watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 40016568: 7f ff e3 84 call 4000f378 4001656c: 90 10 00 02 mov %g2, %o0 40016570: 30 bf ff b3 b,a 4001643c <_Timer_server_Body+0x44> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 40016574: c0 2e 20 7c clrb [ %i0 + 0x7c ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); 40016578: 7f ff ff 70 call 40016338 <_Thread_Disable_dispatch> 4001657c: 01 00 00 00 nop _Thread_Set_state( ts->thread, STATES_DELAYING ); 40016580: d0 06 00 00 ld [ %i0 ], %o0 40016584: 40 00 0f 83 call 4001a390 <_Thread_Set_state> 40016588: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 4001658c: 7f ff ff 71 call 40016350 <_Timer_server_Reset_interval_system_watchdog> 40016590: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 40016594: 7f ff ff 84 call 400163a4 <_Timer_server_Reset_tod_system_watchdog> 40016598: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 4001659c: 40 00 0d 16 call 400199f4 <_Thread_Enable_dispatch> 400165a0: 01 00 00 00 nop ts->active = true; 400165a4: 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 ); 400165a8: 90 10 00 16 mov %l6, %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; 400165ac: 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 ); 400165b0: 40 00 12 02 call 4001adb8 <_Watchdog_Remove> 400165b4: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 400165b8: 40 00 12 00 call 4001adb8 <_Watchdog_Remove> 400165bc: 90 10 00 15 mov %l5, %o0 400165c0: 30 bf ff 9f b,a 4001643c <_Timer_server_Body+0x44> =============================================================================== 400165c4 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 400165c4: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 400165c8: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 400165cc: 80 a0 60 00 cmp %g1, 0 400165d0: 12 80 00 49 bne 400166f4 <_Timer_server_Schedule_operation_method+0x130> 400165d4: a0 10 00 19 mov %i1, %l0 * is the reference point for the delta chain. Thus if we do not update the * reference point we have to add DT to the initial delta of the watchdog * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); 400165d8: 7f ff ff 58 call 40016338 <_Thread_Disable_dispatch> 400165dc: 01 00 00 00 nop if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 400165e0: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 400165e4: 80 a0 60 01 cmp %g1, 1 400165e8: 12 80 00 1f bne 40016664 <_Timer_server_Schedule_operation_method+0xa0> 400165ec: 80 a0 60 03 cmp %g1, 3 /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 400165f0: 7f ff e3 5e call 4000f368 400165f4: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 400165f8: 03 10 00 f8 sethi %hi(0x4003e000), %g1 400165fc: c4 00 60 a0 ld [ %g1 + 0xa0 ], %g2 ! 4003e0a0 <_Watchdog_Ticks_since_boot> initialized = false; } #endif return status; } 40016600: 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; last_snapshot = ts->Interval_watchdogs.last_snapshot; 40016604: c8 06 20 3c ld [ %i0 + 0x3c ], %g4 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40016608: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 4001660c: 80 a0 40 03 cmp %g1, %g3 40016610: 02 80 00 08 be 40016630 <_Timer_server_Schedule_operation_method+0x6c> 40016614: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 40016618: da 00 60 10 ld [ %g1 + 0x10 ], %o5 if (delta_interval > delta) { 4001661c: 80 a3 40 04 cmp %o5, %g4 40016620: 08 80 00 03 bleu 4001662c <_Timer_server_Schedule_operation_method+0x68> 40016624: 86 10 20 00 clr %g3 delta_interval -= delta; 40016628: 86 23 40 04 sub %o5, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 4001662c: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 40016630: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 40016634: 7f ff e3 51 call 4000f378 40016638: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 4001663c: 90 06 20 30 add %i0, 0x30, %o0 40016640: 40 00 11 84 call 4001ac50 <_Watchdog_Insert> 40016644: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 40016648: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 4001664c: 80 a0 60 00 cmp %g1, 0 40016650: 12 80 00 27 bne 400166ec <_Timer_server_Schedule_operation_method+0x128> 40016654: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 40016658: 7f ff ff 3e call 40016350 <_Timer_server_Reset_interval_system_watchdog> 4001665c: 90 10 00 18 mov %i0, %o0 40016660: 30 80 00 23 b,a 400166ec <_Timer_server_Schedule_operation_method+0x128> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 40016664: 12 80 00 22 bne 400166ec <_Timer_server_Schedule_operation_method+0x128> 40016668: 01 00 00 00 nop /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 4001666c: 7f ff e3 3f call 4000f368 40016670: 01 00 00 00 nop initialized = false; } #endif return status; } 40016674: 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; 40016678: da 06 20 74 ld [ %i0 + 0x74 ], %o5 /* * 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(); 4001667c: 03 10 00 f8 sethi %hi(0x4003e000), %g1 40016680: 86 06 20 6c add %i0, 0x6c, %g3 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 40016684: 80 a0 80 03 cmp %g2, %g3 40016688: 02 80 00 0d be 400166bc <_Timer_server_Schedule_operation_method+0xf8> 4001668c: c2 00 60 18 ld [ %g1 + 0x18 ], %g1 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 40016690: c8 00 a0 10 ld [ %g2 + 0x10 ], %g4 if ( snapshot > last_snapshot ) { 40016694: 80 a0 40 0d cmp %g1, %o5 } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 40016698: 86 01 00 0d add %g4, %o5, %g3 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 ) { 4001669c: 08 80 00 07 bleu 400166b8 <_Timer_server_Schedule_operation_method+0xf4> 400166a0: 86 20 c0 01 sub %g3, %g1, %g3 /* * We advanced in time. */ delta = snapshot - last_snapshot; 400166a4: 9a 20 40 0d sub %g1, %o5, %o5 if (delta_interval > delta) { 400166a8: 80 a1 00 0d cmp %g4, %o5 400166ac: 08 80 00 03 bleu 400166b8 <_Timer_server_Schedule_operation_method+0xf4><== NEVER TAKEN 400166b0: 86 10 20 00 clr %g3 delta_interval -= delta; 400166b4: 86 21 00 0d sub %g4, %o5, %g3 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 400166b8: c6 20 a0 10 st %g3, [ %g2 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 400166bc: c2 26 20 74 st %g1, [ %i0 + 0x74 ] _ISR_Enable( level ); 400166c0: 7f ff e3 2e call 4000f378 400166c4: 01 00 00 00 nop _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 400166c8: 90 06 20 68 add %i0, 0x68, %o0 400166cc: 40 00 11 61 call 4001ac50 <_Watchdog_Insert> 400166d0: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 400166d4: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 400166d8: 80 a0 60 00 cmp %g1, 0 400166dc: 12 80 00 04 bne 400166ec <_Timer_server_Schedule_operation_method+0x128> 400166e0: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 400166e4: 7f ff ff 30 call 400163a4 <_Timer_server_Reset_tod_system_watchdog> 400166e8: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 400166ec: 40 00 0c c2 call 400199f4 <_Thread_Enable_dispatch> 400166f0: 81 e8 00 00 restore * 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 ); 400166f4: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 400166f8: 40 00 02 31 call 40016fbc <_Chain_Append> 400166fc: 81 e8 00 00 restore =============================================================================== 40008f24 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40008f24: 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 ); } } 40008f28: 23 10 00 55 sethi %hi(0x40015400), %l1 the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 40008f2c: b2 0e 60 ff and %i1, 0xff, %i1 } } 40008f30: a2 14 62 e8 or %l1, 0x2e8, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 40008f34: 10 80 00 09 b 40008f58 <_User_extensions_Fatal+0x34> 40008f38: e0 04 60 08 ld [ %l1 + 8 ], %l0 !_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 ) 40008f3c: 80 a0 60 00 cmp %g1, 0 40008f40: 02 80 00 05 be 40008f54 <_User_extensions_Fatal+0x30> 40008f44: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 40008f48: 92 10 00 19 mov %i1, %o1 40008f4c: 9f c0 40 00 call %g1 40008f50: 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 ) { 40008f54: 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 ); 40008f58: 80 a4 00 11 cmp %l0, %l1 40008f5c: 32 bf ff f8 bne,a 40008f3c <_User_extensions_Fatal+0x18> <== ALWAYS TAKEN 40008f60: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } 40008f64: 81 c7 e0 08 ret <== NOT EXECUTED 40008f68: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40008de8 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 40008de8: 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; 40008dec: 03 10 00 52 sethi %hi(0x40014800), %g1 40008df0: 82 10 63 78 or %g1, 0x378, %g1 ! 40014b78 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40008df4: 05 10 00 55 sethi %hi(0x40015400), %g2 initial_extensions = Configuration.User_extension_table; 40008df8: e6 00 60 40 ld [ %g1 + 0x40 ], %l3 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; 40008dfc: e4 00 60 3c ld [ %g1 + 0x3c ], %l2 40008e00: 82 10 a2 e8 or %g2, 0x2e8, %g1 40008e04: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40008e08: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 40008e0c: c2 20 60 08 st %g1, [ %g1 + 8 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40008e10: c6 20 a2 e8 st %g3, [ %g2 + 0x2e8 ] 40008e14: 05 10 00 55 sethi %hi(0x40015400), %g2 40008e18: 82 10 a0 e4 or %g2, 0xe4, %g1 ! 400154e4 <_User_extensions_Switches_list> 40008e1c: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40008e20: c0 20 60 04 clr [ %g1 + 4 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40008e24: c6 20 a0 e4 st %g3, [ %g2 + 0xe4 ] initial_extensions = Configuration.User_extension_table; _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 40008e28: 80 a4 e0 00 cmp %l3, 0 40008e2c: 02 80 00 1b be 40008e98 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 40008e30: c2 20 60 08 st %g1, [ %g1 + 8 ] extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) 40008e34: 83 2c a0 02 sll %l2, 2, %g1 40008e38: a1 2c a0 04 sll %l2, 4, %l0 40008e3c: a0 24 00 01 sub %l0, %g1, %l0 40008e40: a0 04 00 12 add %l0, %l2, %l0 40008e44: a1 2c 20 02 sll %l0, 2, %l0 _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( 40008e48: 40 00 01 6a call 400093f0 <_Workspace_Allocate_or_fatal_error> 40008e4c: 90 10 00 10 mov %l0, %o0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40008e50: 94 10 00 10 mov %l0, %o2 _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( 40008e54: a2 10 00 08 mov %o0, %l1 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40008e58: 92 10 20 00 clr %o1 40008e5c: 40 00 17 88 call 4000ec7c 40008e60: a0 10 20 00 clr %l0 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 40008e64: 10 80 00 0b b 40008e90 <_User_extensions_Handler_initialization+0xa8> 40008e68: 80 a4 00 12 cmp %l0, %l2 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; 40008e6c: 90 04 60 14 add %l1, 0x14, %o0 40008e70: 92 04 c0 09 add %l3, %o1, %o1 40008e74: 40 00 17 49 call 4000eb98 40008e78: 94 10 20 20 mov 0x20, %o2 _User_extensions_Add_set( extension ); 40008e7c: 90 10 00 11 mov %l1, %o0 40008e80: 40 00 0e 26 call 4000c718 <_User_extensions_Add_set> 40008e84: a0 04 20 01 inc %l0 _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; 40008e88: a2 04 60 34 add %l1, 0x34, %l1 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 40008e8c: 80 a4 00 12 cmp %l0, %l2 40008e90: 0a bf ff f7 bcs 40008e6c <_User_extensions_Handler_initialization+0x84> 40008e94: 93 2c 20 05 sll %l0, 5, %o1 40008e98: 81 c7 e0 08 ret 40008e9c: 81 e8 00 00 restore =============================================================================== 4000b0c8 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4000b0c8: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 4000b0cc: 7f ff de fe call 40002cc4 4000b0d0: a0 10 00 18 mov %i0, %l0 } } _ISR_Enable( level ); } 4000b0d4: 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 ); 4000b0d8: a2 06 20 04 add %i0, 4, %l1 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { 4000b0dc: 80 a0 40 11 cmp %g1, %l1 4000b0e0: 02 80 00 1f be 4000b15c <_Watchdog_Adjust+0x94> 4000b0e4: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 4000b0e8: 02 80 00 1a be 4000b150 <_Watchdog_Adjust+0x88> 4000b0ec: a4 10 20 01 mov 1, %l2 4000b0f0: 80 a6 60 01 cmp %i1, 1 4000b0f4: 12 80 00 1a bne 4000b15c <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000b0f8: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4000b0fc: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000b100: 10 80 00 07 b 4000b11c <_Watchdog_Adjust+0x54> 4000b104: b4 00 80 1a add %g2, %i2, %i2 break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { 4000b108: f2 00 60 10 ld [ %g1 + 0x10 ], %i1 4000b10c: 80 a6 80 19 cmp %i2, %i1 4000b110: 3a 80 00 05 bcc,a 4000b124 <_Watchdog_Adjust+0x5c> 4000b114: e4 20 60 10 st %l2, [ %g1 + 0x10 ] _Watchdog_First( header )->delta_interval -= units; 4000b118: b4 26 40 1a sub %i1, %i2, %i2 break; 4000b11c: 10 80 00 10 b 4000b15c <_Watchdog_Adjust+0x94> 4000b120: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; _ISR_Enable( level ); 4000b124: 7f ff de ec call 40002cd4 4000b128: 01 00 00 00 nop _Watchdog_Tickle( header ); 4000b12c: 40 00 00 92 call 4000b374 <_Watchdog_Tickle> 4000b130: 90 10 00 10 mov %l0, %o0 _ISR_Disable( level ); 4000b134: 7f ff de e4 call 40002cc4 4000b138: 01 00 00 00 nop if ( _Chain_Is_empty( header ) ) 4000b13c: c2 04 00 00 ld [ %l0 ], %g1 4000b140: 80 a0 40 11 cmp %g1, %l1 4000b144: 02 80 00 06 be 4000b15c <_Watchdog_Adjust+0x94> 4000b148: 01 00 00 00 nop while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; 4000b14c: b4 26 80 19 sub %i2, %i1, %i2 switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4000b150: 80 a6 a0 00 cmp %i2, 0 4000b154: 32 bf ff ed bne,a 4000b108 <_Watchdog_Adjust+0x40> <== ALWAYS TAKEN 4000b158: c2 04 00 00 ld [ %l0 ], %g1 } break; } } _ISR_Enable( level ); 4000b15c: 7f ff de de call 40002cd4 4000b160: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40009204 <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 40009204: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 40009208: 7f ff e2 a4 call 40001c98 4000920c: a0 10 00 18 mov %i0, %l0 previous_state = the_watchdog->state; 40009210: f0 06 20 08 ld [ %i0 + 8 ], %i0 switch ( previous_state ) { 40009214: 80 a6 20 01 cmp %i0, 1 40009218: 22 80 00 1d be,a 4000928c <_Watchdog_Remove+0x88> 4000921c: c0 24 20 08 clr [ %l0 + 8 ] 40009220: 0a 80 00 1c bcs 40009290 <_Watchdog_Remove+0x8c> 40009224: 03 10 00 55 sethi %hi(0x40015400), %g1 40009228: 80 a6 20 03 cmp %i0, 3 4000922c: 18 80 00 19 bgu 40009290 <_Watchdog_Remove+0x8c> <== NEVER TAKEN 40009230: 01 00 00 00 nop 40009234: c2 04 00 00 ld [ %l0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 40009238: c0 24 20 08 clr [ %l0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 4000923c: c4 00 40 00 ld [ %g1 ], %g2 40009240: 80 a0 a0 00 cmp %g2, 0 40009244: 02 80 00 07 be 40009260 <_Watchdog_Remove+0x5c> 40009248: 05 10 00 55 sethi %hi(0x40015400), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 4000924c: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40009250: c4 04 20 10 ld [ %l0 + 0x10 ], %g2 40009254: 84 00 c0 02 add %g3, %g2, %g2 40009258: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 4000925c: 05 10 00 55 sethi %hi(0x40015400), %g2 40009260: c4 00 a2 0c ld [ %g2 + 0x20c ], %g2 ! 4001560c <_Watchdog_Sync_count> 40009264: 80 a0 a0 00 cmp %g2, 0 40009268: 22 80 00 07 be,a 40009284 <_Watchdog_Remove+0x80> 4000926c: c4 04 20 04 ld [ %l0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 40009270: 05 10 00 56 sethi %hi(0x40015800), %g2 40009274: c6 00 a2 40 ld [ %g2 + 0x240 ], %g3 ! 40015a40 <_Per_CPU_Information+0x8> 40009278: 05 10 00 55 sethi %hi(0x40015400), %g2 4000927c: c6 20 a1 a4 st %g3, [ %g2 + 0x1a4 ] ! 400155a4 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 40009280: c4 04 20 04 ld [ %l0 + 4 ], %g2 next->previous = previous; 40009284: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 40009288: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000928c: 03 10 00 55 sethi %hi(0x40015400), %g1 40009290: c2 00 62 10 ld [ %g1 + 0x210 ], %g1 ! 40015610 <_Watchdog_Ticks_since_boot> 40009294: c2 24 20 18 st %g1, [ %l0 + 0x18 ] _ISR_Enable( level ); 40009298: 7f ff e2 84 call 40001ca8 4000929c: 01 00 00 00 nop return( previous_state ); } 400092a0: 81 c7 e0 08 ret 400092a4: 81 e8 00 00 restore =============================================================================== 4000a8e4 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4000a8e4: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4000a8e8: 7f ff df ce call 40002820 4000a8ec: a0 10 00 18 mov %i0, %l0 4000a8f0: b0 10 00 08 mov %o0, %i0 printk( "Watchdog Chain: %s %p\n", name, header ); 4000a8f4: 11 10 00 76 sethi %hi(0x4001d800), %o0 4000a8f8: 94 10 00 19 mov %i1, %o2 4000a8fc: 90 12 21 30 or %o0, 0x130, %o0 4000a900: 7f ff e6 3c call 400041f0 4000a904: 92 10 00 10 mov %l0, %o1 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 4000a908: 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 ); 4000a90c: 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 ) ) { 4000a910: 80 a4 40 19 cmp %l1, %i1 4000a914: 02 80 00 0e be 4000a94c <_Watchdog_Report_chain+0x68> 4000a918: 11 10 00 76 sethi %hi(0x4001d800), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4000a91c: 92 10 00 11 mov %l1, %o1 4000a920: 40 00 00 10 call 4000a960 <_Watchdog_Report> 4000a924: 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 ) 4000a928: 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 ) ; 4000a92c: 80 a4 40 19 cmp %l1, %i1 4000a930: 12 bf ff fc bne 4000a920 <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 4000a934: 92 10 00 11 mov %l1, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4000a938: 11 10 00 76 sethi %hi(0x4001d800), %o0 4000a93c: 92 10 00 10 mov %l0, %o1 4000a940: 7f ff e6 2c call 400041f0 4000a944: 90 12 21 48 or %o0, 0x148, %o0 4000a948: 30 80 00 03 b,a 4000a954 <_Watchdog_Report_chain+0x70> } else { printk( "Chain is empty\n" ); 4000a94c: 7f ff e6 29 call 400041f0 4000a950: 90 12 21 58 or %o0, 0x158, %o0 } _ISR_Enable( level ); 4000a954: 7f ff df b7 call 40002830 4000a958: 81 e8 00 00 restore =============================================================================== 4000650c : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 4000650c: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 40006510: 21 10 00 61 sethi %hi(0x40018400), %l0 40006514: 40 00 04 60 call 40007694 40006518: 90 14 20 04 or %l0, 4, %o0 ! 40018404 if (aiocbp == NULL) 4000651c: 80 a6 60 00 cmp %i1, 0 40006520: 32 80 00 3f bne,a 4000661c 40006524: e2 06 40 00 ld [ %i1 ], %l1 { if (fcntl (fildes, F_GETFL) < 0) { 40006528: 90 10 00 18 mov %i0, %o0 4000652c: 40 00 1c 6e call 4000d6e4 40006530: 92 10 20 03 mov 3, %o1 40006534: 80 a2 20 00 cmp %o0, 0 40006538: 36 80 00 08 bge,a 40006558 <== NEVER TAKEN 4000653c: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED pthread_mutex_unlock(&aio_request_queue.mutex); 40006540: 40 00 04 76 call 40007718 40006544: 90 14 20 04 or %l0, 4, %o0 rtems_set_errno_and_return_minus_one (EBADF); 40006548: 40 00 2a 18 call 40010da8 <__errno> 4000654c: 01 00 00 00 nop 40006550: 10 80 00 50 b 40006690 40006554: 82 10 20 09 mov 9, %g1 ! 9 } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40006558: 92 10 00 18 mov %i0, %o1 <== NOT EXECUTED 4000655c: 90 12 20 4c or %o0, 0x4c, %o0 <== NOT EXECUTED 40006560: 40 00 00 be call 40006858 <== NOT EXECUTED 40006564: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) 40006568: a2 92 20 00 orcc %o0, 0, %l1 <== NOT EXECUTED 4000656c: 12 80 00 1f bne 400065e8 <== NOT EXECUTED 40006570: b2 04 60 1c add %l1, 0x1c, %i1 <== NOT EXECUTED return result; } return AIO_ALLDONE; } 40006574: a0 14 20 04 or %l0, 4, %l0 <== NOT EXECUTED 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)) 40006578: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 <== NOT EXECUTED 4000657c: 82 04 20 58 add %l0, 0x58, %g1 <== NOT EXECUTED 40006580: 80 a0 80 01 cmp %g2, %g1 <== NOT EXECUTED 40006584: 02 80 00 14 be 400065d4 <== NOT EXECUTED 40006588: 90 04 20 54 add %l0, 0x54, %o0 <== NOT EXECUTED { r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, 4000658c: 92 10 00 18 mov %i0, %o1 <== NOT EXECUTED 40006590: 40 00 00 b2 call 40006858 <== NOT EXECUTED 40006594: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) { 40006598: a2 92 20 00 orcc %o0, 0, %l1 <== NOT EXECUTED 4000659c: 22 80 00 0f be,a 400065d8 <== NOT EXECUTED 400065a0: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 400065a4: 40 00 0a bc call 40009094 <_Chain_Extract> <== NOT EXECUTED 400065a8: b2 04 60 1c add %l1, 0x1c, %i1 <== NOT EXECUTED pthread_mutex_unlock(&aio_request_queue.mutex); return AIO_ALLDONE; } rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 400065ac: 40 00 01 8f call 40006be8 <== NOT EXECUTED 400065b0: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_mutex_destroy (&r_chain->mutex); 400065b4: 40 00 03 8f call 400073f0 <== NOT EXECUTED 400065b8: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED pthread_cond_destroy (&r_chain->mutex); 400065bc: 40 00 02 b1 call 40007080 <== NOT EXECUTED 400065c0: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED free (r_chain); 400065c4: 7f ff f3 2c call 40003274 <== NOT EXECUTED 400065c8: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 400065cc: 10 80 00 10 b 4000660c <== NOT EXECUTED 400065d0: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return AIO_CANCELED; } pthread_mutex_unlock (&aio_request_queue.mutex); 400065d4: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 400065d8: 40 00 04 50 call 40007718 <== NOT EXECUTED 400065dc: b0 10 20 02 mov 2, %i0 <== NOT EXECUTED return AIO_ALLDONE; 400065e0: 81 c7 e0 08 ret <== NOT EXECUTED 400065e4: 81 e8 00 00 restore <== NOT EXECUTED } pthread_mutex_lock (&r_chain->mutex); 400065e8: 40 00 04 2b call 40007694 <== NOT EXECUTED 400065ec: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 400065f0: 40 00 0a a9 call 40009094 <_Chain_Extract> <== NOT EXECUTED 400065f4: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 400065f8: 40 00 01 7c call 40006be8 <== NOT EXECUTED 400065fc: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); 40006600: 40 00 04 46 call 40007718 <== NOT EXECUTED 40006604: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 40006608: 90 14 20 04 or %l0, 4, %o0 <== NOT EXECUTED 4000660c: 40 00 04 43 call 40007718 <== NOT EXECUTED 40006610: b0 10 20 00 clr %i0 <== NOT EXECUTED return AIO_CANCELED; 40006614: 81 c7 e0 08 ret <== NOT EXECUTED 40006618: 81 e8 00 00 restore <== NOT EXECUTED } else { if (aiocbp->aio_fildes != fildes) { 4000661c: 80 a4 40 18 cmp %l1, %i0 40006620: 12 80 00 17 bne 4000667c <== ALWAYS TAKEN 40006624: 90 14 20 04 or %l0, 4, %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, 40006628: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 4000662c: 92 10 00 11 mov %l1, %o1 <== NOT EXECUTED 40006630: 90 12 20 4c or %o0, 0x4c, %o0 <== NOT EXECUTED 40006634: 40 00 00 89 call 40006858 <== NOT EXECUTED 40006638: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) 4000663c: b0 92 20 00 orcc %o0, 0, %i0 <== NOT EXECUTED 40006640: 32 80 00 1f bne,a 400066bc <== NOT EXECUTED 40006644: a0 06 20 1c add %i0, 0x1c, %l0 <== NOT EXECUTED return result; } return AIO_ALLDONE; } 40006648: a0 14 20 04 or %l0, 4, %l0 <== NOT EXECUTED 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)) 4000664c: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 <== NOT EXECUTED 40006650: 82 04 20 58 add %l0, 0x58, %g1 <== NOT EXECUTED 40006654: 80 a0 80 01 cmp %g2, %g1 <== NOT EXECUTED 40006658: 02 80 00 18 be 400066b8 <== NOT EXECUTED 4000665c: 92 10 00 11 mov %l1, %o1 <== NOT EXECUTED { r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, 40006660: 90 04 20 54 add %l0, 0x54, %o0 <== NOT EXECUTED 40006664: 40 00 00 7d call 40006858 <== NOT EXECUTED 40006668: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) 4000666c: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40006670: 12 80 00 0b bne 4000669c <== NOT EXECUTED 40006674: 01 00 00 00 nop <== NOT EXECUTED { pthread_mutex_unlock (&aio_request_queue.mutex); 40006678: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 4000667c: 40 00 04 27 call 40007718 40006680: 01 00 00 00 nop rtems_set_errno_and_return_minus_one (EINVAL); 40006684: 40 00 29 c9 call 40010da8 <__errno> 40006688: 01 00 00 00 nop 4000668c: 82 10 20 16 mov 0x16, %g1 ! 16 40006690: c2 22 00 00 st %g1, [ %o0 ] 40006694: 81 c7 e0 08 ret 40006698: 91 e8 3f ff restore %g0, -1, %o0 } result = rtems_aio_remove_req (&r_chain->next_fd, aiocbp); 4000669c: 40 00 01 65 call 40006c30 <== NOT EXECUTED 400066a0: 92 10 00 19 mov %i1, %o1 <== NOT EXECUTED 400066a4: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 400066a8: 40 00 04 1c call 40007718 <== NOT EXECUTED 400066ac: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return result; 400066b0: 81 c7 e0 08 ret <== NOT EXECUTED 400066b4: 81 e8 00 00 restore <== NOT EXECUTED } pthread_mutex_lock (&r_chain->mutex); 400066b8: a0 06 20 1c add %i0, 0x1c, %l0 <== NOT EXECUTED 400066bc: 40 00 03 f6 call 40007694 <== NOT EXECUTED 400066c0: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED result = rtems_aio_remove_req (&r_chain->next_fd, aiocbp); 400066c4: 92 10 00 19 mov %i1, %o1 <== NOT EXECUTED 400066c8: 40 00 01 5a call 40006c30 <== NOT EXECUTED 400066cc: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED 400066d0: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); 400066d4: 40 00 04 11 call 40007718 <== NOT EXECUTED 400066d8: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 400066dc: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 400066e0: 40 00 04 0e call 40007718 <== NOT EXECUTED 400066e4: 90 12 20 04 or %o0, 4, %o0 ! 40018404 <== NOT EXECUTED return result; } return AIO_ALLDONE; } 400066e8: 81 c7 e0 08 ret <== NOT EXECUTED 400066ec: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 400066f8 : int aio_fsync( int op, struct aiocb *aiocbp ) { 400066f8: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; if (op != O_SYNC) 400066fc: 03 00 00 08 sethi %hi(0x2000), %g1 40006700: 80 a6 00 01 cmp %i0, %g1 40006704: 12 80 00 10 bne 40006744 40006708: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 4000670c: d0 06 40 00 ld [ %i1 ], %o0 40006710: 40 00 1b f5 call 4000d6e4 40006714: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40006718: 90 0a 20 03 and %o0, 3, %o0 4000671c: 90 02 3f ff add %o0, -1, %o0 40006720: 80 a2 20 01 cmp %o0, 1 40006724: 18 80 00 08 bgu 40006744 <== ALWAYS TAKEN 40006728: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); 4000672c: 7f ff f4 52 call 40003874 <== NOT EXECUTED 40006730: 90 10 20 18 mov 0x18, %o0 <== NOT EXECUTED if (req == NULL) 40006734: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40006738: 32 80 00 0b bne,a 40006764 <== NOT EXECUTED 4000673c: f2 22 20 14 st %i1, [ %o0 + 0x14 ] <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40006740: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED 40006744: 82 10 3f ff mov -1, %g1 40006748: e0 26 60 34 st %l0, [ %i1 + 0x34 ] 4000674c: c2 26 60 38 st %g1, [ %i1 + 0x38 ] 40006750: 40 00 29 96 call 40010da8 <__errno> 40006754: b0 10 3f ff mov -1, %i0 40006758: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } 4000675c: 81 c7 e0 08 ret 40006760: 81 e8 00 00 restore req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; 40006764: 82 10 20 03 mov 3, %g1 <== NOT EXECUTED 40006768: c2 26 60 30 st %g1, [ %i1 + 0x30 ] <== NOT EXECUTED return rtems_aio_enqueue (req); 4000676c: 40 00 01 49 call 40006c90 <== NOT EXECUTED 40006770: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED =============================================================================== 40006ebc : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 40006ebc: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40006ec0: d0 06 00 00 ld [ %i0 ], %o0 40006ec4: 40 00 1a 08 call 4000d6e4 40006ec8: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40006ecc: 90 0a 20 03 and %o0, 3, %o0 40006ed0: 80 a2 20 02 cmp %o0, 2 40006ed4: 02 80 00 05 be 40006ee8 40006ed8: a0 10 00 18 mov %i0, %l0 40006edc: 80 a2 20 00 cmp %o0, 0 40006ee0: 12 80 00 10 bne 40006f20 <== ALWAYS TAKEN 40006ee4: a2 10 20 09 mov 9, %l1 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 40006ee8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40006eec: 80 a0 60 00 cmp %g1, 0 40006ef0: 32 80 00 0c bne,a 40006f20 40006ef4: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40006ef8: c2 04 20 08 ld [ %l0 + 8 ], %g1 40006efc: 80 a0 60 00 cmp %g1, 0 40006f00: 26 80 00 08 bl,a 40006f20 40006f04: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40006f08: 7f ff f2 5b call 40003874 40006f0c: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40006f10: 80 a2 20 00 cmp %o0, 0 40006f14: 32 80 00 0b bne,a 40006f40 <== ALWAYS TAKEN 40006f18: e0 22 20 14 st %l0, [ %o0 + 0x14 ] 40006f1c: a2 10 20 0b mov 0xb, %l1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40006f20: 82 10 3f ff mov -1, %g1 40006f24: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40006f28: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40006f2c: 40 00 27 9f call 40010da8 <__errno> 40006f30: b0 10 3f ff mov -1, %i0 40006f34: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; return rtems_aio_enqueue (req); } 40006f38: 81 c7 e0 08 ret 40006f3c: 81 e8 00 00 restore req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; 40006f40: 82 10 20 01 mov 1, %g1 40006f44: c2 24 20 30 st %g1, [ %l0 + 0x30 ] return rtems_aio_enqueue (req); 40006f48: 7f ff ff 52 call 40006c90 40006f4c: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006f5c : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40006f5c: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40006f60: d0 06 00 00 ld [ %i0 ], %o0 40006f64: 40 00 19 e0 call 4000d6e4 40006f68: 92 10 20 03 mov 3, %o1 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40006f6c: a0 10 00 18 mov %i0, %l0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40006f70: 90 0a 20 03 and %o0, 3, %o0 40006f74: 90 02 3f ff add %o0, -1, %o0 40006f78: 80 a2 20 01 cmp %o0, 1 40006f7c: 18 80 00 10 bgu 40006fbc 40006f80: a2 10 20 09 mov 9, %l1 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 40006f84: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 40006f88: 80 a0 60 00 cmp %g1, 0 40006f8c: 32 80 00 0c bne,a 40006fbc 40006f90: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40006f94: c2 06 20 08 ld [ %i0 + 8 ], %g1 40006f98: 80 a0 60 00 cmp %g1, 0 40006f9c: 26 80 00 08 bl,a 40006fbc 40006fa0: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40006fa4: 7f ff f2 34 call 40003874 40006fa8: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40006fac: 80 a2 20 00 cmp %o0, 0 40006fb0: 32 80 00 0b bne,a 40006fdc <== ALWAYS TAKEN 40006fb4: f0 22 20 14 st %i0, [ %o0 + 0x14 ] 40006fb8: a2 10 20 0b mov 0xb, %l1 <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40006fbc: 82 10 3f ff mov -1, %g1 40006fc0: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40006fc4: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40006fc8: 40 00 27 78 call 40010da8 <__errno> 40006fcc: b0 10 3f ff mov -1, %i0 40006fd0: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; return rtems_aio_enqueue (req); } 40006fd4: 81 c7 e0 08 ret 40006fd8: 81 e8 00 00 restore req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; 40006fdc: 82 10 20 02 mov 2, %g1 40006fe0: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 40006fe4: 7f ff ff 2b call 40006c90 40006fe8: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40005b20 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 40005b20: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40005b24: 90 96 60 00 orcc %i1, 0, %o0 40005b28: 12 80 00 06 bne 40005b40 40005b2c: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); 40005b30: 40 00 26 60 call 4000f4b0 <__errno> 40005b34: 01 00 00 00 nop 40005b38: 10 80 00 15 b 40005b8c 40005b3c: 82 10 20 16 mov 0x16, %g1 ! 16 if ( clock_id == CLOCK_REALTIME ) { 40005b40: 12 80 00 05 bne 40005b54 40005b44: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); 40005b48: 40 00 07 dc call 40007ab8 <_TOD_Get> 40005b4c: b0 10 20 00 clr %i0 40005b50: 30 80 00 16 b,a 40005ba8 return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 40005b54: 02 80 00 05 be 40005b68 <== NEVER TAKEN 40005b58: 01 00 00 00 nop return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 40005b5c: 80 a6 20 02 cmp %i0, 2 40005b60: 12 80 00 06 bne 40005b78 40005b64: 80 a6 20 03 cmp %i0, 3 _TOD_Get_uptime_as_timespec( tp ); 40005b68: 40 00 07 f3 call 40007b34 <_TOD_Get_uptime_as_timespec> 40005b6c: b0 10 20 00 clr %i0 return 0; 40005b70: 81 c7 e0 08 ret 40005b74: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 40005b78: 12 80 00 08 bne 40005b98 40005b7c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 40005b80: 40 00 26 4c call 4000f4b0 <__errno> 40005b84: 01 00 00 00 nop 40005b88: 82 10 20 58 mov 0x58, %g1 ! 58 40005b8c: c2 22 00 00 st %g1, [ %o0 ] 40005b90: 81 c7 e0 08 ret 40005b94: 91 e8 3f ff restore %g0, -1, %o0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40005b98: 40 00 26 46 call 4000f4b0 <__errno> 40005b9c: b0 10 3f ff mov -1, %i0 40005ba0: 82 10 20 16 mov 0x16, %g1 40005ba4: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40005ba8: 81 c7 e0 08 ret 40005bac: 81 e8 00 00 restore =============================================================================== 40005bb0 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 40005bb0: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40005bb4: 90 96 60 00 orcc %i1, 0, %o0 40005bb8: 02 80 00 0b be 40005be4 <== NEVER TAKEN 40005bbc: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40005bc0: 80 a6 20 01 cmp %i0, 1 40005bc4: 12 80 00 15 bne 40005c18 40005bc8: 80 a6 20 02 cmp %i0, 2 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 40005bcc: c4 02 00 00 ld [ %o0 ], %g2 40005bd0: 03 08 76 b9 sethi %hi(0x21dae400), %g1 40005bd4: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 40005bd8: 80 a0 80 01 cmp %g2, %g1 40005bdc: 38 80 00 06 bgu,a 40005bf4 40005be0: 03 10 00 7c sethi %hi(0x4001f000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40005be4: 40 00 26 33 call 4000f4b0 <__errno> 40005be8: 01 00 00 00 nop 40005bec: 10 80 00 13 b 40005c38 40005bf0: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40005bf4: c4 00 61 70 ld [ %g1 + 0x170 ], %g2 40005bf8: 84 00 a0 01 inc %g2 40005bfc: c4 20 61 70 st %g2, [ %g1 + 0x170 ] _Thread_Disable_dispatch(); _TOD_Set( tp ); 40005c00: 40 00 07 e3 call 40007b8c <_TOD_Set> 40005c04: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40005c08: 40 00 0d 6d call 400091bc <_Thread_Enable_dispatch> 40005c0c: 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; 40005c10: 81 c7 e0 08 ret 40005c14: 81 e8 00 00 restore _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 40005c18: 02 80 00 05 be 40005c2c 40005c1c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) 40005c20: 80 a6 20 03 cmp %i0, 3 40005c24: 12 80 00 08 bne 40005c44 40005c28: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 40005c2c: 40 00 26 21 call 4000f4b0 <__errno> 40005c30: 01 00 00 00 nop 40005c34: 82 10 20 58 mov 0x58, %g1 ! 58 40005c38: c2 22 00 00 st %g1, [ %o0 ] 40005c3c: 81 c7 e0 08 ret 40005c40: 91 e8 3f ff restore %g0, -1, %o0 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 40005c44: 40 00 26 1b call 4000f4b0 <__errno> 40005c48: b0 10 3f ff mov -1, %i0 40005c4c: 82 10 20 16 mov 0x16, %g1 40005c50: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40005c54: 81 c7 e0 08 ret 40005c58: 81 e8 00 00 restore =============================================================================== 40023170 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 40023170: 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() ) 40023174: 7f ff ff 37 call 40022e50 40023178: 01 00 00 00 nop 4002317c: 80 a6 00 08 cmp %i0, %o0 40023180: 02 80 00 06 be 40023198 40023184: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40023188: 7f ff c2 2e call 40013a40 <__errno> 4002318c: 01 00 00 00 nop 40023190: 10 80 00 07 b 400231ac 40023194: 82 10 20 03 mov 3, %g1 ! 3 /* * Validate the signal passed. */ if ( !sig ) 40023198: 12 80 00 08 bne 400231b8 4002319c: a0 06 7f ff add %i1, -1, %l0 rtems_set_errno_and_return_minus_one( EINVAL ); 400231a0: 7f ff c2 28 call 40013a40 <__errno> 400231a4: 01 00 00 00 nop 400231a8: 82 10 20 16 mov 0x16, %g1 ! 16 400231ac: c2 22 00 00 st %g1, [ %o0 ] 400231b0: 10 80 00 a6 b 40023448 400231b4: 90 10 3f ff mov -1, %o0 if ( !is_valid_signo(sig) ) 400231b8: 80 a4 20 1f cmp %l0, 0x1f 400231bc: 18 bf ff f9 bgu 400231a0 400231c0: 01 00 00 00 nop 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 ) 400231c4: 83 2e 60 02 sll %i1, 2, %g1 400231c8: 85 2e 60 04 sll %i1, 4, %g2 400231cc: 84 20 80 01 sub %g2, %g1, %g2 400231d0: 03 10 00 9c sethi %hi(0x40027000), %g1 400231d4: 82 10 60 70 or %g1, 0x70, %g1 ! 40027070 <_POSIX_signals_Vectors> 400231d8: 82 00 40 02 add %g1, %g2, %g1 400231dc: c2 00 60 08 ld [ %g1 + 8 ], %g1 400231e0: 80 a0 60 01 cmp %g1, 1 400231e4: 02 80 00 99 be 40023448 400231e8: 90 10 20 00 clr %o0 /* * 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 ) ) 400231ec: 80 a6 60 04 cmp %i1, 4 400231f0: 02 80 00 06 be 40023208 400231f4: 80 a6 60 08 cmp %i1, 8 400231f8: 02 80 00 04 be 40023208 400231fc: 80 a6 60 0b cmp %i1, 0xb 40023200: 12 80 00 08 bne 40023220 40023204: 82 10 20 01 mov 1, %g1 return pthread_kill( pthread_self(), sig ); 40023208: 40 00 01 27 call 400236a4 4002320c: 01 00 00 00 nop 40023210: 40 00 00 ea call 400235b8 40023214: 92 10 00 19 mov %i1, %o1 40023218: 81 c7 e0 08 ret 4002321c: 91 e8 00 08 restore %g0, %o0, %o0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 40023220: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 40023224: c2 27 bf f8 st %g1, [ %fp + -8 ] if ( !value ) { 40023228: 80 a6 a0 00 cmp %i2, 0 4002322c: 12 80 00 04 bne 4002323c 40023230: a1 28 40 10 sll %g1, %l0, %l0 siginfo->si_value.sival_int = 0; 40023234: 10 80 00 04 b 40023244 40023238: c0 27 bf fc clr [ %fp + -4 ] } else { siginfo->si_value = *value; 4002323c: c2 06 80 00 ld [ %i2 ], %g1 40023240: c2 27 bf fc st %g1, [ %fp + -4 ] 40023244: 03 10 00 9a sethi %hi(0x40026800), %g1 40023248: c4 00 62 c0 ld [ %g1 + 0x2c0 ], %g2 ! 40026ac0 <_Thread_Dispatch_disable_level> 4002324c: 84 00 a0 01 inc %g2 40023250: c4 20 62 c0 st %g2, [ %g1 + 0x2c0 ] /* * 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; 40023254: 03 10 00 9c sethi %hi(0x40027000), %g1 40023258: d0 00 60 24 ld [ %g1 + 0x24 ], %o0 ! 40027024 <_Per_CPU_Information+0xc> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 4002325c: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 40023260: c2 00 60 d0 ld [ %g1 + 0xd0 ], %g1 40023264: 80 ac 00 01 andncc %l0, %g1, %g0 40023268: 12 80 00 51 bne 400233ac 4002326c: 03 10 00 9c sethi %hi(0x40027000), %g1 /* 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 ); 40023270: 05 10 00 9c sethi %hi(0x40027000), %g2 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 40023274: c2 00 61 fc ld [ %g1 + 0x1fc ], %g1 /* 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 ); 40023278: 10 80 00 0b b 400232a4 4002327c: 84 10 a2 00 or %g2, 0x200, %g2 !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 40023280: 90 10 00 01 mov %g1, %o0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 40023284: 80 8c 00 04 btst %l0, %g4 40023288: 12 80 00 49 bne 400233ac 4002328c: c6 00 61 58 ld [ %g1 + 0x158 ], %g3 /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 40023290: c6 00 e0 d0 ld [ %g3 + 0xd0 ], %g3 40023294: 80 ac 00 03 andncc %l0, %g3, %g0 40023298: 12 80 00 46 bne 400233b0 4002329c: 92 10 00 19 mov %i1, %o1 the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { 400232a0: c2 00 40 00 ld [ %g1 ], %g1 /* 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 ); 400232a4: 80 a0 40 02 cmp %g1, %g2 400232a8: 32 bf ff f6 bne,a 40023280 400232ac: c8 00 60 30 ld [ %g1 + 0x30 ], %g4 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 400232b0: 03 10 00 97 sethi %hi(0x40025c00), %g1 400232b4: c6 08 63 e4 ldub [ %g1 + 0x3e4 ], %g3 ! 40025fe4 400232b8: 05 10 00 9a sethi %hi(0x40026800), %g2 400232bc: 86 00 e0 01 inc %g3 400232c0: 84 10 a2 30 or %g2, 0x230, %g2 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 400232c4: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 400232c8: 92 00 a0 08 add %g2, 8, %o1 */ RTEMS_INLINE_ROUTINE bool _States_Is_interruptible_by_signal ( States_Control the_states ) { return (the_states & STATES_INTERRUPTIBLE_BY_SIGNAL); 400232cc: 19 04 00 00 sethi %hi(0x10000000), %o4 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 ] ) 400232d0: c2 00 80 00 ld [ %g2 ], %g1 400232d4: 80 a0 60 00 cmp %g1, 0 400232d8: 22 80 00 2f be,a 40023394 <== NEVER TAKEN 400232dc: 84 00 a0 04 add %g2, 4, %g2 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 400232e0: c2 00 60 04 ld [ %g1 + 4 ], %g1 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 400232e4: 9a 10 20 01 mov 1, %o5 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 400232e8: f4 10 60 10 lduh [ %g1 + 0x10 ], %i2 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 400232ec: 10 80 00 26 b 40023384 400232f0: de 00 60 1c ld [ %g1 + 0x1c ], %o7 the_thread = (Thread_Control *) object_table[ index ]; 400232f4: c2 03 c0 01 ld [ %o7 + %g1 ], %g1 if ( !the_thread ) 400232f8: 80 a0 60 00 cmp %g1, 0 400232fc: 22 80 00 22 be,a 40023384 40023300: 9a 03 60 01 inc %o5 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 40023304: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 40023308: 80 a1 00 03 cmp %g4, %g3 4002330c: 38 80 00 1e bgu,a 40023384 40023310: 9a 03 60 01 inc %o5 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 40023314: d6 00 61 58 ld [ %g1 + 0x158 ], %o3 40023318: d6 02 e0 d0 ld [ %o3 + 0xd0 ], %o3 4002331c: 80 ac 00 0b andncc %l0, %o3, %g0 40023320: 22 80 00 19 be,a 40023384 40023324: 9a 03 60 01 inc %o5 * * 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 ) { 40023328: 80 a1 00 03 cmp %g4, %g3 4002332c: 2a 80 00 14 bcs,a 4002337c 40023330: 86 10 00 04 mov %g4, %g3 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { 40023334: 80 a2 20 00 cmp %o0, 0 40023338: 22 80 00 13 be,a 40023384 <== NEVER TAKEN 4002333c: 9a 03 60 01 inc %o5 <== NOT EXECUTED 40023340: d4 02 20 10 ld [ %o0 + 0x10 ], %o2 40023344: 80 a2 a0 00 cmp %o2, 0 40023348: 22 80 00 0f be,a 40023384 <== NEVER TAKEN 4002334c: 9a 03 60 01 inc %o5 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 40023350: d6 00 60 10 ld [ %g1 + 0x10 ], %o3 40023354: 80 a2 e0 00 cmp %o3, 0 40023358: 22 80 00 09 be,a 4002337c 4002335c: 86 10 00 04 mov %g4, %g3 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 40023360: 80 8a 80 0c btst %o2, %o4 40023364: 32 80 00 08 bne,a 40023384 40023368: 9a 03 60 01 inc %o5 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 4002336c: 80 8a c0 0c btst %o3, %o4 40023370: 22 80 00 05 be,a 40023384 40023374: 9a 03 60 01 inc %o5 */ if ( interested && !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 40023378: 86 10 00 04 mov %g4, %g3 4002337c: 90 10 00 01 mov %g1, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40023380: 9a 03 60 01 inc %o5 40023384: 80 a3 40 1a cmp %o5, %i2 40023388: 08 bf ff db bleu 400232f4 4002338c: 83 2b 60 02 sll %o5, 2, %g1 40023390: 84 00 a0 04 add %g2, 4, %g2 * + 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++) { 40023394: 80 a0 80 09 cmp %g2, %o1 40023398: 32 bf ff cf bne,a 400232d4 4002339c: c2 00 80 00 ld [ %g2 ], %g1 } } } } if ( interested ) { 400233a0: 80 a2 20 00 cmp %o0, 0 400233a4: 02 80 00 08 be 400233c4 400233a8: 01 00 00 00 nop /* * 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 ) ) { 400233ac: 92 10 00 19 mov %i1, %o1 400233b0: 40 00 00 33 call 4002347c <_POSIX_signals_Unblock_thread> 400233b4: 94 07 bf f4 add %fp, -12, %o2 400233b8: 80 8a 20 ff btst 0xff, %o0 400233bc: 12 80 00 20 bne 4002343c 400233c0: 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 ); 400233c4: 40 00 00 24 call 40023454 <_POSIX_signals_Set_process_signals> 400233c8: 90 10 00 10 mov %l0, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 400233cc: 83 2e 60 02 sll %i1, 2, %g1 400233d0: b3 2e 60 04 sll %i1, 4, %i1 400233d4: b2 26 40 01 sub %i1, %g1, %i1 400233d8: 03 10 00 9c sethi %hi(0x40027000), %g1 400233dc: 82 10 60 70 or %g1, 0x70, %g1 ! 40027070 <_POSIX_signals_Vectors> 400233e0: c2 00 40 19 ld [ %g1 + %i1 ], %g1 400233e4: 80 a0 60 02 cmp %g1, 2 400233e8: 12 80 00 15 bne 4002343c 400233ec: 11 10 00 9c sethi %hi(0x40027000), %o0 psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 400233f0: 7f ff a2 67 call 4000bd8c <_Chain_Get> 400233f4: 90 12 21 f0 or %o0, 0x1f0, %o0 ! 400271f0 <_POSIX_signals_Inactive_siginfo> if ( !psiginfo ) { 400233f8: a0 92 20 00 orcc %o0, 0, %l0 400233fc: 12 80 00 08 bne 4002341c 40023400: 92 07 bf f4 add %fp, -12, %o1 _Thread_Enable_dispatch(); 40023404: 7f ff a9 28 call 4000d8a4 <_Thread_Enable_dispatch> 40023408: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 4002340c: 7f ff c1 8d call 40013a40 <__errno> 40023410: 01 00 00 00 nop 40023414: 10 bf ff 66 b 400231ac 40023418: 82 10 20 0b mov 0xb, %g1 ! b } psiginfo->Info = *siginfo; 4002341c: 90 04 20 08 add %l0, 8, %o0 40023420: 7f ff c3 e2 call 400143a8 40023424: 94 10 20 0c mov 0xc, %o2 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 40023428: 11 10 00 9c sethi %hi(0x40027000), %o0 4002342c: 92 10 00 10 mov %l0, %o1 40023430: 90 12 22 68 or %o0, 0x268, %o0 40023434: 7f ff a2 40 call 4000bd34 <_Chain_Append> 40023438: 90 02 00 19 add %o0, %i1, %o0 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 4002343c: 7f ff a9 1a call 4000d8a4 <_Thread_Enable_dispatch> 40023440: 01 00 00 00 nop return 0; 40023444: 90 10 20 00 clr %o0 ! 0 } 40023448: b0 10 00 08 mov %o0, %i0 4002344c: 81 c7 e0 08 ret 40023450: 81 e8 00 00 restore =============================================================================== 4000b304 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 4000b304: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 4000b308: 80 a0 60 00 cmp %g1, 0 4000b30c: 02 80 00 0f be 4000b348 4000b310: 90 10 20 16 mov 0x16, %o0 4000b314: c4 00 40 00 ld [ %g1 ], %g2 4000b318: 80 a0 a0 00 cmp %g2, 0 4000b31c: 02 80 00 0b be 4000b348 4000b320: 80 a2 60 04 cmp %o1, 4 return EINVAL; switch ( policy ) { 4000b324: 18 80 00 09 bgu 4000b348 4000b328: 90 10 20 86 mov 0x86, %o0 4000b32c: 84 10 20 01 mov 1, %g2 4000b330: 85 28 80 09 sll %g2, %o1, %g2 4000b334: 80 88 a0 17 btst 0x17, %g2 4000b338: 02 80 00 04 be 4000b348 <== NEVER TAKEN 4000b33c: 01 00 00 00 nop case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 4000b340: d2 20 60 14 st %o1, [ %g1 + 0x14 ] 4000b344: 90 10 20 00 clr %o0 return 0; default: return ENOTSUP; } } 4000b348: 81 c3 e0 08 retl =============================================================================== 40006174 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 40006174: 9d e3 bf 90 save %sp, -112, %sp 40006178: a0 10 00 18 mov %i0, %l0 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 4000617c: 80 a4 20 00 cmp %l0, 0 40006180: 02 80 00 1f be 400061fc 40006184: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( count == 0 ) 40006188: 80 a6 a0 00 cmp %i2, 0 4000618c: 02 80 00 1c be 400061fc 40006190: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40006194: 32 80 00 06 bne,a 400061ac 40006198: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 4000619c: b2 07 bf f0 add %fp, -16, %i1 400061a0: 7f ff ff bd call 40006094 400061a4: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 400061a8: c2 06 40 00 ld [ %i1 ], %g1 400061ac: 80 a0 60 00 cmp %g1, 0 400061b0: 02 80 00 13 be 400061fc 400061b4: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 400061b8: c2 06 60 04 ld [ %i1 + 4 ], %g1 400061bc: 80 a0 60 00 cmp %g1, 0 400061c0: 12 80 00 0f bne 400061fc <== NEVER TAKEN 400061c4: 03 10 00 5b sethi %hi(0x40016c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400061c8: c4 00 62 a0 ld [ %g1 + 0x2a0 ], %g2 ! 40016ea0 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 400061cc: c0 27 bf f8 clr [ %fp + -8 ] the_attributes.maximum_count = count; 400061d0: f4 27 bf fc st %i2, [ %fp + -4 ] 400061d4: 84 00 a0 01 inc %g2 400061d8: c4 20 62 a0 st %g2, [ %g1 + 0x2a0 ] * 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 ); 400061dc: 25 10 00 5c sethi %hi(0x40017000), %l2 400061e0: 40 00 08 69 call 40008384 <_Objects_Allocate> 400061e4: 90 14 a2 80 or %l2, 0x280, %o0 ! 40017280 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 400061e8: a2 92 20 00 orcc %o0, 0, %l1 400061ec: 12 80 00 06 bne 40006204 400061f0: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 400061f4: 40 00 0c 89 call 40009418 <_Thread_Enable_dispatch> 400061f8: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 400061fc: 81 c7 e0 08 ret 40006200: 81 e8 00 00 restore } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 40006204: 40 00 05 cf call 40007940 <_CORE_barrier_Initialize> 40006208: 92 07 bf f8 add %fp, -8, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 4000620c: 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; } 40006210: a4 14 a2 80 or %l2, 0x280, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006214: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006218: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000621c: 85 28 a0 02 sll %g2, 2, %g2 40006220: 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; 40006224: c0 24 60 0c clr [ %l1 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 40006228: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 4000622c: 40 00 0c 7b call 40009418 <_Thread_Enable_dispatch> 40006230: b0 10 20 00 clr %i0 return 0; } 40006234: 81 c7 e0 08 ret 40006238: 81 e8 00 00 restore =============================================================================== 40005934 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 40005934: 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 ) 40005938: 80 a6 20 00 cmp %i0, 0 4000593c: 02 80 00 14 be 4000598c 40005940: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40005944: 03 10 00 5c sethi %hi(0x40017000), %g1 40005948: c4 00 62 60 ld [ %g1 + 0x260 ], %g2 ! 40017260 <_Thread_Dispatch_disable_level> 4000594c: 84 00 a0 01 inc %g2 40005950: c4 20 62 60 st %g2, [ %g1 + 0x260 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 40005954: 40 00 11 71 call 40009f18 <_Workspace_Allocate> 40005958: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 4000595c: 92 92 20 00 orcc %o0, 0, %o1 40005960: 02 80 00 09 be 40005984 <== NEVER TAKEN 40005964: 01 00 00 00 nop thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40005968: 03 10 00 5d sethi %hi(0x40017400), %g1 4000596c: c2 00 63 c4 ld [ %g1 + 0x3c4 ], %g1 ! 400177c4 <_Per_CPU_Information+0xc> handler_stack = &thread_support->Cancellation_Handlers; 40005970: d0 00 61 58 ld [ %g1 + 0x158 ], %o0 handler->routine = routine; 40005974: f0 22 60 08 st %i0, [ %o1 + 8 ] handler->arg = arg; 40005978: f2 22 60 0c st %i1, [ %o1 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 4000597c: 40 00 06 06 call 40007194 <_Chain_Append> 40005980: 90 02 20 e4 add %o0, 0xe4, %o0 } _Thread_Enable_dispatch(); 40005984: 40 00 0c b0 call 40008c44 <_Thread_Enable_dispatch> 40005988: 81 e8 00 00 restore 4000598c: 81 c7 e0 08 ret 40005990: 81 e8 00 00 restore =============================================================================== 40006a34 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 40006a34: 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; 40006a38: 80 a6 60 00 cmp %i1, 0 40006a3c: 12 80 00 04 bne 40006a4c 40006a40: a0 10 00 18 mov %i0, %l0 else the_attr = &_POSIX_Condition_variables_Default_attributes; 40006a44: 33 10 00 5a sethi %hi(0x40016800), %i1 40006a48: b2 16 63 ac or %i1, 0x3ac, %i1 ! 40016bac <_POSIX_Condition_variables_Default_attributes> /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 40006a4c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006a50: 80 a0 60 01 cmp %g1, 1 40006a54: 02 80 00 11 be 40006a98 <== NEVER TAKEN 40006a58: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !the_attr->is_initialized ) 40006a5c: c2 06 40 00 ld [ %i1 ], %g1 40006a60: 80 a0 60 00 cmp %g1, 0 40006a64: 02 80 00 0d be 40006a98 40006a68: 03 10 00 60 sethi %hi(0x40018000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006a6c: c4 00 60 80 ld [ %g1 + 0x80 ], %g2 ! 40018080 <_Thread_Dispatch_disable_level> 40006a70: 84 00 a0 01 inc %g2 40006a74: c4 20 60 80 st %g2, [ %g1 + 0x80 ] RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 40006a78: 25 10 00 61 sethi %hi(0x40018400), %l2 40006a7c: 40 00 09 d4 call 400091cc <_Objects_Allocate> 40006a80: 90 14 a0 f8 or %l2, 0xf8, %o0 ! 400184f8 <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 40006a84: a2 92 20 00 orcc %o0, 0, %l1 40006a88: 32 80 00 06 bne,a 40006aa0 40006a8c: c2 06 60 04 ld [ %i1 + 4 ], %g1 _Thread_Enable_dispatch(); 40006a90: 40 00 0d f4 call 4000a260 <_Thread_Enable_dispatch> 40006a94: b0 10 20 0c mov 0xc, %i0 return ENOMEM; 40006a98: 81 c7 e0 08 ret 40006a9c: 81 e8 00 00 restore the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40006aa0: 90 04 60 18 add %l1, 0x18, %o0 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40006aa4: c2 24 60 10 st %g1, [ %l1 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40006aa8: 92 10 20 00 clr %o1 40006aac: 15 04 00 02 sethi %hi(0x10000800), %o2 40006ab0: 96 10 20 74 mov 0x74, %o3 40006ab4: 40 00 0f f3 call 4000aa80 <_Thread_queue_Initialize> 40006ab8: c0 24 60 14 clr [ %l1 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006abc: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 40006ac0: a4 14 a0 f8 or %l2, 0xf8, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006ac4: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006ac8: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006acc: 85 28 a0 02 sll %g2, 2, %g2 40006ad0: 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; 40006ad4: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 40006ad8: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40006adc: 40 00 0d e1 call 4000a260 <_Thread_Enable_dispatch> 40006ae0: b0 10 20 00 clr %i0 return 0; } 40006ae4: 81 c7 e0 08 ret 40006ae8: 81 e8 00 00 restore =============================================================================== 40006898 : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 40006898: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 4000689c: 80 a0 60 00 cmp %g1, 0 400068a0: 02 80 00 08 be 400068c0 400068a4: 90 10 20 16 mov 0x16, %o0 400068a8: c4 00 40 00 ld [ %g1 ], %g2 400068ac: 80 a0 a0 00 cmp %g2, 0 400068b0: 02 80 00 04 be 400068c0 <== NEVER TAKEN 400068b4: 01 00 00 00 nop return EINVAL; attr->is_initialized = false; 400068b8: c0 20 40 00 clr [ %g1 ] return 0; 400068bc: 90 10 20 00 clr %o0 } 400068c0: 81 c3 e0 08 retl =============================================================================== 40005e00 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 40005e00: 9d e3 bf 58 save %sp, -168, %sp 40005e04: a0 10 00 18 mov %i0, %l0 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 40005e08: 80 a6 a0 00 cmp %i2, 0 40005e0c: 02 80 00 66 be 40005fa4 40005e10: b0 10 20 0e mov 0xe, %i0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 40005e14: 80 a6 60 00 cmp %i1, 0 40005e18: 32 80 00 05 bne,a 40005e2c 40005e1c: c2 06 40 00 ld [ %i1 ], %g1 40005e20: 33 10 00 72 sethi %hi(0x4001c800), %i1 40005e24: b2 16 62 94 or %i1, 0x294, %i1 ! 4001ca94 <_POSIX_Threads_Default_attributes> if ( !the_attr->is_initialized ) 40005e28: c2 06 40 00 ld [ %i1 ], %g1 40005e2c: 80 a0 60 00 cmp %g1, 0 40005e30: 02 80 00 5d be 40005fa4 40005e34: 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) ) 40005e38: c2 06 60 04 ld [ %i1 + 4 ], %g1 40005e3c: 80 a0 60 00 cmp %g1, 0 40005e40: 02 80 00 07 be 40005e5c 40005e44: 03 10 00 76 sethi %hi(0x4001d800), %g1 40005e48: c4 06 60 08 ld [ %i1 + 8 ], %g2 40005e4c: c2 00 60 24 ld [ %g1 + 0x24 ], %g1 40005e50: 80 a0 80 01 cmp %g2, %g1 40005e54: 0a 80 00 79 bcs 40006038 40005e58: 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 ) { 40005e5c: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 40005e60: 80 a0 60 01 cmp %g1, 1 40005e64: 02 80 00 06 be 40005e7c 40005e68: 80 a0 60 02 cmp %g1, 2 40005e6c: 12 80 00 4e bne 40005fa4 40005e70: b0 10 20 16 mov 0x16, %i0 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 40005e74: 10 80 00 09 b 40005e98 40005e78: e4 06 60 14 ld [ %i1 + 0x14 ], %l2 * 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 ]; 40005e7c: 03 10 00 79 sethi %hi(0x4001e400), %g1 40005e80: c2 00 62 c4 ld [ %g1 + 0x2c4 ], %g1 ! 4001e6c4 <_Per_CPU_Information+0xc> schedpolicy = api->schedpolicy; schedparam = api->schedparam; 40005e84: 90 07 bf dc add %fp, -36, %o0 * 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 ]; 40005e88: d2 00 61 58 ld [ %g1 + 0x158 ], %o1 schedpolicy = api->schedpolicy; 40005e8c: e4 02 60 84 ld [ %o1 + 0x84 ], %l2 schedparam = api->schedparam; 40005e90: 10 80 00 04 b 40005ea0 40005e94: 92 02 60 88 add %o1, 0x88, %o1 break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 40005e98: 90 07 bf dc add %fp, -36, %o0 40005e9c: 92 06 60 18 add %i1, 0x18, %o1 40005ea0: 40 00 26 d2 call 4000f9e8 40005ea4: 94 10 20 1c mov 0x1c, %o2 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 40005ea8: c2 06 60 0c ld [ %i1 + 0xc ], %g1 40005eac: 80 a0 60 00 cmp %g1, 0 40005eb0: 12 80 00 3d bne 40005fa4 40005eb4: b0 10 20 86 mov 0x86, %i0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 40005eb8: d0 07 bf dc ld [ %fp + -36 ], %o0 40005ebc: 40 00 1a 19 call 4000c720 <_POSIX_Priority_Is_valid> 40005ec0: b0 10 20 16 mov 0x16, %i0 40005ec4: 80 8a 20 ff btst 0xff, %o0 40005ec8: 02 80 00 37 be 40005fa4 <== NEVER TAKEN 40005ecc: 03 10 00 76 sethi %hi(0x4001d800), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 40005ed0: e8 07 bf dc ld [ %fp + -36 ], %l4 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 40005ed4: e6 08 60 28 ldub [ %g1 + 0x28 ], %l3 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 40005ed8: 90 10 00 12 mov %l2, %o0 40005edc: 92 07 bf dc add %fp, -36, %o1 40005ee0: 94 07 bf fc add %fp, -4, %o2 40005ee4: 40 00 1a 1a call 4000c74c <_POSIX_Thread_Translate_sched_param> 40005ee8: 96 07 bf f8 add %fp, -8, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 40005eec: b0 92 20 00 orcc %o0, 0, %i0 40005ef0: 12 80 00 2d bne 40005fa4 40005ef4: 2b 10 00 78 sethi %hi(0x4001e000), %l5 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 40005ef8: 40 00 06 0e call 40007730 <_API_Mutex_Lock> 40005efc: d0 05 62 20 ld [ %l5 + 0x220 ], %o0 ! 4001e220 <_RTEMS_Allocator_Mutex> * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 40005f00: 11 10 00 78 sethi %hi(0x4001e000), %o0 40005f04: 40 00 08 b4 call 400081d4 <_Objects_Allocate> 40005f08: 90 12 23 c0 or %o0, 0x3c0, %o0 ! 4001e3c0 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 40005f0c: a2 92 20 00 orcc %o0, 0, %l1 40005f10: 32 80 00 04 bne,a 40005f20 40005f14: c2 06 60 08 ld [ %i1 + 8 ], %g1 _RTEMS_Unlock_allocator(); 40005f18: 10 80 00 21 b 40005f9c 40005f1c: d0 05 62 20 ld [ %l5 + 0x220 ], %o0 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 40005f20: 05 10 00 76 sethi %hi(0x4001d800), %g2 40005f24: d6 00 a0 24 ld [ %g2 + 0x24 ], %o3 ! 4001d824 40005f28: 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( 40005f2c: 80 a2 c0 01 cmp %o3, %g1 40005f30: 1a 80 00 03 bcc 40005f3c 40005f34: d4 06 60 04 ld [ %i1 + 4 ], %o2 40005f38: 96 10 00 01 mov %g1, %o3 40005f3c: 82 10 20 01 mov 1, %g1 40005f40: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40005f44: c2 07 bf fc ld [ %fp + -4 ], %g1 40005f48: 9a 0c e0 ff and %l3, 0xff, %o5 40005f4c: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 40005f50: c2 07 bf f8 ld [ %fp + -8 ], %g1 40005f54: c0 27 bf d4 clr [ %fp + -44 ] 40005f58: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40005f5c: 82 07 bf d4 add %fp, -44, %g1 40005f60: c0 23 a0 68 clr [ %sp + 0x68 ] 40005f64: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40005f68: 27 10 00 78 sethi %hi(0x4001e000), %l3 40005f6c: 92 10 00 11 mov %l1, %o1 40005f70: 90 14 e3 c0 or %l3, 0x3c0, %o0 40005f74: 98 10 20 00 clr %o4 40005f78: 40 00 0c f0 call 40009338 <_Thread_Initialize> 40005f7c: 9a 23 40 14 sub %o5, %l4, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 40005f80: 80 8a 20 ff btst 0xff, %o0 40005f84: 12 80 00 0a bne 40005fac 40005f88: 90 14 e3 c0 or %l3, 0x3c0, %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 40005f8c: 40 00 09 6c call 4000853c <_Objects_Free> 40005f90: 92 10 00 11 mov %l1, %o1 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 40005f94: 03 10 00 78 sethi %hi(0x4001e000), %g1 40005f98: d0 00 62 20 ld [ %g1 + 0x220 ], %o0 ! 4001e220 <_RTEMS_Allocator_Mutex> 40005f9c: 40 00 05 fb call 40007788 <_API_Mutex_Unlock> 40005fa0: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40005fa4: 81 c7 e0 08 ret 40005fa8: 81 e8 00 00 restore } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40005fac: e6 04 61 58 ld [ %l1 + 0x158 ], %l3 api->Attributes = *the_attr; 40005fb0: 92 10 00 19 mov %i1, %o1 40005fb4: 94 10 20 40 mov 0x40, %o2 40005fb8: 40 00 26 8c call 4000f9e8 40005fbc: 90 10 00 13 mov %l3, %o0 api->detachstate = the_attr->detachstate; 40005fc0: c2 06 60 3c ld [ %i1 + 0x3c ], %g1 api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40005fc4: 92 07 bf dc add %fp, -36, %o1 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; 40005fc8: c2 24 e0 40 st %g1, [ %l3 + 0x40 ] api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40005fcc: 94 10 20 1c mov 0x1c, %o2 */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; 40005fd0: e4 24 e0 84 st %l2, [ %l3 + 0x84 ] api->schedparam = schedparam; 40005fd4: 40 00 26 85 call 4000f9e8 40005fd8: 90 04 e0 88 add %l3, 0x88, %o0 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40005fdc: 90 10 00 11 mov %l1, %o0 40005fe0: 92 10 20 01 mov 1, %o1 40005fe4: 94 10 00 1a mov %i2, %o2 40005fe8: 96 10 00 1b mov %i3, %o3 40005fec: 40 00 0f 4b call 40009d18 <_Thread_Start> 40005ff0: 98 10 20 00 clr %o4 _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 40005ff4: 80 a4 a0 04 cmp %l2, 4 40005ff8: 32 80 00 0a bne,a 40006020 40005ffc: c2 04 60 08 ld [ %l1 + 8 ], %g1 _Watchdog_Insert_ticks( 40006000: 40 00 0f c6 call 40009f18 <_Timespec_To_ticks> 40006004: 90 04 e0 90 add %l3, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006008: 92 04 e0 a8 add %l3, 0xa8, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000600c: d0 24 e0 b4 st %o0, [ %l3 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006010: 11 10 00 78 sethi %hi(0x4001e000), %o0 40006014: 40 00 10 9a call 4000a27c <_Watchdog_Insert> 40006018: 90 12 22 40 or %o0, 0x240, %o0 ! 4001e240 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 4000601c: c2 04 60 08 ld [ %l1 + 8 ], %g1 40006020: c2 24 00 00 st %g1, [ %l0 ] _RTEMS_Unlock_allocator(); 40006024: 03 10 00 78 sethi %hi(0x4001e000), %g1 40006028: 40 00 05 d8 call 40007788 <_API_Mutex_Unlock> 4000602c: d0 00 62 20 ld [ %g1 + 0x220 ], %o0 ! 4001e220 <_RTEMS_Allocator_Mutex> return 0; 40006030: 81 c7 e0 08 ret 40006034: 81 e8 00 00 restore } 40006038: 81 c7 e0 08 ret 4000603c: 81 e8 00 00 restore =============================================================================== 40008040 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 40008040: 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 ); 40008044: 92 07 bf fc add %fp, -4, %o1 40008048: 40 00 00 37 call 40008124 <_POSIX_Absolute_timeout_to_ticks> 4000804c: 90 10 00 19 mov %i1, %o0 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 40008050: d4 07 bf fc ld [ %fp + -4 ], %o2 int _EXFUN(pthread_mutex_trylock, (pthread_mutex_t *__mutex)); int _EXFUN(pthread_mutex_unlock, (pthread_mutex_t *__mutex)); #if defined(_POSIX_TIMEOUTS) int _EXFUN(pthread_mutex_timedlock, 40008054: 82 1a 20 03 xor %o0, 3, %g1 40008058: 80 a0 00 01 cmp %g0, %g1 * * 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 ); 4000805c: a0 10 00 08 mov %o0, %l0 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 40008060: a2 60 3f ff subx %g0, -1, %l1 40008064: 90 10 00 18 mov %i0, %o0 40008068: 7f ff ff bd call 40007f5c <_POSIX_Mutex_Lock_support> 4000806c: 92 10 00 11 mov %l1, %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) ) { 40008070: 80 a4 60 00 cmp %l1, 0 40008074: 12 80 00 0c bne 400080a4 40008078: 80 a2 20 10 cmp %o0, 0x10 4000807c: 12 80 00 0a bne 400080a4 <== NEVER TAKEN 40008080: 80 a4 20 00 cmp %l0, 0 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40008084: 02 80 00 07 be 400080a0 <== NEVER TAKEN 40008088: a0 04 3f ff add %l0, -1, %l0 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 4000808c: 80 a4 20 01 cmp %l0, 1 40008090: 18 80 00 05 bgu 400080a4 <== NEVER TAKEN 40008094: 01 00 00 00 nop status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 40008098: 10 80 00 03 b 400080a4 4000809c: 90 10 20 74 mov 0x74, %o0 ! 74 400080a0: 90 10 20 16 mov 0x16, %o0 <== NOT EXECUTED } return lock_status; } 400080a4: 81 c7 e0 08 ret 400080a8: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40005738 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 40005738: 82 10 00 08 mov %o0, %g1 if ( !attr ) 4000573c: 80 a0 60 00 cmp %g1, 0 40005740: 02 80 00 0b be 4000576c 40005744: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40005748: c4 00 40 00 ld [ %g1 ], %g2 4000574c: 80 a0 a0 00 cmp %g2, 0 40005750: 02 80 00 07 be 4000576c 40005754: 80 a2 60 00 cmp %o1, 0 return EINVAL; if ( !type ) 40005758: 02 80 00 05 be 4000576c <== NEVER TAKEN 4000575c: 01 00 00 00 nop return EINVAL; *type = attr->type; 40005760: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 40005764: 90 10 20 00 clr %o0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 40005768: c2 22 40 00 st %g1, [ %o1 ] return 0; } 4000576c: 81 c3 e0 08 retl =============================================================================== 40007c1c : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 40007c1c: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40007c20: 80 a0 60 00 cmp %g1, 0 40007c24: 02 80 00 0a be 40007c4c 40007c28: 90 10 20 16 mov 0x16, %o0 40007c2c: c4 00 40 00 ld [ %g1 ], %g2 40007c30: 80 a0 a0 00 cmp %g2, 0 40007c34: 02 80 00 06 be 40007c4c 40007c38: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40007c3c: 18 80 00 04 bgu 40007c4c <== NEVER TAKEN 40007c40: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40007c44: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 40007c48: 90 10 20 00 clr %o0 default: return EINVAL; } } 40007c4c: 81 c3 e0 08 retl =============================================================================== 400057a4 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 400057a4: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 400057a8: 80 a0 60 00 cmp %g1, 0 400057ac: 02 80 00 0a be 400057d4 400057b0: 90 10 20 16 mov 0x16, %o0 400057b4: c4 00 40 00 ld [ %g1 ], %g2 400057b8: 80 a0 a0 00 cmp %g2, 0 400057bc: 02 80 00 06 be 400057d4 <== NEVER TAKEN 400057c0: 80 a2 60 03 cmp %o1, 3 return EINVAL; switch ( type ) { 400057c4: 18 80 00 04 bgu 400057d4 400057c8: 01 00 00 00 nop case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 400057cc: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; 400057d0: 90 10 20 00 clr %o0 default: return EINVAL; } } 400057d4: 81 c3 e0 08 retl =============================================================================== 40006428 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 40006428: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 4000642c: 80 a6 60 00 cmp %i1, 0 40006430: 02 80 00 1c be 400064a0 40006434: a0 10 00 18 mov %i0, %l0 40006438: 80 a6 20 00 cmp %i0, 0 4000643c: 22 80 00 17 be,a 40006498 40006440: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !once_control->init_executed ) { 40006444: c2 06 20 04 ld [ %i0 + 4 ], %g1 40006448: 80 a0 60 00 cmp %g1, 0 4000644c: 12 80 00 13 bne 40006498 40006450: b0 10 20 00 clr %i0 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 40006454: 90 10 21 00 mov 0x100, %o0 40006458: 92 10 21 00 mov 0x100, %o1 4000645c: 40 00 03 0a call 40007084 40006460: 94 07 bf fc add %fp, -4, %o2 if ( !once_control->init_executed ) { 40006464: c2 04 20 04 ld [ %l0 + 4 ], %g1 40006468: 80 a0 60 00 cmp %g1, 0 4000646c: 12 80 00 07 bne 40006488 <== NEVER TAKEN 40006470: d0 07 bf fc ld [ %fp + -4 ], %o0 once_control->is_initialized = true; 40006474: 82 10 20 01 mov 1, %g1 40006478: c2 24 00 00 st %g1, [ %l0 ] once_control->init_executed = true; (*init_routine)(); 4000647c: 9f c6 40 00 call %i1 40006480: c2 24 20 04 st %g1, [ %l0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 40006484: d0 07 bf fc ld [ %fp + -4 ], %o0 40006488: 92 10 21 00 mov 0x100, %o1 4000648c: 94 07 bf fc add %fp, -4, %o2 40006490: 40 00 02 fd call 40007084 40006494: b0 10 20 00 clr %i0 40006498: 81 c7 e0 08 ret 4000649c: 81 e8 00 00 restore pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) return EINVAL; 400064a0: b0 10 20 16 mov 0x16, %i0 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 400064a4: 81 c7 e0 08 ret 400064a8: 81 e8 00 00 restore =============================================================================== 40006ef8 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 40006ef8: 9d e3 bf 90 save %sp, -112, %sp 40006efc: a0 10 00 18 mov %i0, %l0 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 40006f00: 80 a4 20 00 cmp %l0, 0 40006f04: 02 80 00 1c be 40006f74 40006f08: b0 10 20 16 mov 0x16, %i0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40006f0c: 80 a6 60 00 cmp %i1, 0 40006f10: 32 80 00 06 bne,a 40006f28 40006f14: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 40006f18: b2 07 bf f4 add %fp, -12, %i1 40006f1c: 40 00 02 6d call 400078d0 40006f20: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40006f24: c2 06 40 00 ld [ %i1 ], %g1 40006f28: 80 a0 60 00 cmp %g1, 0 40006f2c: 02 80 00 12 be 40006f74 <== NEVER TAKEN 40006f30: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40006f34: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006f38: 80 a0 60 00 cmp %g1, 0 40006f3c: 12 80 00 0e bne 40006f74 <== NEVER TAKEN 40006f40: 03 10 00 65 sethi %hi(0x40019400), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006f44: c4 00 62 00 ld [ %g1 + 0x200 ], %g2 ! 40019600 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 40006f48: c0 27 bf fc clr [ %fp + -4 ] 40006f4c: 84 00 a0 01 inc %g2 40006f50: c4 20 62 00 st %g2, [ %g1 + 0x200 ] * 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 ); 40006f54: 25 10 00 66 sethi %hi(0x40019800), %l2 40006f58: 40 00 09 f2 call 40009720 <_Objects_Allocate> 40006f5c: 90 14 a0 20 or %l2, 0x20, %o0 ! 40019820 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 40006f60: a2 92 20 00 orcc %o0, 0, %l1 40006f64: 12 80 00 06 bne 40006f7c 40006f68: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 40006f6c: 40 00 0e 12 call 4000a7b4 <_Thread_Enable_dispatch> 40006f70: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40006f74: 81 c7 e0 08 ret 40006f78: 81 e8 00 00 restore } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 40006f7c: 40 00 07 96 call 40008dd4 <_CORE_RWLock_Initialize> 40006f80: 92 07 bf fc add %fp, -4, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006f84: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 40006f88: a4 14 a0 20 or %l2, 0x20, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006f8c: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006f90: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006f94: 85 28 a0 02 sll %g2, 2, %g2 40006f98: 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; 40006f9c: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 40006fa0: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40006fa4: 40 00 0e 04 call 4000a7b4 <_Thread_Enable_dispatch> 40006fa8: b0 10 20 00 clr %i0 return 0; } 40006fac: 81 c7 e0 08 ret 40006fb0: 81 e8 00 00 restore =============================================================================== 40007024 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007024: 9d e3 bf 98 save %sp, -104, %sp Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; 40007028: a0 10 20 16 mov 0x16, %l0 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 4000702c: 80 a6 20 00 cmp %i0, 0 40007030: 02 80 00 2b be 400070dc 40007034: 90 10 00 19 mov %i1, %o0 * * 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 ); 40007038: 40 00 1a 9d call 4000daac <_POSIX_Absolute_timeout_to_ticks> 4000703c: 92 07 bf f8 add %fp, -8, %o1 40007040: d2 06 00 00 ld [ %i0 ], %o1 40007044: a2 10 00 08 mov %o0, %l1 40007048: 94 07 bf fc add %fp, -4, %o2 4000704c: 11 10 00 66 sethi %hi(0x40019800), %o0 40007050: 40 00 0a f3 call 40009c1c <_Objects_Get> 40007054: 90 12 20 20 or %o0, 0x20, %o0 ! 40019820 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007058: c2 07 bf fc ld [ %fp + -4 ], %g1 4000705c: 80 a0 60 00 cmp %g1, 0 40007060: 12 80 00 1f bne 400070dc 40007064: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 40007068: 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, 4000706c: 82 1c 60 03 xor %l1, 3, %g1 40007070: 90 02 20 10 add %o0, 0x10, %o0 40007074: 80 a0 00 01 cmp %g0, %g1 40007078: 98 10 20 00 clr %o4 4000707c: a4 60 3f ff subx %g0, -1, %l2 40007080: 40 00 07 60 call 40008e00 <_CORE_RWLock_Obtain_for_reading> 40007084: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40007088: 40 00 0d cb call 4000a7b4 <_Thread_Enable_dispatch> 4000708c: 01 00 00 00 nop if ( !do_wait ) { 40007090: 80 a4 a0 00 cmp %l2, 0 40007094: 12 80 00 0d bne 400070c8 40007098: 03 10 00 66 sethi %hi(0x40019800), %g1 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 4000709c: c2 00 63 64 ld [ %g1 + 0x364 ], %g1 ! 40019b64 <_Per_CPU_Information+0xc> 400070a0: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 400070a4: 80 a0 60 02 cmp %g1, 2 400070a8: 32 80 00 09 bne,a 400070cc 400070ac: 03 10 00 66 sethi %hi(0x40019800), %g1 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 400070b0: 80 a4 60 00 cmp %l1, 0 400070b4: 02 80 00 0a be 400070dc <== NEVER TAKEN 400070b8: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 400070bc: 80 a4 60 01 cmp %l1, 1 400070c0: 08 80 00 07 bleu 400070dc <== ALWAYS TAKEN 400070c4: a0 10 20 74 mov 0x74, %l0 return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( (CORE_RWLock_Status) _Thread_Executing->Wait.return_code 400070c8: 03 10 00 66 sethi %hi(0x40019800), %g1 400070cc: c2 00 63 64 ld [ %g1 + 0x364 ], %g1 ! 40019b64 <_Per_CPU_Information+0xc> status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 400070d0: 40 00 00 35 call 400071a4 <_POSIX_RWLock_Translate_core_RWLock_return_code> 400070d4: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 400070d8: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 400070dc: 81 c7 e0 08 ret 400070e0: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 400070e4 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 400070e4: 9d e3 bf 98 save %sp, -104, %sp Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; 400070e8: a0 10 20 16 mov 0x16, %l0 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 400070ec: 80 a6 20 00 cmp %i0, 0 400070f0: 02 80 00 2b be 4000719c 400070f4: 90 10 00 19 mov %i1, %o0 * * 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 ); 400070f8: 40 00 1a 6d call 4000daac <_POSIX_Absolute_timeout_to_ticks> 400070fc: 92 07 bf f8 add %fp, -8, %o1 40007100: d2 06 00 00 ld [ %i0 ], %o1 40007104: a2 10 00 08 mov %o0, %l1 40007108: 94 07 bf fc add %fp, -4, %o2 4000710c: 11 10 00 66 sethi %hi(0x40019800), %o0 40007110: 40 00 0a c3 call 40009c1c <_Objects_Get> 40007114: 90 12 20 20 or %o0, 0x20, %o0 ! 40019820 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007118: c2 07 bf fc ld [ %fp + -4 ], %g1 4000711c: 80 a0 60 00 cmp %g1, 0 40007120: 12 80 00 1f bne 4000719c 40007124: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 40007128: 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, 4000712c: 82 1c 60 03 xor %l1, 3, %g1 40007130: 90 02 20 10 add %o0, 0x10, %o0 40007134: 80 a0 00 01 cmp %g0, %g1 40007138: 98 10 20 00 clr %o4 4000713c: a4 60 3f ff subx %g0, -1, %l2 40007140: 40 00 07 64 call 40008ed0 <_CORE_RWLock_Obtain_for_writing> 40007144: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40007148: 40 00 0d 9b call 4000a7b4 <_Thread_Enable_dispatch> 4000714c: 01 00 00 00 nop if ( !do_wait && 40007150: 80 a4 a0 00 cmp %l2, 0 40007154: 12 80 00 0d bne 40007188 40007158: 03 10 00 66 sethi %hi(0x40019800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 4000715c: c2 00 63 64 ld [ %g1 + 0x364 ], %g1 ! 40019b64 <_Per_CPU_Information+0xc> ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 40007160: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007164: 80 a0 60 02 cmp %g1, 2 40007168: 32 80 00 09 bne,a 4000718c 4000716c: 03 10 00 66 sethi %hi(0x40019800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40007170: 80 a4 60 00 cmp %l1, 0 40007174: 02 80 00 0a be 4000719c <== NEVER TAKEN 40007178: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 4000717c: 80 a4 60 01 cmp %l1, 1 40007180: 08 80 00 07 bleu 4000719c <== ALWAYS TAKEN 40007184: a0 10 20 74 mov 0x74, %l0 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( (CORE_RWLock_Status) _Thread_Executing->Wait.return_code 40007188: 03 10 00 66 sethi %hi(0x40019800), %g1 4000718c: c2 00 63 64 ld [ %g1 + 0x364 ], %g1 ! 40019b64 <_Per_CPU_Information+0xc> if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( 40007190: 40 00 00 05 call 400071a4 <_POSIX_RWLock_Translate_core_RWLock_return_code> 40007194: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 40007198: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 4000719c: 81 c7 e0 08 ret 400071a0: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 400078f8 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 400078f8: 82 10 00 08 mov %o0, %g1 if ( !attr ) 400078fc: 80 a0 60 00 cmp %g1, 0 40007900: 02 80 00 0a be 40007928 40007904: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40007908: c4 00 40 00 ld [ %g1 ], %g2 4000790c: 80 a0 a0 00 cmp %g2, 0 40007910: 02 80 00 06 be 40007928 40007914: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40007918: 18 80 00 04 bgu 40007928 <== NEVER TAKEN 4000791c: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40007920: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 40007924: 90 10 20 00 clr %o0 default: return EINVAL; } } 40007928: 81 c3 e0 08 retl =============================================================================== 40008878 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 40008878: 9d e3 bf 90 save %sp, -112, %sp 4000887c: a0 10 00 18 mov %i0, %l0 int rc; /* * Check all the parameters */ if ( !param ) 40008880: 80 a6 a0 00 cmp %i2, 0 40008884: 02 80 00 3f be 40008980 40008888: b0 10 20 16 mov 0x16, %i0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 4000888c: 90 10 00 19 mov %i1, %o0 40008890: 92 10 00 1a mov %i2, %o1 40008894: 94 07 bf fc add %fp, -4, %o2 40008898: 40 00 18 98 call 4000eaf8 <_POSIX_Thread_Translate_sched_param> 4000889c: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 400088a0: b0 92 20 00 orcc %o0, 0, %i0 400088a4: 12 80 00 37 bne 40008980 400088a8: 11 10 00 6b sethi %hi(0x4001ac00), %o0 400088ac: 92 10 00 10 mov %l0, %o1 400088b0: 90 12 23 50 or %o0, 0x350, %o0 400088b4: 40 00 08 48 call 4000a9d4 <_Objects_Get> 400088b8: 94 07 bf f4 add %fp, -12, %o2 /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 400088bc: c2 07 bf f4 ld [ %fp + -12 ], %g1 400088c0: 80 a0 60 00 cmp %g1, 0 400088c4: 12 80 00 31 bne 40008988 400088c8: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 400088cc: e0 02 21 58 ld [ %o0 + 0x158 ], %l0 if ( api->schedpolicy == SCHED_SPORADIC ) 400088d0: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 400088d4: 80 a0 60 04 cmp %g1, 4 400088d8: 32 80 00 05 bne,a 400088ec 400088dc: f2 24 20 84 st %i1, [ %l0 + 0x84 ] (void) _Watchdog_Remove( &api->Sporadic_timer ); 400088e0: 40 00 0f b7 call 4000c7bc <_Watchdog_Remove> 400088e4: 90 04 20 a8 add %l0, 0xa8, %o0 api->schedpolicy = policy; 400088e8: f2 24 20 84 st %i1, [ %l0 + 0x84 ] api->schedparam = *param; 400088ec: 90 04 20 88 add %l0, 0x88, %o0 400088f0: 92 10 00 1a mov %i2, %o1 400088f4: 40 00 25 86 call 40011f0c 400088f8: 94 10 20 1c mov 0x1c, %o2 the_thread->budget_algorithm = budget_algorithm; 400088fc: c2 07 bf fc ld [ %fp + -4 ], %g1 the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40008900: 80 a6 60 00 cmp %i1, 0 if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; 40008904: c2 24 60 7c st %g1, [ %l1 + 0x7c ] the_thread->budget_callout = budget_callout; 40008908: c2 07 bf f8 ld [ %fp + -8 ], %g1 switch ( api->schedpolicy ) { 4000890c: 06 80 00 1b bl 40008978 <== NEVER TAKEN 40008910: c2 24 60 80 st %g1, [ %l1 + 0x80 ] 40008914: 80 a6 60 02 cmp %i1, 2 40008918: 04 80 00 07 ble 40008934 4000891c: 03 10 00 6b sethi %hi(0x4001ac00), %g1 40008920: 80 a6 60 04 cmp %i1, 4 40008924: 12 80 00 15 bne 40008978 <== NEVER TAKEN 40008928: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 4000892c: 10 80 00 0d b 40008960 40008930: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 40008934: c2 00 60 54 ld [ %g1 + 0x54 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40008938: 90 10 00 11 mov %l1, %o0 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000893c: c2 24 60 78 st %g1, [ %l1 + 0x78 ] 40008940: 03 10 00 68 sethi %hi(0x4001a000), %g1 40008944: d2 08 63 58 ldub [ %g1 + 0x358 ], %o1 ! 4001a358 40008948: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 4000894c: 94 10 20 01 mov 1, %o2 40008950: 92 22 40 01 sub %o1, %g1, %o1 40008954: 40 00 09 d9 call 4000b0b8 <_Thread_Change_priority> 40008958: d2 24 60 18 st %o1, [ %l1 + 0x18 ] the_thread, the_thread->real_priority, true ); break; 4000895c: 30 80 00 07 b,a 40008978 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; _Watchdog_Remove( &api->Sporadic_timer ); 40008960: 90 04 20 a8 add %l0, 0xa8, %o0 40008964: 40 00 0f 96 call 4000c7bc <_Watchdog_Remove> 40008968: c2 24 20 a4 st %g1, [ %l0 + 0xa4 ] _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 4000896c: 90 10 20 00 clr %o0 40008970: 7f ff ff 7c call 40008760 <_POSIX_Threads_Sporadic_budget_TSR> 40008974: 92 10 00 11 mov %l1, %o1 break; } _Thread_Enable_dispatch(); 40008978: 40 00 0a fd call 4000b56c <_Thread_Enable_dispatch> 4000897c: 01 00 00 00 nop return 0; 40008980: 81 c7 e0 08 ret 40008984: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return ESRCH; 40008988: b0 10 20 03 mov 3, %i0 } 4000898c: 81 c7 e0 08 ret 40008990: 81 e8 00 00 restore =============================================================================== 400060b4 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 400060b4: 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() ) 400060b8: 03 10 00 5d sethi %hi(0x40017400), %g1 400060bc: 82 10 63 b8 or %g1, 0x3b8, %g1 ! 400177b8 <_Per_CPU_Information> 400060c0: c4 00 60 08 ld [ %g1 + 8 ], %g2 400060c4: 80 a0 a0 00 cmp %g2, 0 400060c8: 12 80 00 18 bne 40006128 <== NEVER TAKEN 400060cc: 01 00 00 00 nop 400060d0: 05 10 00 5c sethi %hi(0x40017000), %g2 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 400060d4: c2 00 60 0c ld [ %g1 + 0xc ], %g1 400060d8: c6 00 a2 60 ld [ %g2 + 0x260 ], %g3 400060dc: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 400060e0: 86 00 e0 01 inc %g3 400060e4: c6 20 a2 60 st %g3, [ %g2 + 0x260 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 400060e8: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 400060ec: 80 a0 a0 00 cmp %g2, 0 400060f0: 12 80 00 05 bne 40006104 <== NEVER TAKEN 400060f4: a0 10 20 00 clr %l0 /* Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ int _EXFUN(pthread_setcancelstate, (int __state, int *__oldstate)); int _EXFUN(pthread_setcanceltype, (int __type, int *__oldtype)); void _EXFUN(pthread_testcancel, (void)); 400060f8: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 400060fc: 80 a0 00 01 cmp %g0, %g1 40006100: a0 40 20 00 addx %g0, 0, %l0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 40006104: 40 00 0a d0 call 40008c44 <_Thread_Enable_dispatch> 40006108: 01 00 00 00 nop if ( cancel ) 4000610c: 80 8c 20 ff btst 0xff, %l0 40006110: 02 80 00 06 be 40006128 40006114: 01 00 00 00 nop _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 40006118: 03 10 00 5d sethi %hi(0x40017400), %g1 4000611c: f0 00 63 c4 ld [ %g1 + 0x3c4 ], %i0 ! 400177c4 <_Per_CPU_Information+0xc> 40006120: 40 00 18 73 call 4000c2ec <_POSIX_Thread_Exit> 40006124: 93 e8 3f ff restore %g0, -1, %o1 40006128: 81 c7 e0 08 ret 4000612c: 81 e8 00 00 restore =============================================================================== 40006c90 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 40006c90: 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); 40006c94: 21 10 00 61 sethi %hi(0x40018400), %l0 40006c98: 40 00 02 7f call 40007694 40006c9c: 90 14 20 04 or %l0, 4, %o0 ! 40018404 if (result != 0) { 40006ca0: a2 92 20 00 orcc %o0, 0, %l1 40006ca4: 02 80 00 06 be 40006cbc <== ALWAYS TAKEN 40006ca8: 01 00 00 00 nop free (req); 40006cac: 7f ff f1 72 call 40003274 <== NOT EXECUTED 40006cb0: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED return result; 40006cb4: 81 c7 e0 08 ret <== NOT EXECUTED 40006cb8: 91 e8 00 11 restore %g0, %l1, %o0 <== NOT EXECUTED } /* _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); 40006cbc: 40 00 04 82 call 40007ec4 40006cc0: a0 14 20 04 or %l0, 4, %l0 40006cc4: 92 07 bf f8 add %fp, -8, %o1 40006cc8: 40 00 03 86 call 40007ae0 40006ccc: 94 07 bf dc add %fp, -36, %o2 req->caller_thread = pthread_self (); 40006cd0: 40 00 04 7d call 40007ec4 40006cd4: 01 00 00 00 nop req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40006cd8: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40006cdc: c6 07 bf dc ld [ %fp + -36 ], %g3 40006ce0: c4 00 60 18 ld [ %g1 + 0x18 ], %g2 /* _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 (); 40006ce4: d0 26 20 10 st %o0, [ %i0 + 0x10 ] req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40006ce8: 84 20 c0 02 sub %g3, %g2, %g2 40006cec: c4 26 20 0c st %g2, [ %i0 + 0xc ] req->policy = policy; 40006cf0: c4 07 bf f8 ld [ %fp + -8 ], %g2 40006cf4: c4 26 20 08 st %g2, [ %i0 + 8 ] req->aiocbp->error_code = EINPROGRESS; 40006cf8: 84 10 20 77 mov 0x77, %g2 40006cfc: c4 20 60 34 st %g2, [ %g1 + 0x34 ] req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 40006d00: c4 04 20 68 ld [ %l0 + 0x68 ], %g2 40006d04: 80 a0 a0 00 cmp %g2, 0 40006d08: 12 80 00 34 bne 40006dd8 40006d0c: c0 20 60 38 clr [ %g1 + 0x38 ] 40006d10: c4 04 20 64 ld [ %l0 + 0x64 ], %g2 40006d14: 80 a0 a0 04 cmp %g2, 4 40006d18: 14 80 00 31 bg 40006ddc 40006d1c: d2 00 40 00 ld [ %g1 ], %o1 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); 40006d20: 90 04 20 48 add %l0, 0x48, %o0 40006d24: 7f ff fe cd call 40006858 40006d28: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40006d2c: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 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); 40006d30: a4 10 00 08 mov %o0, %l2 if (r_chain->new_fd == 1) { 40006d34: 80 a0 60 01 cmp %g1, 1 40006d38: aa 02 20 08 add %o0, 8, %l5 40006d3c: a6 02 20 1c add %o0, 0x1c, %l3 40006d40: 12 80 00 1d bne 40006db4 40006d44: a8 02 20 20 add %o0, 0x20, %l4 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); 40006d48: 90 10 00 15 mov %l5, %o0 40006d4c: 40 00 08 eb call 400090f8 <_Chain_Insert> 40006d50: 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); 40006d54: 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; 40006d58: c0 24 a0 18 clr [ %l2 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40006d5c: 40 00 01 f6 call 40007534 40006d60: 90 10 00 13 mov %l3, %o0 pthread_cond_init (&r_chain->cond, NULL); 40006d64: 92 10 20 00 clr %o1 40006d68: 40 00 00 fb call 40007154 40006d6c: 90 10 00 14 mov %l4, %o0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 40006d70: 96 10 00 12 mov %l2, %o3 40006d74: 90 07 bf fc add %fp, -4, %o0 40006d78: 92 04 20 08 add %l0, 8, %o1 40006d7c: 15 10 00 1a sethi %hi(0x40006800), %o2 40006d80: 40 00 02 c8 call 400078a0 40006d84: 94 12 a1 08 or %o2, 0x108, %o2 ! 40006908 rtems_aio_handle, (void *) r_chain); if (result != 0) { 40006d88: a4 92 20 00 orcc %o0, 0, %l2 40006d8c: 22 80 00 07 be,a 40006da8 <== ALWAYS TAKEN 40006d90: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 40006d94: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40006d98: 40 00 02 60 call 40007718 <== NOT EXECUTED 40006d9c: a2 10 00 12 mov %l2, %l1 <== NOT EXECUTED return result; 40006da0: 81 c7 e0 08 ret <== NOT EXECUTED 40006da4: 91 e8 00 11 restore %g0, %l1, %o0 <== NOT EXECUTED } ++aio_request_queue.active_threads; 40006da8: 82 00 60 01 inc %g1 40006dac: 10 80 00 3e b 40006ea4 40006db0: c2 24 20 64 st %g1, [ %l0 + 0x64 ] } else { /* put request in the fd chain it belongs to */ pthread_mutex_lock (&r_chain->mutex); 40006db4: 40 00 02 38 call 40007694 40006db8: 90 10 00 13 mov %l3, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40006dbc: 90 10 00 15 mov %l5, %o0 40006dc0: 7f ff ff 73 call 40006b8c 40006dc4: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 40006dc8: 40 00 01 11 call 4000720c 40006dcc: 90 10 00 14 mov %l4, %o0 pthread_mutex_unlock (&r_chain->mutex); 40006dd0: 10 80 00 12 b 40006e18 40006dd4: 90 10 00 13 mov %l3, %o0 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, 40006dd8: d2 00 40 00 ld [ %g1 ], %o1 40006ddc: 11 10 00 61 sethi %hi(0x40018400), %o0 40006de0: 94 10 20 00 clr %o2 40006de4: 7f ff fe 9d call 40006858 40006de8: 90 12 20 4c or %o0, 0x4c, %o0 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 40006dec: a0 92 20 00 orcc %o0, 0, %l0 40006df0: 02 80 00 0e be 40006e28 <== ALWAYS TAKEN 40006df4: a4 04 20 1c add %l0, 0x1c, %l2 { pthread_mutex_lock (&r_chain->mutex); 40006df8: 40 00 02 27 call 40007694 <== NOT EXECUTED 40006dfc: 90 10 00 12 mov %l2, %o0 <== NOT EXECUTED rtems_aio_insert_prio (&r_chain->perfd, req); 40006e00: 90 04 20 08 add %l0, 8, %o0 <== NOT EXECUTED 40006e04: 7f ff ff 62 call 40006b8c <== NOT EXECUTED 40006e08: 92 10 00 18 mov %i0, %o1 <== NOT EXECUTED pthread_cond_signal (&r_chain->cond); 40006e0c: 40 00 01 00 call 4000720c <== NOT EXECUTED 40006e10: 90 04 20 20 add %l0, 0x20, %o0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); 40006e14: 90 10 00 12 mov %l2, %o0 <== NOT EXECUTED 40006e18: 40 00 02 40 call 40007718 40006e1c: 01 00 00 00 nop /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); } } pthread_mutex_unlock (&aio_request_queue.mutex); 40006e20: 10 80 00 22 b 40006ea8 40006e24: 11 10 00 61 sethi %hi(0x40018400), %o0 } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 40006e28: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40006e2c: 11 10 00 61 sethi %hi(0x40018400), %o0 40006e30: d2 00 40 00 ld [ %g1 ], %o1 40006e34: 90 12 20 58 or %o0, 0x58, %o0 40006e38: 7f ff fe 88 call 40006858 40006e3c: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40006e40: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 40006e44: a0 10 00 08 mov %o0, %l0 if (r_chain->new_fd == 1) { 40006e48: 80 a0 60 01 cmp %g1, 1 40006e4c: 12 80 00 14 bne 40006e9c 40006e50: 90 02 20 08 add %o0, 8, %o0 40006e54: 40 00 08 a9 call 400090f8 <_Chain_Insert> 40006e58: 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); 40006e5c: 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; 40006e60: c0 24 20 18 clr [ %l0 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40006e64: 40 00 01 b4 call 40007534 40006e68: 90 04 20 1c add %l0, 0x1c, %o0 pthread_cond_init (&r_chain->cond, NULL); 40006e6c: 92 10 20 00 clr %o1 40006e70: 40 00 00 b9 call 40007154 40006e74: 90 04 20 20 add %l0, 0x20, %o0 pthread_cond_signal (&aio_request_queue.new_req); 40006e78: 11 10 00 61 sethi %hi(0x40018400), %o0 40006e7c: 40 00 00 e4 call 4000720c 40006e80: 90 12 20 08 or %o0, 8, %o0 ! 40018408 ++aio_request_queue.idle_threads; 40006e84: 03 10 00 61 sethi %hi(0x40018400), %g1 40006e88: 82 10 60 04 or %g1, 4, %g1 ! 40018404 40006e8c: c4 00 60 68 ld [ %g1 + 0x68 ], %g2 40006e90: 84 00 a0 01 inc %g2 40006e94: 10 80 00 04 b 40006ea4 40006e98: c4 20 60 68 st %g2, [ %g1 + 0x68 ] } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); 40006e9c: 7f ff ff 3c call 40006b8c 40006ea0: 92 10 00 18 mov %i0, %o1 } } pthread_mutex_unlock (&aio_request_queue.mutex); 40006ea4: 11 10 00 61 sethi %hi(0x40018400), %o0 40006ea8: 40 00 02 1c call 40007718 40006eac: 90 12 20 04 or %o0, 4, %o0 ! 40018404 return 0; } 40006eb0: b0 10 00 11 mov %l1, %i0 40006eb4: 81 c7 e0 08 ret 40006eb8: 81 e8 00 00 restore =============================================================================== 40006908 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 40006908: 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); 4000690c: 21 10 00 61 sethi %hi(0x40018400), %l0 <== NOT EXECUTED if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 40006910: a4 07 bf f4 add %fp, -12, %l2 <== NOT EXECUTED The fd chain is already unlocked */ struct timespec timeout; pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 40006914: a0 14 20 04 or %l0, 4, %l0 <== 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); 40006918: a8 07 bf fc add %fp, -4, %l4 <== 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)) { 4000691c: ae 04 20 58 add %l0, 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, 40006920: ac 04 20 04 add %l0, 4, %l6 <== 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, 40006924: aa 04 20 48 add %l0, 0x48, %l5 <== 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); 40006928: a6 07 bf d8 add %fp, -40, %l3 <== NOT EXECUTED default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 4000692c: ba 10 3f ff mov -1, %i5 <== 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); 40006930: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED 40006934: 40 00 03 58 call 40007694 <== NOT EXECUTED 40006938: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED if (result != 0) 4000693c: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40006940: 12 80 00 90 bne 40006b80 <== NOT EXECUTED 40006944: 82 06 20 0c add %i0, 0xc, %g1 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40006948: e2 06 20 08 ld [ %i0 + 8 ], %l1 <== 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)) { 4000694c: 80 a4 40 01 cmp %l1, %g1 <== NOT EXECUTED 40006950: 02 80 00 3a be 40006a38 <== NOT EXECUTED 40006954: 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); 40006958: 40 00 05 5b call 40007ec4 <== NOT EXECUTED 4000695c: 01 00 00 00 nop <== NOT EXECUTED 40006960: 92 10 00 14 mov %l4, %o1 <== NOT EXECUTED 40006964: 40 00 04 5f call 40007ae0 <== NOT EXECUTED 40006968: 94 10 00 13 mov %l3, %o2 <== NOT EXECUTED param.sched_priority = req->priority; 4000696c: c2 04 60 0c ld [ %l1 + 0xc ], %g1 <== NOT EXECUTED pthread_setschedparam (pthread_self(), req->policy, ¶m); 40006970: 40 00 05 55 call 40007ec4 <== NOT EXECUTED 40006974: c2 27 bf d8 st %g1, [ %fp + -40 ] <== NOT EXECUTED 40006978: d2 04 60 08 ld [ %l1 + 8 ], %o1 <== NOT EXECUTED 4000697c: 40 00 05 56 call 40007ed4 <== NOT EXECUTED 40006980: 94 10 00 13 mov %l3, %o2 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40006984: 40 00 09 c4 call 40009094 <_Chain_Extract> <== NOT EXECUTED 40006988: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 4000698c: 40 00 03 63 call 40007718 <== NOT EXECUTED 40006990: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED switch (req->aiocbp->aio_lio_opcode) { 40006994: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 <== NOT EXECUTED 40006998: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 <== NOT EXECUTED 4000699c: 80 a0 a0 02 cmp %g2, 2 <== NOT EXECUTED 400069a0: 22 80 00 10 be,a 400069e0 <== NOT EXECUTED 400069a4: c4 18 60 08 ldd [ %g1 + 8 ], %g2 <== NOT EXECUTED 400069a8: 80 a0 a0 03 cmp %g2, 3 <== NOT EXECUTED 400069ac: 02 80 00 15 be 40006a00 <== NOT EXECUTED 400069b0: 80 a0 a0 01 cmp %g2, 1 <== NOT EXECUTED 400069b4: 32 80 00 19 bne,a 40006a18 <== NOT EXECUTED 400069b8: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED case LIO_READ: result = pread (req->aiocbp->aio_fildes, 400069bc: c4 18 60 08 ldd [ %g1 + 8 ], %g2 <== NOT EXECUTED 400069c0: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED 400069c4: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 <== NOT EXECUTED 400069c8: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 <== NOT EXECUTED 400069cc: 96 10 00 02 mov %g2, %o3 <== NOT EXECUTED 400069d0: 40 00 2c 2a call 40011a78 <== NOT EXECUTED 400069d4: 98 10 00 03 mov %g3, %o4 <== NOT EXECUTED (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 400069d8: 10 80 00 0d b 40006a0c <== NOT EXECUTED 400069dc: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED case LIO_WRITE: result = pwrite (req->aiocbp->aio_fildes, 400069e0: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED 400069e4: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 <== NOT EXECUTED 400069e8: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 <== NOT EXECUTED 400069ec: 96 10 00 02 mov %g2, %o3 <== NOT EXECUTED 400069f0: 40 00 2c 5e call 40011b68 <== NOT EXECUTED 400069f4: 98 10 00 03 mov %g3, %o4 <== NOT EXECUTED (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 400069f8: 10 80 00 05 b 40006a0c <== NOT EXECUTED 400069fc: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED case LIO_SYNC: result = fsync (req->aiocbp->aio_fildes); 40006a00: 40 00 1b a9 call 4000d8a4 <== NOT EXECUTED 40006a04: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { 40006a08: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED 40006a0c: 32 80 00 08 bne,a 40006a2c <== NOT EXECUTED 40006a10: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 <== NOT EXECUTED req->aiocbp->return_value = -1; 40006a14: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED req->aiocbp->error_code = errno; 40006a18: 40 00 28 e4 call 40010da8 <__errno> <== NOT EXECUTED 40006a1c: fa 24 60 38 st %i5, [ %l1 + 0x38 ] <== NOT EXECUTED 40006a20: c2 02 00 00 ld [ %o0 ], %g1 <== NOT EXECUTED 40006a24: 10 bf ff c3 b 40006930 <== NOT EXECUTED 40006a28: c2 24 60 34 st %g1, [ %l1 + 0x34 ] <== NOT EXECUTED } else { req->aiocbp->return_value = result; 40006a2c: d0 20 60 38 st %o0, [ %g1 + 0x38 ] <== NOT EXECUTED req->aiocbp->error_code = 0; 40006a30: 10 bf ff c0 b 40006930 <== NOT EXECUTED 40006a34: c0 20 60 34 clr [ %g1 + 0x34 ] <== 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); 40006a38: 40 00 03 38 call 40007718 <== NOT EXECUTED 40006a3c: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED pthread_mutex_lock (&aio_request_queue.mutex); 40006a40: 40 00 03 15 call 40007694 <== NOT EXECUTED 40006a44: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED if (rtems_chain_is_empty (chain)) 40006a48: c2 06 20 08 ld [ %i0 + 8 ], %g1 <== NOT EXECUTED 40006a4c: 80 a0 40 11 cmp %g1, %l1 <== NOT EXECUTED 40006a50: 32 bf ff b9 bne,a 40006934 <== NOT EXECUTED 40006a54: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED { clock_gettime (CLOCK_REALTIME, &timeout); 40006a58: 92 10 00 12 mov %l2, %o1 <== NOT EXECUTED 40006a5c: 40 00 01 65 call 40006ff0 <== NOT EXECUTED 40006a60: 90 10 20 01 mov 1, %o0 <== NOT EXECUTED timeout.tv_sec += 3; 40006a64: c2 07 bf f4 ld [ %fp + -12 ], %g1 <== NOT EXECUTED timeout.tv_nsec = 0; 40006a68: 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; 40006a6c: 82 00 60 03 add %g1, 3, %g1 <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40006a70: a2 06 20 20 add %i0, 0x20, %l1 <== 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; 40006a74: c2 27 bf f4 st %g1, [ %fp + -12 ] <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40006a78: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED 40006a7c: 92 10 00 10 mov %l0, %o1 <== NOT EXECUTED 40006a80: 40 00 02 02 call 40007288 <== NOT EXECUTED 40006a84: 94 10 00 12 mov %l2, %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) { 40006a88: 80 a2 20 74 cmp %o0, 0x74 <== NOT EXECUTED 40006a8c: 32 bf ff aa bne,a 40006934 <== NOT EXECUTED 40006a90: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED 40006a94: 40 00 09 80 call 40009094 <_Chain_Extract> <== NOT EXECUTED 40006a98: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 40006a9c: 40 00 02 55 call 400073f0 <== NOT EXECUTED 40006aa0: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED pthread_cond_destroy (&r_chain->cond); 40006aa4: 40 00 01 77 call 40007080 <== NOT EXECUTED 40006aa8: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED free (r_chain); 40006aac: 7f ff f1 f2 call 40003274 <== NOT EXECUTED 40006ab0: 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)) { 40006ab4: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 <== NOT EXECUTED 40006ab8: 80 a0 40 17 cmp %g1, %l7 <== NOT EXECUTED 40006abc: 12 80 00 2d bne 40006b70 <== NOT EXECUTED 40006ac0: 92 10 00 12 mov %l2, %o1 <== NOT EXECUTED ++aio_request_queue.idle_threads; 40006ac4: c2 04 20 68 ld [ %l0 + 0x68 ], %g1 <== NOT EXECUTED 40006ac8: 82 00 60 01 inc %g1 <== NOT EXECUTED clock_gettime (CLOCK_REALTIME, &timeout); 40006acc: 90 10 20 01 mov 1, %o0 <== NOT EXECUTED 40006ad0: 40 00 01 48 call 40006ff0 <== NOT EXECUTED 40006ad4: c2 24 20 68 st %g1, [ %l0 + 0x68 ] <== NOT EXECUTED timeout.tv_sec += 3; 40006ad8: c2 07 bf f4 ld [ %fp + -12 ], %g1 <== NOT EXECUTED timeout.tv_nsec = 0; 40006adc: 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; 40006ae0: 82 00 60 03 add %g1, 3, %g1 <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40006ae4: 90 10 00 16 mov %l6, %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; 40006ae8: c2 27 bf f4 st %g1, [ %fp + -12 ] <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40006aec: 92 10 00 10 mov %l0, %o1 <== NOT EXECUTED 40006af0: 40 00 01 e6 call 40007288 <== NOT EXECUTED 40006af4: 94 10 00 12 mov %l2, %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) { 40006af8: 80 a2 20 74 cmp %o0, 0x74 <== NOT EXECUTED 40006afc: 32 80 00 06 bne,a 40006b14 <== NOT EXECUTED 40006b00: c2 04 20 68 ld [ %l0 + 0x68 ], %g1 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 40006b04: 40 00 03 05 call 40007718 <== NOT EXECUTED 40006b08: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return NULL; 40006b0c: 81 c7 e0 08 ret <== NOT EXECUTED 40006b10: 91 e8 20 00 restore %g0, 0, %o0 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40006b14: e2 04 20 54 ld [ %l0 + 0x54 ], %l1 <== NOT EXECUTED return NULL; } /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; 40006b18: 82 00 7f ff add %g1, -1, %g1 <== NOT EXECUTED 40006b1c: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED 40006b20: 40 00 09 5d call 40009094 <_Chain_Extract> <== NOT EXECUTED 40006b24: c2 24 20 68 st %g1, [ %l0 + 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, 40006b28: d2 04 60 14 ld [ %l1 + 0x14 ], %o1 <== NOT EXECUTED 40006b2c: 94 10 20 01 mov 1, %o2 <== NOT EXECUTED 40006b30: 7f ff ff 4a call 40006858 <== NOT EXECUTED 40006b34: 90 10 00 15 mov %l5, %o0 <== NOT EXECUTED ((rtems_aio_request_chain *)node)->fildes, 1); r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); 40006b38: 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, 40006b3c: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED ((rtems_aio_request_chain *)node)->fildes, 1); r_chain->new_fd = 0; 40006b40: c0 22 20 18 clr [ %o0 + 0x18 ] <== NOT EXECUTED pthread_mutex_init (&r_chain->mutex, NULL); 40006b44: 40 00 02 7c call 40007534 <== NOT EXECUTED 40006b48: 90 02 20 1c add %o0, 0x1c, %o0 <== NOT EXECUTED pthread_cond_init (&r_chain->cond, NULL); 40006b4c: 90 06 20 20 add %i0, 0x20, %o0 <== NOT EXECUTED 40006b50: 40 00 01 81 call 40007154 <== NOT EXECUTED 40006b54: 92 10 20 00 clr %o1 <== NOT EXECUTED r_chain->perfd = ((rtems_aio_request_chain *)node)->perfd; 40006b58: 90 06 20 08 add %i0, 8, %o0 <== NOT EXECUTED 40006b5c: 92 04 60 08 add %l1, 8, %o1 <== NOT EXECUTED 40006b60: 40 00 2b 1b call 400117cc <== NOT EXECUTED 40006b64: 94 10 20 0c mov 0xc, %o2 <== 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); 40006b68: 10 bf ff 73 b 40006934 <== NOT EXECUTED 40006b6c: b8 06 20 1c add %i0, 0x1c, %i4 <== 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); 40006b70: 40 00 02 ea call 40007718 <== NOT EXECUTED 40006b74: 90 10 00 10 mov %l0, %o0 <== 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); 40006b78: 10 bf ff 6f b 40006934 <== NOT EXECUTED 40006b7c: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40006b80: b0 10 20 00 clr %i0 <== NOT EXECUTED 40006b84: 81 c7 e0 08 ret <== NOT EXECUTED 40006b88: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40006778 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 40006778: 9d e3 bf a0 save %sp, -96, %sp int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 4000677c: 21 10 00 61 sethi %hi(0x40018400), %l0 40006780: 40 00 04 2e call 40007838 40006784: 90 14 20 0c or %l0, 0xc, %o0 ! 4001840c if (result != 0) 40006788: b0 92 20 00 orcc %o0, 0, %i0 4000678c: 12 80 00 31 bne 40006850 <== NEVER TAKEN 40006790: 90 14 20 0c or %l0, 0xc, %o0 return result; result = 40006794: 40 00 04 35 call 40007868 40006798: 92 10 20 00 clr %o1 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 4000679c: 80 a2 20 00 cmp %o0, 0 400067a0: 22 80 00 05 be,a 400067b4 <== ALWAYS TAKEN 400067a4: 11 10 00 61 sethi %hi(0x40018400), %o0 pthread_attr_destroy (&aio_request_queue.attr); 400067a8: 40 00 04 18 call 40007808 <== NOT EXECUTED 400067ac: 90 14 20 0c or %l0, 0xc, %o0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 400067b0: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 400067b4: 92 10 20 00 clr %o1 400067b8: 40 00 03 5f call 40007534 400067bc: 90 12 20 04 or %o0, 4, %o0 if (result != 0) 400067c0: 80 a2 20 00 cmp %o0, 0 400067c4: 22 80 00 06 be,a 400067dc <== ALWAYS TAKEN 400067c8: 11 10 00 61 sethi %hi(0x40018400), %o0 pthread_attr_destroy (&aio_request_queue.attr); 400067cc: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 400067d0: 40 00 04 0e call 40007808 <== NOT EXECUTED 400067d4: 90 12 20 0c or %o0, 0xc, %o0 ! 4001840c <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 400067d8: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 400067dc: 92 10 20 00 clr %o1 400067e0: 40 00 02 5d call 40007154 400067e4: 90 12 20 08 or %o0, 8, %o0 if (result != 0) { 400067e8: b0 92 20 00 orcc %o0, 0, %i0 400067ec: 02 80 00 09 be 40006810 <== ALWAYS TAKEN 400067f0: 03 10 00 61 sethi %hi(0x40018400), %g1 pthread_mutex_destroy (&aio_request_queue.mutex); 400067f4: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 400067f8: 40 00 02 fe call 400073f0 <== NOT EXECUTED 400067fc: 90 12 20 04 or %o0, 4, %o0 ! 40018404 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40006800: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 40006804: 40 00 04 01 call 40007808 <== NOT EXECUTED 40006808: 90 12 20 0c or %o0, 0xc, %o0 ! 4001840c <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 4000680c: 03 10 00 61 sethi %hi(0x40018400), %g1 <== NOT EXECUTED 40006810: 82 10 60 04 or %g1, 4, %g1 ! 40018404 40006814: 84 00 60 4c add %g1, 0x4c, %g2 40006818: c4 20 60 48 st %g2, [ %g1 + 0x48 ] head->previous = NULL; tail->previous = head; 4000681c: 84 00 60 48 add %g1, 0x48, %g2 40006820: c4 20 60 50 st %g2, [ %g1 + 0x50 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006824: 84 00 60 58 add %g1, 0x58, %g2 40006828: c4 20 60 54 st %g2, [ %g1 + 0x54 ] head->previous = NULL; tail->previous = head; 4000682c: 84 00 60 54 add %g1, 0x54, %g2 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 40006830: c0 20 60 4c clr [ %g1 + 0x4c ] tail->previous = head; 40006834: c4 20 60 5c st %g2, [ %g1 + 0x5c ] { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 40006838: c0 20 60 58 clr [ %g1 + 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; aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 4000683c: 05 00 00 2c sethi %hi(0xb000), %g2 } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; 40006840: c0 20 60 64 clr [ %g1 + 0x64 ] aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 40006844: 84 10 a0 0b or %g2, 0xb, %g2 rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; 40006848: c0 20 60 68 clr [ %g1 + 0x68 ] aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 4000684c: c4 20 60 60 st %g2, [ %g1 + 0x60 ] return result; } 40006850: 81 c7 e0 08 ret 40006854: 81 e8 00 00 restore =============================================================================== 40006b8c : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 40006b8c: 9d e3 bf a0 save %sp, -96, %sp } AIO_printf ("Thread finished\n"); return NULL; } 40006b90: c2 06 00 00 ld [ %i0 ], %g1 40006b94: 86 06 20 04 add %i0, 4, %g3 rtems_chain_node *node; AIO_printf ("FD exists \n"); node = rtems_chain_first (chain); if (rtems_chain_is_empty (chain)) { 40006b98: 80 a0 40 03 cmp %g1, %g3 40006b9c: 02 80 00 10 be 40006bdc <== NEVER TAKEN 40006ba0: 84 10 00 19 mov %i1, %g2 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; 40006ba4: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 while (req->aiocbp->aio_reqprio > prio && 40006ba8: 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; 40006bac: c8 01 20 18 ld [ %g4 + 0x18 ], %g4 while (req->aiocbp->aio_reqprio > prio && 40006bb0: 10 80 00 04 b 40006bc0 40006bb4: da 03 60 18 ld [ %o5 + 0x18 ], %o5 !rtems_chain_is_tail (chain, node)) { node = rtems_chain_next (node); prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 40006bb8: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 40006bbc: c8 01 20 18 ld [ %g4 + 0x18 ], %g4 <== 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 && 40006bc0: 80 a3 40 04 cmp %o5, %g4 40006bc4: 04 80 00 04 ble 40006bd4 <== ALWAYS TAKEN 40006bc8: 80 a0 40 03 cmp %g1, %g3 40006bcc: 32 bf ff fb bne,a 40006bb8 <== NOT EXECUTED 40006bd0: c2 00 40 00 ld [ %g1 ], %g1 <== NOT EXECUTED RTEMS_INLINE_ROUTINE void rtems_chain_insert( rtems_chain_node *after_node, rtems_chain_node *the_node ) { _Chain_Insert( after_node, the_node ); 40006bd4: f0 00 60 04 ld [ %g1 + 4 ], %i0 40006bd8: b2 10 00 02 mov %g2, %i1 40006bdc: 40 00 09 47 call 400090f8 <_Chain_Insert> 40006be0: 81 e8 00 00 restore =============================================================================== 40006be8 : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { 40006be8: 9d e3 bf a0 save %sp, -96, %sp <== NOT EXECUTED while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; 40006bec: a4 10 20 8c mov 0x8c, %l2 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40006bf0: e0 06 20 08 ld [ %i0 + 8 ], %l0 <== NOT EXECUTED while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; 40006bf4: a2 10 3f ff mov -1, %l1 <== NOT EXECUTED rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 40006bf8: 10 80 00 09 b 40006c1c <== NOT EXECUTED 40006bfc: b0 06 20 0c add %i0, 0xc, %i0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40006c00: 40 00 09 25 call 40009094 <_Chain_Extract> <== NOT EXECUTED 40006c04: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; 40006c08: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 <== NOT EXECUTED req->aiocbp->return_value = -1; free (req); 40006c0c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; 40006c10: e4 20 60 34 st %l2, [ %g1 + 0x34 ] <== NOT EXECUTED req->aiocbp->return_value = -1; free (req); 40006c14: 7f ff f1 98 call 40003274 <== NOT EXECUTED 40006c18: e2 20 60 38 st %l1, [ %g1 + 0x38 ] <== NOT EXECUTED rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 40006c1c: 80 a4 00 18 cmp %l0, %i0 <== NOT EXECUTED 40006c20: 12 bf ff f8 bne 40006c00 <== NOT EXECUTED 40006c24: 01 00 00 00 nop <== NOT EXECUTED rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); } } 40006c28: 81 c7 e0 08 ret <== NOT EXECUTED 40006c2c: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40006c30 : * 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) { 40006c30: 9d e3 bf a0 save %sp, -96, %sp <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40006c34: e0 06 00 00 ld [ %i0 ], %l0 <== NOT EXECUTED 40006c38: b0 06 20 04 add %i0, 4, %i0 <== 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) { 40006c3c: 80 a4 00 18 cmp %l0, %i0 <== NOT EXECUTED 40006c40: 02 80 00 12 be 40006c88 <== NOT EXECUTED 40006c44: 01 00 00 00 nop <== NOT EXECUTED 40006c48: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 <== NOT EXECUTED 40006c4c: 80 a0 40 19 cmp %g1, %i1 <== NOT EXECUTED 40006c50: 32 bf ff fb bne,a 40006c3c <== NOT EXECUTED 40006c54: e0 04 00 00 ld [ %l0 ], %l0 <== NOT EXECUTED 40006c58: 40 00 09 0f call 40009094 <_Chain_Extract> <== NOT EXECUTED 40006c5c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 40006c60: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 <== NOT EXECUTED 40006c64: 84 10 20 8c mov 0x8c, %g2 <== NOT EXECUTED 40006c68: c4 20 60 34 st %g2, [ %g1 + 0x34 ] <== NOT EXECUTED current->aiocbp->return_value = -1; 40006c6c: 84 10 3f ff mov -1, %g2 <== NOT EXECUTED free (current); 40006c70: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; current->aiocbp->return_value = -1; 40006c74: c4 20 60 38 st %g2, [ %g1 + 0x38 ] <== NOT EXECUTED free (current); 40006c78: 7f ff f1 7f call 40003274 <== NOT EXECUTED 40006c7c: b0 10 20 00 clr %i0 <== NOT EXECUTED } return AIO_CANCELED; 40006c80: 81 c7 e0 08 ret <== NOT EXECUTED 40006c84: 81 e8 00 00 restore <== NOT EXECUTED } 40006c88: 81 c7 e0 08 ret <== NOT EXECUTED 40006c8c: 91 e8 20 01 restore %g0, 1, %o0 <== NOT EXECUTED =============================================================================== 400068d8 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 400068d8: 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 ); 400068dc: 90 10 00 18 mov %i0, %o0 400068e0: 40 00 01 67 call 40006e7c <_Chain_Append_with_empty_check> 400068e4: 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 ) { 400068e8: 80 8a 20 ff btst 0xff, %o0 400068ec: 02 80 00 05 be 40006900 <== NEVER TAKEN 400068f0: 01 00 00 00 nop sc = rtems_event_send( task, events ); 400068f4: b0 10 00 1a mov %i2, %i0 400068f8: 7f ff fd 75 call 40005ecc 400068fc: 93 e8 00 1b restore %g0, %i3, %o1 } return sc; } 40006900: 81 c7 e0 08 ret 40006904: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 40006938 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 40006938: 9d e3 bf 98 save %sp, -104, %sp 4000693c: 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( 40006940: 10 80 00 09 b 40006964 40006944: a4 07 bf fc add %fp, -4, %l2 40006948: 92 10 20 00 clr %o1 4000694c: 94 10 00 1a mov %i2, %o2 40006950: 7f ff fc fb call 40005d3c 40006954: 96 10 00 12 mov %l2, %o3 ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 40006958: 80 a2 20 00 cmp %o0, 0 4000695c: 32 80 00 09 bne,a 40006980 <== ALWAYS TAKEN 40006960: e2 26 c0 00 st %l1, [ %i3 ] */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); 40006964: 40 00 01 82 call 40006f6c <_Chain_Get> 40006968: 90 10 00 10 mov %l0, %o0 sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 4000696c: a2 92 20 00 orcc %o0, 0, %l1 40006970: 02 bf ff f6 be 40006948 40006974: 90 10 00 19 mov %i1, %o0 40006978: 90 10 20 00 clr %o0 timeout, &out ); } *node_ptr = node; 4000697c: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 40006980: 81 c7 e0 08 ret 40006984: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006988 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 40006988: 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 ); 4000698c: 90 10 00 18 mov %i0, %o0 40006990: 40 00 01 91 call 40006fd4 <_Chain_Prepend_with_empty_check> 40006994: 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) { 40006998: 80 8a 20 ff btst 0xff, %o0 4000699c: 02 80 00 05 be 400069b0 <== NEVER TAKEN 400069a0: 01 00 00 00 nop sc = rtems_event_send( task, events ); 400069a4: b0 10 00 1a mov %i2, %i0 400069a8: 7f ff fd 49 call 40005ecc 400069ac: 93 e8 00 1b restore %g0, %i3, %o1 } return sc; } 400069b0: 81 c7 e0 08 ret <== NOT EXECUTED 400069b4: 91 e8 20 00 restore %g0, 0, %o0 <== NOT EXECUTED =============================================================================== 40008c70 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 40008c70: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 40008c74: 80 a6 20 00 cmp %i0, 0 40008c78: 02 80 00 1a be 40008ce0 <== NEVER TAKEN 40008c7c: 21 10 00 9e sethi %hi(0x40027800), %l0 40008c80: a0 14 23 ec or %l0, 0x3ec, %l0 ! 40027bec <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 40008c84: a6 04 20 0c add %l0, 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 ]; 40008c88: c2 04 00 00 ld [ %l0 ], %g1 40008c8c: e4 00 60 04 ld [ %g1 + 4 ], %l2 if ( !information ) 40008c90: 80 a4 a0 00 cmp %l2, 0 40008c94: 12 80 00 0b bne 40008cc0 40008c98: a2 10 20 01 mov 1, %l1 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40008c9c: 10 80 00 0e b 40008cd4 40008ca0: a0 04 20 04 add %l0, 4, %l0 the_thread = (Thread_Control *)information->local_table[ i ]; 40008ca4: 83 2c 60 02 sll %l1, 2, %g1 40008ca8: d0 00 80 01 ld [ %g2 + %g1 ], %o0 if ( !the_thread ) 40008cac: 80 a2 20 00 cmp %o0, 0 40008cb0: 02 80 00 04 be 40008cc0 <== NEVER TAKEN 40008cb4: a2 04 60 01 inc %l1 continue; (*routine)(the_thread); 40008cb8: 9f c6 00 00 call %i0 40008cbc: 01 00 00 00 nop information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40008cc0: c2 14 a0 10 lduh [ %l2 + 0x10 ], %g1 40008cc4: 80 a4 40 01 cmp %l1, %g1 40008cc8: 28 bf ff f7 bleu,a 40008ca4 40008ccc: c4 04 a0 1c ld [ %l2 + 0x1c ], %g2 40008cd0: a0 04 20 04 add %l0, 4, %l0 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 40008cd4: 80 a4 00 13 cmp %l0, %l3 40008cd8: 32 bf ff ed bne,a 40008c8c 40008cdc: c2 04 00 00 ld [ %l0 ], %g1 40008ce0: 81 c7 e0 08 ret 40008ce4: 81 e8 00 00 restore =============================================================================== 40013dac : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 40013dac: 9d e3 bf a0 save %sp, -96, %sp 40013db0: a0 10 00 18 mov %i0, %l0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 40013db4: 80 a4 20 00 cmp %l0, 0 40013db8: 02 80 00 1f be 40013e34 40013dbc: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !starting_address ) 40013dc0: 80 a6 60 00 cmp %i1, 0 40013dc4: 02 80 00 1c be 40013e34 40013dc8: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !id ) 40013dcc: 80 a7 60 00 cmp %i5, 0 40013dd0: 02 80 00 19 be 40013e34 <== NEVER TAKEN 40013dd4: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 40013dd8: 02 80 00 32 be 40013ea0 40013ddc: 80 a6 a0 00 cmp %i2, 0 40013de0: 02 80 00 30 be 40013ea0 40013de4: 80 a6 80 1b cmp %i2, %i3 40013de8: 0a 80 00 13 bcs 40013e34 40013dec: b0 10 20 08 mov 8, %i0 40013df0: 80 8e e0 07 btst 7, %i3 40013df4: 12 80 00 10 bne 40013e34 40013df8: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 40013dfc: 12 80 00 0e bne 40013e34 40013e00: b0 10 20 09 mov 9, %i0 40013e04: 03 10 00 f7 sethi %hi(0x4003dc00), %g1 40013e08: c4 00 63 70 ld [ %g1 + 0x370 ], %g2 ! 4003df70 <_Thread_Dispatch_disable_level> 40013e0c: 84 00 a0 01 inc %g2 40013e10: c4 20 63 70 st %g2, [ %g1 + 0x370 ] * 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 ); 40013e14: 25 10 00 f7 sethi %hi(0x4003dc00), %l2 40013e18: 40 00 12 94 call 40018868 <_Objects_Allocate> 40013e1c: 90 14 a1 84 or %l2, 0x184, %o0 ! 4003dd84 <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 40013e20: a2 92 20 00 orcc %o0, 0, %l1 40013e24: 12 80 00 06 bne 40013e3c 40013e28: 92 10 00 1b mov %i3, %o1 _Thread_Enable_dispatch(); 40013e2c: 40 00 16 f2 call 400199f4 <_Thread_Enable_dispatch> 40013e30: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 40013e34: 81 c7 e0 08 ret 40013e38: 81 e8 00 00 restore _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 40013e3c: f2 24 60 10 st %i1, [ %l1 + 0x10 ] the_partition->length = length; 40013e40: f4 24 60 14 st %i2, [ %l1 + 0x14 ] the_partition->buffer_size = buffer_size; 40013e44: f6 24 60 18 st %i3, [ %l1 + 0x18 ] the_partition->attribute_set = attribute_set; 40013e48: f8 24 60 1c st %i4, [ %l1 + 0x1c ] the_partition->number_of_used_blocks = 0; 40013e4c: c0 24 60 20 clr [ %l1 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 40013e50: 40 00 62 a7 call 4002c8ec <.udiv> 40013e54: 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, 40013e58: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 40013e5c: 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, 40013e60: 96 10 00 1b mov %i3, %o3 40013e64: a6 04 60 24 add %l1, 0x24, %l3 40013e68: 40 00 0c 7a call 40017050 <_Chain_Initialize> 40013e6c: 90 10 00 13 mov %l3, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40013e70: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40013e74: a4 14 a1 84 or %l2, 0x184, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40013e78: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40013e7c: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40013e80: 85 28 a0 02 sll %g2, 2, %g2 40013e84: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40013e88: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 40013e8c: c2 27 40 00 st %g1, [ %i5 ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 40013e90: 40 00 16 d9 call 400199f4 <_Thread_Enable_dispatch> 40013e94: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40013e98: 81 c7 e0 08 ret 40013e9c: 81 e8 00 00 restore if ( !id ) return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; 40013ea0: b0 10 20 08 mov 8, %i0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40013ea4: 81 c7 e0 08 ret 40013ea8: 81 e8 00 00 restore =============================================================================== 40006e90 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 40006e90: 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 ); 40006e94: 11 10 00 7d sethi %hi(0x4001f400), %o0 40006e98: 92 10 00 18 mov %i0, %o1 40006e9c: 90 12 21 2c or %o0, 0x12c, %o0 40006ea0: 40 00 09 15 call 400092f4 <_Objects_Get> 40006ea4: 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 ) { 40006ea8: c2 07 bf fc ld [ %fp + -4 ], %g1 40006eac: 80 a0 60 00 cmp %g1, 0 40006eb0: 12 80 00 66 bne 40007048 40006eb4: a0 10 00 08 mov %o0, %l0 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40006eb8: 25 10 00 7e sethi %hi(0x4001f800), %l2 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 40006ebc: c4 02 20 40 ld [ %o0 + 0x40 ], %g2 40006ec0: a4 14 a3 e8 or %l2, 0x3e8, %l2 40006ec4: c2 04 a0 0c ld [ %l2 + 0xc ], %g1 40006ec8: 80 a0 80 01 cmp %g2, %g1 40006ecc: 02 80 00 06 be 40006ee4 40006ed0: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 40006ed4: 40 00 0c 1a call 40009f3c <_Thread_Enable_dispatch> 40006ed8: b0 10 20 17 mov 0x17, %i0 return RTEMS_NOT_OWNER_OF_RESOURCE; 40006edc: 81 c7 e0 08 ret 40006ee0: 81 e8 00 00 restore } if ( length == RTEMS_PERIOD_STATUS ) { 40006ee4: 12 80 00 0e bne 40006f1c 40006ee8: 01 00 00 00 nop switch ( the_period->state ) { 40006eec: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40006ef0: 80 a0 60 04 cmp %g1, 4 40006ef4: 18 80 00 06 bgu 40006f0c <== NEVER TAKEN 40006ef8: b0 10 20 00 clr %i0 40006efc: 83 28 60 02 sll %g1, 2, %g1 40006f00: 05 10 00 75 sethi %hi(0x4001d400), %g2 40006f04: 84 10 a2 7c or %g2, 0x27c, %g2 ! 4001d67c 40006f08: f0 00 80 01 ld [ %g2 + %g1 ], %i0 case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); 40006f0c: 40 00 0c 0c call 40009f3c <_Thread_Enable_dispatch> 40006f10: 01 00 00 00 nop return( return_value ); 40006f14: 81 c7 e0 08 ret 40006f18: 81 e8 00 00 restore } _ISR_Disable( level ); 40006f1c: 7f ff ef 24 call 40002bac 40006f20: 01 00 00 00 nop 40006f24: a6 10 00 08 mov %o0, %l3 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 40006f28: e2 04 20 38 ld [ %l0 + 0x38 ], %l1 40006f2c: 80 a4 60 00 cmp %l1, 0 40006f30: 12 80 00 15 bne 40006f84 40006f34: 80 a4 60 02 cmp %l1, 2 _ISR_Enable( level ); 40006f38: 7f ff ef 21 call 40002bbc 40006f3c: 01 00 00 00 nop /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 40006f40: 7f ff ff 7a call 40006d28 <_Rate_monotonic_Initiate_statistics> 40006f44: 90 10 00 10 mov %l0, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40006f48: 82 10 20 02 mov 2, %g1 40006f4c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40006f50: 03 10 00 1c sethi %hi(0x40007000), %g1 40006f54: 82 10 63 18 or %g1, 0x318, %g1 ! 40007318 <_Rate_monotonic_Timeout> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40006f58: c0 24 20 18 clr [ %l0 + 0x18 ] the_watchdog->routine = routine; 40006f5c: c2 24 20 2c st %g1, [ %l0 + 0x2c ] the_watchdog->id = id; 40006f60: f0 24 20 30 st %i0, [ %l0 + 0x30 ] the_watchdog->user_data = user_data; 40006f64: c0 24 20 34 clr [ %l0 + 0x34 ] _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 40006f68: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006f6c: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006f70: 11 10 00 7d sethi %hi(0x4001f400), %o0 40006f74: 92 04 20 10 add %l0, 0x10, %o1 40006f78: 40 00 10 2d call 4000b02c <_Watchdog_Insert> 40006f7c: 90 12 23 70 or %o0, 0x370, %o0 40006f80: 30 80 00 1b b,a 40006fec _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 40006f84: 12 80 00 1e bne 40006ffc 40006f88: 80 a4 60 04 cmp %l1, 4 /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 40006f8c: 7f ff ff 83 call 40006d98 <_Rate_monotonic_Update_statistics> 40006f90: 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; 40006f94: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 40006f98: 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; 40006f9c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 40006fa0: 7f ff ef 07 call 40002bbc 40006fa4: 90 10 00 13 mov %l3, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 40006fa8: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40006fac: c2 04 20 08 ld [ %l0 + 8 ], %g1 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40006fb0: 13 00 00 10 sethi %hi(0x4000), %o1 40006fb4: 40 00 0e 1b call 4000a820 <_Thread_Set_state> 40006fb8: c2 22 20 20 st %g1, [ %o0 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 40006fbc: 7f ff ee fc call 40002bac 40006fc0: 01 00 00 00 nop local_state = the_period->state; 40006fc4: e6 04 20 38 ld [ %l0 + 0x38 ], %l3 the_period->state = RATE_MONOTONIC_ACTIVE; 40006fc8: e2 24 20 38 st %l1, [ %l0 + 0x38 ] _ISR_Enable( level ); 40006fcc: 7f ff ee fc call 40002bbc 40006fd0: 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 ) 40006fd4: 80 a4 e0 03 cmp %l3, 3 40006fd8: 12 80 00 05 bne 40006fec 40006fdc: 01 00 00 00 nop _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40006fe0: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40006fe4: 40 00 0b 0a call 40009c0c <_Thread_Clear_state> 40006fe8: 13 00 00 10 sethi %hi(0x4000), %o1 _Thread_Enable_dispatch(); 40006fec: 40 00 0b d4 call 40009f3c <_Thread_Enable_dispatch> 40006ff0: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40006ff4: 81 c7 e0 08 ret 40006ff8: 81 e8 00 00 restore } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 40006ffc: 12 bf ff b8 bne 40006edc <== NEVER TAKEN 40007000: b0 10 20 04 mov 4, %i0 /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 40007004: 7f ff ff 65 call 40006d98 <_Rate_monotonic_Update_statistics> 40007008: 90 10 00 10 mov %l0, %o0 _ISR_Enable( level ); 4000700c: 7f ff ee ec call 40002bbc 40007010: 90 10 00 13 mov %l3, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40007014: 82 10 20 02 mov 2, %g1 40007018: 92 04 20 10 add %l0, 0x10, %o1 4000701c: 11 10 00 7d sethi %hi(0x4001f400), %o0 40007020: 90 12 23 70 or %o0, 0x370, %o0 ! 4001f770 <_Watchdog_Ticks_chain> 40007024: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; 40007028: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000702c: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007030: 40 00 0f ff call 4000b02c <_Watchdog_Insert> 40007034: b0 10 20 06 mov 6, %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 40007038: 40 00 0b c1 call 40009f3c <_Thread_Enable_dispatch> 4000703c: 01 00 00 00 nop return RTEMS_TIMEOUT; 40007040: 81 c7 e0 08 ret 40007044: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 40007048: b0 10 20 04 mov 4, %i0 } 4000704c: 81 c7 e0 08 ret 40007050: 81 e8 00 00 restore =============================================================================== 40007054 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 40007054: 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 ) 40007058: 80 a6 60 00 cmp %i1, 0 4000705c: 02 80 00 79 be 40007240 <== NEVER TAKEN 40007060: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 40007064: 13 10 00 75 sethi %hi(0x4001d400), %o1 40007068: 9f c6 40 00 call %i1 4000706c: 92 12 62 90 or %o1, 0x290, %o1 ! 4001d690 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 40007070: 90 10 00 18 mov %i0, %o0 40007074: 13 10 00 75 sethi %hi(0x4001d400), %o1 40007078: 9f c6 40 00 call %i1 4000707c: 92 12 62 b0 or %o1, 0x2b0, %o1 ! 4001d6b0 (*print)( context, "--- Wall times are in seconds ---\n" ); 40007080: 90 10 00 18 mov %i0, %o0 40007084: 13 10 00 75 sethi %hi(0x4001d400), %o1 40007088: 9f c6 40 00 call %i1 4000708c: 92 12 62 d8 or %o1, 0x2d8, %o1 ! 4001d6d8 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 40007090: 90 10 00 18 mov %i0, %o0 40007094: 13 10 00 75 sethi %hi(0x4001d400), %o1 40007098: 9f c6 40 00 call %i1 4000709c: 92 12 63 00 or %o1, 0x300, %o1 ! 4001d700 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 400070a0: 90 10 00 18 mov %i0, %o0 400070a4: 13 10 00 75 sethi %hi(0x4001d400), %o1 400070a8: 9f c6 40 00 call %i1 400070ac: 92 12 63 50 or %o1, 0x350, %o1 ! 4001d750 /* * 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 ; 400070b0: 3b 10 00 7d sethi %hi(0x4001f400), %i5 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, 400070b4: 2b 10 00 75 sethi %hi(0x4001d400), %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 ; 400070b8: 82 17 61 2c or %i5, 0x12c, %g1 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, 400070bc: 27 10 00 75 sethi %hi(0x4001d400), %l3 struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, 400070c0: 35 10 00 75 sethi %hi(0x4001d400), %i2 /* * 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 ; 400070c4: e0 00 60 08 ld [ %g1 + 8 ], %l0 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 400070c8: ae 07 bf a0 add %fp, -96, %l7 #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 ); 400070cc: ac 07 bf d8 add %fp, -40, %l6 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 400070d0: a4 07 bf f8 add %fp, -8, %l2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 400070d4: aa 15 63 a0 or %l5, 0x3a0, %l5 { #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; 400070d8: a8 07 bf b8 add %fp, -72, %l4 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 400070dc: a2 07 bf f0 add %fp, -16, %l1 (*print)( context, 400070e0: a6 14 e3 b8 or %l3, 0x3b8, %l3 { #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; 400070e4: b8 07 bf d0 add %fp, -48, %i4 /* * 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 ; 400070e8: 10 80 00 52 b 40007230 400070ec: b4 16 a3 d8 or %i2, 0x3d8, %i2 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 400070f0: 40 00 19 fb call 4000d8dc 400070f4: 92 10 00 17 mov %l7, %o1 if ( status != RTEMS_SUCCESSFUL ) 400070f8: 80 a2 20 00 cmp %o0, 0 400070fc: 32 80 00 4c bne,a 4000722c 40007100: a0 04 20 01 inc %l0 #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 ); 40007104: 92 10 00 16 mov %l6, %o1 40007108: 40 00 1a 22 call 4000d990 4000710c: 90 10 00 10 mov %l0, %o0 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007110: d0 07 bf d8 ld [ %fp + -40 ], %o0 40007114: 92 10 20 05 mov 5, %o1 40007118: 40 00 00 ae call 400073d0 4000711c: 94 10 00 12 mov %l2, %o2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007120: d8 1f bf a0 ldd [ %fp + -96 ], %o4 40007124: 92 10 00 15 mov %l5, %o1 40007128: 90 10 00 18 mov %i0, %o0 4000712c: 94 10 00 10 mov %l0, %o2 40007130: 9f c6 40 00 call %i1 40007134: 96 10 00 12 mov %l2, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 40007138: d2 07 bf a0 ld [ %fp + -96 ], %o1 4000713c: 80 a2 60 00 cmp %o1, 0 40007140: 12 80 00 08 bne 40007160 40007144: 94 10 00 11 mov %l1, %o2 (*print)( context, "\n" ); 40007148: 90 10 00 18 mov %i0, %o0 4000714c: 13 10 00 72 sethi %hi(0x4001c800), %o1 40007150: 9f c6 40 00 call %i1 40007154: 92 12 61 28 or %o1, 0x128, %o1 ! 4001c928 <_rodata_start+0x158> continue; 40007158: 10 80 00 35 b 4000722c 4000715c: a0 04 20 01 inc %l0 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 ); 40007160: 40 00 0e 90 call 4000aba0 <_Timespec_Divide_by_integer> 40007164: 90 10 00 14 mov %l4, %o0 (*print)( context, 40007168: d0 07 bf ac ld [ %fp + -84 ], %o0 4000716c: 40 00 47 b0 call 4001902c <.div> 40007170: 92 10 23 e8 mov 0x3e8, %o1 40007174: 96 10 00 08 mov %o0, %o3 40007178: d0 07 bf b4 ld [ %fp + -76 ], %o0 4000717c: d6 27 bf 9c st %o3, [ %fp + -100 ] 40007180: 40 00 47 ab call 4001902c <.div> 40007184: 92 10 23 e8 mov 0x3e8, %o1 40007188: c2 07 bf f0 ld [ %fp + -16 ], %g1 4000718c: b6 10 00 08 mov %o0, %i3 40007190: d0 07 bf f4 ld [ %fp + -12 ], %o0 40007194: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007198: 40 00 47 a5 call 4001902c <.div> 4000719c: 92 10 23 e8 mov 0x3e8, %o1 400071a0: d8 07 bf b0 ld [ %fp + -80 ], %o4 400071a4: d6 07 bf 9c ld [ %fp + -100 ], %o3 400071a8: d4 07 bf a8 ld [ %fp + -88 ], %o2 400071ac: 9a 10 00 1b mov %i3, %o5 400071b0: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 400071b4: 92 10 00 13 mov %l3, %o1 400071b8: 9f c6 40 00 call %i1 400071bc: 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); 400071c0: d2 07 bf a0 ld [ %fp + -96 ], %o1 400071c4: 94 10 00 11 mov %l1, %o2 400071c8: 40 00 0e 76 call 4000aba0 <_Timespec_Divide_by_integer> 400071cc: 90 10 00 1c mov %i4, %o0 (*print)( context, 400071d0: d0 07 bf c4 ld [ %fp + -60 ], %o0 400071d4: 40 00 47 96 call 4001902c <.div> 400071d8: 92 10 23 e8 mov 0x3e8, %o1 400071dc: 96 10 00 08 mov %o0, %o3 400071e0: d0 07 bf cc ld [ %fp + -52 ], %o0 400071e4: d6 27 bf 9c st %o3, [ %fp + -100 ] 400071e8: 40 00 47 91 call 4001902c <.div> 400071ec: 92 10 23 e8 mov 0x3e8, %o1 400071f0: c2 07 bf f0 ld [ %fp + -16 ], %g1 400071f4: b6 10 00 08 mov %o0, %i3 400071f8: d0 07 bf f4 ld [ %fp + -12 ], %o0 400071fc: 92 10 23 e8 mov 0x3e8, %o1 40007200: 40 00 47 8b call 4001902c <.div> 40007204: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007208: d4 07 bf c0 ld [ %fp + -64 ], %o2 4000720c: d6 07 bf 9c ld [ %fp + -100 ], %o3 40007210: d8 07 bf c8 ld [ %fp + -56 ], %o4 40007214: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40007218: 92 10 00 1a mov %i2, %o1 4000721c: 90 10 00 18 mov %i0, %o0 40007220: 9f c6 40 00 call %i1 40007224: 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 ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 40007228: 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 ; id <= _Rate_monotonic_Information.maximum_id ; 4000722c: 82 17 61 2c or %i5, 0x12c, %g1 /* * 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 ; 40007230: c2 00 60 0c ld [ %g1 + 0xc ], %g1 40007234: 80 a4 00 01 cmp %l0, %g1 40007238: 08 bf ff ae bleu 400070f0 4000723c: 90 10 00 10 mov %l0, %o0 40007240: 81 c7 e0 08 ret 40007244: 81 e8 00 00 restore =============================================================================== 40015350 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 40015350: 9d e3 bf 98 save %sp, -104, %sp 40015354: 90 10 00 18 mov %i0, %o0 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 40015358: 80 a6 60 00 cmp %i1, 0 4001535c: 02 80 00 2e be 40015414 40015360: b0 10 20 0a mov 0xa, %i0 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 40015364: 40 00 11 b1 call 40019a28 <_Thread_Get> 40015368: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4001536c: c2 07 bf fc ld [ %fp + -4 ], %g1 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 40015370: a2 10 00 08 mov %o0, %l1 switch ( location ) { 40015374: 80 a0 60 00 cmp %g1, 0 40015378: 12 80 00 27 bne 40015414 4001537c: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 40015380: e0 02 21 54 ld [ %o0 + 0x154 ], %l0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 40015384: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40015388: 80 a0 60 00 cmp %g1, 0 4001538c: 02 80 00 24 be 4001541c 40015390: 01 00 00 00 nop if ( asr->is_enabled ) { 40015394: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 40015398: 80 a0 60 00 cmp %g1, 0 4001539c: 02 80 00 15 be 400153f0 400153a0: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 400153a4: 7f ff e7 f1 call 4000f368 400153a8: 01 00 00 00 nop *signal_set |= signals; 400153ac: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 400153b0: b2 10 40 19 or %g1, %i1, %i1 400153b4: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _ISR_Enable( _level ); 400153b8: 7f ff e7 f0 call 4000f378 400153bc: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 400153c0: 03 10 00 f9 sethi %hi(0x4003e400), %g1 400153c4: 82 10 60 d0 or %g1, 0xd0, %g1 ! 4003e4d0 <_Per_CPU_Information> 400153c8: c4 00 60 08 ld [ %g1 + 8 ], %g2 400153cc: 80 a0 a0 00 cmp %g2, 0 400153d0: 02 80 00 0f be 4001540c 400153d4: 01 00 00 00 nop 400153d8: c4 00 60 0c ld [ %g1 + 0xc ], %g2 400153dc: 80 a4 40 02 cmp %l1, %g2 400153e0: 12 80 00 0b bne 4001540c <== NEVER TAKEN 400153e4: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 400153e8: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 400153ec: 30 80 00 08 b,a 4001540c rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 400153f0: 7f ff e7 de call 4000f368 400153f4: 01 00 00 00 nop *signal_set |= signals; 400153f8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 400153fc: b2 10 40 19 or %g1, %i1, %i1 40015400: f2 24 20 18 st %i1, [ %l0 + 0x18 ] _ISR_Enable( _level ); 40015404: 7f ff e7 dd call 4000f378 40015408: 01 00 00 00 nop } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 4001540c: 40 00 11 7a call 400199f4 <_Thread_Enable_dispatch> 40015410: b0 10 20 00 clr %i0 ! 0 return RTEMS_SUCCESSFUL; 40015414: 81 c7 e0 08 ret 40015418: 81 e8 00 00 restore } _Thread_Enable_dispatch(); 4001541c: 40 00 11 76 call 400199f4 <_Thread_Enable_dispatch> 40015420: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; 40015424: 81 c7 e0 08 ret 40015428: 81 e8 00 00 restore =============================================================================== 4000dcd8 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4000dcd8: 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 ) 4000dcdc: 80 a6 a0 00 cmp %i2, 0 4000dce0: 02 80 00 5a be 4000de48 4000dce4: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4000dce8: 03 10 00 56 sethi %hi(0x40015800), %g1 4000dcec: e2 00 62 44 ld [ %g1 + 0x244 ], %l1 ! 40015a44 <_Per_CPU_Information+0xc> api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000dcf0: c2 0c 60 74 ldub [ %l1 + 0x74 ], %g1 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 4000dcf4: e0 04 61 54 ld [ %l1 + 0x154 ], %l0 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000dcf8: 80 a0 00 01 cmp %g0, %g1 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000dcfc: c2 04 60 7c ld [ %l1 + 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; 4000dd00: a4 60 3f ff subx %g0, -1, %l2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000dd04: 80 a0 60 00 cmp %g1, 0 4000dd08: 02 80 00 03 be 4000dd14 4000dd0c: a5 2c a0 08 sll %l2, 8, %l2 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4000dd10: a4 14 a2 00 or %l2, 0x200, %l2 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000dd14: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 4000dd18: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000dd1c: 7f ff ee c7 call 40009838 <_CPU_ISR_Get_level> 4000dd20: a6 60 3f ff subx %g0, -1, %l3 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; 4000dd24: a7 2c e0 0a sll %l3, 0xa, %l3 4000dd28: a6 14 c0 08 or %l3, %o0, %l3 old_mode |= _ISR_Get_level(); 4000dd2c: a4 14 c0 12 or %l3, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000dd30: 80 8e 61 00 btst 0x100, %i1 4000dd34: 02 80 00 06 be 4000dd4c 4000dd38: 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; 4000dd3c: 82 0e 21 00 and %i0, 0x100, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4000dd40: 80 a0 00 01 cmp %g0, %g1 4000dd44: 82 60 3f ff subx %g0, -1, %g1 4000dd48: c2 2c 60 74 stb %g1, [ %l1 + 0x74 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 4000dd4c: 80 8e 62 00 btst 0x200, %i1 4000dd50: 02 80 00 0b be 4000dd7c 4000dd54: 80 8e 60 0f btst 0xf, %i1 if ( _Modes_Is_timeslice(mode_set) ) { 4000dd58: 80 8e 22 00 btst 0x200, %i0 4000dd5c: 22 80 00 07 be,a 4000dd78 4000dd60: c0 24 60 7c clr [ %l1 + 0x7c ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000dd64: 82 10 20 01 mov 1, %g1 4000dd68: c2 24 60 7c st %g1, [ %l1 + 0x7c ] executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000dd6c: 03 10 00 55 sethi %hi(0x40015400), %g1 4000dd70: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 40015444 <_Thread_Ticks_per_timeslice> 4000dd74: c2 24 60 78 st %g1, [ %l1 + 0x78 ] } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4000dd78: 80 8e 60 0f btst 0xf, %i1 4000dd7c: 02 80 00 06 be 4000dd94 4000dd80: 80 8e 64 00 btst 0x400, %i1 */ RTEMS_INLINE_ROUTINE ISR_Level _Modes_Get_interrupt_level ( Modes_Control mode_set ) { return ( mode_set & RTEMS_INTERRUPT_MASK ); 4000dd84: 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 ) ); 4000dd88: 7f ff cf c8 call 40001ca8 4000dd8c: 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 ) { 4000dd90: 80 8e 64 00 btst 0x400, %i1 4000dd94: 02 80 00 14 be 4000dde4 4000dd98: 88 10 20 00 clr %g4 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4000dd9c: c4 0c 20 08 ldub [ %l0 + 8 ], %g2 */ RTEMS_INLINE_ROUTINE bool _Modes_Is_asr_disabled ( Modes_Control mode_set ) { return (mode_set & RTEMS_ASR_MASK) == RTEMS_NO_ASR; 4000dda0: 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( 4000dda4: 80 a0 00 18 cmp %g0, %i0 4000dda8: 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 ) { 4000ddac: 80 a0 40 02 cmp %g1, %g2 4000ddb0: 22 80 00 0e be,a 4000dde8 4000ddb4: 03 10 00 55 sethi %hi(0x40015400), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4000ddb8: 7f ff cf b8 call 40001c98 4000ddbc: c2 2c 20 08 stb %g1, [ %l0 + 8 ] _signals = information->signals_pending; 4000ddc0: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 information->signals_pending = information->signals_posted; 4000ddc4: c4 04 20 14 ld [ %l0 + 0x14 ], %g2 information->signals_posted = _signals; 4000ddc8: c2 24 20 14 st %g1, [ %l0 + 0x14 ] rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; 4000ddcc: c4 24 20 18 st %g2, [ %l0 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 4000ddd0: 7f ff cf b6 call 40001ca8 4000ddd4: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 4000ddd8: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4000dddc: 80 a0 00 01 cmp %g0, %g1 4000dde0: 88 40 20 00 addx %g0, 0, %g4 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4000dde4: 03 10 00 55 sethi %hi(0x40015400), %g1 4000dde8: c4 00 62 58 ld [ %g1 + 0x258 ], %g2 ! 40015658 <_System_state_Current> 4000ddec: 80 a0 a0 03 cmp %g2, 3 4000ddf0: 12 80 00 16 bne 4000de48 <== NEVER TAKEN 4000ddf4: 82 10 20 00 clr %g1 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000ddf8: 07 10 00 56 sethi %hi(0x40015800), %g3 if ( are_signals_pending || 4000ddfc: 80 89 20 ff btst 0xff, %g4 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000de00: 86 10 e2 38 or %g3, 0x238, %g3 if ( are_signals_pending || 4000de04: 12 80 00 0a bne 4000de2c 4000de08: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 4000de0c: c6 00 e0 10 ld [ %g3 + 0x10 ], %g3 4000de10: 80 a0 80 03 cmp %g2, %g3 4000de14: 02 80 00 0d be 4000de48 4000de18: 01 00 00 00 nop (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 4000de1c: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 4000de20: 80 a0 a0 00 cmp %g2, 0 4000de24: 02 80 00 09 be 4000de48 <== NEVER TAKEN 4000de28: 01 00 00 00 nop _Thread_Dispatch_necessary = true; 4000de2c: 84 10 20 01 mov 1, %g2 ! 1 4000de30: 03 10 00 56 sethi %hi(0x40015800), %g1 4000de34: 82 10 62 38 or %g1, 0x238, %g1 ! 40015a38 <_Per_CPU_Information> 4000de38: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 4000de3c: 7f ff e8 90 call 4000807c <_Thread_Dispatch> 4000de40: 01 00 00 00 nop } return RTEMS_SUCCESSFUL; 4000de44: 82 10 20 00 clr %g1 ! 0 } 4000de48: 81 c7 e0 08 ret 4000de4c: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 4000a69c : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4000a69c: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4000a6a0: 80 a6 60 00 cmp %i1, 0 4000a6a4: 02 80 00 07 be 4000a6c0 4000a6a8: 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 ) ); 4000a6ac: 03 10 00 64 sethi %hi(0x40019000), %g1 4000a6b0: c2 08 63 04 ldub [ %g1 + 0x304 ], %g1 ! 40019304 4000a6b4: 80 a6 40 01 cmp %i1, %g1 4000a6b8: 18 80 00 1c bgu 4000a728 4000a6bc: b0 10 20 13 mov 0x13, %i0 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4000a6c0: 80 a6 a0 00 cmp %i2, 0 4000a6c4: 02 80 00 19 be 4000a728 4000a6c8: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4000a6cc: 40 00 08 e3 call 4000ca58 <_Thread_Get> 4000a6d0: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000a6d4: c2 07 bf fc ld [ %fp + -4 ], %g1 4000a6d8: 80 a0 60 00 cmp %g1, 0 4000a6dc: 12 80 00 13 bne 4000a728 4000a6e0: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4000a6e4: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4000a6e8: 80 a6 60 00 cmp %i1, 0 4000a6ec: 02 80 00 0d be 4000a720 4000a6f0: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 4000a6f4: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4000a6f8: 80 a0 60 00 cmp %g1, 0 4000a6fc: 02 80 00 06 be 4000a714 4000a700: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 4000a704: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000a708: 80 a0 40 19 cmp %g1, %i1 4000a70c: 08 80 00 05 bleu 4000a720 <== ALWAYS TAKEN 4000a710: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4000a714: 92 10 00 19 mov %i1, %o1 4000a718: 40 00 07 96 call 4000c570 <_Thread_Change_priority> 4000a71c: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 4000a720: 40 00 08 c1 call 4000ca24 <_Thread_Enable_dispatch> 4000a724: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 4000a728: 81 c7 e0 08 ret 4000a72c: 81 e8 00 00 restore =============================================================================== 40015d60 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 40015d60: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 40015d64: 11 10 00 fa sethi %hi(0x4003e800), %o0 40015d68: 92 10 00 18 mov %i0, %o1 40015d6c: 90 12 21 04 or %o0, 0x104, %o0 40015d70: 40 00 0c 0f call 40018dac <_Objects_Get> 40015d74: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40015d78: c2 07 bf fc ld [ %fp + -4 ], %g1 40015d7c: 80 a0 60 00 cmp %g1, 0 40015d80: 12 80 00 0c bne 40015db0 40015d84: 01 00 00 00 nop case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 40015d88: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40015d8c: 80 a0 60 04 cmp %g1, 4 40015d90: 02 80 00 04 be 40015da0 <== NEVER TAKEN 40015d94: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 40015d98: 40 00 14 08 call 4001adb8 <_Watchdog_Remove> 40015d9c: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 40015da0: 40 00 0f 15 call 400199f4 <_Thread_Enable_dispatch> 40015da4: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40015da8: 81 c7 e0 08 ret 40015dac: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40015db0: 81 c7 e0 08 ret 40015db4: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 40016248 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 40016248: 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; 4001624c: 03 10 00 fa sethi %hi(0x4003e800), %g1 40016250: e2 00 61 44 ld [ %g1 + 0x144 ], %l1 ! 4003e944 <_Timer_server> rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 40016254: a0 10 00 18 mov %i0, %l0 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) 40016258: 80 a4 60 00 cmp %l1, 0 4001625c: 02 80 00 33 be 40016328 40016260: b0 10 20 0e mov 0xe, %i0 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 40016264: 03 10 00 f7 sethi %hi(0x4003dc00), %g1 40016268: c2 08 63 80 ldub [ %g1 + 0x380 ], %g1 ! 4003df80 <_TOD_Is_set> 4001626c: 80 a0 60 00 cmp %g1, 0 40016270: 02 80 00 2e be 40016328 <== NEVER TAKEN 40016274: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; if ( !routine ) 40016278: 80 a6 a0 00 cmp %i2, 0 4001627c: 02 80 00 2b be 40016328 40016280: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 40016284: 90 10 00 19 mov %i1, %o0 40016288: 7f ff f4 06 call 400132a0 <_TOD_Validate> 4001628c: b0 10 20 14 mov 0x14, %i0 40016290: 80 8a 20 ff btst 0xff, %o0 40016294: 02 80 00 27 be 40016330 40016298: 01 00 00 00 nop return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 4001629c: 7f ff f3 cd call 400131d0 <_TOD_To_seconds> 400162a0: 90 10 00 19 mov %i1, %o0 if ( seconds <= _TOD_Seconds_since_epoch() ) 400162a4: 27 10 00 f8 sethi %hi(0x4003e000), %l3 400162a8: c2 04 e0 18 ld [ %l3 + 0x18 ], %g1 ! 4003e018 <_TOD_Now> 400162ac: 80 a2 00 01 cmp %o0, %g1 400162b0: 08 80 00 1e bleu 40016328 400162b4: a4 10 00 08 mov %o0, %l2 400162b8: 11 10 00 fa sethi %hi(0x4003e800), %o0 400162bc: 92 10 00 10 mov %l0, %o1 400162c0: 90 12 21 04 or %o0, 0x104, %o0 400162c4: 40 00 0a ba call 40018dac <_Objects_Get> 400162c8: 94 07 bf fc add %fp, -4, %o2 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 400162cc: c2 07 bf fc ld [ %fp + -4 ], %g1 400162d0: b2 10 00 08 mov %o0, %i1 400162d4: 80 a0 60 00 cmp %g1, 0 400162d8: 12 80 00 14 bne 40016328 400162dc: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 400162e0: 40 00 12 b6 call 4001adb8 <_Watchdog_Remove> 400162e4: 90 02 20 10 add %o0, 0x10, %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 400162e8: 82 10 20 03 mov 3, %g1 400162ec: c2 26 60 38 st %g1, [ %i1 + 0x38 ] _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 400162f0: c2 04 e0 18 ld [ %l3 + 0x18 ], %g1 (*timer_server->schedule_operation)( timer_server, the_timer ); 400162f4: 90 10 00 11 mov %l1, %o0 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(); 400162f8: a4 24 80 01 sub %l2, %g1, %l2 (*timer_server->schedule_operation)( timer_server, the_timer ); 400162fc: c2 04 60 04 ld [ %l1 + 4 ], %g1 40016300: 92 10 00 19 mov %i1, %o1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40016304: c0 26 60 18 clr [ %i1 + 0x18 ] the_watchdog->routine = routine; 40016308: f4 26 60 2c st %i2, [ %i1 + 0x2c ] the_watchdog->id = id; 4001630c: e0 26 60 30 st %l0, [ %i1 + 0x30 ] the_watchdog->user_data = user_data; 40016310: f6 26 60 34 st %i3, [ %i1 + 0x34 ] case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 40016314: e4 26 60 1c st %l2, [ %i1 + 0x1c ] (*timer_server->schedule_operation)( timer_server, the_timer ); 40016318: 9f c0 40 00 call %g1 4001631c: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40016320: 40 00 0d b5 call 400199f4 <_Thread_Enable_dispatch> 40016324: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40016328: 81 c7 e0 08 ret 4001632c: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40016330: 81 c7 e0 08 ret 40016334: 81 e8 00 00 restore =============================================================================== 400064bc : #include int sched_get_priority_max( int policy ) { 400064bc: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 400064c0: 80 a6 20 04 cmp %i0, 4 400064c4: 18 80 00 06 bgu 400064dc 400064c8: 82 10 20 01 mov 1, %g1 400064cc: b1 28 40 18 sll %g1, %i0, %i0 400064d0: 80 8e 20 17 btst 0x17, %i0 400064d4: 12 80 00 08 bne 400064f4 <== ALWAYS TAKEN 400064d8: 03 10 00 76 sethi %hi(0x4001d800), %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 400064dc: 40 00 22 e9 call 4000f080 <__errno> 400064e0: b0 10 3f ff mov -1, %i0 400064e4: 82 10 20 16 mov 0x16, %g1 400064e8: c2 22 00 00 st %g1, [ %o0 ] 400064ec: 81 c7 e0 08 ret 400064f0: 81 e8 00 00 restore } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 400064f4: f0 08 60 28 ldub [ %g1 + 0x28 ], %i0 } 400064f8: 81 c7 e0 08 ret 400064fc: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 40006500 : #include int sched_get_priority_min( int policy ) { 40006500: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 40006504: 80 a6 20 04 cmp %i0, 4 40006508: 18 80 00 06 bgu 40006520 4000650c: 82 10 20 01 mov 1, %g1 40006510: 83 28 40 18 sll %g1, %i0, %g1 40006514: 80 88 60 17 btst 0x17, %g1 40006518: 12 80 00 06 bne 40006530 <== ALWAYS TAKEN 4000651c: b0 10 20 01 mov 1, %i0 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40006520: 40 00 22 d8 call 4000f080 <__errno> 40006524: b0 10 3f ff mov -1, %i0 40006528: 82 10 20 16 mov 0x16, %g1 4000652c: c2 22 00 00 st %g1, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40006530: 81 c7 e0 08 ret 40006534: 81 e8 00 00 restore =============================================================================== 40006538 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 40006538: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 4000653c: 80 a6 20 00 cmp %i0, 0 40006540: 02 80 00 0b be 4000656c <== NEVER TAKEN 40006544: 80 a6 60 00 cmp %i1, 0 40006548: 7f ff f2 5f call 40002ec4 4000654c: 01 00 00 00 nop 40006550: 80 a6 00 08 cmp %i0, %o0 40006554: 02 80 00 06 be 4000656c 40006558: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 4000655c: 40 00 22 c9 call 4000f080 <__errno> 40006560: 01 00 00 00 nop 40006564: 10 80 00 07 b 40006580 40006568: 82 10 20 03 mov 3, %g1 ! 3 if ( !interval ) 4000656c: 12 80 00 08 bne 4000658c 40006570: 03 10 00 78 sethi %hi(0x4001e000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40006574: 40 00 22 c3 call 4000f080 <__errno> 40006578: 01 00 00 00 nop 4000657c: 82 10 20 16 mov 0x16, %g1 ! 16 40006580: c2 22 00 00 st %g1, [ %o0 ] 40006584: 81 c7 e0 08 ret 40006588: 91 e8 3f ff restore %g0, -1, %o0 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 4000658c: d0 00 60 c4 ld [ %g1 + 0xc4 ], %o0 40006590: 92 10 00 19 mov %i1, %o1 40006594: 40 00 0e 3a call 40009e7c <_Timespec_From_ticks> 40006598: b0 10 20 00 clr %i0 return 0; } 4000659c: 81 c7 e0 08 ret 400065a0: 81 e8 00 00 restore =============================================================================== 40008ee4 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 40008ee4: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40008ee8: 03 10 00 8c sethi %hi(0x40023000), %g1 40008eec: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 ! 40023160 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40008ef0: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 40008ef4: 84 00 a0 01 inc %g2 40008ef8: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 40008efc: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40008f00: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 40008f04: c4 20 61 60 st %g2, [ %g1 + 0x160 ] POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 40008f08: a2 8e 62 00 andcc %i1, 0x200, %l1 40008f0c: 02 80 00 05 be 40008f20 40008f10: a0 10 20 00 clr %l0 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 40008f14: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 40008f18: 82 07 a0 54 add %fp, 0x54, %g1 40008f1c: c2 27 bf fc st %g1, [ %fp + -4 ] va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 40008f20: 90 10 00 18 mov %i0, %o0 40008f24: 40 00 1a 2a call 4000f7cc <_POSIX_Semaphore_Name_to_id> 40008f28: 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 ) { 40008f2c: a4 92 20 00 orcc %o0, 0, %l2 40008f30: 22 80 00 0e be,a 40008f68 40008f34: 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) ) ) { 40008f38: 80 a4 a0 02 cmp %l2, 2 40008f3c: 12 80 00 04 bne 40008f4c <== NEVER TAKEN 40008f40: 80 a4 60 00 cmp %l1, 0 40008f44: 12 80 00 21 bne 40008fc8 40008f48: 94 10 00 10 mov %l0, %o2 _Thread_Enable_dispatch(); 40008f4c: 40 00 0b 84 call 4000bd5c <_Thread_Enable_dispatch> 40008f50: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 40008f54: 40 00 26 01 call 40012758 <__errno> 40008f58: 01 00 00 00 nop 40008f5c: e4 22 00 00 st %l2, [ %o0 ] 40008f60: 81 c7 e0 08 ret 40008f64: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 40008f68: 80 a6 6a 00 cmp %i1, 0xa00 40008f6c: 12 80 00 0a bne 40008f94 40008f70: d2 07 bf f8 ld [ %fp + -8 ], %o1 _Thread_Enable_dispatch(); 40008f74: 40 00 0b 7a call 4000bd5c <_Thread_Enable_dispatch> 40008f78: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 40008f7c: 40 00 25 f7 call 40012758 <__errno> 40008f80: 01 00 00 00 nop 40008f84: 82 10 20 11 mov 0x11, %g1 ! 11 40008f88: c2 22 00 00 st %g1, [ %o0 ] 40008f8c: 81 c7 e0 08 ret 40008f90: 81 e8 00 00 restore 40008f94: 94 07 bf f0 add %fp, -16, %o2 40008f98: 11 10 00 8d sethi %hi(0x40023400), %o0 40008f9c: 40 00 08 6c call 4000b14c <_Objects_Get> 40008fa0: 90 12 20 40 or %o0, 0x40, %o0 ! 40023440 <_POSIX_Semaphore_Information> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 40008fa4: 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 ); 40008fa8: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 40008fac: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 40008fb0: 40 00 0b 6b call 4000bd5c <_Thread_Enable_dispatch> 40008fb4: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 40008fb8: 40 00 0b 69 call 4000bd5c <_Thread_Enable_dispatch> 40008fbc: 01 00 00 00 nop goto return_id; 40008fc0: 10 80 00 0c b 40008ff0 40008fc4: f0 07 bf f4 ld [ %fp + -12 ], %i0 /* * 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( 40008fc8: 90 10 00 18 mov %i0, %o0 40008fcc: 92 10 20 00 clr %o1 40008fd0: 40 00 19 a8 call 4000f670 <_POSIX_Semaphore_Create_support> 40008fd4: 96 07 bf f4 add %fp, -12, %o3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 40008fd8: 40 00 0b 61 call 4000bd5c <_Thread_Enable_dispatch> 40008fdc: a0 10 00 08 mov %o0, %l0 if ( status == -1 ) 40008fe0: 80 a4 3f ff cmp %l0, -1 40008fe4: 02 bf ff ea be 40008f8c 40008fe8: 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; 40008fec: f0 07 bf f4 ld [ %fp + -12 ], %i0 40008ff0: b0 06 20 08 add %i0, 8, %i0 #endif return id; } 40008ff4: 81 c7 e0 08 ret 40008ff8: 81 e8 00 00 restore =============================================================================== 40006434 : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 40006434: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 40006438: 90 96 a0 00 orcc %i2, 0, %o0 4000643c: 02 80 00 0a be 40006464 40006440: a0 10 00 18 mov %i0, %l0 *oact = _POSIX_signals_Vectors[ sig ]; 40006444: 83 2e 20 02 sll %i0, 2, %g1 40006448: 85 2e 20 04 sll %i0, 4, %g2 4000644c: 82 20 80 01 sub %g2, %g1, %g1 40006450: 13 10 00 7d sethi %hi(0x4001f400), %o1 40006454: 94 10 20 0c mov 0xc, %o2 40006458: 92 12 63 20 or %o1, 0x320, %o1 4000645c: 40 00 26 74 call 4000fe2c 40006460: 92 02 40 01 add %o1, %g1, %o1 if ( !sig ) 40006464: 80 a4 20 00 cmp %l0, 0 40006468: 02 80 00 09 be 4000648c 4000646c: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 40006470: 82 04 3f ff add %l0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 40006474: 80 a0 60 1f cmp %g1, 0x1f 40006478: 18 80 00 05 bgu 4000648c 4000647c: 01 00 00 00 nop * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 40006480: 80 a4 20 09 cmp %l0, 9 40006484: 12 80 00 08 bne 400064a4 40006488: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 4000648c: 40 00 24 09 call 4000f4b0 <__errno> 40006490: b0 10 3f ff mov -1, %i0 40006494: 82 10 20 16 mov 0x16, %g1 40006498: c2 22 00 00 st %g1, [ %o0 ] 4000649c: 81 c7 e0 08 ret 400064a0: 81 e8 00 00 restore /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 400064a4: 02 bf ff fe be 4000649c <== NEVER TAKEN 400064a8: b0 10 20 00 clr %i0 /* * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); 400064ac: 7f ff ef 8d call 400022e0 400064b0: 01 00 00 00 nop 400064b4: a2 10 00 08 mov %o0, %l1 if ( act->sa_handler == SIG_DFL ) { 400064b8: c2 06 60 08 ld [ %i1 + 8 ], %g1 400064bc: 25 10 00 7d sethi %hi(0x4001f400), %l2 400064c0: 80 a0 60 00 cmp %g1, 0 400064c4: a4 14 a3 20 or %l2, 0x320, %l2 400064c8: a7 2c 20 02 sll %l0, 2, %l3 400064cc: 12 80 00 08 bne 400064ec 400064d0: a9 2c 20 04 sll %l0, 4, %l4 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 400064d4: a6 25 00 13 sub %l4, %l3, %l3 400064d8: 13 10 00 77 sethi %hi(0x4001dc00), %o1 400064dc: 90 04 80 13 add %l2, %l3, %o0 400064e0: 92 12 61 28 or %o1, 0x128, %o1 400064e4: 10 80 00 07 b 40006500 400064e8: 92 02 40 13 add %o1, %l3, %o1 } else { _POSIX_signals_Clear_process_signals( sig ); 400064ec: 40 00 17 d2 call 4000c434 <_POSIX_signals_Clear_process_signals> 400064f0: 90 10 00 10 mov %l0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 400064f4: a6 25 00 13 sub %l4, %l3, %l3 400064f8: 92 10 00 19 mov %i1, %o1 400064fc: 90 04 80 13 add %l2, %l3, %o0 40006500: 40 00 26 4b call 4000fe2c 40006504: 94 10 20 0c mov 0xc, %o2 * 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; 40006508: b0 10 20 00 clr %i0 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); _POSIX_signals_Vectors[ sig ] = *act; } _ISR_Enable( level ); 4000650c: 7f ff ef 79 call 400022f0 40006510: 90 10 00 11 mov %l1, %o0 * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; } 40006514: 81 c7 e0 08 ret 40006518: 81 e8 00 00 restore =============================================================================== 400068e4 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 400068e4: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 400068e8: a0 96 20 00 orcc %i0, 0, %l0 400068ec: 02 80 00 0f be 40006928 400068f0: 01 00 00 00 nop /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 400068f4: 80 a6 a0 00 cmp %i2, 0 400068f8: 02 80 00 12 be 40006940 400068fc: a8 10 20 00 clr %l4 if ( !_Timespec_Is_valid( timeout ) ) 40006900: 40 00 0e 69 call 4000a2a4 <_Timespec_Is_valid> 40006904: 90 10 00 1a mov %i2, %o0 40006908: 80 8a 20 ff btst 0xff, %o0 4000690c: 02 80 00 07 be 40006928 40006910: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 40006914: 40 00 0e 87 call 4000a330 <_Timespec_To_ticks> 40006918: 90 10 00 1a mov %i2, %o0 if ( !interval ) 4000691c: a8 92 20 00 orcc %o0, 0, %l4 40006920: 12 80 00 09 bne 40006944 <== ALWAYS TAKEN 40006924: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 40006928: 40 00 24 a6 call 4000fbc0 <__errno> 4000692c: b0 10 3f ff mov -1, %i0 40006930: 82 10 20 16 mov 0x16, %g1 40006934: c2 22 00 00 st %g1, [ %o0 ] 40006938: 81 c7 e0 08 ret 4000693c: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40006940: 80 a6 60 00 cmp %i1, 0 40006944: 22 80 00 02 be,a 4000694c 40006948: b2 07 bf f4 add %fp, -12, %i1 the_thread = _Thread_Executing; 4000694c: 31 10 00 7f sethi %hi(0x4001fc00), %i0 40006950: b0 16 22 b8 or %i0, 0x2b8, %i0 ! 4001feb8 <_Per_CPU_Information> 40006954: e6 06 20 0c ld [ %i0 + 0xc ], %l3 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40006958: 7f ff ef 3d call 4000264c 4000695c: e4 04 e1 58 ld [ %l3 + 0x158 ], %l2 40006960: a2 10 00 08 mov %o0, %l1 if ( *set & api->signals_pending ) { 40006964: c4 04 00 00 ld [ %l0 ], %g2 40006968: c2 04 a0 d4 ld [ %l2 + 0xd4 ], %g1 4000696c: 80 88 80 01 btst %g2, %g1 40006970: 22 80 00 13 be,a 400069bc 40006974: 03 10 00 80 sethi %hi(0x40020000), %g1 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 40006978: 7f ff ff c3 call 40006884 <_POSIX_signals_Get_lowest> 4000697c: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( 40006980: 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 ); 40006984: 92 10 00 08 mov %o0, %o1 40006988: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 4000698c: 96 10 20 00 clr %o3 40006990: 90 10 00 12 mov %l2, %o0 40006994: 40 00 18 9e call 4000cc0c <_POSIX_signals_Clear_signals> 40006998: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 4000699c: 7f ff ef 30 call 4000265c 400069a0: 90 10 00 11 mov %l1, %o0 the_info->si_code = SI_USER; 400069a4: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 400069a8: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 400069ac: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 400069b0: f0 06 40 00 ld [ %i1 ], %i0 400069b4: 81 c7 e0 08 ret 400069b8: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 400069bc: c2 00 61 04 ld [ %g1 + 0x104 ], %g1 400069c0: 80 88 80 01 btst %g2, %g1 400069c4: 22 80 00 13 be,a 40006a10 400069c8: 82 10 3f ff mov -1, %g1 signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 400069cc: 7f ff ff ae call 40006884 <_POSIX_signals_Get_lowest> 400069d0: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 400069d4: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 400069d8: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 400069dc: 96 10 20 01 mov 1, %o3 400069e0: 90 10 00 12 mov %l2, %o0 400069e4: 92 10 00 18 mov %i0, %o1 400069e8: 40 00 18 89 call 4000cc0c <_POSIX_signals_Clear_signals> 400069ec: 98 10 20 00 clr %o4 _ISR_Enable( level ); 400069f0: 7f ff ef 1b call 4000265c 400069f4: 90 10 00 11 mov %l1, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 400069f8: 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; 400069fc: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 40006a00: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 40006a04: c0 26 60 08 clr [ %i1 + 8 ] return signo; 40006a08: 81 c7 e0 08 ret 40006a0c: 81 e8 00 00 restore } the_info->si_signo = -1; 40006a10: c2 26 40 00 st %g1, [ %i1 ] 40006a14: 03 10 00 7e sethi %hi(0x4001f800), %g1 40006a18: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 ! 4001f960 <_Thread_Dispatch_disable_level> 40006a1c: 84 00 a0 01 inc %g2 40006a20: c4 20 61 60 st %g2, [ %g1 + 0x160 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 40006a24: 82 10 20 04 mov 4, %g1 40006a28: c2 24 e0 34 st %g1, [ %l3 + 0x34 ] the_thread->Wait.option = *set; 40006a2c: c2 04 00 00 ld [ %l0 ], %g1 the_thread->Wait.return_argument = the_info; 40006a30: f2 24 e0 28 st %i1, [ %l3 + 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; 40006a34: c2 24 e0 30 st %g1, [ %l3 + 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; 40006a38: a2 10 20 01 mov 1, %l1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 40006a3c: 2b 10 00 80 sethi %hi(0x40020000), %l5 40006a40: aa 15 60 9c or %l5, 0x9c, %l5 ! 4002009c <_POSIX_signals_Wait_queue> 40006a44: ea 24 e0 44 st %l5, [ %l3 + 0x44 ] 40006a48: e2 25 60 30 st %l1, [ %l5 + 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 ); 40006a4c: 7f ff ef 04 call 4000265c 40006a50: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 40006a54: 90 10 00 15 mov %l5, %o0 40006a58: 92 10 00 14 mov %l4, %o1 40006a5c: 15 10 00 27 sethi %hi(0x40009c00), %o2 40006a60: 40 00 0c 4a call 40009b88 <_Thread_queue_Enqueue_with_handler> 40006a64: 94 12 a3 10 or %o2, 0x310, %o2 ! 40009f10 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 40006a68: 40 00 0b 0a call 40009690 <_Thread_Enable_dispatch> 40006a6c: 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 ); 40006a70: d2 06 40 00 ld [ %i1 ], %o1 40006a74: 90 10 00 12 mov %l2, %o0 40006a78: 94 10 00 19 mov %i1, %o2 40006a7c: 96 10 20 00 clr %o3 40006a80: 40 00 18 63 call 4000cc0c <_POSIX_signals_Clear_signals> 40006a84: 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) 40006a88: c2 06 20 0c ld [ %i0 + 0xc ], %g1 40006a8c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40006a90: 80 a0 60 04 cmp %g1, 4 40006a94: 12 80 00 09 bne 40006ab8 40006a98: 01 00 00 00 nop || !(*set & signo_to_mask( the_info->si_signo )) ) { 40006a9c: f0 06 40 00 ld [ %i1 ], %i0 40006aa0: 82 06 3f ff add %i0, -1, %g1 40006aa4: a3 2c 40 01 sll %l1, %g1, %l1 40006aa8: c2 04 00 00 ld [ %l0 ], %g1 40006aac: 80 8c 40 01 btst %l1, %g1 40006ab0: 12 80 00 08 bne 40006ad0 40006ab4: 01 00 00 00 nop errno = _Thread_Executing->Wait.return_code; 40006ab8: 40 00 24 42 call 4000fbc0 <__errno> 40006abc: b0 10 3f ff mov -1, %i0 ! ffffffff 40006ac0: 03 10 00 7f sethi %hi(0x4001fc00), %g1 40006ac4: c2 00 62 c4 ld [ %g1 + 0x2c4 ], %g1 ! 4001fec4 <_Per_CPU_Information+0xc> 40006ac8: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40006acc: c2 22 00 00 st %g1, [ %o0 ] return -1; } return the_info->si_signo; } 40006ad0: 81 c7 e0 08 ret 40006ad4: 81 e8 00 00 restore =============================================================================== 40008ab0 : int sigwait( const sigset_t *set, int *sig ) { 40008ab0: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 40008ab4: 92 10 20 00 clr %o1 40008ab8: 90 10 00 18 mov %i0, %o0 40008abc: 7f ff ff 7b call 400088a8 40008ac0: 94 10 20 00 clr %o2 if ( status != -1 ) { 40008ac4: 80 a2 3f ff cmp %o0, -1 40008ac8: 02 80 00 07 be 40008ae4 40008acc: 80 a6 60 00 cmp %i1, 0 if ( sig ) 40008ad0: 02 80 00 03 be 40008adc <== NEVER TAKEN 40008ad4: b0 10 20 00 clr %i0 *sig = status; 40008ad8: d0 26 40 00 st %o0, [ %i1 ] 40008adc: 81 c7 e0 08 ret 40008ae0: 81 e8 00 00 restore return 0; } return errno; 40008ae4: 40 00 23 3d call 400117d8 <__errno> 40008ae8: 01 00 00 00 nop 40008aec: f0 02 00 00 ld [ %o0 ], %i0 } 40008af0: 81 c7 e0 08 ret 40008af4: 81 e8 00 00 restore =============================================================================== 4000577c : */ long sysconf( int name ) { 4000577c: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 40005780: 80 a6 20 02 cmp %i0, 2 40005784: 12 80 00 09 bne 400057a8 40005788: 80 a6 20 04 cmp %i0, 4 return (TOD_MICROSECONDS_PER_SECOND / 4000578c: 03 10 00 57 sethi %hi(0x40015c00), %g1 40005790: d2 00 62 c8 ld [ %g1 + 0x2c8 ], %o1 ! 40015ec8 40005794: 11 00 03 d0 sethi %hi(0xf4000), %o0 40005798: 40 00 33 6e call 40012550 <.udiv> 4000579c: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 400057a0: 81 c7 e0 08 ret 400057a4: 91 e8 00 08 restore %g0, %o0, %o0 rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 400057a8: 12 80 00 05 bne 400057bc 400057ac: 80 a6 20 33 cmp %i0, 0x33 return rtems_libio_number_iops; 400057b0: 03 10 00 57 sethi %hi(0x40015c00), %g1 400057b4: 10 80 00 0f b 400057f0 400057b8: d0 00 61 e4 ld [ %g1 + 0x1e4 ], %o0 ! 40015de4 if ( name == _SC_GETPW_R_SIZE_MAX ) 400057bc: 02 80 00 0d be 400057f0 400057c0: 90 10 24 00 mov 0x400, %o0 return 1024; if ( name == _SC_PAGESIZE ) 400057c4: 80 a6 20 08 cmp %i0, 8 400057c8: 02 80 00 0a be 400057f0 400057cc: 90 02 2c 00 add %o0, 0xc00, %o0 return PAGE_SIZE; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 400057d0: 80 a6 22 03 cmp %i0, 0x203 400057d4: 02 80 00 07 be 400057f0 <== NEVER TAKEN 400057d8: 90 10 20 00 clr %o0 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 400057dc: 40 00 23 fe call 4000e7d4 <__errno> 400057e0: 01 00 00 00 nop 400057e4: 82 10 20 16 mov 0x16, %g1 ! 16 400057e8: c2 22 00 00 st %g1, [ %o0 ] 400057ec: 90 10 3f ff mov -1, %o0 } 400057f0: b0 10 00 08 mov %o0, %i0 400057f4: 81 c7 e0 08 ret 400057f8: 81 e8 00 00 restore =============================================================================== 40005b08 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 40005b08: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 40005b0c: 80 a6 20 01 cmp %i0, 1 40005b10: 12 80 00 15 bne 40005b64 40005b14: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 40005b18: 80 a6 a0 00 cmp %i2, 0 40005b1c: 02 80 00 12 be 40005b64 40005b20: 01 00 00 00 nop /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 40005b24: 80 a6 60 00 cmp %i1, 0 40005b28: 02 80 00 13 be 40005b74 40005b2c: 03 10 00 78 sethi %hi(0x4001e000), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 40005b30: c2 06 40 00 ld [ %i1 ], %g1 40005b34: 82 00 7f ff add %g1, -1, %g1 40005b38: 80 a0 60 01 cmp %g1, 1 40005b3c: 18 80 00 0a bgu 40005b64 <== NEVER TAKEN 40005b40: 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 ) 40005b44: c2 06 60 04 ld [ %i1 + 4 ], %g1 40005b48: 80 a0 60 00 cmp %g1, 0 40005b4c: 02 80 00 06 be 40005b64 <== NEVER TAKEN 40005b50: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 40005b54: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 40005b58: 80 a0 60 1f cmp %g1, 0x1f 40005b5c: 28 80 00 06 bleu,a 40005b74 <== ALWAYS TAKEN 40005b60: 03 10 00 78 sethi %hi(0x4001e000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40005b64: 40 00 25 38 call 4000f044 <__errno> 40005b68: 01 00 00 00 nop 40005b6c: 10 80 00 10 b 40005bac 40005b70: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40005b74: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 40005b78: 84 00 a0 01 inc %g2 40005b7c: c4 20 61 60 st %g2, [ %g1 + 0x160 ] * 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 ); 40005b80: 11 10 00 79 sethi %hi(0x4001e400), %o0 40005b84: 40 00 07 ed call 40007b38 <_Objects_Allocate> 40005b88: 90 12 20 80 or %o0, 0x80, %o0 ! 4001e480 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 40005b8c: 80 a2 20 00 cmp %o0, 0 40005b90: 12 80 00 0a bne 40005bb8 40005b94: 82 10 20 02 mov 2, %g1 _Thread_Enable_dispatch(); 40005b98: 40 00 0c 0d call 40008bcc <_Thread_Enable_dispatch> 40005b9c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 40005ba0: 40 00 25 29 call 4000f044 <__errno> 40005ba4: 01 00 00 00 nop 40005ba8: 82 10 20 0b mov 0xb, %g1 ! b 40005bac: c2 22 00 00 st %g1, [ %o0 ] 40005bb0: 81 c7 e0 08 ret 40005bb4: 91 e8 3f ff restore %g0, -1, %o0 } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 40005bb8: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 40005bbc: 03 10 00 79 sethi %hi(0x4001e400), %g1 40005bc0: c2 00 62 c4 ld [ %g1 + 0x2c4 ], %g1 ! 4001e6c4 <_Per_CPU_Information+0xc> if ( evp != NULL ) { 40005bc4: 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; 40005bc8: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 40005bcc: 02 80 00 08 be 40005bec 40005bd0: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 40005bd4: c2 06 40 00 ld [ %i1 ], %g1 40005bd8: c2 22 20 40 st %g1, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 40005bdc: c2 06 60 04 ld [ %i1 + 4 ], %g1 40005be0: c2 22 20 44 st %g1, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 40005be4: c2 06 60 08 ld [ %i1 + 8 ], %g1 40005be8: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40005bec: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40005bf0: 07 10 00 79 sethi %hi(0x4001e400), %g3 40005bf4: c6 00 e0 9c ld [ %g3 + 0x9c ], %g3 ! 4001e49c <_POSIX_Timer_Information+0x1c> } ptimer->overrun = 0; 40005bf8: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 40005bfc: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 40005c00: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 40005c04: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 40005c08: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40005c0c: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 40005c10: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 40005c14: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 40005c18: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40005c1c: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40005c20: 85 28 a0 02 sll %g2, 2, %g2 40005c24: 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; 40005c28: 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; 40005c2c: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 40005c30: 40 00 0b e7 call 40008bcc <_Thread_Enable_dispatch> 40005c34: b0 10 20 00 clr %i0 return 0; } 40005c38: 81 c7 e0 08 ret 40005c3c: 81 e8 00 00 restore =============================================================================== 40005c40 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 40005c40: 9d e3 bf 80 save %sp, -128, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 40005c44: 80 a6 a0 00 cmp %i2, 0 40005c48: 02 80 00 22 be 40005cd0 <== NEVER TAKEN 40005c4c: 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) ) ) { 40005c50: 40 00 0e f5 call 40009824 <_Timespec_Is_valid> 40005c54: 90 06 a0 08 add %i2, 8, %o0 40005c58: 80 8a 20 ff btst 0xff, %o0 40005c5c: 02 80 00 1d be 40005cd0 40005c60: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 40005c64: 40 00 0e f0 call 40009824 <_Timespec_Is_valid> 40005c68: 90 10 00 1a mov %i2, %o0 40005c6c: 80 8a 20 ff btst 0xff, %o0 40005c70: 02 80 00 18 be 40005cd0 <== NEVER TAKEN 40005c74: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40005c78: 80 a6 60 00 cmp %i1, 0 40005c7c: 02 80 00 05 be 40005c90 40005c80: 90 07 bf e4 add %fp, -28, %o0 40005c84: 80 a6 60 04 cmp %i1, 4 40005c88: 12 80 00 12 bne 40005cd0 40005c8c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 40005c90: 92 10 00 1a mov %i2, %o1 40005c94: 40 00 27 60 call 4000fa14 40005c98: 94 10 20 10 mov 0x10, %o2 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 40005c9c: 80 a6 60 04 cmp %i1, 4 40005ca0: 12 80 00 16 bne 40005cf8 40005ca4: 92 10 00 18 mov %i0, %o1 struct timespec now; _TOD_Get( &now ); 40005ca8: b2 07 bf f4 add %fp, -12, %i1 40005cac: 40 00 06 30 call 4000756c <_TOD_Get> 40005cb0: 90 10 00 19 mov %i1, %o0 /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 40005cb4: a0 07 bf ec add %fp, -20, %l0 40005cb8: 90 10 00 19 mov %i1, %o0 40005cbc: 40 00 0e c9 call 400097e0 <_Timespec_Greater_than> 40005cc0: 92 10 00 10 mov %l0, %o1 40005cc4: 80 8a 20 ff btst 0xff, %o0 40005cc8: 02 80 00 08 be 40005ce8 40005ccc: 90 10 00 19 mov %i1, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); 40005cd0: 40 00 24 dd call 4000f044 <__errno> 40005cd4: b0 10 3f ff mov -1, %i0 40005cd8: 82 10 20 16 mov 0x16, %g1 40005cdc: c2 22 00 00 st %g1, [ %o0 ] 40005ce0: 81 c7 e0 08 ret 40005ce4: 81 e8 00 00 restore _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 40005ce8: 92 10 00 10 mov %l0, %o1 40005cec: 40 00 0e df call 40009868 <_Timespec_Subtract> 40005cf0: 94 10 00 10 mov %l0, %o2 timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) _Objects_Get( &_POSIX_Timer_Information, (Objects_Id) id, location ); 40005cf4: 92 10 00 18 mov %i0, %o1 40005cf8: 11 10 00 79 sethi %hi(0x4001e400), %o0 40005cfc: 94 07 bf fc add %fp, -4, %o2 40005d00: 40 00 08 cd call 40008034 <_Objects_Get> 40005d04: 90 12 20 80 or %o0, 0x80, %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 ) { 40005d08: c2 07 bf fc ld [ %fp + -4 ], %g1 40005d0c: 80 a0 60 00 cmp %g1, 0 40005d10: 12 80 00 39 bne 40005df4 40005d14: b0 10 00 08 mov %o0, %i0 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 ) { 40005d18: c2 07 bf ec ld [ %fp + -20 ], %g1 40005d1c: 80 a0 60 00 cmp %g1, 0 40005d20: 12 80 00 14 bne 40005d70 40005d24: c2 07 bf f0 ld [ %fp + -16 ], %g1 40005d28: 80 a0 60 00 cmp %g1, 0 40005d2c: 12 80 00 11 bne 40005d70 40005d30: 01 00 00 00 nop /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 40005d34: 40 00 10 02 call 40009d3c <_Watchdog_Remove> 40005d38: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 40005d3c: 80 a6 e0 00 cmp %i3, 0 40005d40: 02 80 00 05 be 40005d54 40005d44: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40005d48: 92 06 20 54 add %i0, 0x54, %o1 40005d4c: 40 00 27 32 call 4000fa14 40005d50: 94 10 20 10 mov 0x10, %o2 /* The new data are set */ ptimer->timer_data = normalize; 40005d54: 90 06 20 54 add %i0, 0x54, %o0 40005d58: 92 07 bf e4 add %fp, -28, %o1 40005d5c: 40 00 27 2e call 4000fa14 40005d60: 94 10 20 10 mov 0x10, %o2 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 40005d64: 82 10 20 04 mov 4, %g1 40005d68: 10 80 00 1f b 40005de4 40005d6c: c2 2e 20 3c stb %g1, [ %i0 + 0x3c ] _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); 40005d70: 40 00 0e d0 call 400098b0 <_Timespec_To_ticks> 40005d74: 90 10 00 1a mov %i2, %o0 40005d78: d0 26 20 64 st %o0, [ %i0 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 40005d7c: 40 00 0e cd call 400098b0 <_Timespec_To_ticks> 40005d80: 90 07 bf ec add %fp, -20, %o0 activated = _POSIX_Timer_Insert_helper( 40005d84: d4 06 20 08 ld [ %i0 + 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 ); 40005d88: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 40005d8c: 17 10 00 17 sethi %hi(0x40005c00), %o3 40005d90: 90 06 20 10 add %i0, 0x10, %o0 40005d94: 96 12 e2 0c or %o3, 0x20c, %o3 40005d98: 40 00 19 ae call 4000c450 <_POSIX_Timer_Insert_helper> 40005d9c: 98 10 00 18 mov %i0, %o4 initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 40005da0: 80 8a 20 ff btst 0xff, %o0 40005da4: 02 80 00 10 be 40005de4 40005da8: 01 00 00 00 nop /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 40005dac: 80 a6 e0 00 cmp %i3, 0 40005db0: 02 80 00 05 be 40005dc4 40005db4: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40005db8: 92 06 20 54 add %i0, 0x54, %o1 40005dbc: 40 00 27 16 call 4000fa14 40005dc0: 94 10 20 10 mov 0x10, %o2 ptimer->timer_data = normalize; 40005dc4: 90 06 20 54 add %i0, 0x54, %o0 40005dc8: 92 07 bf e4 add %fp, -28, %o1 40005dcc: 40 00 27 12 call 4000fa14 40005dd0: 94 10 20 10 mov 0x10, %o2 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40005dd4: 82 10 20 03 mov 3, %g1 _TOD_Get( &ptimer->time ); 40005dd8: 90 06 20 6c add %i0, 0x6c, %o0 40005ddc: 40 00 05 e4 call 4000756c <_TOD_Get> 40005de0: c2 2e 20 3c stb %g1, [ %i0 + 0x3c ] _Thread_Enable_dispatch(); 40005de4: 40 00 0b 7a call 40008bcc <_Thread_Enable_dispatch> 40005de8: b0 10 20 00 clr %i0 return 0; 40005dec: 81 c7 e0 08 ret 40005df0: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 40005df4: 40 00 24 94 call 4000f044 <__errno> 40005df8: b0 10 3f ff mov -1, %i0 40005dfc: 82 10 20 16 mov 0x16, %g1 40005e00: c2 22 00 00 st %g1, [ %o0 ] } 40005e04: 81 c7 e0 08 ret 40005e08: 81 e8 00 00 restore =============================================================================== 40005a20 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 40005a20: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 40005a24: 23 10 00 5f sethi %hi(0x40017c00), %l1 40005a28: a2 14 63 a8 or %l1, 0x3a8, %l1 ! 40017fa8 <_POSIX_signals_Ualarm_timer> 40005a2c: c2 04 60 1c ld [ %l1 + 0x1c ], %g1 40005a30: 80 a0 60 00 cmp %g1, 0 40005a34: 12 80 00 0a bne 40005a5c 40005a38: a0 10 00 18 mov %i0, %l0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40005a3c: 03 10 00 16 sethi %hi(0x40005800), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40005a40: c0 24 60 08 clr [ %l1 + 8 ] the_watchdog->routine = routine; 40005a44: 82 10 61 f0 or %g1, 0x1f0, %g1 the_watchdog->id = id; 40005a48: c0 24 60 20 clr [ %l1 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40005a4c: c2 24 60 1c st %g1, [ %l1 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 40005a50: c0 24 60 24 clr [ %l1 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 40005a54: 10 80 00 1b b 40005ac0 40005a58: b0 10 20 00 clr %i0 if ( !the_timer->routine ) { _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 40005a5c: 40 00 0f 92 call 400098a4 <_Watchdog_Remove> 40005a60: 90 10 00 11 mov %l1, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 40005a64: 90 02 3f fe add %o0, -2, %o0 40005a68: 80 a2 20 01 cmp %o0, 1 40005a6c: 18 80 00 15 bgu 40005ac0 <== NEVER TAKEN 40005a70: 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); 40005a74: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40005a78: d0 04 60 14 ld [ %l1 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40005a7c: 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); 40005a80: 90 02 00 01 add %o0, %g1, %o0 40005a84: c2 04 60 18 ld [ %l1 + 0x18 ], %g1 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40005a88: 40 00 0e 15 call 400092dc <_Timespec_From_ticks> 40005a8c: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40005a90: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 40005a94: 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; 40005a98: b1 28 60 08 sll %g1, 8, %i0 40005a9c: 85 28 60 03 sll %g1, 3, %g2 40005aa0: 84 26 00 02 sub %i0, %g2, %g2 remaining += tp.tv_nsec / 1000; 40005aa4: 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; 40005aa8: b1 28 a0 06 sll %g2, 6, %i0 40005aac: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 40005ab0: 40 00 37 94 call 40013900 <.div> 40005ab4: 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; 40005ab8: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 40005abc: b0 02 00 18 add %o0, %i0, %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 ) { 40005ac0: 80 a4 20 00 cmp %l0, 0 40005ac4: 02 80 00 1a be 40005b2c 40005ac8: 23 00 03 d0 sethi %hi(0xf4000), %l1 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40005acc: 90 10 00 10 mov %l0, %o0 40005ad0: 40 00 37 8a call 400138f8 <.udiv> 40005ad4: 92 14 62 40 or %l1, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005ad8: 92 14 62 40 or %l1, 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; 40005adc: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005ae0: 40 00 38 32 call 40013ba8 <.urem> 40005ae4: 90 10 00 10 mov %l0, %o0 40005ae8: 85 2a 20 07 sll %o0, 7, %g2 40005aec: 83 2a 20 02 sll %o0, 2, %g1 40005af0: 82 20 80 01 sub %g2, %g1, %g1 40005af4: 90 00 40 08 add %g1, %o0, %o0 40005af8: 91 2a 20 03 sll %o0, 3, %o0 ticks = _Timespec_To_ticks( &tp ); 40005afc: a0 07 bf f8 add %fp, -8, %l0 */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005b00: d0 27 bf fc st %o0, [ %fp + -4 ] ticks = _Timespec_To_ticks( &tp ); 40005b04: 40 00 0e 1d call 40009378 <_Timespec_To_ticks> 40005b08: 90 10 00 10 mov %l0, %o0 if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 40005b0c: 40 00 0e 1b call 40009378 <_Timespec_To_ticks> 40005b10: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40005b14: 13 10 00 5f sethi %hi(0x40017c00), %o1 40005b18: 92 12 63 a8 or %o1, 0x3a8, %o1 ! 40017fa8 <_POSIX_signals_Ualarm_timer> 40005b1c: d0 22 60 0c st %o0, [ %o1 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40005b20: 11 10 00 5d sethi %hi(0x40017400), %o0 40005b24: 40 00 0f 06 call 4000973c <_Watchdog_Insert> 40005b28: 90 12 23 60 or %o0, 0x360, %o0 ! 40017760 <_Watchdog_Ticks_chain> } return remaining; } 40005b2c: 81 c7 e0 08 ret 40005b30: 81 e8 00 00 restore