=============================================================================== 40008fb4 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 40008fb4: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 40008fb8: 03 10 00 67 sethi %hi(0x40019c00), %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 ); 40008fbc: 7f ff e9 82 call 400035c4 40008fc0: e0 00 60 44 ld [ %g1 + 0x44 ], %l0 ! 40019c44 <_Per_CPU_Information+0xc> 40008fc4: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 40008fc8: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 40008fcc: 80 a0 60 00 cmp %g1, 0 40008fd0: 12 80 00 08 bne 40008ff0 <_CORE_RWLock_Release+0x3c> 40008fd4: 80 a0 60 01 cmp %g1, 1 _ISR_Enable( level ); 40008fd8: 7f ff e9 7f call 400035d4 40008fdc: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 40008fe0: 82 10 20 02 mov 2, %g1 40008fe4: c2 24 20 34 st %g1, [ %l0 + 0x34 ] 40008fe8: 81 c7 e0 08 ret 40008fec: 81 e8 00 00 restore return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 40008ff0: 32 80 00 0b bne,a 4000901c <_CORE_RWLock_Release+0x68> 40008ff4: c0 24 20 34 clr [ %l0 + 0x34 ] the_rwlock->number_of_readers -= 1; 40008ff8: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40008ffc: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 40009000: 80 a0 60 00 cmp %g1, 0 40009004: 02 80 00 05 be 40009018 <_CORE_RWLock_Release+0x64> 40009008: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 4000900c: 7f ff e9 72 call 400035d4 40009010: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 40009014: 30 80 00 24 b,a 400090a4 <_CORE_RWLock_Release+0xf0> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 40009018: 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; 4000901c: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 40009020: 7f ff e9 6d call 400035d4 40009024: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 40009028: 40 00 07 29 call 4000accc <_Thread_queue_Dequeue> 4000902c: 90 10 00 18 mov %i0, %o0 if ( next ) { 40009030: 80 a2 20 00 cmp %o0, 0 40009034: 22 80 00 1c be,a 400090a4 <_CORE_RWLock_Release+0xf0> 40009038: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 4000903c: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 40009040: 80 a0 60 01 cmp %g1, 1 40009044: 32 80 00 05 bne,a 40009058 <_CORE_RWLock_Release+0xa4> 40009048: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 4000904c: 82 10 20 02 mov 2, %g1 return CORE_RWLOCK_SUCCESSFUL; 40009050: 10 80 00 14 b 400090a0 <_CORE_RWLock_Release+0xec> 40009054: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 40009058: 82 00 60 01 inc %g1 4000905c: c2 26 20 48 st %g1, [ %i0 + 0x48 ] the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 40009060: 82 10 20 01 mov 1, %g1 40009064: 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 ); 40009068: 40 00 08 61 call 4000b1ec <_Thread_queue_First> 4000906c: 90 10 00 18 mov %i0, %o0 if ( !next || 40009070: 92 92 20 00 orcc %o0, 0, %o1 40009074: 22 80 00 0c be,a 400090a4 <_CORE_RWLock_Release+0xf0> 40009078: b0 10 20 00 clr %i0 4000907c: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 40009080: 80 a0 60 01 cmp %g1, 1 40009084: 02 80 00 07 be 400090a0 <_CORE_RWLock_Release+0xec> <== NEVER TAKEN 40009088: 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; 4000908c: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40009090: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 40009094: 40 00 08 06 call 4000b0ac <_Thread_queue_Extract> 40009098: c2 26 20 48 st %g1, [ %i0 + 0x48 ] } 4000909c: 30 bf ff f3 b,a 40009068 <_CORE_RWLock_Release+0xb4> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 400090a0: b0 10 20 00 clr %i0 400090a4: 81 c7 e0 08 ret 400090a8: 81 e8 00 00 restore =============================================================================== 400090ac <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 400090ac: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 400090b0: 90 10 00 18 mov %i0, %o0 400090b4: 40 00 06 46 call 4000a9cc <_Thread_Get> 400090b8: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 400090bc: c2 07 bf fc ld [ %fp + -4 ], %g1 400090c0: 80 a0 60 00 cmp %g1, 0 400090c4: 12 80 00 08 bne 400090e4 <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 400090c8: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 400090cc: 40 00 08 8b call 4000b2f8 <_Thread_queue_Process_timeout> 400090d0: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 400090d4: 03 10 00 65 sethi %hi(0x40019400), %g1 400090d8: c4 00 63 00 ld [ %g1 + 0x300 ], %g2 ! 40019700 <_Thread_Dispatch_disable_level> 400090dc: 84 00 bf ff add %g2, -1, %g2 400090e0: c4 20 63 00 st %g2, [ %g1 + 0x300 ] 400090e4: 81 c7 e0 08 ret 400090e8: 81 e8 00 00 restore =============================================================================== 4000f9d0 <_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 ) { 4000f9d0: 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; 4000f9d4: f4 26 20 44 st %i2, [ %i0 + 0x44 ] the_message_queue->number_of_pending_messages = 0; 4000f9d8: c0 26 20 48 clr [ %i0 + 0x48 ] the_message_queue->maximum_message_size = maximum_message_size; 4000f9dc: 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; 4000f9e0: c0 26 20 60 clr [ %i0 + 0x60 ] the_message_queue->notify_argument = the_argument; 4000f9e4: 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 ) { 4000f9e8: 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)) { 4000f9ec: 80 8e e0 03 btst 3, %i3 4000f9f0: 02 80 00 07 be 4000fa0c <_CORE_message_queue_Initialize+0x3c> 4000f9f4: a4 10 00 1b mov %i3, %l2 allocated_message_size += sizeof(uint32_t); 4000f9f8: a4 06 e0 04 add %i3, 4, %l2 allocated_message_size &= ~(sizeof(uint32_t) - 1); 4000f9fc: a4 0c bf fc and %l2, -4, %l2 } if (allocated_message_size < maximum_message_size) 4000fa00: 80 a4 80 1b cmp %l2, %i3 4000fa04: 0a 80 00 22 bcs 4000fa8c <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 4000fa08: 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)); 4000fa0c: 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 * 4000fa10: 92 10 00 1a mov %i2, %o1 4000fa14: 90 10 00 11 mov %l1, %o0 4000fa18: 40 00 42 94 call 40020468 <.umul> 4000fa1c: b0 10 20 00 clr %i0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 4000fa20: 80 a2 00 12 cmp %o0, %l2 4000fa24: 0a 80 00 1a bcs 4000fa8c <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 4000fa28: 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 ); 4000fa2c: 40 00 0c 3a call 40012b14 <_Workspace_Allocate> 4000fa30: 01 00 00 00 nop return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 4000fa34: d0 24 20 5c st %o0, [ %l0 + 0x5c ] _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 4000fa38: 80 a2 20 00 cmp %o0, 0 4000fa3c: 02 80 00 14 be 4000fa8c <_CORE_message_queue_Initialize+0xbc> 4000fa40: 92 10 00 08 mov %o0, %o1 /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 4000fa44: 90 04 20 68 add %l0, 0x68, %o0 4000fa48: 94 10 00 1a mov %i2, %o2 4000fa4c: 40 00 16 73 call 40015418 <_Chain_Initialize> 4000fa50: 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 ); 4000fa54: 82 04 20 54 add %l0, 0x54, %g1 head->next = tail; 4000fa58: 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 ); 4000fa5c: 82 04 20 50 add %l0, 0x50, %g1 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 4000fa60: c0 24 20 54 clr [ %l0 + 0x54 ] tail->previous = head; 4000fa64: 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( 4000fa68: c2 06 40 00 ld [ %i1 ], %g1 4000fa6c: 90 10 00 10 mov %l0, %o0 4000fa70: 82 18 60 01 xor %g1, 1, %g1 4000fa74: 80 a0 00 01 cmp %g0, %g1 4000fa78: 94 10 20 80 mov 0x80, %o2 4000fa7c: 92 60 3f ff subx %g0, -1, %o1 4000fa80: 96 10 20 06 mov 6, %o3 4000fa84: 40 00 09 9c call 400120f4 <_Thread_queue_Initialize> 4000fa88: b0 10 20 01 mov 1, %i0 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 4000fa8c: 81 c7 e0 08 ret 4000fa90: 81 e8 00 00 restore =============================================================================== 4000fa94 <_CORE_message_queue_Seize>: void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4000fa94: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 4000fa98: 27 10 00 99 sethi %hi(0x40026400), %l3 4000fa9c: a6 14 e2 88 or %l3, 0x288, %l3 ! 40026688 <_Per_CPU_Information> 4000faa0: e4 04 e0 0c ld [ %l3 + 0xc ], %l2 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4000faa4: 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; 4000faa8: c0 24 a0 34 clr [ %l2 + 0x34 ] _ISR_Disable( level ); 4000faac: 7f ff de 09 call 400072d0 4000fab0: a2 10 00 19 mov %i1, %l1 4000fab4: 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 ); } 4000fab8: 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 ); 4000fabc: 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)) 4000fac0: 80 a6 40 02 cmp %i1, %g2 4000fac4: 02 80 00 24 be 4000fb54 <_CORE_message_queue_Seize+0xc0> 4000fac8: 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; 4000facc: c4 06 40 00 ld [ %i1 ], %g2 head->next = new_first; 4000fad0: 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 ) { 4000fad4: 80 a6 60 00 cmp %i1, 0 4000fad8: 02 80 00 1f be 4000fb54 <_CORE_message_queue_Seize+0xc0> <== NEVER TAKEN 4000fadc: c6 20 a0 04 st %g3, [ %g2 + 4 ] the_message_queue->number_of_pending_messages -= 1; 4000fae0: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 4000fae4: 82 00 7f ff add %g1, -1, %g1 4000fae8: c2 26 20 48 st %g1, [ %i0 + 0x48 ] _ISR_Enable( level ); 4000faec: 7f ff dd fd call 400072e0 4000faf0: a2 06 60 10 add %i1, 0x10, %l1 *size_p = the_message->Contents.size; 4000faf4: d4 06 60 0c ld [ %i1 + 0xc ], %o2 _Thread_Executing->Wait.count = 4000faf8: 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; 4000fafc: d4 26 c0 00 st %o2, [ %i3 ] _Thread_Executing->Wait.count = 4000fb00: c4 06 60 08 ld [ %i1 + 8 ], %g2 4000fb04: c4 20 60 24 st %g2, [ %g1 + 0x24 ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4000fb08: 92 10 00 11 mov %l1, %o1 4000fb0c: 40 00 21 e9 call 400182b0 4000fb10: 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 ); 4000fb14: 40 00 08 6b call 40011cc0 <_Thread_queue_Dequeue> 4000fb18: 90 10 00 18 mov %i0, %o0 if ( !the_thread ) { 4000fb1c: 82 92 20 00 orcc %o0, 0, %g1 4000fb20: 32 80 00 04 bne,a 4000fb30 <_CORE_message_queue_Seize+0x9c> 4000fb24: 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 ); 4000fb28: 7f ff ff 7a call 4000f910 <_Chain_Append> 4000fb2c: 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; 4000fb30: d4 00 60 30 ld [ %g1 + 0x30 ], %o2 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4000fb34: 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; 4000fb38: c4 26 60 08 st %g2, [ %i1 + 8 ] 4000fb3c: d4 26 60 0c st %o2, [ %i1 + 0xc ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4000fb40: 40 00 21 dc call 400182b0 4000fb44: 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( 4000fb48: f4 06 60 08 ld [ %i1 + 8 ], %i2 4000fb4c: 40 00 16 41 call 40015450 <_CORE_message_queue_Insert_message> 4000fb50: 81 e8 00 00 restore return; } #endif } if ( !wait ) { 4000fb54: 80 8f 20 ff btst 0xff, %i4 4000fb58: 32 80 00 08 bne,a 4000fb78 <_CORE_message_queue_Seize+0xe4> 4000fb5c: 84 10 20 01 mov 1, %g2 _ISR_Enable( level ); 4000fb60: 7f ff dd e0 call 400072e0 4000fb64: 90 10 00 01 mov %g1, %o0 executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 4000fb68: 82 10 20 04 mov 4, %g1 4000fb6c: 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 ); } 4000fb70: 81 c7 e0 08 ret 4000fb74: 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; 4000fb78: 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; 4000fb7c: e0 24 a0 44 st %l0, [ %l2 + 0x44 ] executing->Wait.id = id; 4000fb80: e2 24 a0 20 st %l1, [ %l2 + 0x20 ] executing->Wait.return_argument_second.mutable_object = buffer; 4000fb84: f4 24 a0 2c st %i2, [ %l2 + 0x2c ] executing->Wait.return_argument = size_p; 4000fb88: f6 24 a0 28 st %i3, [ %l2 + 0x28 ] /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 4000fb8c: 90 10 00 01 mov %g1, %o0 4000fb90: 7f ff dd d4 call 400072e0 4000fb94: 35 10 00 48 sethi %hi(0x40012000), %i2 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 4000fb98: b0 10 00 10 mov %l0, %i0 4000fb9c: b2 10 00 1d mov %i5, %i1 4000fba0: 40 00 08 ab call 40011e4c <_Thread_queue_Enqueue_with_handler> 4000fba4: 95 ee a1 d4 restore %i2, 0x1d4, %o2 =============================================================================== 40006844 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 40006844: 9d e3 bf a0 save %sp, -96, %sp _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 40006848: 03 10 00 55 sethi %hi(0x40015400), %g1 4000684c: c2 00 61 c0 ld [ %g1 + 0x1c0 ], %g1 ! 400155c0 <_Thread_Dispatch_disable_level> 40006850: 80 a0 60 00 cmp %g1, 0 40006854: 02 80 00 0d be 40006888 <_CORE_mutex_Seize+0x44> 40006858: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 4000685c: 80 8e a0 ff btst 0xff, %i2 40006860: 02 80 00 0b be 4000688c <_CORE_mutex_Seize+0x48> <== NEVER TAKEN 40006864: 90 10 00 18 mov %i0, %o0 40006868: 03 10 00 55 sethi %hi(0x40015400), %g1 4000686c: c2 00 63 18 ld [ %g1 + 0x318 ], %g1 ! 40015718 <_System_state_Current> 40006870: 80 a0 60 01 cmp %g1, 1 40006874: 08 80 00 05 bleu 40006888 <_CORE_mutex_Seize+0x44> 40006878: 90 10 20 00 clr %o0 4000687c: 92 10 20 00 clr %o1 40006880: 40 00 01 da call 40006fe8 <_Internal_error_Occurred> 40006884: 94 10 20 12 mov 0x12, %o2 40006888: 90 10 00 18 mov %i0, %o0 4000688c: 40 00 15 64 call 4000be1c <_CORE_mutex_Seize_interrupt_trylock> 40006890: 92 07 a0 54 add %fp, 0x54, %o1 40006894: 80 a2 20 00 cmp %o0, 0 40006898: 02 80 00 0a be 400068c0 <_CORE_mutex_Seize+0x7c> 4000689c: 80 8e a0 ff btst 0xff, %i2 400068a0: 35 10 00 56 sethi %hi(0x40015800), %i2 400068a4: 12 80 00 09 bne 400068c8 <_CORE_mutex_Seize+0x84> 400068a8: b4 16 a2 f8 or %i2, 0x2f8, %i2 ! 40015af8 <_Per_CPU_Information> 400068ac: 7f ff ed 07 call 40001cc8 400068b0: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 400068b4: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 400068b8: 84 10 20 01 mov 1, %g2 400068bc: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 400068c0: 81 c7 e0 08 ret 400068c4: 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; 400068c8: 82 10 20 01 mov 1, %g1 400068cc: c2 26 20 30 st %g1, [ %i0 + 0x30 ] 400068d0: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 400068d4: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 400068d8: f2 20 60 20 st %i1, [ %g1 + 0x20 ] 400068dc: 03 10 00 55 sethi %hi(0x40015400), %g1 400068e0: c4 00 61 c0 ld [ %g1 + 0x1c0 ], %g2 ! 400155c0 <_Thread_Dispatch_disable_level> 400068e4: 84 00 a0 01 inc %g2 400068e8: c4 20 61 c0 st %g2, [ %g1 + 0x1c0 ] 400068ec: 7f ff ec f7 call 40001cc8 400068f0: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 400068f4: 90 10 00 18 mov %i0, %o0 400068f8: 7f ff ff ba call 400067e0 <_CORE_mutex_Seize_interrupt_blocking> 400068fc: 92 10 00 1b mov %i3, %o1 40006900: 81 c7 e0 08 ret 40006904: 81 e8 00 00 restore =============================================================================== 40006a84 <_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 ) { 40006a84: 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)) ) { 40006a88: 90 10 00 18 mov %i0, %o0 40006a8c: 40 00 07 06 call 400086a4 <_Thread_queue_Dequeue> 40006a90: a0 10 00 18 mov %i0, %l0 40006a94: 80 a2 20 00 cmp %o0, 0 40006a98: 12 80 00 0e bne 40006ad0 <_CORE_semaphore_Surrender+0x4c> 40006a9c: 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 ); 40006aa0: 7f ff ec 86 call 40001cb8 40006aa4: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 40006aa8: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40006aac: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 40006ab0: 80 a0 40 02 cmp %g1, %g2 40006ab4: 1a 80 00 05 bcc 40006ac8 <_CORE_semaphore_Surrender+0x44> <== NEVER TAKEN 40006ab8: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 40006abc: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 40006ac0: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 40006ac4: c2 24 20 48 st %g1, [ %l0 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 40006ac8: 7f ff ec 80 call 40001cc8 40006acc: 01 00 00 00 nop } return status; } 40006ad0: 81 c7 e0 08 ret 40006ad4: 81 e8 00 00 restore =============================================================================== 400057cc <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 400057cc: 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 ]; 400057d0: e2 06 21 54 ld [ %i0 + 0x154 ], %l1 option_set = (rtems_option) the_thread->Wait.option; 400057d4: e4 06 20 30 ld [ %i0 + 0x30 ], %l2 _ISR_Disable( level ); 400057d8: 7f ff f1 38 call 40001cb8 400057dc: a0 10 00 18 mov %i0, %l0 400057e0: b0 10 00 08 mov %o0, %i0 pending_events = api->pending_events; 400057e4: c4 04 40 00 ld [ %l1 ], %g2 event_condition = (rtems_event_set) the_thread->Wait.count; 400057e8: 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 ) ) { 400057ec: 82 88 c0 02 andcc %g3, %g2, %g1 400057f0: 12 80 00 03 bne 400057fc <_Event_Surrender+0x30> 400057f4: 09 10 00 56 sethi %hi(0x40015800), %g4 _ISR_Enable( level ); 400057f8: 30 80 00 42 b,a 40005900 <_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() && 400057fc: 88 11 22 f8 or %g4, 0x2f8, %g4 ! 40015af8 <_Per_CPU_Information> 40005800: da 01 20 08 ld [ %g4 + 8 ], %o5 40005804: 80 a3 60 00 cmp %o5, 0 40005808: 22 80 00 1d be,a 4000587c <_Event_Surrender+0xb0> 4000580c: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 40005810: c8 01 20 0c ld [ %g4 + 0xc ], %g4 40005814: 80 a4 00 04 cmp %l0, %g4 40005818: 32 80 00 19 bne,a 4000587c <_Event_Surrender+0xb0> 4000581c: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 40005820: 09 10 00 57 sethi %hi(0x40015c00), %g4 40005824: da 01 22 f0 ld [ %g4 + 0x2f0 ], %o5 ! 40015ef0 <_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 ) && 40005828: 80 a3 60 02 cmp %o5, 2 4000582c: 02 80 00 07 be 40005848 <_Event_Surrender+0x7c> <== NEVER TAKEN 40005830: 80 a0 40 03 cmp %g1, %g3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 40005834: c8 01 22 f0 ld [ %g4 + 0x2f0 ], %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) || 40005838: 80 a1 20 01 cmp %g4, 1 4000583c: 32 80 00 10 bne,a 4000587c <_Event_Surrender+0xb0> 40005840: 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) ) { 40005844: 80 a0 40 03 cmp %g1, %g3 40005848: 02 80 00 04 be 40005858 <_Event_Surrender+0x8c> 4000584c: 80 8c a0 02 btst 2, %l2 40005850: 02 80 00 0a be 40005878 <_Event_Surrender+0xac> <== NEVER TAKEN 40005854: 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) ); 40005858: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 4000585c: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005860: 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; 40005864: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40005868: c2 20 80 00 st %g1, [ %g2 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 4000586c: 84 10 20 03 mov 3, %g2 40005870: 03 10 00 57 sethi %hi(0x40015c00), %g1 40005874: c4 20 62 f0 st %g2, [ %g1 + 0x2f0 ] ! 40015ef0 <_Event_Sync_state> } _ISR_Enable( level ); 40005878: 30 80 00 22 b,a 40005900 <_Event_Surrender+0x134> } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 4000587c: 80 89 21 00 btst 0x100, %g4 40005880: 02 80 00 20 be 40005900 <_Event_Surrender+0x134> 40005884: 80 a0 40 03 cmp %g1, %g3 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 40005888: 02 80 00 04 be 40005898 <_Event_Surrender+0xcc> 4000588c: 80 8c a0 02 btst 2, %l2 40005890: 02 80 00 1c be 40005900 <_Event_Surrender+0x134> <== NEVER TAKEN 40005894: 01 00 00 00 nop 40005898: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 4000589c: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 400058a0: 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; 400058a4: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 400058a8: c2 20 80 00 st %g1, [ %g2 ] _ISR_Flash( level ); 400058ac: 7f ff f1 07 call 40001cc8 400058b0: 90 10 00 18 mov %i0, %o0 400058b4: 7f ff f1 01 call 40001cb8 400058b8: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 400058bc: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 400058c0: 80 a0 60 02 cmp %g1, 2 400058c4: 02 80 00 06 be 400058dc <_Event_Surrender+0x110> 400058c8: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 400058cc: 7f ff f0 ff call 40001cc8 400058d0: 90 10 00 18 mov %i0, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 400058d4: 10 80 00 08 b 400058f4 <_Event_Surrender+0x128> 400058d8: 33 04 00 ff sethi %hi(0x1003fc00), %i1 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 400058dc: c2 24 20 50 st %g1, [ %l0 + 0x50 ] _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 400058e0: 7f ff f0 fa call 40001cc8 400058e4: 90 10 00 18 mov %i0, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 400058e8: 40 00 0e 99 call 4000934c <_Watchdog_Remove> 400058ec: 90 04 20 48 add %l0, 0x48, %o0 400058f0: 33 04 00 ff sethi %hi(0x1003fc00), %i1 400058f4: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 400058f8: 40 00 09 d7 call 40008054 <_Thread_Clear_state> 400058fc: 91 e8 00 10 restore %g0, %l0, %o0 _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 40005900: 7f ff f0 f2 call 40001cc8 40005904: 81 e8 00 00 restore =============================================================================== 4000590c <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 4000590c: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 40005910: 90 10 00 18 mov %i0, %o0 40005914: 40 00 0a a4 call 400083a4 <_Thread_Get> 40005918: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000591c: c2 07 bf fc ld [ %fp + -4 ], %g1 40005920: 80 a0 60 00 cmp %g1, 0 40005924: 12 80 00 1c bne 40005994 <_Event_Timeout+0x88> <== NEVER TAKEN 40005928: 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 ); 4000592c: 7f ff f0 e3 call 40001cb8 40005930: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40005934: 03 10 00 56 sethi %hi(0x40015800), %g1 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 40005938: c2 00 63 04 ld [ %g1 + 0x304 ], %g1 ! 40015b04 <_Per_CPU_Information+0xc> 4000593c: 80 a4 00 01 cmp %l0, %g1 40005940: 12 80 00 09 bne 40005964 <_Event_Timeout+0x58> 40005944: c0 24 20 24 clr [ %l0 + 0x24 ] if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 40005948: 03 10 00 57 sethi %hi(0x40015c00), %g1 4000594c: c4 00 62 f0 ld [ %g1 + 0x2f0 ], %g2 ! 40015ef0 <_Event_Sync_state> 40005950: 80 a0 a0 01 cmp %g2, 1 40005954: 32 80 00 05 bne,a 40005968 <_Event_Timeout+0x5c> 40005958: 82 10 20 06 mov 6, %g1 _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 4000595c: 84 10 20 02 mov 2, %g2 40005960: c4 20 62 f0 st %g2, [ %g1 + 0x2f0 ] } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40005964: 82 10 20 06 mov 6, %g1 40005968: c2 24 20 34 st %g1, [ %l0 + 0x34 ] _ISR_Enable( level ); 4000596c: 7f ff f0 d7 call 40001cc8 40005970: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40005974: 90 10 00 10 mov %l0, %o0 40005978: 13 04 00 ff sethi %hi(0x1003fc00), %o1 4000597c: 40 00 09 b6 call 40008054 <_Thread_Clear_state> 40005980: 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; 40005984: 03 10 00 55 sethi %hi(0x40015400), %g1 40005988: c4 00 61 c0 ld [ %g1 + 0x1c0 ], %g2 ! 400155c0 <_Thread_Dispatch_disable_level> 4000598c: 84 00 bf ff add %g2, -1, %g2 40005990: c4 20 61 c0 st %g2, [ %g1 + 0x1c0 ] 40005994: 81 c7 e0 08 ret 40005998: 81 e8 00 00 restore =============================================================================== 4000c48c <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000c48c: 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; 4000c490: c0 27 bf fc clr [ %fp + -4 ] Heap_Block *extend_last_block = NULL; 4000c494: 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 ) { 4000c498: a0 10 00 18 mov %i0, %l0 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4000c49c: 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; 4000c4a0: e6 06 20 10 ld [ %i0 + 0x10 ], %l3 uintptr_t const min_block_size = heap->min_block_size; 4000c4a4: 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; 4000c4a8: a2 06 40 1a add %i1, %i2, %l1 uintptr_t const free_size = stats->free_size; 4000c4ac: 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 ) { 4000c4b0: 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 ) { 4000c4b4: 80 a4 40 19 cmp %l1, %i1 4000c4b8: 0a 80 00 9f bcs 4000c734 <_Heap_Extend+0x2a8> 4000c4bc: b0 10 20 00 clr %i0 return false; } extend_area_ok = _Heap_Get_first_and_last_block( 4000c4c0: 90 10 00 19 mov %i1, %o0 4000c4c4: 94 10 00 13 mov %l3, %o2 4000c4c8: 98 07 bf fc add %fp, -4, %o4 4000c4cc: 7f ff ea e3 call 40007058 <_Heap_Get_first_and_last_block> 4000c4d0: 9a 07 bf f8 add %fp, -8, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4000c4d4: 80 8a 20 ff btst 0xff, %o0 4000c4d8: 02 80 00 97 be 4000c734 <_Heap_Extend+0x2a8> 4000c4dc: aa 10 00 12 mov %l2, %l5 4000c4e0: ba 10 20 00 clr %i5 4000c4e4: b8 10 20 00 clr %i4 4000c4e8: b0 10 20 00 clr %i0 4000c4ec: ae 10 20 00 clr %l7 4000c4f0: 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 ( 4000c4f4: 80 a0 40 11 cmp %g1, %l1 4000c4f8: 1a 80 00 05 bcc 4000c50c <_Heap_Extend+0x80> 4000c4fc: ec 05 40 00 ld [ %l5 ], %l6 4000c500: 80 a6 40 16 cmp %i1, %l6 4000c504: 2a 80 00 8c bcs,a 4000c734 <_Heap_Extend+0x2a8> 4000c508: 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 ) { 4000c50c: 80 a4 40 01 cmp %l1, %g1 4000c510: 02 80 00 06 be 4000c528 <_Heap_Extend+0x9c> 4000c514: 80 a4 40 16 cmp %l1, %l6 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4000c518: 2a 80 00 05 bcs,a 4000c52c <_Heap_Extend+0xa0> 4000c51c: b8 10 00 15 mov %l5, %i4 4000c520: 10 80 00 04 b 4000c530 <_Heap_Extend+0xa4> 4000c524: 90 10 00 16 mov %l6, %o0 4000c528: ae 10 00 15 mov %l5, %l7 4000c52c: 90 10 00 16 mov %l6, %o0 4000c530: 40 00 17 70 call 400122f0 <.urem> 4000c534: 92 10 00 13 mov %l3, %o1 4000c538: b4 05 bf f8 add %l6, -8, %i2 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000c53c: 80 a5 80 19 cmp %l6, %i1 4000c540: 12 80 00 05 bne 4000c554 <_Heap_Extend+0xc8> 4000c544: 90 26 80 08 sub %i2, %o0, %o0 start_block->prev_size = extend_area_end; 4000c548: 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 ) 4000c54c: 10 80 00 04 b 4000c55c <_Heap_Extend+0xd0> 4000c550: b0 10 00 08 mov %o0, %i0 merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4000c554: 2a 80 00 02 bcs,a 4000c55c <_Heap_Extend+0xd0> 4000c558: 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; 4000c55c: ea 02 20 04 ld [ %o0 + 4 ], %l5 4000c560: 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); 4000c564: 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 ); 4000c568: 80 a5 40 12 cmp %l5, %l2 4000c56c: 12 bf ff e2 bne 4000c4f4 <_Heap_Extend+0x68> 4000c570: 82 10 00 15 mov %l5, %g1 if ( extend_area_begin < heap->area_begin ) { 4000c574: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000c578: 80 a6 40 01 cmp %i1, %g1 4000c57c: 3a 80 00 04 bcc,a 4000c58c <_Heap_Extend+0x100> 4000c580: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 4000c584: 10 80 00 05 b 4000c598 <_Heap_Extend+0x10c> 4000c588: f2 24 20 18 st %i1, [ %l0 + 0x18 ] } else if ( heap->area_end < extend_area_end ) { 4000c58c: 80 a0 40 11 cmp %g1, %l1 4000c590: 2a 80 00 02 bcs,a 4000c598 <_Heap_Extend+0x10c> 4000c594: 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; 4000c598: c4 07 bf fc ld [ %fp + -4 ], %g2 4000c59c: c2 07 bf f8 ld [ %fp + -8 ], %g1 extend_first_block->prev_size = extend_area_end; 4000c5a0: 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 = 4000c5a4: 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; 4000c5a8: 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; 4000c5ac: 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 = 4000c5b0: 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 ) { 4000c5b4: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 4000c5b8: 80 a0 c0 02 cmp %g3, %g2 4000c5bc: 08 80 00 04 bleu 4000c5cc <_Heap_Extend+0x140> 4000c5c0: c0 20 60 04 clr [ %g1 + 4 ] heap->first_block = extend_first_block; 4000c5c4: 10 80 00 06 b 4000c5dc <_Heap_Extend+0x150> 4000c5c8: c4 24 20 20 st %g2, [ %l0 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 4000c5cc: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 4000c5d0: 80 a0 80 01 cmp %g2, %g1 4000c5d4: 2a 80 00 02 bcs,a 4000c5dc <_Heap_Extend+0x150> 4000c5d8: c2 24 20 24 st %g1, [ %l0 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000c5dc: 80 a5 e0 00 cmp %l7, 0 4000c5e0: 02 80 00 14 be 4000c630 <_Heap_Extend+0x1a4> 4000c5e4: 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; 4000c5e8: 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; 4000c5ec: 92 10 00 12 mov %l2, %o1 4000c5f0: 40 00 17 40 call 400122f0 <.urem> 4000c5f4: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 4000c5f8: 80 a2 20 00 cmp %o0, 0 4000c5fc: 02 80 00 04 be 4000c60c <_Heap_Extend+0x180> 4000c600: c2 05 c0 00 ld [ %l7 ], %g1 return value - remainder + alignment; 4000c604: b2 06 40 12 add %i1, %l2, %i1 4000c608: b2 26 40 08 sub %i1, %o0, %i1 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 = 4000c60c: 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; 4000c610: 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 = 4000c614: 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; 4000c618: 82 10 60 01 or %g1, 1, %g1 _Heap_Free_block( heap, new_first_block ); 4000c61c: 90 10 00 10 mov %l0, %o0 4000c620: 7f ff ff 90 call 4000c460 <_Heap_Free_block> 4000c624: c2 22 60 04 st %g1, [ %o1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000c628: 10 80 00 09 b 4000c64c <_Heap_Extend+0x1c0> 4000c62c: 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 ) { 4000c630: 80 a7 20 00 cmp %i4, 0 4000c634: 02 80 00 05 be 4000c648 <_Heap_Extend+0x1bc> 4000c638: 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; 4000c63c: b8 27 00 01 sub %i4, %g1, %i4 4000c640: 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 = 4000c644: f8 20 60 04 st %i4, [ %g1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000c648: 80 a6 20 00 cmp %i0, 0 4000c64c: 02 80 00 15 be 4000c6a0 <_Heap_Extend+0x214> 4000c650: 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); 4000c654: 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( 4000c658: a2 24 40 18 sub %l1, %i0, %l1 4000c65c: 40 00 17 25 call 400122f0 <.urem> 4000c660: 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) 4000c664: c4 06 20 04 ld [ %i0 + 4 ], %g2 4000c668: 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 = 4000c66c: 82 04 40 18 add %l1, %i0, %g1 (last_block->size_and_flag - last_block_new_size) 4000c670: 84 20 80 11 sub %g2, %l1, %g2 | HEAP_PREV_BLOCK_USED; 4000c674: 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 = 4000c678: 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; 4000c67c: 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 ); 4000c680: 90 10 00 10 mov %l0, %o0 4000c684: 82 08 60 01 and %g1, 1, %g1 4000c688: 92 10 00 18 mov %i0, %o1 block->size_and_flag = size | flag; 4000c68c: a2 14 40 01 or %l1, %g1, %l1 4000c690: 7f ff ff 74 call 4000c460 <_Heap_Free_block> 4000c694: e2 26 20 04 st %l1, [ %i0 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000c698: 10 80 00 0f b 4000c6d4 <_Heap_Extend+0x248> 4000c69c: 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 ) { 4000c6a0: 80 a7 60 00 cmp %i5, 0 4000c6a4: 02 80 00 0b be 4000c6d0 <_Heap_Extend+0x244> 4000c6a8: 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; 4000c6ac: c4 07 60 04 ld [ %i5 + 4 ], %g2 _Heap_Link_above( 4000c6b0: 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 ); 4000c6b4: 86 20 c0 1d sub %g3, %i5, %g3 4000c6b8: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000c6bc: 84 10 c0 02 or %g3, %g2, %g2 4000c6c0: c4 27 60 04 st %g2, [ %i5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4000c6c4: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000c6c8: 84 10 a0 01 or %g2, 1, %g2 4000c6cc: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000c6d0: 80 a6 20 00 cmp %i0, 0 4000c6d4: 32 80 00 09 bne,a 4000c6f8 <_Heap_Extend+0x26c> 4000c6d8: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000c6dc: 80 a5 e0 00 cmp %l7, 0 4000c6e0: 32 80 00 06 bne,a 4000c6f8 <_Heap_Extend+0x26c> 4000c6e4: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 4000c6e8: d2 07 bf fc ld [ %fp + -4 ], %o1 4000c6ec: 7f ff ff 5d call 4000c460 <_Heap_Free_block> 4000c6f0: 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 4000c6f4: 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( 4000c6f8: 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; 4000c6fc: 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( 4000c700: 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; 4000c704: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000c708: 84 10 c0 02 or %g3, %g2, %g2 4000c70c: c4 20 60 04 st %g2, [ %g1 + 4 ] } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000c710: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 4000c714: 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; 4000c718: a8 20 40 14 sub %g1, %l4, %l4 /* Statistics */ stats->size += extended_size; 4000c71c: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 if ( extended_size_ptr != NULL ) 4000c720: 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; 4000c724: 82 00 40 14 add %g1, %l4, %g1 if ( extended_size_ptr != NULL ) 4000c728: 02 80 00 03 be 4000c734 <_Heap_Extend+0x2a8> <== NEVER TAKEN 4000c72c: c2 24 20 2c st %g1, [ %l0 + 0x2c ] *extended_size_ptr = extended_size; 4000c730: e8 26 c0 00 st %l4, [ %i3 ] 4000c734: 81 c7 e0 08 ret 4000c738: 81 e8 00 00 restore =============================================================================== 4000c18c <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4000c18c: 9d e3 bf a0 save %sp, -96, %sp 4000c190: a0 10 00 18 mov %i0, %l0 4000c194: 90 10 00 19 mov %i1, %o0 /* * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { 4000c198: 80 a6 60 00 cmp %i1, 0 4000c19c: 02 80 00 78 be 4000c37c <_Heap_Free+0x1f0> 4000c1a0: b0 10 20 01 mov 1, %i0 4000c1a4: d2 04 20 10 ld [ %l0 + 0x10 ], %o1 4000c1a8: 40 00 17 14 call 40011df8 <.urem> 4000c1ac: a2 06 7f f8 add %i1, -8, %l1 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 4000c1b0: d8 04 20 20 ld [ %l0 + 0x20 ], %o4 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4000c1b4: 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; 4000c1b8: 80 a2 00 0c cmp %o0, %o4 4000c1bc: 0a 80 00 05 bcs 4000c1d0 <_Heap_Free+0x44> 4000c1c0: 82 10 20 00 clr %g1 4000c1c4: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000c1c8: 80 a0 40 08 cmp %g1, %o0 4000c1cc: 82 60 3f ff subx %g0, -1, %g1 } alloc_begin = (uintptr_t) alloc_begin_ptr; block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { 4000c1d0: 80 a0 60 00 cmp %g1, 0 4000c1d4: 02 80 00 6a be 4000c37c <_Heap_Free+0x1f0> 4000c1d8: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000c1dc: 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; 4000c1e0: 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); 4000c1e4: 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; 4000c1e8: 80 a0 40 0c cmp %g1, %o4 4000c1ec: 0a 80 00 05 bcs 4000c200 <_Heap_Free+0x74> <== NEVER TAKEN 4000c1f0: 86 10 20 00 clr %g3 4000c1f4: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 4000c1f8: 80 a0 c0 01 cmp %g3, %g1 4000c1fc: 86 60 3f ff subx %g0, -1, %g3 _Heap_Protection_block_check( heap, block ); block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 4000c200: 80 a0 e0 00 cmp %g3, 0 4000c204: 02 80 00 5e be 4000c37c <_Heap_Free+0x1f0> <== NEVER TAKEN 4000c208: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000c20c: c8 00 60 04 ld [ %g1 + 4 ], %g4 return false; } _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_prev_used( next_block ) ) { 4000c210: 80 89 20 01 btst 1, %g4 4000c214: 02 80 00 5a be 4000c37c <_Heap_Free+0x1f0> <== NEVER TAKEN 4000c218: 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 4000c21c: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4000c220: 80 a0 40 09 cmp %g1, %o1 4000c224: 02 80 00 07 be 4000c240 <_Heap_Free+0xb4> 4000c228: 96 10 20 00 clr %o3 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000c22c: 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; 4000c230: c6 00 e0 04 ld [ %g3 + 4 ], %g3 4000c234: 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 )); 4000c238: 80 a0 00 03 cmp %g0, %g3 4000c23c: 96 60 3f ff subx %g0, -1, %o3 if ( !_Heap_Is_prev_used( block ) ) { 4000c240: 80 8b 60 01 btst 1, %o5 4000c244: 12 80 00 26 bne 4000c2dc <_Heap_Free+0x150> 4000c248: 80 8a e0 ff btst 0xff, %o3 uintptr_t const prev_size = block->prev_size; 4000c24c: 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); 4000c250: 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; 4000c254: 80 a0 c0 0c cmp %g3, %o4 4000c258: 0a 80 00 04 bcs 4000c268 <_Heap_Free+0xdc> <== NEVER TAKEN 4000c25c: 94 10 20 00 clr %o2 4000c260: 80 a2 40 03 cmp %o1, %g3 4000c264: 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 ) ) { 4000c268: 80 a2 a0 00 cmp %o2, 0 4000c26c: 02 80 00 44 be 4000c37c <_Heap_Free+0x1f0> <== NEVER TAKEN 4000c270: 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; 4000c274: 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) ) { 4000c278: 80 8b 20 01 btst 1, %o4 4000c27c: 02 80 00 40 be 4000c37c <_Heap_Free+0x1f0> <== NEVER TAKEN 4000c280: 80 8a e0 ff btst 0xff, %o3 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4000c284: 22 80 00 0f be,a 4000c2c0 <_Heap_Free+0x134> 4000c288: 9a 00 80 0d add %g2, %o5, %o5 uintptr_t const size = block_size + prev_size + next_block_size; 4000c28c: 88 00 80 04 add %g2, %g4, %g4 4000c290: 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; 4000c294: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = block->prev; 4000c298: c2 00 60 0c ld [ %g1 + 0xc ], %g1 prev->next = next; 4000c29c: c8 20 60 08 st %g4, [ %g1 + 8 ] next->prev = prev; 4000c2a0: c2 21 20 0c st %g1, [ %g4 + 0xc ] _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4000c2a4: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 4000c2a8: 82 00 7f ff add %g1, -1, %g1 4000c2ac: 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; 4000c2b0: 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; 4000c2b4: 82 13 60 01 or %o5, 1, %g1 4000c2b8: 10 80 00 27 b 4000c354 <_Heap_Free+0x1c8> 4000c2bc: 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; 4000c2c0: 88 13 60 01 or %o5, 1, %g4 4000c2c4: c8 20 e0 04 st %g4, [ %g3 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000c2c8: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = size; 4000c2cc: 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; 4000c2d0: 86 08 ff fe and %g3, -2, %g3 4000c2d4: 10 80 00 20 b 4000c354 <_Heap_Free+0x1c8> 4000c2d8: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4000c2dc: 22 80 00 0d be,a 4000c310 <_Heap_Free+0x184> 4000c2e0: c6 04 20 08 ld [ %l0 + 8 ], %g3 uintptr_t const size = block_size + next_block_size; 4000c2e4: 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; 4000c2e8: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = old_block->prev; 4000c2ec: c2 00 60 0c ld [ %g1 + 0xc ], %g1 new_block->next = next; 4000c2f0: c8 22 20 08 st %g4, [ %o0 + 8 ] new_block->prev = prev; 4000c2f4: c2 22 20 0c st %g1, [ %o0 + 0xc ] next->prev = new_block; prev->next = new_block; 4000c2f8: 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; 4000c2fc: d0 21 20 0c st %o0, [ %g4 + 0xc ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000c300: 82 10 e0 01 or %g3, 1, %g1 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4000c304: 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; 4000c308: 10 80 00 13 b 4000c354 <_Heap_Free+0x1c8> 4000c30c: c2 22 20 04 st %g1, [ %o0 + 4 ] ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 4000c310: e0 22 20 0c st %l0, [ %o0 + 0xc ] Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4000c314: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4000c318: 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; 4000c31c: 86 10 a0 01 or %g2, 1, %g3 4000c320: c6 22 20 04 st %g3, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000c324: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = block_size; 4000c328: 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; 4000c32c: 86 08 ff fe and %g3, -2, %g3 4000c330: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000c334: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 if ( stats->max_free_blocks < stats->free_blocks ) { 4000c338: 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; 4000c33c: 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; 4000c340: d0 24 20 08 st %o0, [ %l0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 4000c344: 80 a0 c0 01 cmp %g3, %g1 4000c348: 1a 80 00 03 bcc 4000c354 <_Heap_Free+0x1c8> 4000c34c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 4000c350: c2 24 20 3c st %g1, [ %l0 + 0x3c ] } } /* Statistics */ --stats->used_blocks; 4000c354: c2 04 20 40 ld [ %l0 + 0x40 ], %g1 ++stats->frees; stats->free_size += block_size; return( true ); 4000c358: b0 10 20 01 mov 1, %i0 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000c35c: 82 00 7f ff add %g1, -1, %g1 4000c360: c2 24 20 40 st %g1, [ %l0 + 0x40 ] ++stats->frees; 4000c364: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 4000c368: 82 00 60 01 inc %g1 4000c36c: c2 24 20 50 st %g1, [ %l0 + 0x50 ] stats->free_size += block_size; 4000c370: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 4000c374: 84 00 40 02 add %g1, %g2, %g2 4000c378: c4 24 20 30 st %g2, [ %l0 + 0x30 ] return( true ); } 4000c37c: 81 c7 e0 08 ret 4000c380: 81 e8 00 00 restore =============================================================================== 4001373c <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 4001373c: 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); 40013740: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 40013744: 7f ff f9 ad call 40011df8 <.urem> 40013748: 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 4001374c: 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); 40013750: a2 06 7f f8 add %i1, -8, %l1 40013754: 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); 40013758: 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; 4001375c: 80 a2 00 02 cmp %o0, %g2 40013760: 0a 80 00 05 bcs 40013774 <_Heap_Size_of_alloc_area+0x38> 40013764: 82 10 20 00 clr %g1 40013768: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 4001376c: 80 a0 40 08 cmp %g1, %o0 40013770: 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 ) ) { 40013774: 80 a0 60 00 cmp %g1, 0 40013778: 02 80 00 15 be 400137cc <_Heap_Size_of_alloc_area+0x90> 4001377c: 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; 40013780: e2 02 20 04 ld [ %o0 + 4 ], %l1 40013784: 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); 40013788: 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; 4001378c: 80 a4 40 02 cmp %l1, %g2 40013790: 0a 80 00 05 bcs 400137a4 <_Heap_Size_of_alloc_area+0x68> <== NEVER TAKEN 40013794: 82 10 20 00 clr %g1 40013798: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4001379c: 80 a0 40 11 cmp %g1, %l1 400137a0: 82 60 3f ff subx %g0, -1, %g1 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 400137a4: 80 a0 60 00 cmp %g1, 0 400137a8: 02 80 00 09 be 400137cc <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 400137ac: 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; 400137b0: c2 04 60 04 ld [ %l1 + 4 ], %g1 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 400137b4: 80 88 60 01 btst 1, %g1 400137b8: 02 80 00 05 be 400137cc <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 400137bc: a2 24 40 19 sub %l1, %i1, %l1 return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; 400137c0: 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; 400137c4: a2 04 60 04 add %l1, 4, %l1 400137c8: e2 26 80 00 st %l1, [ %i2 ] return true; } 400137cc: 81 c7 e0 08 ret 400137d0: 81 e8 00 00 restore =============================================================================== 40007ea0 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40007ea0: 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; 40007ea4: 23 10 00 1f sethi %hi(0x40007c00), %l1 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40007ea8: a0 10 00 18 mov %i0, %l0 uintptr_t const page_size = heap->page_size; 40007eac: e4 06 20 10 ld [ %i0 + 0x10 ], %l2 uintptr_t const min_block_size = heap->min_block_size; 40007eb0: e8 06 20 14 ld [ %i0 + 0x14 ], %l4 Heap_Block *const first_block = heap->first_block; 40007eb4: e6 06 20 20 ld [ %i0 + 0x20 ], %l3 Heap_Block *const last_block = heap->last_block; 40007eb8: 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; 40007ebc: 80 8e a0 ff btst 0xff, %i2 40007ec0: 02 80 00 04 be 40007ed0 <_Heap_Walk+0x30> 40007ec4: a2 14 62 4c or %l1, 0x24c, %l1 40007ec8: 23 10 00 1f sethi %hi(0x40007c00), %l1 40007ecc: a2 14 62 54 or %l1, 0x254, %l1 ! 40007e54 <_Heap_Walk_print> if ( !_System_state_Is_up( _System_state_Get() ) ) { 40007ed0: 03 10 00 5f sethi %hi(0x40017c00), %g1 40007ed4: c2 00 61 f8 ld [ %g1 + 0x1f8 ], %g1 ! 40017df8 <_System_state_Current> 40007ed8: 80 a0 60 03 cmp %g1, 3 40007edc: 12 80 01 2d bne 40008390 <_Heap_Walk+0x4f0> 40007ee0: 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)( 40007ee4: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40007ee8: da 04 20 18 ld [ %l0 + 0x18 ], %o5 40007eec: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007ef0: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007ef4: e6 23 a0 60 st %l3, [ %sp + 0x60 ] 40007ef8: c2 23 a0 68 st %g1, [ %sp + 0x68 ] 40007efc: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40007f00: ea 23 a0 64 st %l5, [ %sp + 0x64 ] 40007f04: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40007f08: 90 10 00 19 mov %i1, %o0 40007f0c: 92 10 20 00 clr %o1 40007f10: 15 10 00 55 sethi %hi(0x40015400), %o2 40007f14: 96 10 00 12 mov %l2, %o3 40007f18: 94 12 a0 c0 or %o2, 0xc0, %o2 40007f1c: 9f c4 40 00 call %l1 40007f20: 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 ) { 40007f24: 80 a4 a0 00 cmp %l2, 0 40007f28: 12 80 00 07 bne 40007f44 <_Heap_Walk+0xa4> 40007f2c: 80 8c a0 07 btst 7, %l2 (*printer)( source, true, "page size is zero\n" ); 40007f30: 15 10 00 55 sethi %hi(0x40015400), %o2 40007f34: 90 10 00 19 mov %i1, %o0 40007f38: 92 10 20 01 mov 1, %o1 40007f3c: 10 80 00 38 b 4000801c <_Heap_Walk+0x17c> 40007f40: 94 12 a1 58 or %o2, 0x158, %o2 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 40007f44: 22 80 00 08 be,a 40007f64 <_Heap_Walk+0xc4> 40007f48: 90 10 00 14 mov %l4, %o0 (*printer)( 40007f4c: 15 10 00 55 sethi %hi(0x40015400), %o2 40007f50: 90 10 00 19 mov %i1, %o0 40007f54: 92 10 20 01 mov 1, %o1 40007f58: 94 12 a1 70 or %o2, 0x170, %o2 40007f5c: 10 80 01 0b b 40008388 <_Heap_Walk+0x4e8> 40007f60: 96 10 00 12 mov %l2, %o3 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40007f64: 7f ff e6 e5 call 40001af8 <.urem> 40007f68: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 40007f6c: 80 a2 20 00 cmp %o0, 0 40007f70: 22 80 00 08 be,a 40007f90 <_Heap_Walk+0xf0> 40007f74: 90 04 e0 08 add %l3, 8, %o0 (*printer)( 40007f78: 15 10 00 55 sethi %hi(0x40015400), %o2 40007f7c: 90 10 00 19 mov %i1, %o0 40007f80: 92 10 20 01 mov 1, %o1 40007f84: 94 12 a1 90 or %o2, 0x190, %o2 40007f88: 10 80 01 00 b 40008388 <_Heap_Walk+0x4e8> 40007f8c: 96 10 00 14 mov %l4, %o3 40007f90: 7f ff e6 da call 40001af8 <.urem> 40007f94: 92 10 00 12 mov %l2, %o1 ); return false; } if ( 40007f98: 80 a2 20 00 cmp %o0, 0 40007f9c: 22 80 00 08 be,a 40007fbc <_Heap_Walk+0x11c> 40007fa0: c2 04 e0 04 ld [ %l3 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 40007fa4: 15 10 00 55 sethi %hi(0x40015400), %o2 40007fa8: 90 10 00 19 mov %i1, %o0 40007fac: 92 10 20 01 mov 1, %o1 40007fb0: 94 12 a1 b8 or %o2, 0x1b8, %o2 40007fb4: 10 80 00 f5 b 40008388 <_Heap_Walk+0x4e8> 40007fb8: 96 10 00 13 mov %l3, %o3 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 40007fbc: 80 88 60 01 btst 1, %g1 40007fc0: 32 80 00 07 bne,a 40007fdc <_Heap_Walk+0x13c> 40007fc4: ec 05 60 04 ld [ %l5 + 4 ], %l6 (*printer)( 40007fc8: 15 10 00 55 sethi %hi(0x40015400), %o2 40007fcc: 90 10 00 19 mov %i1, %o0 40007fd0: 92 10 20 01 mov 1, %o1 40007fd4: 10 80 00 12 b 4000801c <_Heap_Walk+0x17c> 40007fd8: 94 12 a1 f0 or %o2, 0x1f0, %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; 40007fdc: 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); 40007fe0: 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; 40007fe4: c2 05 a0 04 ld [ %l6 + 4 ], %g1 ); return false; } if ( _Heap_Is_free( last_block ) ) { 40007fe8: 80 88 60 01 btst 1, %g1 40007fec: 12 80 00 07 bne 40008008 <_Heap_Walk+0x168> 40007ff0: 80 a5 80 13 cmp %l6, %l3 (*printer)( 40007ff4: 15 10 00 55 sethi %hi(0x40015400), %o2 40007ff8: 90 10 00 19 mov %i1, %o0 40007ffc: 92 10 20 01 mov 1, %o1 40008000: 10 80 00 07 b 4000801c <_Heap_Walk+0x17c> 40008004: 94 12 a2 20 or %o2, 0x220, %o2 ); return false; } if ( 40008008: 02 80 00 08 be 40008028 <_Heap_Walk+0x188> 4000800c: 15 10 00 55 sethi %hi(0x40015400), %o2 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40008010: 90 10 00 19 mov %i1, %o0 40008014: 92 10 20 01 mov 1, %o1 40008018: 94 12 a2 38 or %o2, 0x238, %o2 4000801c: 9f c4 40 00 call %l1 40008020: b0 10 20 00 clr %i0 40008024: 30 80 00 db b,a 40008390 <_Heap_Walk+0x4f0> block = next_block; } while ( block != first_block ); return true; } 40008028: 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; 4000802c: fa 04 20 10 ld [ %l0 + 0x10 ], %i5 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); 40008030: ae 10 00 10 mov %l0, %l7 40008034: 10 80 00 32 b 400080fc <_Heap_Walk+0x25c> 40008038: 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; 4000803c: 80 a0 80 1c cmp %g2, %i4 40008040: 18 80 00 05 bgu 40008054 <_Heap_Walk+0x1b4> 40008044: 82 10 20 00 clr %g1 40008048: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000804c: 80 a0 40 1c cmp %g1, %i4 40008050: 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 ) ) { 40008054: 80 a0 60 00 cmp %g1, 0 40008058: 32 80 00 08 bne,a 40008078 <_Heap_Walk+0x1d8> 4000805c: 90 07 20 08 add %i4, 8, %o0 (*printer)( 40008060: 15 10 00 55 sethi %hi(0x40015400), %o2 40008064: 96 10 00 1c mov %i4, %o3 40008068: 90 10 00 19 mov %i1, %o0 4000806c: 92 10 20 01 mov 1, %o1 40008070: 10 80 00 c6 b 40008388 <_Heap_Walk+0x4e8> 40008074: 94 12 a2 68 or %o2, 0x268, %o2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008078: 7f ff e6 a0 call 40001af8 <.urem> 4000807c: 92 10 00 1d mov %i5, %o1 ); return false; } if ( 40008080: 80 a2 20 00 cmp %o0, 0 40008084: 22 80 00 08 be,a 400080a4 <_Heap_Walk+0x204> 40008088: c2 07 20 04 ld [ %i4 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 4000808c: 15 10 00 55 sethi %hi(0x40015400), %o2 40008090: 96 10 00 1c mov %i4, %o3 40008094: 90 10 00 19 mov %i1, %o0 40008098: 92 10 20 01 mov 1, %o1 4000809c: 10 80 00 bb b 40008388 <_Heap_Walk+0x4e8> 400080a0: 94 12 a2 88 or %o2, 0x288, %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; 400080a4: 82 08 7f fe and %g1, -2, %g1 block = next_block; } while ( block != first_block ); return true; } 400080a8: 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; 400080ac: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 400080b0: 80 88 60 01 btst 1, %g1 400080b4: 22 80 00 08 be,a 400080d4 <_Heap_Walk+0x234> 400080b8: d8 07 20 0c ld [ %i4 + 0xc ], %o4 (*printer)( 400080bc: 15 10 00 55 sethi %hi(0x40015400), %o2 400080c0: 96 10 00 1c mov %i4, %o3 400080c4: 90 10 00 19 mov %i1, %o0 400080c8: 92 10 20 01 mov 1, %o1 400080cc: 10 80 00 af b 40008388 <_Heap_Walk+0x4e8> 400080d0: 94 12 a2 b8 or %o2, 0x2b8, %o2 ); return false; } if ( free_block->prev != prev_block ) { 400080d4: 80 a3 00 17 cmp %o4, %l7 400080d8: 22 80 00 08 be,a 400080f8 <_Heap_Walk+0x258> 400080dc: ae 10 00 1c mov %i4, %l7 (*printer)( 400080e0: 15 10 00 55 sethi %hi(0x40015400), %o2 400080e4: 96 10 00 1c mov %i4, %o3 400080e8: 90 10 00 19 mov %i1, %o0 400080ec: 92 10 20 01 mov 1, %o1 400080f0: 10 80 00 49 b 40008214 <_Heap_Walk+0x374> 400080f4: 94 12 a2 d8 or %o2, 0x2d8, %o2 return false; } prev_block = free_block; free_block = free_block->next; 400080f8: 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 ) { 400080fc: 80 a7 00 10 cmp %i4, %l0 40008100: 32 bf ff cf bne,a 4000803c <_Heap_Walk+0x19c> 40008104: c4 04 20 20 ld [ %l0 + 0x20 ], %g2 40008108: 35 10 00 56 sethi %hi(0x40015800), %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)( 4000810c: 31 10 00 56 sethi %hi(0x40015800), %i0 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40008110: b4 16 a0 98 or %i2, 0x98, %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)( 40008114: b0 16 20 80 or %i0, 0x80, %i0 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40008118: 37 10 00 56 sethi %hi(0x40015800), %i3 block = next_block; } while ( block != first_block ); return true; } 4000811c: 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; 40008120: 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; 40008124: 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); 40008128: 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; 4000812c: 80 a0 c0 1d cmp %g3, %i5 40008130: 18 80 00 05 bgu 40008144 <_Heap_Walk+0x2a4> <== NEVER TAKEN 40008134: 84 10 20 00 clr %g2 40008138: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 4000813c: 80 a0 80 1d cmp %g2, %i5 40008140: 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 ) ) { 40008144: 80 a0 a0 00 cmp %g2, 0 40008148: 12 80 00 07 bne 40008164 <_Heap_Walk+0x2c4> 4000814c: 84 1d 80 15 xor %l6, %l5, %g2 (*printer)( 40008150: 15 10 00 55 sethi %hi(0x40015400), %o2 40008154: 90 10 00 19 mov %i1, %o0 40008158: 92 10 20 01 mov 1, %o1 4000815c: 10 80 00 2c b 4000820c <_Heap_Walk+0x36c> 40008160: 94 12 a3 10 or %o2, 0x310, %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; 40008164: 80 a0 00 02 cmp %g0, %g2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008168: c2 27 bf fc st %g1, [ %fp + -4 ] 4000816c: b8 40 20 00 addx %g0, 0, %i4 40008170: 90 10 00 17 mov %l7, %o0 40008174: 7f ff e6 61 call 40001af8 <.urem> 40008178: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 4000817c: 80 a2 20 00 cmp %o0, 0 40008180: 02 80 00 0c be 400081b0 <_Heap_Walk+0x310> 40008184: c2 07 bf fc ld [ %fp + -4 ], %g1 40008188: 80 8f 20 ff btst 0xff, %i4 4000818c: 02 80 00 0a be 400081b4 <_Heap_Walk+0x314> 40008190: 80 a5 c0 14 cmp %l7, %l4 (*printer)( 40008194: 15 10 00 55 sethi %hi(0x40015400), %o2 40008198: 90 10 00 19 mov %i1, %o0 4000819c: 92 10 20 01 mov 1, %o1 400081a0: 94 12 a3 40 or %o2, 0x340, %o2 400081a4: 96 10 00 16 mov %l6, %o3 400081a8: 10 80 00 1b b 40008214 <_Heap_Walk+0x374> 400081ac: 98 10 00 17 mov %l7, %o4 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 400081b0: 80 a5 c0 14 cmp %l7, %l4 400081b4: 1a 80 00 0d bcc 400081e8 <_Heap_Walk+0x348> 400081b8: 80 a7 40 16 cmp %i5, %l6 400081bc: 80 8f 20 ff btst 0xff, %i4 400081c0: 02 80 00 0a be 400081e8 <_Heap_Walk+0x348> <== NEVER TAKEN 400081c4: 80 a7 40 16 cmp %i5, %l6 (*printer)( 400081c8: 15 10 00 55 sethi %hi(0x40015400), %o2 400081cc: 90 10 00 19 mov %i1, %o0 400081d0: 92 10 20 01 mov 1, %o1 400081d4: 94 12 a3 70 or %o2, 0x370, %o2 400081d8: 96 10 00 16 mov %l6, %o3 400081dc: 98 10 00 17 mov %l7, %o4 400081e0: 10 80 00 3f b 400082dc <_Heap_Walk+0x43c> 400081e4: 9a 10 00 14 mov %l4, %o5 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 400081e8: 38 80 00 0e bgu,a 40008220 <_Heap_Walk+0x380> 400081ec: b8 08 60 01 and %g1, 1, %i4 400081f0: 80 8f 20 ff btst 0xff, %i4 400081f4: 02 80 00 0b be 40008220 <_Heap_Walk+0x380> 400081f8: b8 08 60 01 and %g1, 1, %i4 (*printer)( 400081fc: 15 10 00 55 sethi %hi(0x40015400), %o2 40008200: 90 10 00 19 mov %i1, %o0 40008204: 92 10 20 01 mov 1, %o1 40008208: 94 12 a3 a0 or %o2, 0x3a0, %o2 4000820c: 96 10 00 16 mov %l6, %o3 40008210: 98 10 00 1d mov %i5, %o4 40008214: 9f c4 40 00 call %l1 40008218: b0 10 20 00 clr %i0 4000821c: 30 80 00 5d b,a 40008390 <_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; 40008220: c2 07 60 04 ld [ %i5 + 4 ], %g1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 40008224: 80 88 60 01 btst 1, %g1 40008228: 12 80 00 3f bne 40008324 <_Heap_Walk+0x484> 4000822c: 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 ? 40008230: 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)( 40008234: c2 04 20 08 ld [ %l0 + 8 ], %g1 40008238: 05 10 00 55 sethi %hi(0x40015400), %g2 block = next_block; } while ( block != first_block ); return true; } 4000823c: 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)( 40008240: 80 a3 40 01 cmp %o5, %g1 40008244: 02 80 00 07 be 40008260 <_Heap_Walk+0x3c0> 40008248: 86 10 a0 80 or %g2, 0x80, %g3 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 4000824c: 80 a3 40 10 cmp %o5, %l0 40008250: 12 80 00 04 bne 40008260 <_Heap_Walk+0x3c0> 40008254: 86 16 e0 48 or %i3, 0x48, %g3 40008258: 19 10 00 55 sethi %hi(0x40015400), %o4 4000825c: 86 13 20 90 or %o4, 0x90, %g3 ! 40015490 <_Status_Object_name_errors_to_status+0x48> block->next, block->next == last_free_block ? 40008260: 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)( 40008264: 19 10 00 55 sethi %hi(0x40015400), %o4 40008268: 80 a0 80 04 cmp %g2, %g4 4000826c: 02 80 00 07 be 40008288 <_Heap_Walk+0x3e8> 40008270: 82 13 20 a0 or %o4, 0xa0, %g1 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40008274: 80 a0 80 10 cmp %g2, %l0 40008278: 12 80 00 04 bne 40008288 <_Heap_Walk+0x3e8> 4000827c: 82 16 e0 48 or %i3, 0x48, %g1 40008280: 09 10 00 55 sethi %hi(0x40015400), %g4 40008284: 82 11 20 b0 or %g4, 0xb0, %g1 ! 400154b0 <_Status_Object_name_errors_to_status+0x68> 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)( 40008288: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 4000828c: c4 23 a0 60 st %g2, [ %sp + 0x60 ] 40008290: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40008294: 90 10 00 19 mov %i1, %o0 40008298: 92 10 20 00 clr %o1 4000829c: 15 10 00 55 sethi %hi(0x40015400), %o2 400082a0: 96 10 00 16 mov %l6, %o3 400082a4: 94 12 a3 d8 or %o2, 0x3d8, %o2 400082a8: 9f c4 40 00 call %l1 400082ac: 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 ) { 400082b0: da 07 40 00 ld [ %i5 ], %o5 400082b4: 80 a5 c0 0d cmp %l7, %o5 400082b8: 02 80 00 0c be 400082e8 <_Heap_Walk+0x448> 400082bc: 80 a7 20 00 cmp %i4, 0 (*printer)( 400082c0: 15 10 00 56 sethi %hi(0x40015800), %o2 400082c4: fa 23 a0 5c st %i5, [ %sp + 0x5c ] 400082c8: 90 10 00 19 mov %i1, %o0 400082cc: 92 10 20 01 mov 1, %o1 400082d0: 94 12 a0 10 or %o2, 0x10, %o2 400082d4: 96 10 00 16 mov %l6, %o3 400082d8: 98 10 00 17 mov %l7, %o4 400082dc: 9f c4 40 00 call %l1 400082e0: b0 10 20 00 clr %i0 400082e4: 30 80 00 2b b,a 40008390 <_Heap_Walk+0x4f0> ); return false; } if ( !prev_used ) { 400082e8: 32 80 00 0a bne,a 40008310 <_Heap_Walk+0x470> 400082ec: c2 04 20 08 ld [ %l0 + 8 ], %g1 (*printer)( 400082f0: 15 10 00 56 sethi %hi(0x40015800), %o2 400082f4: 90 10 00 19 mov %i1, %o0 400082f8: 92 10 20 01 mov 1, %o1 400082fc: 10 80 00 22 b 40008384 <_Heap_Walk+0x4e4> 40008300: 94 12 a0 50 or %o2, 0x50, %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 ) { 40008304: 02 80 00 19 be 40008368 <_Heap_Walk+0x4c8> 40008308: 80 a7 40 13 cmp %i5, %l3 return true; } free_block = free_block->next; 4000830c: 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 ) { 40008310: 80 a0 40 10 cmp %g1, %l0 40008314: 12 bf ff fc bne 40008304 <_Heap_Walk+0x464> 40008318: 80 a0 40 16 cmp %g1, %l6 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 4000831c: 10 80 00 17 b 40008378 <_Heap_Walk+0x4d8> 40008320: 15 10 00 56 sethi %hi(0x40015800), %o2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 40008324: 22 80 00 0a be,a 4000834c <_Heap_Walk+0x4ac> 40008328: da 05 80 00 ld [ %l6 ], %o5 (*printer)( 4000832c: 90 10 00 19 mov %i1, %o0 40008330: 92 10 20 00 clr %o1 40008334: 94 10 00 18 mov %i0, %o2 40008338: 96 10 00 16 mov %l6, %o3 4000833c: 9f c4 40 00 call %l1 40008340: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 40008344: 10 80 00 09 b 40008368 <_Heap_Walk+0x4c8> 40008348: 80 a7 40 13 cmp %i5, %l3 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 4000834c: 90 10 00 19 mov %i1, %o0 40008350: 92 10 20 00 clr %o1 40008354: 94 10 00 1a mov %i2, %o2 40008358: 96 10 00 16 mov %l6, %o3 4000835c: 9f c4 40 00 call %l1 40008360: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 40008364: 80 a7 40 13 cmp %i5, %l3 40008368: 12 bf ff 6d bne 4000811c <_Heap_Walk+0x27c> 4000836c: ac 10 00 1d mov %i5, %l6 return true; } 40008370: 81 c7 e0 08 ret 40008374: 91 e8 20 01 restore %g0, 1, %o0 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 40008378: 90 10 00 19 mov %i1, %o0 4000837c: 92 10 20 01 mov 1, %o1 40008380: 94 12 a0 c0 or %o2, 0xc0, %o2 40008384: 96 10 00 16 mov %l6, %o3 40008388: 9f c4 40 00 call %l1 4000838c: b0 10 20 00 clr %i0 40008390: 81 c7 e0 08 ret 40008394: 81 e8 00 00 restore =============================================================================== 40006fe8 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40006fe8: 9d e3 bf a0 save %sp, -96, %sp _Internal_errors_What_happened.the_source = the_source; 40006fec: 05 10 00 55 sethi %hi(0x40015400), %g2 40006ff0: 82 10 a2 54 or %g2, 0x254, %g1 ! 40015654 <_Internal_errors_What_happened> void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40006ff4: 90 10 00 18 mov %i0, %o0 40006ff8: 94 10 00 1a mov %i2, %o2 _Internal_errors_What_happened.the_source = the_source; 40006ffc: f0 20 a2 54 st %i0, [ %g2 + 0x254 ] _Internal_errors_What_happened.is_internal = is_internal; 40007000: f2 28 60 04 stb %i1, [ %g1 + 4 ] _Internal_errors_What_happened.the_error = the_error; 40007004: f4 20 60 08 st %i2, [ %g1 + 8 ] _User_extensions_Fatal( the_source, is_internal, the_error ); 40007008: 40 00 08 17 call 40009064 <_User_extensions_Fatal> 4000700c: 92 0e 60 ff and %i1, 0xff, %o1 RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 40007010: 84 10 20 05 mov 5, %g2 <== NOT EXECUTED 40007014: 03 10 00 55 sethi %hi(0x40015400), %g1 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 40007018: 7f ff eb 28 call 40001cb8 <== NOT EXECUTED 4000701c: c4 20 63 18 st %g2, [ %g1 + 0x318 ] ! 40015718 <_System_state_Current><== NOT EXECUTED 40007020: 82 10 00 08 mov %o0, %g1 <== NOT EXECUTED 40007024: 30 80 00 00 b,a 40007024 <_Internal_error_Occurred+0x3c> <== NOT EXECUTED =============================================================================== 40007098 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007098: 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 ) 4000709c: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 400070a0: 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 ) 400070a4: 80 a0 60 00 cmp %g1, 0 400070a8: 02 80 00 20 be 40007128 <_Objects_Allocate+0x90> <== NEVER TAKEN 400070ac: 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 ); 400070b0: a2 04 20 20 add %l0, 0x20, %l1 400070b4: 7f ff fd 8b call 400066e0 <_Chain_Get> 400070b8: 90 10 00 11 mov %l1, %o0 if ( information->auto_extend ) { 400070bc: c2 0c 20 12 ldub [ %l0 + 0x12 ], %g1 400070c0: 80 a0 60 00 cmp %g1, 0 400070c4: 02 80 00 19 be 40007128 <_Objects_Allocate+0x90> 400070c8: 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 ) { 400070cc: 80 a2 20 00 cmp %o0, 0 400070d0: 32 80 00 0a bne,a 400070f8 <_Objects_Allocate+0x60> 400070d4: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 _Objects_Extend_information( information ); 400070d8: 40 00 00 1e call 40007150 <_Objects_Extend_information> 400070dc: 90 10 00 10 mov %l0, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 400070e0: 7f ff fd 80 call 400066e0 <_Chain_Get> 400070e4: 90 10 00 11 mov %l1, %o0 } if ( the_object ) { 400070e8: b0 92 20 00 orcc %o0, 0, %i0 400070ec: 02 80 00 0f be 40007128 <_Objects_Allocate+0x90> 400070f0: 01 00 00 00 nop uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 400070f4: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 400070f8: d0 16 20 0a lduh [ %i0 + 0xa ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 400070fc: d2 14 20 14 lduh [ %l0 + 0x14 ], %o1 40007100: 40 00 2a 92 call 40011b48 <.udiv> 40007104: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 40007108: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 4000710c: 91 2a 20 02 sll %o0, 2, %o0 40007110: c4 00 40 08 ld [ %g1 + %o0 ], %g2 40007114: 84 00 bf ff add %g2, -1, %g2 40007118: c4 20 40 08 st %g2, [ %g1 + %o0 ] information->inactive--; 4000711c: c2 14 20 2c lduh [ %l0 + 0x2c ], %g1 40007120: 82 00 7f ff add %g1, -1, %g1 40007124: c2 34 20 2c sth %g1, [ %l0 + 0x2c ] ); } #endif return the_object; } 40007128: 81 c7 e0 08 ret 4000712c: 81 e8 00 00 restore =============================================================================== 400074a0 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 400074a0: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 400074a4: b3 2e 60 10 sll %i1, 0x10, %i1 400074a8: b3 36 60 10 srl %i1, 0x10, %i1 400074ac: 80 a6 60 00 cmp %i1, 0 400074b0: 02 80 00 17 be 4000750c <_Objects_Get_information+0x6c> 400074b4: 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 ); 400074b8: 40 00 13 b3 call 4000c384 <_Objects_API_maximum_class> 400074bc: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 400074c0: 80 a2 20 00 cmp %o0, 0 400074c4: 02 80 00 12 be 4000750c <_Objects_Get_information+0x6c> 400074c8: 80 a6 40 08 cmp %i1, %o0 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 400074cc: 18 80 00 10 bgu 4000750c <_Objects_Get_information+0x6c> 400074d0: 03 10 00 55 sethi %hi(0x40015400), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 400074d4: b1 2e 20 02 sll %i0, 2, %i0 400074d8: 82 10 61 28 or %g1, 0x128, %g1 400074dc: c2 00 40 18 ld [ %g1 + %i0 ], %g1 400074e0: 80 a0 60 00 cmp %g1, 0 400074e4: 02 80 00 0a be 4000750c <_Objects_Get_information+0x6c> <== NEVER TAKEN 400074e8: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 400074ec: e0 00 40 19 ld [ %g1 + %i1 ], %l0 if ( !info ) 400074f0: 80 a4 20 00 cmp %l0, 0 400074f4: 02 80 00 06 be 4000750c <_Objects_Get_information+0x6c> <== NEVER TAKEN 400074f8: 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 ) 400074fc: c2 14 20 10 lduh [ %l0 + 0x10 ], %g1 return NULL; 40007500: 80 a0 00 01 cmp %g0, %g1 40007504: 82 60 20 00 subx %g0, 0, %g1 40007508: a0 0c 00 01 and %l0, %g1, %l0 #endif return info; } 4000750c: 81 c7 e0 08 ret 40007510: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40018e84 <_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; 40018e84: c2 02 20 08 ld [ %o0 + 8 ], %g1 if ( information->maximum >= index ) { 40018e88: 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; 40018e8c: 82 22 40 01 sub %o1, %g1, %g1 40018e90: 82 00 60 01 inc %g1 if ( information->maximum >= index ) { 40018e94: 80 a0 80 01 cmp %g2, %g1 40018e98: 0a 80 00 09 bcs 40018ebc <_Objects_Get_no_protection+0x38> 40018e9c: 83 28 60 02 sll %g1, 2, %g1 if ( (the_object = information->local_table[ index ]) != NULL ) { 40018ea0: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 40018ea4: d0 00 80 01 ld [ %g2 + %g1 ], %o0 40018ea8: 80 a2 20 00 cmp %o0, 0 40018eac: 02 80 00 05 be 40018ec0 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 40018eb0: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 40018eb4: 81 c3 e0 08 retl 40018eb8: 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; 40018ebc: 82 10 20 01 mov 1, %g1 return NULL; 40018ec0: 90 10 20 00 clr %o0 } 40018ec4: 81 c3 e0 08 retl 40018ec8: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 40008d7c <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 40008d7c: 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; 40008d80: 92 96 20 00 orcc %i0, 0, %o1 40008d84: 12 80 00 06 bne 40008d9c <_Objects_Id_to_name+0x20> 40008d88: 83 32 60 18 srl %o1, 0x18, %g1 40008d8c: 03 10 00 7e sethi %hi(0x4001f800), %g1 40008d90: c2 00 62 c4 ld [ %g1 + 0x2c4 ], %g1 ! 4001fac4 <_Per_CPU_Information+0xc> 40008d94: d2 00 60 08 ld [ %g1 + 8 ], %o1 40008d98: 83 32 60 18 srl %o1, 0x18, %g1 40008d9c: 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 ) 40008da0: 84 00 7f ff add %g1, -1, %g2 40008da4: 80 a0 a0 02 cmp %g2, 2 40008da8: 18 80 00 16 bgu 40008e00 <_Objects_Id_to_name+0x84> 40008dac: 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 ] ) 40008db0: 10 80 00 16 b 40008e08 <_Objects_Id_to_name+0x8c> 40008db4: 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 ]; 40008db8: 85 28 a0 02 sll %g2, 2, %g2 40008dbc: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 40008dc0: 80 a2 20 00 cmp %o0, 0 40008dc4: 02 80 00 0f be 40008e00 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40008dc8: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 40008dcc: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 40008dd0: 80 a0 60 00 cmp %g1, 0 40008dd4: 12 80 00 0b bne 40008e00 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40008dd8: 01 00 00 00 nop return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 40008ddc: 7f ff ff cb call 40008d08 <_Objects_Get> 40008de0: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 40008de4: 80 a2 20 00 cmp %o0, 0 40008de8: 02 80 00 06 be 40008e00 <_Objects_Id_to_name+0x84> 40008dec: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 40008df0: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 40008df4: 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(); 40008df8: 40 00 03 68 call 40009b98 <_Thread_Enable_dispatch> 40008dfc: c2 26 40 00 st %g1, [ %i1 ] return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 40008e00: 81 c7 e0 08 ret 40008e04: 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 ] ) 40008e08: 05 10 00 7d sethi %hi(0x4001f400), %g2 40008e0c: 84 10 a0 e8 or %g2, 0xe8, %g2 ! 4001f4e8 <_Objects_Information_table> 40008e10: c2 00 80 01 ld [ %g2 + %g1 ], %g1 40008e14: 80 a0 60 00 cmp %g1, 0 40008e18: 12 bf ff e8 bne 40008db8 <_Objects_Id_to_name+0x3c> 40008e1c: 85 32 60 1b srl %o1, 0x1b, %g2 40008e20: 30 bf ff f8 b,a 40008e00 <_Objects_Id_to_name+0x84> =============================================================================== 4000ad54 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4000ad54: 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( 4000ad58: 11 10 00 9f sethi %hi(0x40027c00), %o0 4000ad5c: 92 10 00 18 mov %i0, %o1 4000ad60: 90 12 22 0c or %o0, 0x20c, %o0 4000ad64: 40 00 0c 94 call 4000dfb4 <_Objects_Get> 4000ad68: 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 ) { 4000ad6c: c2 07 bf fc ld [ %fp + -4 ], %g1 4000ad70: 80 a0 60 00 cmp %g1, 0 4000ad74: 12 80 00 3f bne 4000ae70 <_POSIX_Message_queue_Receive_support+0x11c> 4000ad78: 01 00 00 00 nop case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 4000ad7c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000ad80: 84 08 60 03 and %g1, 3, %g2 4000ad84: 80 a0 a0 01 cmp %g2, 1 4000ad88: 32 80 00 08 bne,a 4000ada8 <_POSIX_Message_queue_Receive_support+0x54> 4000ad8c: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 _Thread_Enable_dispatch(); 4000ad90: 40 00 0f f5 call 4000ed64 <_Thread_Enable_dispatch> 4000ad94: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EBADF ); 4000ad98: 40 00 2a 06 call 400155b0 <__errno> 4000ad9c: 01 00 00 00 nop 4000ada0: 10 80 00 0b b 4000adcc <_POSIX_Message_queue_Receive_support+0x78> 4000ada4: 82 10 20 09 mov 9, %g1 ! 9 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 4000ada8: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 4000adac: 80 a6 80 02 cmp %i2, %g2 4000adb0: 1a 80 00 09 bcc 4000add4 <_POSIX_Message_queue_Receive_support+0x80> 4000adb4: 84 10 3f ff mov -1, %g2 _Thread_Enable_dispatch(); 4000adb8: 40 00 0f eb call 4000ed64 <_Thread_Enable_dispatch> 4000adbc: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EMSGSIZE ); 4000adc0: 40 00 29 fc call 400155b0 <__errno> 4000adc4: 01 00 00 00 nop 4000adc8: 82 10 20 7a mov 0x7a, %g1 ! 7a 4000adcc: 10 80 00 27 b 4000ae68 <_POSIX_Message_queue_Receive_support+0x114> 4000add0: 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; 4000add4: c4 27 bf f8 st %g2, [ %fp + -8 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000add8: 80 8f 20 ff btst 0xff, %i4 4000addc: 02 80 00 06 be 4000adf4 <_POSIX_Message_queue_Receive_support+0xa0><== NEVER TAKEN 4000ade0: 98 10 20 00 clr %o4 do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000ade4: 05 00 00 10 sethi %hi(0x4000), %g2 4000ade8: 82 08 40 02 and %g1, %g2, %g1 4000adec: 80 a0 00 01 cmp %g0, %g1 4000adf0: 98 60 3f ff subx %g0, -1, %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4000adf4: 9a 10 00 1d mov %i5, %o5 4000adf8: 90 02 20 1c add %o0, 0x1c, %o0 4000adfc: 92 10 00 18 mov %i0, %o1 4000ae00: 94 10 00 19 mov %i1, %o2 4000ae04: 96 07 bf f8 add %fp, -8, %o3 4000ae08: 40 00 08 3c call 4000cef8 <_CORE_message_queue_Seize> 4000ae0c: 98 0b 20 01 and %o4, 1, %o4 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 4000ae10: 40 00 0f d5 call 4000ed64 <_Thread_Enable_dispatch> 4000ae14: 3b 10 00 9f sethi %hi(0x40027c00), %i5 *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4000ae18: ba 17 62 78 or %i5, 0x278, %i5 ! 40027e78 <_Per_CPU_Information> 4000ae1c: 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); 4000ae20: c6 00 60 24 ld [ %g1 + 0x24 ], %g3 if ( !_Thread_Executing->Wait.return_code ) 4000ae24: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 4000ae28: 85 38 e0 1f sra %g3, 0x1f, %g2 4000ae2c: 86 18 80 03 xor %g2, %g3, %g3 4000ae30: 84 20 c0 02 sub %g3, %g2, %g2 4000ae34: 80 a0 60 00 cmp %g1, 0 4000ae38: 12 80 00 05 bne 4000ae4c <_POSIX_Message_queue_Receive_support+0xf8> 4000ae3c: c4 26 c0 00 st %g2, [ %i3 ] return length_out; 4000ae40: f0 07 bf f8 ld [ %fp + -8 ], %i0 4000ae44: 81 c7 e0 08 ret 4000ae48: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one( 4000ae4c: 40 00 29 d9 call 400155b0 <__errno> 4000ae50: 01 00 00 00 nop 4000ae54: c2 07 60 0c ld [ %i5 + 0xc ], %g1 4000ae58: b8 10 00 08 mov %o0, %i4 4000ae5c: 40 00 00 9c call 4000b0cc <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000ae60: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000ae64: d0 27 00 00 st %o0, [ %i4 ] 4000ae68: 81 c7 e0 08 ret 4000ae6c: 91 e8 3f ff restore %g0, -1, %o0 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000ae70: 40 00 29 d0 call 400155b0 <__errno> 4000ae74: b0 10 3f ff mov -1, %i0 4000ae78: 82 10 20 09 mov 9, %g1 4000ae7c: c2 22 00 00 st %g1, [ %o0 ] } 4000ae80: 81 c7 e0 08 ret 4000ae84: 81 e8 00 00 restore =============================================================================== 4000b3f8 <_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 ]; 4000b3f8: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000b3fc: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 4000b400: 80 a0 a0 00 cmp %g2, 0 4000b404: 12 80 00 12 bne 4000b44c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54><== NEVER TAKEN 4000b408: 01 00 00 00 nop 4000b40c: c4 00 60 dc ld [ %g1 + 0xdc ], %g2 4000b410: 80 a0 a0 01 cmp %g2, 1 4000b414: 12 80 00 0e bne 4000b44c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000b418: 01 00 00 00 nop thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 4000b41c: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 4000b420: 80 a0 60 00 cmp %g1, 0 4000b424: 02 80 00 0a be 4000b44c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000b428: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000b42c: 03 10 00 5a sethi %hi(0x40016800), %g1 4000b430: c4 00 62 10 ld [ %g1 + 0x210 ], %g2 ! 40016a10 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 4000b434: 92 10 3f ff mov -1, %o1 4000b438: 84 00 bf ff add %g2, -1, %g2 4000b43c: c4 20 62 10 st %g2, [ %g1 + 0x210 ] 4000b440: 82 13 c0 00 mov %o7, %g1 4000b444: 40 00 01 f8 call 4000bc24 <_POSIX_Thread_Exit> 4000b448: 9e 10 40 00 mov %g1, %o7 } else _Thread_Enable_dispatch(); 4000b44c: 82 13 c0 00 mov %o7, %g1 4000b450: 7f ff f4 9d call 400086c4 <_Thread_Enable_dispatch> 4000b454: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000c890 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4000c890: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4000c894: d0 06 40 00 ld [ %i1 ], %o0 4000c898: 7f ff ff f3 call 4000c864 <_POSIX_Priority_Is_valid> 4000c89c: a0 10 00 18 mov %i0, %l0 4000c8a0: 80 8a 20 ff btst 0xff, %o0 4000c8a4: 02 80 00 11 be 4000c8e8 <_POSIX_Thread_Translate_sched_param+0x58><== NEVER TAKEN 4000c8a8: b0 10 20 16 mov 0x16, %i0 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4000c8ac: c0 26 80 00 clr [ %i2 ] *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 4000c8b0: 80 a4 20 00 cmp %l0, 0 4000c8b4: 12 80 00 06 bne 4000c8cc <_POSIX_Thread_Translate_sched_param+0x3c> 4000c8b8: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000c8bc: 82 10 20 01 mov 1, %g1 4000c8c0: c2 26 80 00 st %g1, [ %i2 ] return 0; 4000c8c4: 81 c7 e0 08 ret 4000c8c8: 91 e8 20 00 restore %g0, 0, %o0 } if ( policy == SCHED_FIFO ) { 4000c8cc: 80 a4 20 01 cmp %l0, 1 4000c8d0: 02 80 00 06 be 4000c8e8 <_POSIX_Thread_Translate_sched_param+0x58> 4000c8d4: b0 10 20 00 clr %i0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 4000c8d8: 80 a4 20 02 cmp %l0, 2 4000c8dc: 32 80 00 05 bne,a 4000c8f0 <_POSIX_Thread_Translate_sched_param+0x60> 4000c8e0: 80 a4 20 04 cmp %l0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 4000c8e4: e0 26 80 00 st %l0, [ %i2 ] return 0; 4000c8e8: 81 c7 e0 08 ret 4000c8ec: 81 e8 00 00 restore } if ( policy == SCHED_SPORADIC ) { 4000c8f0: 12 bf ff fe bne 4000c8e8 <_POSIX_Thread_Translate_sched_param+0x58> 4000c8f4: b0 10 20 16 mov 0x16, %i0 if ( (param->sched_ss_repl_period.tv_sec == 0) && 4000c8f8: c2 06 60 08 ld [ %i1 + 8 ], %g1 4000c8fc: 80 a0 60 00 cmp %g1, 0 4000c900: 32 80 00 07 bne,a 4000c91c <_POSIX_Thread_Translate_sched_param+0x8c> 4000c904: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000c908: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000c90c: 80 a0 60 00 cmp %g1, 0 4000c910: 02 80 00 1d be 4000c984 <_POSIX_Thread_Translate_sched_param+0xf4> 4000c914: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4000c918: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000c91c: 80 a0 60 00 cmp %g1, 0 4000c920: 12 80 00 06 bne 4000c938 <_POSIX_Thread_Translate_sched_param+0xa8> 4000c924: 01 00 00 00 nop 4000c928: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000c92c: 80 a0 60 00 cmp %g1, 0 4000c930: 02 bf ff ee be 4000c8e8 <_POSIX_Thread_Translate_sched_param+0x58> 4000c934: 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 ) < 4000c938: 7f ff f5 c7 call 4000a054 <_Timespec_To_ticks> 4000c93c: 90 06 60 08 add %i1, 8, %o0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; 4000c940: 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 ) < 4000c944: a0 10 00 08 mov %o0, %l0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 4000c948: 7f ff f5 c3 call 4000a054 <_Timespec_To_ticks> 4000c94c: 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 ) < 4000c950: 80 a4 00 08 cmp %l0, %o0 4000c954: 0a 80 00 0c bcs 4000c984 <_POSIX_Thread_Translate_sched_param+0xf4> 4000c958: 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 ) ) 4000c95c: 7f ff ff c2 call 4000c864 <_POSIX_Priority_Is_valid> 4000c960: d0 06 60 04 ld [ %i1 + 4 ], %o0 4000c964: 80 8a 20 ff btst 0xff, %o0 4000c968: 02 bf ff e0 be 4000c8e8 <_POSIX_Thread_Translate_sched_param+0x58> 4000c96c: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4000c970: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; 4000c974: 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; 4000c978: 03 10 00 18 sethi %hi(0x40006000), %g1 4000c97c: 82 10 63 f0 or %g1, 0x3f0, %g1 ! 400063f0 <_POSIX_Threads_Sporadic_budget_callout> 4000c980: c2 26 c0 00 st %g1, [ %i3 ] return 0; } return EINVAL; } 4000c984: 81 c7 e0 08 ret 4000c988: 81 e8 00 00 restore =============================================================================== 40006130 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 40006130: 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; 40006134: 03 10 00 77 sethi %hi(0x4001dc00), %g1 40006138: 82 10 62 7c or %g1, 0x27c, %g1 ! 4001de7c maximum = Configuration_POSIX_API.number_of_initialization_threads; 4000613c: e6 00 60 30 ld [ %g1 + 0x30 ], %l3 if ( !user_threads || maximum == 0 ) 40006140: 80 a4 e0 00 cmp %l3, 0 40006144: 02 80 00 1d be 400061b8 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 40006148: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 4000614c: 80 a4 60 00 cmp %l1, 0 40006150: 02 80 00 1a be 400061b8 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 40006154: 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 ); 40006158: 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( 4000615c: 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 ); 40006160: 40 00 1a 0b call 4000c98c 40006164: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 40006168: 92 10 20 02 mov 2, %o1 4000616c: 40 00 1a 14 call 4000c9bc 40006170: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 40006174: d2 04 60 04 ld [ %l1 + 4 ], %o1 40006178: 40 00 1a 20 call 4000c9f8 4000617c: 90 10 00 10 mov %l0, %o0 status = pthread_create( 40006180: d4 04 40 00 ld [ %l1 ], %o2 40006184: 90 10 00 14 mov %l4, %o0 40006188: 92 10 00 10 mov %l0, %o1 4000618c: 7f ff ff 36 call 40005e64 40006190: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 40006194: 94 92 20 00 orcc %o0, 0, %o2 40006198: 22 80 00 05 be,a 400061ac <_POSIX_Threads_Initialize_user_threads_body+0x7c> 4000619c: a4 04 a0 01 inc %l2 _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 400061a0: 90 10 20 02 mov 2, %o0 400061a4: 40 00 07 f3 call 40008170 <_Internal_error_Occurred> 400061a8: 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++ ) { 400061ac: 80 a4 80 13 cmp %l2, %l3 400061b0: 0a bf ff ec bcs 40006160 <_POSIX_Threads_Initialize_user_threads_body+0x30><== NEVER TAKEN 400061b4: a2 04 60 08 add %l1, 8, %l1 400061b8: 81 c7 e0 08 ret 400061bc: 81 e8 00 00 restore =============================================================================== 4000b738 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 4000b738: 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 ]; 4000b73c: 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 ); 4000b740: 40 00 03 ce call 4000c678 <_Timespec_To_ticks> 4000b744: 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); 4000b748: 03 10 00 53 sethi %hi(0x40014c00), %g1 4000b74c: d2 08 60 24 ldub [ %g1 + 0x24 ], %o1 ! 40014c24 4000b750: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->cpu_time_budget = ticks; 4000b754: d0 26 60 78 st %o0, [ %i1 + 0x78 ] 4000b758: 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 ) { 4000b75c: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 4000b760: 80 a0 60 00 cmp %g1, 0 4000b764: 12 80 00 08 bne 4000b784 <_POSIX_Threads_Sporadic_budget_TSR+0x4c><== NEVER TAKEN 4000b768: 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 ) { 4000b76c: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000b770: 80 a0 40 09 cmp %g1, %o1 4000b774: 08 80 00 04 bleu 4000b784 <_POSIX_Threads_Sporadic_budget_TSR+0x4c> 4000b778: 90 10 00 19 mov %i1, %o0 _Thread_Change_priority( the_thread, new_priority, true ); 4000b77c: 7f ff f1 f1 call 40007f40 <_Thread_Change_priority> 4000b780: 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 ); 4000b784: 40 00 03 bd call 4000c678 <_Timespec_To_ticks> 4000b788: 90 04 20 90 add %l0, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000b78c: 31 10 00 55 sethi %hi(0x40015400), %i0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000b790: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000b794: b0 16 22 80 or %i0, 0x280, %i0 4000b798: 7f ff f6 91 call 400091dc <_Watchdog_Insert> 4000b79c: 93 ec 20 a8 restore %l0, 0xa8, %o1 =============================================================================== 4000b7a4 <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000b7a4: 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 */ 4000b7a8: 86 10 3f ff mov -1, %g3 4000b7ac: c4 00 a0 8c ld [ %g2 + 0x8c ], %g2 4000b7b0: c6 22 20 78 st %g3, [ %o0 + 0x78 ] 4000b7b4: 07 10 00 53 sethi %hi(0x40014c00), %g3 4000b7b8: d2 08 e0 24 ldub [ %g3 + 0x24 ], %o1 ! 40014c24 4000b7bc: 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 ) { 4000b7c0: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 4000b7c4: 80 a0 a0 00 cmp %g2, 0 4000b7c8: 12 80 00 09 bne 4000b7ec <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000b7cc: 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 ) { 4000b7d0: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000b7d4: 80 a0 40 09 cmp %g1, %o1 4000b7d8: 1a 80 00 05 bcc 4000b7ec <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000b7dc: 94 10 20 01 mov 1, %o2 _Thread_Change_priority( the_thread, new_priority, true ); 4000b7e0: 82 13 c0 00 mov %o7, %g1 4000b7e4: 7f ff f1 d7 call 40007f40 <_Thread_Change_priority> 4000b7e8: 9e 10 40 00 mov %g1, %o7 4000b7ec: 81 c3 e0 08 retl <== NOT EXECUTED =============================================================================== 40005e70 <_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) { 40005e70: 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; 40005e74: c2 06 60 68 ld [ %i1 + 0x68 ], %g1 40005e78: 82 00 60 01 inc %g1 40005e7c: c2 26 60 68 st %g1, [ %i1 + 0x68 ] /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 40005e80: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 40005e84: 80 a0 60 00 cmp %g1, 0 40005e88: 32 80 00 07 bne,a 40005ea4 <_POSIX_Timer_TSR+0x34> 40005e8c: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40005e90: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 40005e94: 80 a0 60 00 cmp %g1, 0 40005e98: 02 80 00 0f be 40005ed4 <_POSIX_Timer_TSR+0x64> <== NEVER TAKEN 40005e9c: 82 10 20 04 mov 4, %g1 ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 40005ea0: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40005ea4: d4 06 60 08 ld [ %i1 + 8 ], %o2 40005ea8: 90 06 60 10 add %i1, 0x10, %o0 40005eac: 17 10 00 17 sethi %hi(0x40005c00), %o3 40005eb0: 98 10 00 19 mov %i1, %o4 40005eb4: 40 00 19 b8 call 4000c594 <_POSIX_Timer_Insert_helper> 40005eb8: 96 12 e2 70 or %o3, 0x270, %o3 ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 40005ebc: 80 8a 20 ff btst 0xff, %o0 40005ec0: 02 80 00 0a be 40005ee8 <_POSIX_Timer_TSR+0x78> <== NEVER TAKEN 40005ec4: 01 00 00 00 nop return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 40005ec8: 40 00 05 c0 call 400075c8 <_TOD_Get> 40005ecc: 90 06 60 6c add %i1, 0x6c, %o0 40005ed0: 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 ) ) { 40005ed4: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 40005ed8: d2 06 60 44 ld [ %i1 + 0x44 ], %o1 40005edc: 40 00 18 99 call 4000c140 40005ee0: 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; 40005ee4: c0 26 60 68 clr [ %i1 + 0x68 ] 40005ee8: 81 c7 e0 08 ret 40005eec: 81 e8 00 00 restore =============================================================================== 4000da54 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000da54: 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, 4000da58: 98 10 20 01 mov 1, %o4 4000da5c: 90 10 00 18 mov %i0, %o0 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000da60: 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, 4000da64: a2 07 bf f4 add %fp, -12, %l1 4000da68: 92 10 00 19 mov %i1, %o1 4000da6c: 94 10 00 11 mov %l1, %o2 4000da70: 96 0e a0 ff and %i2, 0xff, %o3 4000da74: 40 00 00 2c call 4000db24 <_POSIX_signals_Clear_signals> 4000da78: b0 10 20 00 clr %i0 4000da7c: 80 8a 20 ff btst 0xff, %o0 4000da80: 02 80 00 27 be 4000db1c <_POSIX_signals_Check_signal+0xc8> 4000da84: 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 ) 4000da88: 2b 10 00 56 sethi %hi(0x40015800), %l5 4000da8c: a9 2e 60 04 sll %i1, 4, %l4 4000da90: aa 15 63 50 or %l5, 0x350, %l5 4000da94: a8 25 00 01 sub %l4, %g1, %l4 4000da98: 82 05 40 14 add %l5, %l4, %g1 4000da9c: e4 00 60 08 ld [ %g1 + 8 ], %l2 4000daa0: 80 a4 a0 01 cmp %l2, 1 4000daa4: 02 80 00 1e be 4000db1c <_POSIX_signals_Check_signal+0xc8><== NEVER TAKEN 4000daa8: 90 07 bf cc add %fp, -52, %o0 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 4000daac: e6 04 20 d0 ld [ %l0 + 0xd0 ], %l3 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000dab0: c2 00 60 04 ld [ %g1 + 4 ], %g1 4000dab4: 82 10 40 13 or %g1, %l3, %g1 4000dab8: 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, 4000dabc: 03 10 00 56 sethi %hi(0x40015800), %g1 4000dac0: d2 00 63 04 ld [ %g1 + 0x304 ], %o1 ! 40015b04 <_Per_CPU_Information+0xc> 4000dac4: 94 10 20 28 mov 0x28, %o2 4000dac8: 40 00 04 2e call 4000eb80 4000dacc: 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 ) { 4000dad0: c2 05 40 14 ld [ %l5 + %l4 ], %g1 4000dad4: 80 a0 60 02 cmp %g1, 2 4000dad8: 12 80 00 07 bne 4000daf4 <_POSIX_signals_Check_signal+0xa0> 4000dadc: 90 10 00 19 mov %i1, %o0 case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 4000dae0: 92 10 00 11 mov %l1, %o1 4000dae4: 9f c4 80 00 call %l2 4000dae8: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 4000daec: 10 80 00 05 b 4000db00 <_POSIX_signals_Check_signal+0xac> 4000daf0: 03 10 00 56 sethi %hi(0x40015800), %g1 default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 4000daf4: 9f c4 80 00 call %l2 4000daf8: 90 10 00 19 mov %i1, %o0 } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 4000dafc: 03 10 00 56 sethi %hi(0x40015800), %g1 4000db00: d0 00 63 04 ld [ %g1 + 0x304 ], %o0 ! 40015b04 <_Per_CPU_Information+0xc> 4000db04: 92 07 bf cc add %fp, -52, %o1 4000db08: 90 02 20 20 add %o0, 0x20, %o0 4000db0c: 94 10 20 28 mov 0x28, %o2 4000db10: 40 00 04 1c call 4000eb80 4000db14: b0 10 20 01 mov 1, %i0 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 4000db18: e6 24 20 d0 st %l3, [ %l0 + 0xd0 ] return true; } 4000db1c: 81 c7 e0 08 ret 4000db20: 81 e8 00 00 restore =============================================================================== 4000e184 <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 4000e184: 9d e3 bf a0 save %sp, -96, %sp clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4000e188: 7f ff ce cc call 40001cb8 4000e18c: 01 00 00 00 nop if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4000e190: 85 2e 20 04 sll %i0, 4, %g2 4000e194: 83 2e 20 02 sll %i0, 2, %g1 4000e198: 82 20 80 01 sub %g2, %g1, %g1 4000e19c: 05 10 00 56 sethi %hi(0x40015800), %g2 4000e1a0: 84 10 a3 50 or %g2, 0x350, %g2 ! 40015b50 <_POSIX_signals_Vectors> 4000e1a4: c4 00 80 01 ld [ %g2 + %g1 ], %g2 4000e1a8: 80 a0 a0 02 cmp %g2, 2 4000e1ac: 12 80 00 0a bne 4000e1d4 <_POSIX_signals_Clear_process_signals+0x50> 4000e1b0: 84 10 20 01 mov 1, %g2 } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } 4000e1b4: 05 10 00 57 sethi %hi(0x40015c00), %g2 4000e1b8: 84 10 a1 48 or %g2, 0x148, %g2 ! 40015d48 <_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 ); 4000e1bc: 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 ] ) ) 4000e1c0: c2 00 80 01 ld [ %g2 + %g1 ], %g1 4000e1c4: 86 00 e0 04 add %g3, 4, %g3 4000e1c8: 80 a0 40 03 cmp %g1, %g3 4000e1cc: 12 80 00 08 bne 4000e1ec <_POSIX_signals_Clear_process_signals+0x68><== NEVER TAKEN 4000e1d0: 84 10 20 01 mov 1, %g2 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 4000e1d4: 03 10 00 57 sethi %hi(0x40015c00), %g1 4000e1d8: b0 06 3f ff add %i0, -1, %i0 4000e1dc: b1 28 80 18 sll %g2, %i0, %i0 4000e1e0: c4 00 61 44 ld [ %g1 + 0x144 ], %g2 4000e1e4: b0 28 80 18 andn %g2, %i0, %i0 4000e1e8: f0 20 61 44 st %i0, [ %g1 + 0x144 ] } _ISR_Enable( level ); 4000e1ec: 7f ff ce b7 call 40001cc8 4000e1f0: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 400068e4 <_POSIX_signals_Get_lowest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 400068e4: 82 10 20 1b mov 0x1b, %g1 ! 1b 400068e8: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 400068ec: 86 00 7f ff add %g1, -1, %g3 400068f0: 87 28 80 03 sll %g2, %g3, %g3 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 400068f4: 80 88 c0 08 btst %g3, %o0 400068f8: 12 80 00 11 bne 4000693c <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 400068fc: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40006900: 82 00 60 01 inc %g1 40006904: 80 a0 60 20 cmp %g1, 0x20 40006908: 12 bf ff fa bne 400068f0 <_POSIX_signals_Get_lowest+0xc> 4000690c: 86 00 7f ff add %g1, -1, %g3 40006910: 82 10 20 01 mov 1, %g1 40006914: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 40006918: 86 00 7f ff add %g1, -1, %g3 4000691c: 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 ) ) { 40006920: 80 88 c0 08 btst %g3, %o0 40006924: 12 80 00 06 bne 4000693c <_POSIX_signals_Get_lowest+0x58> 40006928: 01 00 00 00 nop */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 4000692c: 82 00 60 01 inc %g1 40006930: 80 a0 60 1b cmp %g1, 0x1b 40006934: 12 bf ff fa bne 4000691c <_POSIX_signals_Get_lowest+0x38> <== ALWAYS TAKEN 40006938: 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; } 4000693c: 81 c3 e0 08 retl 40006940: 90 10 00 01 mov %g1, %o0 =============================================================================== 40023f94 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 40023f94: 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 ) ) { 40023f98: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 40023f9c: 1b 04 00 20 sethi %hi(0x10008000), %o5 40023fa0: 84 06 7f ff add %i1, -1, %g2 40023fa4: 86 10 20 01 mov 1, %g3 40023fa8: 98 08 40 0d and %g1, %o5, %o4 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 40023fac: a0 10 00 18 mov %i0, %l0 40023fb0: 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 ]; 40023fb4: 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 ) ) { 40023fb8: 80 a3 00 0d cmp %o4, %o5 40023fbc: 12 80 00 1b bne 40024028 <_POSIX_signals_Unblock_thread+0x94> 40023fc0: 85 28 c0 02 sll %g3, %g2, %g2 if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 40023fc4: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 40023fc8: 80 88 80 01 btst %g2, %g1 40023fcc: 12 80 00 07 bne 40023fe8 <_POSIX_signals_Unblock_thread+0x54> 40023fd0: 82 10 20 04 mov 4, %g1 40023fd4: c2 01 20 d0 ld [ %g4 + 0xd0 ], %g1 40023fd8: 80 a8 80 01 andncc %g2, %g1, %g0 40023fdc: 02 80 00 11 be 40024020 <_POSIX_signals_Unblock_thread+0x8c> 40023fe0: b0 10 20 00 clr %i0 the_thread->Wait.return_code = EINTR; 40023fe4: 82 10 20 04 mov 4, %g1 40023fe8: c2 24 20 34 st %g1, [ %l0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 40023fec: 80 a2 60 00 cmp %o1, 0 40023ff0: 12 80 00 07 bne 4002400c <_POSIX_signals_Unblock_thread+0x78> 40023ff4: d0 04 20 28 ld [ %l0 + 0x28 ], %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 40023ff8: 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; 40023ffc: f2 22 00 00 st %i1, [ %o0 ] the_info->si_code = SI_USER; 40024000: c2 22 20 04 st %g1, [ %o0 + 4 ] the_info->si_value.sival_int = 0; 40024004: 10 80 00 04 b 40024014 <_POSIX_signals_Unblock_thread+0x80> 40024008: c0 22 20 08 clr [ %o0 + 8 ] } else { *the_info = *info; 4002400c: 7f ff c0 e2 call 40014394 40024010: 94 10 20 0c mov 0xc, %o2 } _Thread_queue_Extract_with_proxy( the_thread ); 40024014: 90 10 00 10 mov %l0, %o0 40024018: 7f ff a8 62 call 4000e1a0 <_Thread_queue_Extract_with_proxy> 4002401c: b0 10 20 01 mov 1, %i0 return true; 40024020: 81 c7 e0 08 ret 40024024: 81 e8 00 00 restore } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 40024028: c8 01 20 d0 ld [ %g4 + 0xd0 ], %g4 4002402c: 80 a8 80 04 andncc %g2, %g4, %g0 40024030: 02 bf ff fc be 40024020 <_POSIX_signals_Unblock_thread+0x8c> 40024034: 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 ) ) { 40024038: 05 04 00 00 sethi %hi(0x10000000), %g2 4002403c: 80 88 40 02 btst %g1, %g2 40024040: 02 80 00 17 be 4002409c <_POSIX_signals_Unblock_thread+0x108> 40024044: 80 a0 60 00 cmp %g1, 0 the_thread->Wait.return_code = EINTR; 40024048: 84 10 20 04 mov 4, %g2 4002404c: 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) ) 40024050: 05 00 00 ef sethi %hi(0x3bc00), %g2 40024054: 84 10 a2 e0 or %g2, 0x2e0, %g2 ! 3bee0 40024058: 80 88 40 02 btst %g1, %g2 4002405c: 02 80 00 06 be 40024074 <_POSIX_signals_Unblock_thread+0xe0> 40024060: 80 88 60 08 btst 8, %g1 _Thread_queue_Extract_with_proxy( the_thread ); 40024064: 7f ff a8 4f call 4000e1a0 <_Thread_queue_Extract_with_proxy> 40024068: 90 10 00 10 mov %l0, %o0 4002406c: 81 c7 e0 08 ret 40024070: 81 e8 00 00 restore else if ( _States_Is_delaying(the_thread->current_state) ) { 40024074: 02 80 00 15 be 400240c8 <_POSIX_signals_Unblock_thread+0x134><== NEVER TAKEN 40024078: 01 00 00 00 nop (void) _Watchdog_Remove( &the_thread->Timer ); 4002407c: 7f ff aa 7b call 4000ea68 <_Watchdog_Remove> 40024080: 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 ); 40024084: 90 10 00 10 mov %l0, %o0 40024088: 13 04 00 ff sethi %hi(0x1003fc00), %o1 4002408c: 7f ff a5 b9 call 4000d770 <_Thread_Clear_state> 40024090: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 40024094: 81 c7 e0 08 ret 40024098: 81 e8 00 00 restore _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 4002409c: 12 bf ff e1 bne 40024020 <_POSIX_signals_Unblock_thread+0x8c><== NEVER TAKEN 400240a0: 03 10 00 9e sethi %hi(0x40027800), %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 400240a4: 82 10 63 38 or %g1, 0x338, %g1 ! 40027b38 <_Per_CPU_Information> 400240a8: c4 00 60 08 ld [ %g1 + 8 ], %g2 400240ac: 80 a0 a0 00 cmp %g2, 0 400240b0: 02 80 00 06 be 400240c8 <_POSIX_signals_Unblock_thread+0x134> 400240b4: 01 00 00 00 nop 400240b8: c4 00 60 0c ld [ %g1 + 0xc ], %g2 400240bc: 80 a4 00 02 cmp %l0, %g2 400240c0: 22 bf ff d8 be,a 40024020 <_POSIX_signals_Unblock_thread+0x8c><== ALWAYS TAKEN 400240c4: c6 28 60 18 stb %g3, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } } return false; } 400240c8: 81 c7 e0 08 ret 400240cc: 81 e8 00 00 restore =============================================================================== 4000737c <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 4000737c: 9d e3 bf 98 save %sp, -104, %sp 40007380: 11 10 00 7e sethi %hi(0x4001f800), %o0 40007384: 92 10 00 18 mov %i0, %o1 40007388: 90 12 22 6c or %o0, 0x26c, %o0 4000738c: 40 00 07 e8 call 4000932c <_Objects_Get> 40007390: 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 ) { 40007394: c2 07 bf fc ld [ %fp + -4 ], %g1 40007398: 80 a0 60 00 cmp %g1, 0 4000739c: 12 80 00 24 bne 4000742c <_Rate_monotonic_Timeout+0xb0> <== NEVER TAKEN 400073a0: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: the_thread = the_period->owner; 400073a4: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 400073a8: 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); 400073ac: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 400073b0: 80 88 80 01 btst %g2, %g1 400073b4: 22 80 00 0b be,a 400073e0 <_Rate_monotonic_Timeout+0x64> 400073b8: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 400073bc: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 400073c0: c2 04 20 08 ld [ %l0 + 8 ], %g1 400073c4: 80 a0 80 01 cmp %g2, %g1 400073c8: 32 80 00 06 bne,a 400073e0 <_Rate_monotonic_Timeout+0x64> 400073cc: 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 ); 400073d0: 13 04 00 ff sethi %hi(0x1003fc00), %o1 400073d4: 40 00 0a 89 call 40009df8 <_Thread_Clear_state> 400073d8: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 400073dc: 30 80 00 06 b,a 400073f4 <_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 ) { 400073e0: 80 a0 60 01 cmp %g1, 1 400073e4: 12 80 00 0d bne 40007418 <_Rate_monotonic_Timeout+0x9c> 400073e8: 82 10 20 04 mov 4, %g1 the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 400073ec: 82 10 20 03 mov 3, %g1 400073f0: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 400073f4: 7f ff fe 66 call 40006d8c <_Rate_monotonic_Initiate_statistics> 400073f8: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400073fc: c2 04 20 3c ld [ %l0 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007400: 11 10 00 7f sethi %hi(0x4001fc00), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007404: c2 24 20 1c st %g1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007408: 90 12 20 90 or %o0, 0x90, %o0 4000740c: 40 00 0f 54 call 4000b15c <_Watchdog_Insert> 40007410: 92 04 20 10 add %l0, 0x10, %o1 40007414: 30 80 00 02 b,a 4000741c <_Rate_monotonic_Timeout+0xa0> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 40007418: 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; 4000741c: 03 10 00 7e sethi %hi(0x4001f800), %g1 40007420: c4 00 63 d0 ld [ %g1 + 0x3d0 ], %g2 ! 4001fbd0 <_Thread_Dispatch_disable_level> 40007424: 84 00 bf ff add %g2, -1, %g2 40007428: c4 20 63 d0 st %g2, [ %g1 + 0x3d0 ] 4000742c: 81 c7 e0 08 ret 40007430: 81 e8 00 00 restore =============================================================================== 40006dfc <_Rate_monotonic_Update_statistics>: } void _Rate_monotonic_Update_statistics( Rate_monotonic_Control *the_period ) { 40006dfc: 9d e3 bf 90 save %sp, -112, %sp /* * Update the counts. */ stats = &the_period->Statistics; stats->count++; 40006e00: c2 06 20 54 ld [ %i0 + 0x54 ], %g1 40006e04: 82 00 60 01 inc %g1 40006e08: c2 26 20 54 st %g1, [ %i0 + 0x54 ] if ( the_period->state == RATE_MONOTONIC_EXPIRED ) 40006e0c: c2 06 20 38 ld [ %i0 + 0x38 ], %g1 40006e10: 80 a0 60 04 cmp %g1, 4 40006e14: 12 80 00 05 bne 40006e28 <_Rate_monotonic_Update_statistics+0x2c> 40006e18: a0 07 bf f8 add %fp, -8, %l0 stats->missed_count++; 40006e1c: c2 06 20 58 ld [ %i0 + 0x58 ], %g1 40006e20: 82 00 60 01 inc %g1 40006e24: c2 26 20 58 st %g1, [ %i0 + 0x58 ] /* * Grab status for time statistics. */ valid_status = 40006e28: 90 10 00 18 mov %i0, %o0 40006e2c: 92 07 bf f0 add %fp, -16, %o1 40006e30: 7f ff ff ad call 40006ce4 <_Rate_monotonic_Get_status> 40006e34: 94 10 00 10 mov %l0, %o2 _Rate_monotonic_Get_status( the_period, &since_last_period, &executed ); if (!valid_status) 40006e38: 80 8a 20 ff btst 0xff, %o0 40006e3c: 02 80 00 2c be 40006eec <_Rate_monotonic_Update_statistics+0xf0><== NEVER TAKEN 40006e40: 92 10 00 10 mov %l0, %o1 /* * Update CPU time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_cpu_time, &executed ); 40006e44: 40 00 0f 8a call 4000ac6c <_Timespec_Add_to> 40006e48: 90 06 20 6c add %i0, 0x6c, %o0 if ( _Timestamp_Less_than( &executed, &stats->min_cpu_time ) ) 40006e4c: 90 10 00 10 mov %l0, %o0 40006e50: 40 00 0f f3 call 4000ae1c <_Timespec_Less_than> 40006e54: 92 06 20 5c add %i0, 0x5c, %o1 40006e58: 80 8a 20 ff btst 0xff, %o0 40006e5c: 02 80 00 06 be 40006e74 <_Rate_monotonic_Update_statistics+0x78> 40006e60: 90 07 bf f8 add %fp, -8, %o0 stats->min_cpu_time = executed; 40006e64: c2 07 bf f8 ld [ %fp + -8 ], %g1 40006e68: c2 26 20 5c st %g1, [ %i0 + 0x5c ] 40006e6c: c2 07 bf fc ld [ %fp + -4 ], %g1 40006e70: c2 26 20 60 st %g1, [ %i0 + 0x60 ] if ( _Timestamp_Greater_than( &executed, &stats->max_cpu_time ) ) 40006e74: 40 00 0f d9 call 4000add8 <_Timespec_Greater_than> 40006e78: 92 06 20 64 add %i0, 0x64, %o1 40006e7c: 80 8a 20 ff btst 0xff, %o0 40006e80: 02 80 00 06 be 40006e98 <_Rate_monotonic_Update_statistics+0x9c> 40006e84: a0 07 bf f0 add %fp, -16, %l0 stats->max_cpu_time = executed; 40006e88: c2 07 bf f8 ld [ %fp + -8 ], %g1 40006e8c: c2 26 20 64 st %g1, [ %i0 + 0x64 ] 40006e90: c2 07 bf fc ld [ %fp + -4 ], %g1 40006e94: c2 26 20 68 st %g1, [ %i0 + 0x68 ] /* * Update Wall time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_wall_time, &since_last_period ); 40006e98: 90 06 20 84 add %i0, 0x84, %o0 40006e9c: 40 00 0f 74 call 4000ac6c <_Timespec_Add_to> 40006ea0: 92 10 00 10 mov %l0, %o1 if ( _Timestamp_Less_than( &since_last_period, &stats->min_wall_time ) ) 40006ea4: 90 10 00 10 mov %l0, %o0 40006ea8: 40 00 0f dd call 4000ae1c <_Timespec_Less_than> 40006eac: 92 06 20 74 add %i0, 0x74, %o1 40006eb0: 80 8a 20 ff btst 0xff, %o0 40006eb4: 02 80 00 06 be 40006ecc <_Rate_monotonic_Update_statistics+0xd0> 40006eb8: 90 07 bf f0 add %fp, -16, %o0 stats->min_wall_time = since_last_period; 40006ebc: c2 07 bf f0 ld [ %fp + -16 ], %g1 40006ec0: c2 26 20 74 st %g1, [ %i0 + 0x74 ] 40006ec4: c2 07 bf f4 ld [ %fp + -12 ], %g1 40006ec8: c2 26 20 78 st %g1, [ %i0 + 0x78 ] if ( _Timestamp_Greater_than( &since_last_period, &stats->max_wall_time ) ) 40006ecc: 40 00 0f c3 call 4000add8 <_Timespec_Greater_than> 40006ed0: 92 06 20 7c add %i0, 0x7c, %o1 40006ed4: 80 8a 20 ff btst 0xff, %o0 40006ed8: 02 80 00 05 be 40006eec <_Rate_monotonic_Update_statistics+0xf0> 40006edc: c2 07 bf f0 ld [ %fp + -16 ], %g1 stats->max_wall_time = since_last_period; 40006ee0: c2 26 20 7c st %g1, [ %i0 + 0x7c ] 40006ee4: c2 07 bf f4 ld [ %fp + -12 ], %g1 40006ee8: c2 26 20 80 st %g1, [ %i0 + 0x80 ] 40006eec: 81 c7 e0 08 ret 40006ef0: 81 e8 00 00 restore =============================================================================== 40007934 <_Scheduler_priority_Block>: #include void _Scheduler_priority_Block( Thread_Control *the_thread ) { 40007934: 9d e3 bf a0 save %sp, -96, %sp ) { Scheduler_priority_Per_thread *sched_info; Chain_Control *ready; sched_info = (Scheduler_priority_Per_thread *) the_thread->scheduler_info; 40007938: c4 06 20 8c ld [ %i0 + 0x8c ], %g2 ready = sched_info->ready_chain; 4000793c: c2 00 80 00 ld [ %g2 ], %g1 if ( _Chain_Has_only_one_node( ready ) ) { 40007940: c8 00 40 00 ld [ %g1 ], %g4 40007944: c6 00 60 08 ld [ %g1 + 8 ], %g3 40007948: 80 a1 00 03 cmp %g4, %g3 4000794c: 32 80 00 16 bne,a 400079a4 <_Scheduler_priority_Block+0x70> 40007950: c4 06 00 00 ld [ %i0 ], %g2 Chain_Node *tail = _Chain_Tail( the_chain ); 40007954: 86 00 60 04 add %g1, 4, %g3 head->next = tail; 40007958: c6 20 40 00 st %g3, [ %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; 4000795c: c6 00 a0 04 ld [ %g2 + 4 ], %g3 head->previous = NULL; 40007960: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 40007964: c2 20 60 08 st %g1, [ %g1 + 8 ] 40007968: c2 10 a0 0e lduh [ %g2 + 0xe ], %g1 4000796c: c8 10 c0 00 lduh [ %g3 ], %g4 40007970: 82 09 00 01 and %g4, %g1, %g1 40007974: c2 30 c0 00 sth %g1, [ %g3 ] if ( *the_priority_map->minor == 0 ) 40007978: 83 28 60 10 sll %g1, 0x10, %g1 4000797c: 80 a0 60 00 cmp %g1, 0 40007980: 32 80 00 0d bne,a 400079b4 <_Scheduler_priority_Block+0x80> 40007984: 03 10 00 56 sethi %hi(0x40015800), %g1 _Priority_Major_bit_map &= the_priority_map->block_major; 40007988: 03 10 00 56 sethi %hi(0x40015800), %g1 4000798c: c4 10 a0 0c lduh [ %g2 + 0xc ], %g2 40007990: c6 10 63 20 lduh [ %g1 + 0x320 ], %g3 40007994: 84 08 80 03 and %g2, %g3, %g2 40007998: c4 30 63 20 sth %g2, [ %g1 + 0x320 ] RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); 4000799c: 10 80 00 06 b 400079b4 <_Scheduler_priority_Block+0x80> 400079a0: 03 10 00 56 sethi %hi(0x40015800), %g1 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 400079a4: c2 06 20 04 ld [ %i0 + 4 ], %g1 next->previous = previous; 400079a8: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 400079ac: c4 20 40 00 st %g2, [ %g1 ] 400079b0: 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 ) ) 400079b4: c2 00 63 08 ld [ %g1 + 0x308 ], %g1 ! 40015b08 <_Per_CPU_Information+0x10> 400079b8: 80 a6 00 01 cmp %i0, %g1 400079bc: 32 80 00 33 bne,a 40007a88 <_Scheduler_priority_Block+0x154> 400079c0: 03 10 00 56 sethi %hi(0x40015800), %g1 * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( (Chain_Control *) _Scheduler.information 400079c4: 03 10 00 52 sethi %hi(0x40014800), %g1 * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 400079c8: c6 00 63 50 ld [ %g1 + 0x350 ], %g3 ! 40014b50 <_Scheduler> 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 ); 400079cc: 03 10 00 56 sethi %hi(0x40015800), %g1 400079d0: c4 10 63 20 lduh [ %g1 + 0x320 ], %g2 ! 40015b20 <_Priority_Major_bit_map> 400079d4: 03 10 00 50 sethi %hi(0x40014000), %g1 400079d8: 85 28 a0 10 sll %g2, 0x10, %g2 400079dc: 89 30 a0 10 srl %g2, 0x10, %g4 400079e0: 80 a1 20 ff cmp %g4, 0xff 400079e4: 18 80 00 05 bgu 400079f8 <_Scheduler_priority_Block+0xc4> 400079e8: 82 10 61 18 or %g1, 0x118, %g1 400079ec: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 400079f0: 10 80 00 04 b 40007a00 <_Scheduler_priority_Block+0xcc> 400079f4: 84 00 a0 08 add %g2, 8, %g2 400079f8: 85 30 a0 18 srl %g2, 0x18, %g2 400079fc: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40007a00: 83 28 a0 10 sll %g2, 0x10, %g1 40007a04: 09 10 00 56 sethi %hi(0x40015800), %g4 40007a08: 83 30 60 0f srl %g1, 0xf, %g1 40007a0c: 88 11 23 30 or %g4, 0x330, %g4 40007a10: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 40007a14: 03 10 00 50 sethi %hi(0x40014000), %g1 40007a18: 89 29 20 10 sll %g4, 0x10, %g4 40007a1c: 9b 31 20 10 srl %g4, 0x10, %o5 40007a20: 80 a3 60 ff cmp %o5, 0xff 40007a24: 18 80 00 05 bgu 40007a38 <_Scheduler_priority_Block+0x104> 40007a28: 82 10 61 18 or %g1, 0x118, %g1 40007a2c: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 40007a30: 10 80 00 04 b 40007a40 <_Scheduler_priority_Block+0x10c> 40007a34: 82 00 60 08 add %g1, 8, %g1 40007a38: 89 31 20 18 srl %g4, 0x18, %g4 40007a3c: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 40007a40: 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) + 40007a44: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 40007a48: 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) + 40007a4c: 85 30 a0 0c srl %g2, 0xc, %g2 40007a50: 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 ] ) ) 40007a54: 89 28 a0 02 sll %g2, 2, %g4 40007a58: 83 28 a0 04 sll %g2, 4, %g1 40007a5c: 82 20 40 04 sub %g1, %g4, %g1 _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } 40007a60: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 40007a64: 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 ); 40007a68: 86 01 20 04 add %g4, 4, %g3 40007a6c: 80 a0 80 03 cmp %g2, %g3 40007a70: 02 80 00 03 be 40007a7c <_Scheduler_priority_Block+0x148> <== NEVER TAKEN 40007a74: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 40007a78: 82 10 00 02 mov %g2, %g1 * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 40007a7c: 05 10 00 56 sethi %hi(0x40015800), %g2 40007a80: c2 20 a3 08 st %g1, [ %g2 + 0x308 ] ! 40015b08 <_Per_CPU_Information+0x10> RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40007a84: 03 10 00 56 sethi %hi(0x40015800), %g1 40007a88: 82 10 62 f8 or %g1, 0x2f8, %g1 ! 40015af8 <_Per_CPU_Information> /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) 40007a8c: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40007a90: 80 a6 00 02 cmp %i0, %g2 40007a94: 12 80 00 03 bne 40007aa0 <_Scheduler_priority_Block+0x16c> 40007a98: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 40007a9c: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 40007aa0: 81 c7 e0 08 ret 40007aa4: 81 e8 00 00 restore =============================================================================== 40007c58 <_Scheduler_priority_Schedule>: #include #include #include void _Scheduler_priority_Schedule(void) { 40007c58: 9d e3 bf a0 save %sp, -96, %sp * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( (Chain_Control *) _Scheduler.information 40007c5c: 03 10 00 52 sethi %hi(0x40014800), %g1 * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 40007c60: c6 00 63 50 ld [ %g1 + 0x350 ], %g3 ! 40014b50 <_Scheduler> 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 ); 40007c64: 03 10 00 56 sethi %hi(0x40015800), %g1 40007c68: c4 10 63 20 lduh [ %g1 + 0x320 ], %g2 ! 40015b20 <_Priority_Major_bit_map> 40007c6c: 03 10 00 50 sethi %hi(0x40014000), %g1 40007c70: 85 28 a0 10 sll %g2, 0x10, %g2 40007c74: 89 30 a0 10 srl %g2, 0x10, %g4 40007c78: 80 a1 20 ff cmp %g4, 0xff 40007c7c: 18 80 00 05 bgu 40007c90 <_Scheduler_priority_Schedule+0x38> 40007c80: 82 10 61 18 or %g1, 0x118, %g1 40007c84: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 40007c88: 10 80 00 04 b 40007c98 <_Scheduler_priority_Schedule+0x40> 40007c8c: 84 00 a0 08 add %g2, 8, %g2 40007c90: 85 30 a0 18 srl %g2, 0x18, %g2 40007c94: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40007c98: 83 28 a0 10 sll %g2, 0x10, %g1 40007c9c: 09 10 00 56 sethi %hi(0x40015800), %g4 40007ca0: 83 30 60 0f srl %g1, 0xf, %g1 40007ca4: 88 11 23 30 or %g4, 0x330, %g4 40007ca8: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 40007cac: 03 10 00 50 sethi %hi(0x40014000), %g1 40007cb0: 89 29 20 10 sll %g4, 0x10, %g4 40007cb4: 9b 31 20 10 srl %g4, 0x10, %o5 40007cb8: 80 a3 60 ff cmp %o5, 0xff 40007cbc: 18 80 00 05 bgu 40007cd0 <_Scheduler_priority_Schedule+0x78> 40007cc0: 82 10 61 18 or %g1, 0x118, %g1 40007cc4: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 40007cc8: 10 80 00 04 b 40007cd8 <_Scheduler_priority_Schedule+0x80> 40007ccc: 82 00 60 08 add %g1, 8, %g1 40007cd0: 89 31 20 18 srl %g4, 0x18, %g4 40007cd4: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 40007cd8: 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) + 40007cdc: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 40007ce0: 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) + 40007ce4: 85 30 a0 0c srl %g2, 0xc, %g2 40007ce8: 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 ] ) ) 40007cec: 89 28 a0 02 sll %g2, 2, %g4 40007cf0: 83 28 a0 04 sll %g2, 4, %g1 40007cf4: 82 20 40 04 sub %g1, %g4, %g1 _Scheduler_priority_Schedule_body(); } 40007cf8: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 40007cfc: 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 ); 40007d00: 86 01 20 04 add %g4, 4, %g3 40007d04: 80 a0 80 03 cmp %g2, %g3 40007d08: 02 80 00 03 be 40007d14 <_Scheduler_priority_Schedule+0xbc><== NEVER TAKEN 40007d0c: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 40007d10: 82 10 00 02 mov %g2, %g1 * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 40007d14: 05 10 00 56 sethi %hi(0x40015800), %g2 40007d18: c2 20 a3 08 st %g1, [ %g2 + 0x308 ] ! 40015b08 <_Per_CPU_Information+0x10> 40007d1c: 81 c7 e0 08 ret 40007d20: 81 e8 00 00 restore =============================================================================== 40006db0 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40006db0: 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(); 40006db4: 03 10 00 7e sethi %hi(0x4001f800), %g1 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40006db8: 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(); 40006dbc: d2 00 62 64 ld [ %g1 + 0x264 ], %o1 if ((!the_tod) || 40006dc0: 80 a4 20 00 cmp %l0, 0 40006dc4: 02 80 00 2b be 40006e70 <_TOD_Validate+0xc0> <== NEVER TAKEN 40006dc8: b0 10 20 00 clr %i0 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 40006dcc: 11 00 03 d0 sethi %hi(0xf4000), %o0 40006dd0: 40 00 4b 94 call 40019c20 <.udiv> 40006dd4: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 40006dd8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40006ddc: 80 a0 40 08 cmp %g1, %o0 40006de0: 1a 80 00 24 bcc 40006e70 <_TOD_Validate+0xc0> 40006de4: 01 00 00 00 nop (the_tod->ticks >= ticks_per_second) || 40006de8: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40006dec: 80 a0 60 3b cmp %g1, 0x3b 40006df0: 18 80 00 20 bgu 40006e70 <_TOD_Validate+0xc0> 40006df4: 01 00 00 00 nop (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 40006df8: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40006dfc: 80 a0 60 3b cmp %g1, 0x3b 40006e00: 18 80 00 1c bgu 40006e70 <_TOD_Validate+0xc0> 40006e04: 01 00 00 00 nop (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 40006e08: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40006e0c: 80 a0 60 17 cmp %g1, 0x17 40006e10: 18 80 00 18 bgu 40006e70 <_TOD_Validate+0xc0> 40006e14: 01 00 00 00 nop (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 40006e18: 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) || 40006e1c: 80 a0 60 00 cmp %g1, 0 40006e20: 02 80 00 14 be 40006e70 <_TOD_Validate+0xc0> <== NEVER TAKEN 40006e24: 80 a0 60 0c cmp %g1, 0xc (the_tod->month == 0) || 40006e28: 18 80 00 12 bgu 40006e70 <_TOD_Validate+0xc0> 40006e2c: 01 00 00 00 nop (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 40006e30: 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) || 40006e34: 80 a0 e7 c3 cmp %g3, 0x7c3 40006e38: 08 80 00 0e bleu 40006e70 <_TOD_Validate+0xc0> 40006e3c: 01 00 00 00 nop (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 40006e40: 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) || 40006e44: 80 a0 a0 00 cmp %g2, 0 40006e48: 02 80 00 0a be 40006e70 <_TOD_Validate+0xc0> <== NEVER TAKEN 40006e4c: 80 88 e0 03 btst 3, %g3 40006e50: 07 10 00 79 sethi %hi(0x4001e400), %g3 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 40006e54: 12 80 00 03 bne 40006e60 <_TOD_Validate+0xb0> 40006e58: 86 10 e1 78 or %g3, 0x178, %g3 ! 4001e578 <_TOD_Days_per_month> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 40006e5c: 82 00 60 0d add %g1, 0xd, %g1 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 40006e60: 83 28 60 02 sll %g1, 2, %g1 40006e64: 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( 40006e68: 80 a0 40 02 cmp %g1, %g2 40006e6c: b0 60 3f ff subx %g0, -1, %i0 if ( the_tod->day > days_in_month ) return false; return true; } 40006e70: 81 c7 e0 08 ret 40006e74: 81 e8 00 00 restore =============================================================================== 40007f40 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 40007f40: 9d e3 bf a0 save %sp, -96, %sp States_Control state, original_state; /* * Save original state */ original_state = the_thread->current_state; 40007f44: 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 ); 40007f48: 40 00 03 46 call 40008c60 <_Thread_Set_transient> 40007f4c: 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 ) 40007f50: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40007f54: 80 a0 40 19 cmp %g1, %i1 40007f58: 02 80 00 05 be 40007f6c <_Thread_Change_priority+0x2c> 40007f5c: a0 10 00 18 mov %i0, %l0 _Thread_Set_priority( the_thread, new_priority ); 40007f60: 90 10 00 18 mov %i0, %o0 40007f64: 40 00 03 25 call 40008bf8 <_Thread_Set_priority> 40007f68: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 40007f6c: 7f ff e7 53 call 40001cb8 40007f70: 01 00 00 00 nop 40007f74: 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; 40007f78: f2 04 20 10 ld [ %l0 + 0x10 ], %i1 if ( state != STATES_TRANSIENT ) { 40007f7c: 80 a6 60 04 cmp %i1, 4 40007f80: 02 80 00 10 be 40007fc0 <_Thread_Change_priority+0x80> 40007f84: 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 ) ) 40007f88: 80 a4 60 00 cmp %l1, 0 40007f8c: 12 80 00 03 bne 40007f98 <_Thread_Change_priority+0x58> <== NEVER TAKEN 40007f90: 82 0e 7f fb and %i1, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 40007f94: c2 24 20 10 st %g1, [ %l0 + 0x10 ] _ISR_Enable( level ); 40007f98: 7f ff e7 4c call 40001cc8 40007f9c: 90 10 00 18 mov %i0, %o0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 40007fa0: 03 00 00 ef sethi %hi(0x3bc00), %g1 40007fa4: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 40007fa8: 80 8e 40 01 btst %i1, %g1 40007fac: 02 80 00 28 be 4000804c <_Thread_Change_priority+0x10c> 40007fb0: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 40007fb4: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 40007fb8: 40 00 02 e3 call 40008b44 <_Thread_queue_Requeue> 40007fbc: 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 ) ) { 40007fc0: 80 a4 60 00 cmp %l1, 0 40007fc4: 12 80 00 0b bne 40007ff0 <_Thread_Change_priority+0xb0> <== NEVER TAKEN 40007fc8: 03 10 00 52 sethi %hi(0x40014800), %g1 * Interrupts are STILL disabled. * We now know the thread will be in the READY state when we remove * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 40007fcc: c0 24 20 10 clr [ %l0 + 0x10 ] if ( prepend_it ) 40007fd0: 80 8e a0 ff btst 0xff, %i2 40007fd4: 02 80 00 04 be 40007fe4 <_Thread_Change_priority+0xa4> 40007fd8: 82 10 63 50 or %g1, 0x350, %g1 */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue_first( the_thread ); 40007fdc: 10 80 00 03 b 40007fe8 <_Thread_Change_priority+0xa8> 40007fe0: c2 00 60 28 ld [ %g1 + 0x28 ], %g1 */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue( the_thread ); 40007fe4: c2 00 60 24 ld [ %g1 + 0x24 ], %g1 40007fe8: 9f c0 40 00 call %g1 40007fec: 90 10 00 10 mov %l0, %o0 _Scheduler_Enqueue_first( the_thread ); else _Scheduler_Enqueue( the_thread ); } _ISR_Flash( level ); 40007ff0: 7f ff e7 36 call 40001cc8 40007ff4: 90 10 00 18 mov %i0, %o0 40007ff8: 7f ff e7 30 call 40001cb8 40007ffc: 01 00 00 00 nop * This kernel routine implements the scheduling decision logic for * the scheduler. It does NOT dispatch. */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( void ) { _Scheduler.Operations.schedule(); 40008000: 03 10 00 52 sethi %hi(0x40014800), %g1 40008004: c2 00 63 58 ld [ %g1 + 0x358 ], %g1 ! 40014b58 <_Scheduler+0x8> 40008008: 9f c0 40 00 call %g1 4000800c: 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 ); 40008010: 03 10 00 56 sethi %hi(0x40015800), %g1 40008014: 82 10 62 f8 or %g1, 0x2f8, %g1 ! 40015af8 <_Per_CPU_Information> 40008018: 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(); if ( !_Thread_Is_executing_also_the_heir() && 4000801c: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40008020: 80 a0 80 03 cmp %g2, %g3 40008024: 02 80 00 08 be 40008044 <_Thread_Change_priority+0x104> 40008028: 01 00 00 00 nop 4000802c: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 40008030: 80 a0 a0 00 cmp %g2, 0 40008034: 02 80 00 04 be 40008044 <_Thread_Change_priority+0x104> 40008038: 01 00 00 00 nop _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 4000803c: 84 10 20 01 mov 1, %g2 ! 1 40008040: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] _ISR_Enable( level ); 40008044: 7f ff e7 21 call 40001cc8 40008048: 81 e8 00 00 restore 4000804c: 81 c7 e0 08 ret 40008050: 81 e8 00 00 restore =============================================================================== 40008220 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 40008220: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40008224: 90 10 00 18 mov %i0, %o0 40008228: 40 00 00 5f call 400083a4 <_Thread_Get> 4000822c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40008230: c2 07 bf fc ld [ %fp + -4 ], %g1 40008234: 80 a0 60 00 cmp %g1, 0 40008238: 12 80 00 08 bne 40008258 <_Thread_Delay_ended+0x38> <== NEVER TAKEN 4000823c: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 40008240: 7f ff ff 85 call 40008054 <_Thread_Clear_state> 40008244: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 40008248: 03 10 00 55 sethi %hi(0x40015400), %g1 4000824c: c4 00 61 c0 ld [ %g1 + 0x1c0 ], %g2 ! 400155c0 <_Thread_Dispatch_disable_level> 40008250: 84 00 bf ff add %g2, -1, %g2 40008254: c4 20 61 c0 st %g2, [ %g1 + 0x1c0 ] 40008258: 81 c7 e0 08 ret 4000825c: 81 e8 00 00 restore =============================================================================== 40008260 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 40008260: 9d e3 bf 90 save %sp, -112, %sp Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 40008264: 2b 10 00 56 sethi %hi(0x40015800), %l5 40008268: 82 15 62 f8 or %l5, 0x2f8, %g1 ! 40015af8 <_Per_CPU_Information> _ISR_Disable( level ); 4000826c: 7f ff e6 93 call 40001cb8 40008270: e2 00 60 0c ld [ %g1 + 0xc ], %l1 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 40008274: 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; 40008278: 39 10 00 55 sethi %hi(0x40015400), %i4 4000827c: 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; 40008280: 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 ); 40008284: a8 07 bf f8 add %fp, -8, %l4 _Timestamp_Subtract( 40008288: a6 07 bf f0 add %fp, -16, %l3 4000828c: a4 14 a2 6c or %l2, 0x26c, %l2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 40008290: 10 80 00 2b b 4000833c <_Thread_Dispatch+0xdc> 40008294: 2d 10 00 55 sethi %hi(0x40015400), %l6 heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 40008298: fa 27 21 c0 st %i5, [ %i4 + 0x1c0 ] _Thread_Dispatch_necessary = false; 4000829c: 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 ) 400082a0: 80 a4 00 11 cmp %l0, %l1 400082a4: 02 80 00 2b be 40008350 <_Thread_Dispatch+0xf0> 400082a8: 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 ) 400082ac: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 400082b0: 80 a0 60 01 cmp %g1, 1 400082b4: 12 80 00 03 bne 400082c0 <_Thread_Dispatch+0x60> 400082b8: c2 05 e1 24 ld [ %l7 + 0x124 ], %g1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 400082bc: c2 24 20 78 st %g1, [ %l0 + 0x78 ] _ISR_Enable( level ); 400082c0: 7f ff e6 82 call 40001cc8 400082c4: 01 00 00 00 nop #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 400082c8: 40 00 0f 22 call 4000bf50 <_TOD_Get_uptime> 400082cc: 90 10 00 14 mov %l4, %o0 _Timestamp_Subtract( 400082d0: 90 10 00 12 mov %l2, %o0 400082d4: 92 10 00 14 mov %l4, %o1 400082d8: 40 00 03 02 call 40008ee0 <_Timespec_Subtract> 400082dc: 94 10 00 13 mov %l3, %o2 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 400082e0: 90 04 60 84 add %l1, 0x84, %o0 400082e4: 40 00 02 e6 call 40008e7c <_Timespec_Add_to> 400082e8: 92 10 00 13 mov %l3, %o1 _Thread_Time_of_last_context_switch = uptime; 400082ec: c2 07 bf f8 ld [ %fp + -8 ], %g1 400082f0: c2 24 80 00 st %g1, [ %l2 ] 400082f4: c2 07 bf fc ld [ %fp + -4 ], %g1 400082f8: c2 24 a0 04 st %g1, [ %l2 + 4 ] #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 400082fc: c2 05 a2 44 ld [ %l6 + 0x244 ], %g1 40008300: 80 a0 60 00 cmp %g1, 0 40008304: 02 80 00 06 be 4000831c <_Thread_Dispatch+0xbc> <== NEVER TAKEN 40008308: 90 10 00 11 mov %l1, %o0 executing->libc_reent = *_Thread_libc_reent; 4000830c: c4 00 40 00 ld [ %g1 ], %g2 40008310: c4 24 61 50 st %g2, [ %l1 + 0x150 ] *_Thread_libc_reent = heir->libc_reent; 40008314: c4 04 21 50 ld [ %l0 + 0x150 ], %g2 40008318: c4 20 40 00 st %g2, [ %g1 ] } _User_extensions_Thread_switch( executing, heir ); 4000831c: 40 00 03 a1 call 400091a0 <_User_extensions_Thread_switch> 40008320: 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 ); 40008324: 90 04 60 c8 add %l1, 0xc8, %o0 40008328: 40 00 04 92 call 40009570 <_CPU_Context_switch> 4000832c: 92 04 20 c8 add %l0, 0xc8, %o1 if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; 40008330: 82 15 62 f8 or %l5, 0x2f8, %g1 _ISR_Disable( level ); 40008334: 7f ff e6 61 call 40001cb8 40008338: 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 ) { 4000833c: 82 15 62 f8 or %l5, 0x2f8, %g1 40008340: c4 08 60 18 ldub [ %g1 + 0x18 ], %g2 40008344: 80 a0 a0 00 cmp %g2, 0 40008348: 32 bf ff d4 bne,a 40008298 <_Thread_Dispatch+0x38> 4000834c: e0 00 60 10 ld [ %g1 + 0x10 ], %l0 _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 40008350: 03 10 00 55 sethi %hi(0x40015400), %g1 40008354: c0 20 61 c0 clr [ %g1 + 0x1c0 ] ! 400155c0 <_Thread_Dispatch_disable_level> _ISR_Enable( level ); 40008358: 7f ff e6 5c call 40001cc8 4000835c: 01 00 00 00 nop _API_extensions_Run_postswitch(); 40008360: 7f ff f8 80 call 40006560 <_API_extensions_Run_postswitch> 40008364: 01 00 00 00 nop } 40008368: 81 c7 e0 08 ret 4000836c: 81 e8 00 00 restore =============================================================================== 4000e010 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 4000e010: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 4000e014: 03 10 00 56 sethi %hi(0x40015800), %g1 4000e018: e0 00 63 04 ld [ %g1 + 0x304 ], %l0 ! 40015b04 <_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(); 4000e01c: 3f 10 00 38 sethi %hi(0x4000e000), %i7 4000e020: be 17 e0 10 or %i7, 0x10, %i7 ! 4000e010 <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4000e024: d0 04 20 ac ld [ %l0 + 0xac ], %o0 _ISR_Set_level(level); 4000e028: 7f ff cf 28 call 40001cc8 4000e02c: 91 2a 20 08 sll %o0, 8, %o0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000e030: 03 10 00 54 sethi %hi(0x40015000), %g1 doneConstructors = 1; 4000e034: 84 10 20 01 mov 1, %g2 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000e038: e2 08 63 84 ldub [ %g1 + 0x384 ], %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 ); 4000e03c: 90 10 00 10 mov %l0, %o0 4000e040: 7f ff eb e8 call 40008fe0 <_User_extensions_Thread_begin> 4000e044: c4 28 63 84 stb %g2, [ %g1 + 0x384 ] /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4000e048: 7f ff e8 ca call 40008370 <_Thread_Enable_dispatch> 4000e04c: 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) */ { 4000e050: 80 a4 60 00 cmp %l1, 0 4000e054: 32 80 00 05 bne,a 4000e068 <_Thread_Handler+0x58> 4000e058: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 INIT_NAME (); 4000e05c: 40 00 1a a7 call 40014af8 <_init> 4000e060: 01 00 00 00 nop } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000e064: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000e068: 80 a0 60 00 cmp %g1, 0 4000e06c: 12 80 00 05 bne 4000e080 <_Thread_Handler+0x70> 4000e070: 80 a0 60 01 cmp %g1, 1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4000e074: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000e078: 10 80 00 06 b 4000e090 <_Thread_Handler+0x80> 4000e07c: 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 ) { 4000e080: 12 80 00 07 bne 4000e09c <_Thread_Handler+0x8c> <== NEVER TAKEN 4000e084: 01 00 00 00 nop executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 4000e088: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000e08c: d0 04 20 98 ld [ %l0 + 0x98 ], %o0 4000e090: 9f c0 40 00 call %g1 4000e094: 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 = 4000e098: 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 ); 4000e09c: 7f ff eb e2 call 40009024 <_User_extensions_Thread_exitted> 4000e0a0: 90 10 00 10 mov %l0, %o0 _Internal_error_Occurred( 4000e0a4: 90 10 20 00 clr %o0 4000e0a8: 92 10 20 01 mov 1, %o1 4000e0ac: 7f ff e3 cf call 40006fe8 <_Internal_error_Occurred> 4000e0b0: 94 10 20 05 mov 5, %o2 =============================================================================== 40008450 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 40008450: 9d e3 bf a0 save %sp, -96, %sp 40008454: 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; 40008458: c0 26 61 54 clr [ %i1 + 0x154 ] 4000845c: c0 26 61 58 clr [ %i1 + 0x158 ] extensions_area = NULL; the_thread->libc_reent = NULL; 40008460: 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 ) { 40008464: e0 07 a0 60 ld [ %fp + 0x60 ], %l0 40008468: 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 ) { 4000846c: 80 a6 a0 00 cmp %i2, 0 40008470: 12 80 00 0d bne 400084a4 <_Thread_Initialize+0x54> 40008474: e4 0f a0 5f ldub [ %fp + 0x5f ], %l2 actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 40008478: 90 10 00 19 mov %i1, %o0 4000847c: 40 00 02 09 call 40008ca0 <_Thread_Stack_Allocate> 40008480: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 40008484: 80 a2 00 1b cmp %o0, %i3 40008488: 0a 80 00 5f bcs 40008604 <_Thread_Initialize+0x1b4> 4000848c: 80 a2 20 00 cmp %o0, 0 40008490: 02 80 00 5d be 40008604 <_Thread_Initialize+0x1b4> <== NEVER TAKEN 40008494: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 40008498: f4 06 60 c0 ld [ %i1 + 0xc0 ], %i2 the_thread->Start.core_allocated_stack = true; 4000849c: 10 80 00 04 b 400084ac <_Thread_Initialize+0x5c> 400084a0: c2 2e 60 b4 stb %g1, [ %i1 + 0xb4 ] } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 400084a4: c0 2e 60 b4 clrb [ %i1 + 0xb4 ] 400084a8: 90 10 00 1b mov %i3, %o0 void *starting_address, size_t size ) { the_stack->area = starting_address; the_stack->size = size; 400084ac: d0 26 60 b8 st %o0, [ %i1 + 0xb8 ] #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 400084b0: 03 10 00 55 sethi %hi(0x40015400), %g1 400084b4: d0 00 62 50 ld [ %g1 + 0x250 ], %o0 ! 40015650 <_Thread_Maximum_extensions> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 400084b8: f4 26 60 bc st %i2, [ %i1 + 0xbc ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 400084bc: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 400084c0: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 400084c4: c0 26 60 68 clr [ %i1 + 0x68 ] the_watchdog->user_data = user_data; 400084c8: c0 26 60 6c clr [ %i1 + 0x6c ] 400084cc: 80 a2 20 00 cmp %o0, 0 400084d0: 02 80 00 08 be 400084f0 <_Thread_Initialize+0xa0> 400084d4: b6 10 20 00 clr %i3 extensions_area = _Workspace_Allocate( 400084d8: 90 02 20 01 inc %o0 400084dc: 40 00 04 07 call 400094f8 <_Workspace_Allocate> 400084e0: 91 2a 20 02 sll %o0, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 400084e4: b6 92 20 00 orcc %o0, 0, %i3 400084e8: 22 80 00 38 be,a 400085c8 <_Thread_Initialize+0x178> 400084ec: 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 ) { 400084f0: 80 a6 e0 00 cmp %i3, 0 400084f4: 02 80 00 0b be 40008520 <_Thread_Initialize+0xd0> 400084f8: f6 26 61 5c st %i3, [ %i1 + 0x15c ] for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 400084fc: 03 10 00 55 sethi %hi(0x40015400), %g1 40008500: c4 00 62 50 ld [ %g1 + 0x250 ], %g2 ! 40015650 <_Thread_Maximum_extensions> 40008504: 10 80 00 04 b 40008514 <_Thread_Initialize+0xc4> 40008508: 82 10 20 00 clr %g1 4000850c: 82 00 60 01 inc %g1 the_thread->extensions[i] = NULL; 40008510: 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++ ) 40008514: 80 a0 40 02 cmp %g1, %g2 40008518: 08 bf ff fd bleu 4000850c <_Thread_Initialize+0xbc> 4000851c: 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; 40008520: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 40008524: e4 2e 60 a0 stb %l2, [ %i1 + 0xa0 ] the_thread->Start.budget_algorithm = budget_algorithm; 40008528: e0 26 60 a4 st %l0, [ %i1 + 0xa4 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 4000852c: 80 a4 20 02 cmp %l0, 2 40008530: 12 80 00 05 bne 40008544 <_Thread_Initialize+0xf4> 40008534: 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; 40008538: 03 10 00 55 sethi %hi(0x40015400), %g1 4000853c: c2 00 61 24 ld [ %g1 + 0x124 ], %g1 ! 40015524 <_Thread_Ticks_per_timeslice> 40008540: c2 26 60 78 st %g1, [ %i1 + 0x78 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 40008544: c2 07 a0 68 ld [ %fp + 0x68 ], %g1 the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; 40008548: c0 26 60 44 clr [ %i1 + 0x44 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 4000854c: c2 26 60 ac st %g1, [ %i1 + 0xac ] the_thread->current_state = STATES_DORMANT; 40008550: 82 10 20 01 mov 1, %g1 40008554: c2 26 60 10 st %g1, [ %i1 + 0x10 ] */ RTEMS_INLINE_ROUTINE void* _Scheduler_Allocate( Thread_Control *the_thread ) { return _Scheduler.Operations.allocate( the_thread ); 40008558: 03 10 00 52 sethi %hi(0x40014800), %g1 4000855c: c2 00 63 68 ld [ %g1 + 0x368 ], %g1 ! 40014b68 <_Scheduler+0x18> the_thread->Wait.queue = NULL; the_thread->resource_count = 0; 40008560: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 40008564: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; 40008568: fa 26 60 b0 st %i5, [ %i1 + 0xb0 ] 4000856c: 9f c0 40 00 call %g1 40008570: 90 10 00 19 mov %i1, %o0 sched =_Scheduler_Allocate( the_thread ); if ( !sched ) 40008574: a0 92 20 00 orcc %o0, 0, %l0 40008578: 22 80 00 15 be,a 400085cc <_Thread_Initialize+0x17c> 4000857c: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 goto failed; _Thread_Set_priority( the_thread, priority ); 40008580: 90 10 00 19 mov %i1, %o0 40008584: 40 00 01 9d call 40008bf8 <_Thread_Set_priority> 40008588: 92 10 00 1d mov %i5, %o1 _Workspace_Free( sched ); _Thread_Stack_Free( the_thread ); return false; } 4000858c: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40008590: 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 ); 40008594: c0 26 60 84 clr [ %i1 + 0x84 ] 40008598: c0 26 60 88 clr [ %i1 + 0x88 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000859c: 83 28 60 02 sll %g1, 2, %g1 400085a0: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 400085a4: 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 ); 400085a8: 90 10 00 19 mov %i1, %o0 400085ac: 40 00 02 c0 call 400090ac <_User_extensions_Thread_create> 400085b0: b0 10 20 01 mov 1, %i0 if ( extension_status ) 400085b4: 80 8a 20 ff btst 0xff, %o0 400085b8: 22 80 00 05 be,a 400085cc <_Thread_Initialize+0x17c> 400085bc: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 400085c0: 81 c7 e0 08 ret 400085c4: 81 e8 00 00 restore return true; failed: _Workspace_Free( the_thread->libc_reent ); 400085c8: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 400085cc: 40 00 03 d4 call 4000951c <_Workspace_Free> 400085d0: b0 10 20 00 clr %i0 for ( i=0 ; i <= THREAD_API_LAST ; i++ ) _Workspace_Free( the_thread->API_Extensions[i] ); 400085d4: 40 00 03 d2 call 4000951c <_Workspace_Free> 400085d8: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 400085dc: 40 00 03 d0 call 4000951c <_Workspace_Free> 400085e0: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 _Workspace_Free( extensions_area ); 400085e4: 40 00 03 ce call 4000951c <_Workspace_Free> 400085e8: 90 10 00 1b mov %i3, %o0 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Workspace_Free( fp_area ); #endif _Workspace_Free( sched ); 400085ec: 40 00 03 cc call 4000951c <_Workspace_Free> 400085f0: 90 10 00 10 mov %l0, %o0 _Thread_Stack_Free( the_thread ); 400085f4: 40 00 01 c2 call 40008cfc <_Thread_Stack_Free> 400085f8: 90 10 00 19 mov %i1, %o0 return false; 400085fc: 81 c7 e0 08 ret 40008600: 81 e8 00 00 restore } 40008604: 81 c7 e0 08 ret 40008608: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000c264 <_Thread_Resume>: */ void _Thread_Resume( Thread_Control *the_thread, bool force ) { 4000c264: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 4000c268: 7f ff d7 08 call 40001e88 4000c26c: a0 10 00 18 mov %i0, %l0 4000c270: b0 10 00 08 mov %o0, %i0 current_state = the_thread->current_state; 4000c274: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 if ( current_state & STATES_SUSPENDED ) { 4000c278: 80 88 60 02 btst 2, %g1 4000c27c: 02 80 00 09 be 4000c2a0 <_Thread_Resume+0x3c> <== NEVER TAKEN 4000c280: 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 ) ) { 4000c284: 80 a0 60 00 cmp %g1, 0 4000c288: 12 80 00 06 bne 4000c2a0 <_Thread_Resume+0x3c> 4000c28c: c2 24 20 10 st %g1, [ %l0 + 0x10 ] */ RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Thread_Control *the_thread ) { _Scheduler.Operations.unblock( the_thread ); 4000c290: 03 10 00 61 sethi %hi(0x40018400), %g1 4000c294: c2 00 61 a4 ld [ %g1 + 0x1a4 ], %g1 ! 400185a4 <_Scheduler+0x14> 4000c298: 9f c0 40 00 call %g1 4000c29c: 90 10 00 10 mov %l0, %o0 _Scheduler_Unblock( the_thread ); } } _ISR_Enable( level ); 4000c2a0: 7f ff d6 fe call 40001e98 4000c2a4: 81 e8 00 00 restore =============================================================================== 40008dcc <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 40008dcc: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing; executing = _Thread_Executing; 40008dd0: 03 10 00 56 sethi %hi(0x40015800), %g1 40008dd4: e0 00 63 04 ld [ %g1 + 0x304 ], %l0 ! 40015b04 <_Per_CPU_Information+0xc> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 40008dd8: c2 0c 20 74 ldub [ %l0 + 0x74 ], %g1 40008ddc: 80 a0 60 00 cmp %g1, 0 40008de0: 02 80 00 25 be 40008e74 <_Thread_Tickle_timeslice+0xa8> 40008de4: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 40008de8: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40008dec: 80 a0 60 00 cmp %g1, 0 40008df0: 12 80 00 21 bne 40008e74 <_Thread_Tickle_timeslice+0xa8> 40008df4: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 40008df8: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40008dfc: 80 a0 60 01 cmp %g1, 1 40008e00: 0a 80 00 14 bcs 40008e50 <_Thread_Tickle_timeslice+0x84> 40008e04: 80 a0 60 02 cmp %g1, 2 40008e08: 28 80 00 07 bleu,a 40008e24 <_Thread_Tickle_timeslice+0x58> 40008e0c: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 40008e10: 80 a0 60 03 cmp %g1, 3 40008e14: 12 80 00 18 bne 40008e74 <_Thread_Tickle_timeslice+0xa8> <== NEVER TAKEN 40008e18: 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 ) 40008e1c: 10 80 00 0f b 40008e58 <_Thread_Tickle_timeslice+0x8c> 40008e20: 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 ) { 40008e24: 82 00 7f ff add %g1, -1, %g1 40008e28: 80 a0 60 00 cmp %g1, 0 40008e2c: 14 80 00 09 bg 40008e50 <_Thread_Tickle_timeslice+0x84> 40008e30: 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(); 40008e34: 03 10 00 52 sethi %hi(0x40014800), %g1 40008e38: c2 00 63 5c ld [ %g1 + 0x35c ], %g1 ! 40014b5c <_Scheduler+0xc> 40008e3c: 9f c0 40 00 call %g1 40008e40: 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; 40008e44: 03 10 00 55 sethi %hi(0x40015400), %g1 40008e48: c2 00 61 24 ld [ %g1 + 0x124 ], %g1 ! 40015524 <_Thread_Ticks_per_timeslice> 40008e4c: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 40008e50: 81 c7 e0 08 ret 40008e54: 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 ) 40008e58: 82 00 7f ff add %g1, -1, %g1 40008e5c: 80 a0 60 00 cmp %g1, 0 40008e60: 12 bf ff fc bne 40008e50 <_Thread_Tickle_timeslice+0x84> 40008e64: c2 24 20 78 st %g1, [ %l0 + 0x78 ] (*executing->budget_callout)( executing ); 40008e68: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 40008e6c: 9f c0 40 00 call %g1 40008e70: 90 10 00 10 mov %l0, %o0 40008e74: 81 c7 e0 08 ret 40008e78: 81 e8 00 00 restore =============================================================================== 40008b44 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 40008b44: 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 ) 40008b48: 80 a6 20 00 cmp %i0, 0 40008b4c: 02 80 00 19 be 40008bb0 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 40008b50: 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 ) { 40008b54: e2 06 20 34 ld [ %i0 + 0x34 ], %l1 40008b58: 80 a4 60 01 cmp %l1, 1 40008b5c: 12 80 00 15 bne 40008bb0 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 40008b60: 01 00 00 00 nop Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 40008b64: 7f ff e4 55 call 40001cb8 40008b68: 01 00 00 00 nop 40008b6c: a0 10 00 08 mov %o0, %l0 40008b70: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 40008b74: 03 00 00 ef sethi %hi(0x3bc00), %g1 40008b78: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 40008b7c: 80 88 80 01 btst %g2, %g1 40008b80: 02 80 00 0a be 40008ba8 <_Thread_queue_Requeue+0x64> <== NEVER TAKEN 40008b84: 90 10 00 18 mov %i0, %o0 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 40008b88: 92 10 00 19 mov %i1, %o1 40008b8c: 94 10 20 01 mov 1, %o2 40008b90: 40 00 0e 5d call 4000c504 <_Thread_queue_Extract_priority_helper> 40008b94: e2 26 20 30 st %l1, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 40008b98: 90 10 00 18 mov %i0, %o0 40008b9c: 92 10 00 19 mov %i1, %o1 40008ba0: 7f ff ff 49 call 400088c4 <_Thread_queue_Enqueue_priority> 40008ba4: 94 07 bf fc add %fp, -4, %o2 } _ISR_Enable( level ); 40008ba8: 7f ff e4 48 call 40001cc8 40008bac: 90 10 00 10 mov %l0, %o0 40008bb0: 81 c7 e0 08 ret 40008bb4: 81 e8 00 00 restore =============================================================================== 40008bb8 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 40008bb8: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40008bbc: 90 10 00 18 mov %i0, %o0 40008bc0: 7f ff fd f9 call 400083a4 <_Thread_Get> 40008bc4: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40008bc8: c2 07 bf fc ld [ %fp + -4 ], %g1 40008bcc: 80 a0 60 00 cmp %g1, 0 40008bd0: 12 80 00 08 bne 40008bf0 <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 40008bd4: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40008bd8: 40 00 0e 83 call 4000c5e4 <_Thread_queue_Process_timeout> 40008bdc: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40008be0: 03 10 00 55 sethi %hi(0x40015400), %g1 40008be4: c4 00 61 c0 ld [ %g1 + 0x1c0 ], %g2 ! 400155c0 <_Thread_Dispatch_disable_level> 40008be8: 84 00 bf ff add %g2, -1, %g2 40008bec: c4 20 61 c0 st %g2, [ %g1 + 0x1c0 ] 40008bf0: 81 c7 e0 08 ret 40008bf4: 81 e8 00 00 restore =============================================================================== 40016534 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 40016534: 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; 40016538: 39 10 00 fb sethi %hi(0x4003ec00), %i4 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 4001653c: b6 07 bf f4 add %fp, -12, %i3 40016540: ae 07 bf f8 add %fp, -8, %l7 40016544: a4 07 bf e8 add %fp, -24, %l2 40016548: a6 07 bf ec add %fp, -20, %l3 4001654c: ee 27 bf f4 st %l7, [ %fp + -12 ] head->previous = NULL; 40016550: c0 27 bf f8 clr [ %fp + -8 ] tail->previous = head; 40016554: 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; 40016558: e6 27 bf e8 st %l3, [ %fp + -24 ] head->previous = NULL; 4001655c: c0 27 bf ec clr [ %fp + -20 ] tail->previous = head; 40016560: 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 ); 40016564: 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(); 40016568: 3b 10 00 fb sethi %hi(0x4003ec00), %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 ); 4001656c: 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 ); 40016570: 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 ); 40016574: 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; 40016578: 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; 4001657c: c2 07 20 e0 ld [ %i4 + 0xe0 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 40016580: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40016584: 94 10 00 12 mov %l2, %o2 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 40016588: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 4001658c: 90 10 00 14 mov %l4, %o0 40016590: 40 00 12 01 call 4001ad94 <_Watchdog_Adjust_to_chain> 40016594: 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; 40016598: 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(); 4001659c: e0 07 60 58 ld [ %i5 + 0x58 ], %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 ) { 400165a0: 80 a4 00 0a cmp %l0, %o2 400165a4: 08 80 00 06 bleu 400165bc <_Timer_server_Body+0x88> 400165a8: 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 ); 400165ac: 90 10 00 11 mov %l1, %o0 400165b0: 40 00 11 f9 call 4001ad94 <_Watchdog_Adjust_to_chain> 400165b4: 94 10 00 12 mov %l2, %o2 400165b8: 30 80 00 06 b,a 400165d0 <_Timer_server_Body+0x9c> } else if ( snapshot < last_snapshot ) { 400165bc: 1a 80 00 05 bcc 400165d0 <_Timer_server_Body+0x9c> 400165c0: 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 ); 400165c4: 92 10 20 01 mov 1, %o1 400165c8: 40 00 11 cb call 4001acf4 <_Watchdog_Adjust> 400165cc: 94 22 80 10 sub %o2, %l0, %o2 } watchdogs->last_snapshot = snapshot; 400165d0: 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 ); 400165d4: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 400165d8: 40 00 02 dd call 4001714c <_Chain_Get> 400165dc: 01 00 00 00 nop if ( timer == NULL ) { 400165e0: 92 92 20 00 orcc %o0, 0, %o1 400165e4: 02 80 00 0c be 40016614 <_Timer_server_Body+0xe0> 400165e8: 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 ) { 400165ec: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 400165f0: 80 a0 60 01 cmp %g1, 1 400165f4: 02 80 00 05 be 40016608 <_Timer_server_Body+0xd4> 400165f8: 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 ) { 400165fc: 80 a0 60 03 cmp %g1, 3 40016600: 12 bf ff f5 bne 400165d4 <_Timer_server_Body+0xa0> <== NEVER TAKEN 40016604: 90 10 00 11 mov %l1, %o0 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 40016608: 40 00 12 17 call 4001ae64 <_Watchdog_Insert> 4001660c: 92 02 60 10 add %o1, 0x10, %o1 40016610: 30 bf ff f1 b,a 400165d4 <_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 ); 40016614: 7f ff e3 94 call 4000f464 40016618: 01 00 00 00 nop tmp = ts->insert_chain; 4001661c: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 if ( _Chain_Is_empty( insert_chain ) ) { 40016620: c2 07 bf f4 ld [ %fp + -12 ], %g1 40016624: 80 a0 40 17 cmp %g1, %l7 40016628: 12 80 00 04 bne 40016638 <_Timer_server_Body+0x104> <== NEVER TAKEN 4001662c: a0 10 20 01 mov 1, %l0 ts->insert_chain = NULL; 40016630: c0 26 20 78 clr [ %i0 + 0x78 ] do_loop = false; 40016634: a0 10 20 00 clr %l0 } _ISR_Enable( level ); 40016638: 7f ff e3 8f call 4000f474 4001663c: 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 ) { 40016640: 80 8c 20 ff btst 0xff, %l0 40016644: 12 bf ff ce bne 4001657c <_Timer_server_Body+0x48> <== NEVER TAKEN 40016648: 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 ) ) { 4001664c: 80 a0 40 13 cmp %g1, %l3 40016650: 02 80 00 18 be 400166b0 <_Timer_server_Body+0x17c> 40016654: 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 ); 40016658: 7f ff e3 83 call 4000f464 4001665c: 01 00 00 00 nop 40016660: 84 10 00 08 mov %o0, %g2 initialized = false; } #endif return status; } 40016664: 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)) 40016668: 80 a4 00 13 cmp %l0, %l3 4001666c: 02 80 00 0e be 400166a4 <_Timer_server_Body+0x170> 40016670: 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; 40016674: c2 04 00 00 ld [ %l0 ], %g1 head->next = new_first; 40016678: 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 ) { 4001667c: 02 80 00 0a be 400166a4 <_Timer_server_Body+0x170> <== NEVER TAKEN 40016680: e4 20 60 04 st %l2, [ %g1 + 4 ] watchdog->state = WATCHDOG_INACTIVE; 40016684: c0 24 20 08 clr [ %l0 + 8 ] _ISR_Enable( level ); 40016688: 7f ff e3 7b call 4000f474 4001668c: 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 ); 40016690: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40016694: d0 04 20 20 ld [ %l0 + 0x20 ], %o0 40016698: 9f c0 40 00 call %g1 4001669c: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 } 400166a0: 30 bf ff ee b,a 40016658 <_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 ); 400166a4: 7f ff e3 74 call 4000f474 400166a8: 90 10 00 02 mov %g2, %o0 400166ac: 30 bf ff b3 b,a 40016578 <_Timer_server_Body+0x44> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 400166b0: c0 2e 20 7c clrb [ %i0 + 0x7c ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); 400166b4: 7f ff ff 70 call 40016474 <_Thread_Disable_dispatch> 400166b8: 01 00 00 00 nop _Thread_Set_state( ts->thread, STATES_DELAYING ); 400166bc: d0 06 00 00 ld [ %i0 ], %o0 400166c0: 40 00 0f d4 call 4001a610 <_Thread_Set_state> 400166c4: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 400166c8: 7f ff ff 71 call 4001648c <_Timer_server_Reset_interval_system_watchdog> 400166cc: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 400166d0: 7f ff ff 84 call 400164e0 <_Timer_server_Reset_tod_system_watchdog> 400166d4: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 400166d8: 40 00 0d 77 call 40019cb4 <_Thread_Enable_dispatch> 400166dc: 01 00 00 00 nop ts->active = true; 400166e0: 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 ); 400166e4: 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; 400166e8: 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 ); 400166ec: 40 00 12 3a call 4001afd4 <_Watchdog_Remove> 400166f0: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 400166f4: 40 00 12 38 call 4001afd4 <_Watchdog_Remove> 400166f8: 90 10 00 15 mov %l5, %o0 400166fc: 30 bf ff 9f b,a 40016578 <_Timer_server_Body+0x44> =============================================================================== 40016700 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 40016700: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 40016704: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 40016708: 80 a0 60 00 cmp %g1, 0 4001670c: 12 80 00 49 bne 40016830 <_Timer_server_Schedule_operation_method+0x130> 40016710: 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(); 40016714: 7f ff ff 58 call 40016474 <_Thread_Disable_dispatch> 40016718: 01 00 00 00 nop if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 4001671c: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 40016720: 80 a0 60 01 cmp %g1, 1 40016724: 12 80 00 1f bne 400167a0 <_Timer_server_Schedule_operation_method+0xa0> 40016728: 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 ); 4001672c: 7f ff e3 4e call 4000f464 40016730: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 40016734: 03 10 00 fb sethi %hi(0x4003ec00), %g1 40016738: c4 00 60 e0 ld [ %g1 + 0xe0 ], %g2 ! 4003ece0 <_Watchdog_Ticks_since_boot> initialized = false; } #endif return status; } 4001673c: 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; 40016740: 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 ); 40016744: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 40016748: 80 a0 40 03 cmp %g1, %g3 4001674c: 02 80 00 08 be 4001676c <_Timer_server_Schedule_operation_method+0x6c> 40016750: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 40016754: da 00 60 10 ld [ %g1 + 0x10 ], %o5 if (delta_interval > delta) { 40016758: 80 a3 40 04 cmp %o5, %g4 4001675c: 08 80 00 03 bleu 40016768 <_Timer_server_Schedule_operation_method+0x68> 40016760: 86 10 20 00 clr %g3 delta_interval -= delta; 40016764: 86 23 40 04 sub %o5, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 40016768: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 4001676c: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 40016770: 7f ff e3 41 call 4000f474 40016774: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 40016778: 90 06 20 30 add %i0, 0x30, %o0 4001677c: 40 00 11 ba call 4001ae64 <_Watchdog_Insert> 40016780: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 40016784: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 40016788: 80 a0 60 00 cmp %g1, 0 4001678c: 12 80 00 27 bne 40016828 <_Timer_server_Schedule_operation_method+0x128> 40016790: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 40016794: 7f ff ff 3e call 4001648c <_Timer_server_Reset_interval_system_watchdog> 40016798: 90 10 00 18 mov %i0, %o0 4001679c: 30 80 00 23 b,a 40016828 <_Timer_server_Schedule_operation_method+0x128> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 400167a0: 12 80 00 22 bne 40016828 <_Timer_server_Schedule_operation_method+0x128> 400167a4: 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 ); 400167a8: 7f ff e3 2f call 4000f464 400167ac: 01 00 00 00 nop initialized = false; } #endif return status; } 400167b0: 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; 400167b4: 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(); 400167b8: 03 10 00 fb sethi %hi(0x4003ec00), %g1 400167bc: 86 06 20 6c add %i0, 0x6c, %g3 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 400167c0: 80 a0 80 03 cmp %g2, %g3 400167c4: 02 80 00 0d be 400167f8 <_Timer_server_Schedule_operation_method+0xf8> 400167c8: c2 00 60 58 ld [ %g1 + 0x58 ], %g1 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 400167cc: c8 00 a0 10 ld [ %g2 + 0x10 ], %g4 if ( snapshot > last_snapshot ) { 400167d0: 80 a0 40 0d cmp %g1, %o5 } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 400167d4: 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 ) { 400167d8: 08 80 00 07 bleu 400167f4 <_Timer_server_Schedule_operation_method+0xf4> 400167dc: 86 20 c0 01 sub %g3, %g1, %g3 /* * We advanced in time. */ delta = snapshot - last_snapshot; 400167e0: 9a 20 40 0d sub %g1, %o5, %o5 if (delta_interval > delta) { 400167e4: 80 a1 00 0d cmp %g4, %o5 400167e8: 08 80 00 03 bleu 400167f4 <_Timer_server_Schedule_operation_method+0xf4><== NEVER TAKEN 400167ec: 86 10 20 00 clr %g3 delta_interval -= delta; 400167f0: 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; 400167f4: c6 20 a0 10 st %g3, [ %g2 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 400167f8: c2 26 20 74 st %g1, [ %i0 + 0x74 ] _ISR_Enable( level ); 400167fc: 7f ff e3 1e call 4000f474 40016800: 01 00 00 00 nop _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 40016804: 90 06 20 68 add %i0, 0x68, %o0 40016808: 40 00 11 97 call 4001ae64 <_Watchdog_Insert> 4001680c: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 40016810: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 40016814: 80 a0 60 00 cmp %g1, 0 40016818: 12 80 00 04 bne 40016828 <_Timer_server_Schedule_operation_method+0x128> 4001681c: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 40016820: 7f ff ff 30 call 400164e0 <_Timer_server_Reset_tod_system_watchdog> 40016824: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 40016828: 40 00 0d 23 call 40019cb4 <_Thread_Enable_dispatch> 4001682c: 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 ); 40016830: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 40016834: 40 00 02 30 call 400170f4 <_Chain_Append> 40016838: 81 e8 00 00 restore =============================================================================== 40009064 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40009064: 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 ); } } 40009068: 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 ); 4000906c: b2 0e 60 ff and %i1, 0xff, %i1 } } 40009070: a2 14 63 a8 or %l1, 0x3a8, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 40009074: 10 80 00 09 b 40009098 <_User_extensions_Fatal+0x34> 40009078: 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 ) 4000907c: 80 a0 60 00 cmp %g1, 0 40009080: 02 80 00 05 be 40009094 <_User_extensions_Fatal+0x30> 40009084: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 40009088: 92 10 00 19 mov %i1, %o1 4000908c: 9f c0 40 00 call %g1 40009090: 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 ) { 40009094: 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 ); 40009098: 80 a4 00 11 cmp %l0, %l1 4000909c: 32 bf ff f8 bne,a 4000907c <_User_extensions_Fatal+0x18> <== ALWAYS TAKEN 400090a0: 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 ); } } 400090a4: 81 c7 e0 08 ret <== NOT EXECUTED 400090a8: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40008f28 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 40008f28: 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; 40008f2c: 03 10 00 53 sethi %hi(0x40014c00), %g1 40008f30: 82 10 60 28 or %g1, 0x28, %g1 ! 40014c28 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40008f34: 05 10 00 55 sethi %hi(0x40015400), %g2 initial_extensions = Configuration.User_extension_table; 40008f38: e6 00 60 3c ld [ %g1 + 0x3c ], %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; 40008f3c: e4 00 60 38 ld [ %g1 + 0x38 ], %l2 40008f40: 82 10 a3 a8 or %g2, 0x3a8, %g1 40008f44: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40008f48: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 40008f4c: 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; 40008f50: c6 20 a3 a8 st %g3, [ %g2 + 0x3a8 ] 40008f54: 05 10 00 55 sethi %hi(0x40015400), %g2 40008f58: 82 10 a1 c4 or %g2, 0x1c4, %g1 ! 400155c4 <_User_extensions_Switches_list> 40008f5c: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40008f60: c0 20 60 04 clr [ %g1 + 4 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40008f64: c6 20 a1 c4 st %g3, [ %g2 + 0x1c4 ] initial_extensions = Configuration.User_extension_table; _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 40008f68: 80 a4 e0 00 cmp %l3, 0 40008f6c: 02 80 00 1b be 40008fd8 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 40008f70: c2 20 60 08 st %g1, [ %g1 + 8 ] extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) 40008f74: 83 2c a0 02 sll %l2, 2, %g1 40008f78: a1 2c a0 04 sll %l2, 4, %l0 40008f7c: a0 24 00 01 sub %l0, %g1, %l0 40008f80: a0 04 00 12 add %l0, %l2, %l0 40008f84: 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( 40008f88: 40 00 01 6c call 40009538 <_Workspace_Allocate_or_fatal_error> 40008f8c: 90 10 00 10 mov %l0, %o0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40008f90: 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( 40008f94: a2 10 00 08 mov %o0, %l1 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40008f98: 92 10 20 00 clr %o1 40008f9c: 40 00 17 32 call 4000ec64 40008fa0: a0 10 20 00 clr %l0 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 40008fa4: 10 80 00 0b b 40008fd0 <_User_extensions_Handler_initialization+0xa8> 40008fa8: 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; 40008fac: 90 04 60 14 add %l1, 0x14, %o0 40008fb0: 92 04 c0 09 add %l3, %o1, %o1 40008fb4: 40 00 16 f3 call 4000eb80 40008fb8: 94 10 20 20 mov 0x20, %o2 _User_extensions_Add_set( extension ); 40008fbc: 90 10 00 11 mov %l1, %o0 40008fc0: 40 00 0d ca call 4000c6e8 <_User_extensions_Add_set> 40008fc4: a0 04 20 01 inc %l0 _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; 40008fc8: 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++ ) { 40008fcc: 80 a4 00 12 cmp %l0, %l2 40008fd0: 0a bf ff f7 bcs 40008fac <_User_extensions_Handler_initialization+0x84> 40008fd4: 93 2c 20 05 sll %l0, 5, %o1 40008fd8: 81 c7 e0 08 ret 40008fdc: 81 e8 00 00 restore =============================================================================== 4000b218 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4000b218: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 4000b21c: 7f ff de b2 call 40002ce4 4000b220: a0 10 00 18 mov %i0, %l0 } } _ISR_Enable( level ); } 4000b224: 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 ); 4000b228: 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 ) ) { 4000b22c: 80 a0 40 11 cmp %g1, %l1 4000b230: 02 80 00 1f be 4000b2ac <_Watchdog_Adjust+0x94> 4000b234: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 4000b238: 02 80 00 1a be 4000b2a0 <_Watchdog_Adjust+0x88> 4000b23c: a4 10 20 01 mov 1, %l2 4000b240: 80 a6 60 01 cmp %i1, 1 4000b244: 12 80 00 1a bne 4000b2ac <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000b248: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4000b24c: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000b250: 10 80 00 07 b 4000b26c <_Watchdog_Adjust+0x54> 4000b254: b4 00 80 1a add %g2, %i2, %i2 break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { 4000b258: f2 00 60 10 ld [ %g1 + 0x10 ], %i1 4000b25c: 80 a6 80 19 cmp %i2, %i1 4000b260: 3a 80 00 05 bcc,a 4000b274 <_Watchdog_Adjust+0x5c> 4000b264: e4 20 60 10 st %l2, [ %g1 + 0x10 ] _Watchdog_First( header )->delta_interval -= units; 4000b268: b4 26 40 1a sub %i1, %i2, %i2 break; 4000b26c: 10 80 00 10 b 4000b2ac <_Watchdog_Adjust+0x94> 4000b270: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; _ISR_Enable( level ); 4000b274: 7f ff de a0 call 40002cf4 4000b278: 01 00 00 00 nop _Watchdog_Tickle( header ); 4000b27c: 40 00 00 94 call 4000b4cc <_Watchdog_Tickle> 4000b280: 90 10 00 10 mov %l0, %o0 _ISR_Disable( level ); 4000b284: 7f ff de 98 call 40002ce4 4000b288: 01 00 00 00 nop if ( _Chain_Is_empty( header ) ) 4000b28c: c2 04 00 00 ld [ %l0 ], %g1 4000b290: 80 a0 40 11 cmp %g1, %l1 4000b294: 02 80 00 06 be 4000b2ac <_Watchdog_Adjust+0x94> 4000b298: 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; 4000b29c: 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 ) { 4000b2a0: 80 a6 a0 00 cmp %i2, 0 4000b2a4: 32 bf ff ed bne,a 4000b258 <_Watchdog_Adjust+0x40> <== ALWAYS TAKEN 4000b2a8: c2 04 00 00 ld [ %l0 ], %g1 } break; } } _ISR_Enable( level ); 4000b2ac: 7f ff de 92 call 40002cf4 4000b2b0: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 4000934c <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 4000934c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 40009350: 7f ff e2 5a call 40001cb8 40009354: a0 10 00 18 mov %i0, %l0 previous_state = the_watchdog->state; 40009358: f0 06 20 08 ld [ %i0 + 8 ], %i0 switch ( previous_state ) { 4000935c: 80 a6 20 01 cmp %i0, 1 40009360: 22 80 00 1d be,a 400093d4 <_Watchdog_Remove+0x88> 40009364: c0 24 20 08 clr [ %l0 + 8 ] 40009368: 0a 80 00 1c bcs 400093d8 <_Watchdog_Remove+0x8c> 4000936c: 03 10 00 55 sethi %hi(0x40015400), %g1 40009370: 80 a6 20 03 cmp %i0, 3 40009374: 18 80 00 19 bgu 400093d8 <_Watchdog_Remove+0x8c> <== NEVER TAKEN 40009378: 01 00 00 00 nop 4000937c: c2 04 00 00 ld [ %l0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 40009380: c0 24 20 08 clr [ %l0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 40009384: c4 00 40 00 ld [ %g1 ], %g2 40009388: 80 a0 a0 00 cmp %g2, 0 4000938c: 02 80 00 07 be 400093a8 <_Watchdog_Remove+0x5c> 40009390: 05 10 00 55 sethi %hi(0x40015400), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 40009394: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40009398: c4 04 20 10 ld [ %l0 + 0x10 ], %g2 4000939c: 84 00 c0 02 add %g3, %g2, %g2 400093a0: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 400093a4: 05 10 00 55 sethi %hi(0x40015400), %g2 400093a8: c4 00 a2 cc ld [ %g2 + 0x2cc ], %g2 ! 400156cc <_Watchdog_Sync_count> 400093ac: 80 a0 a0 00 cmp %g2, 0 400093b0: 22 80 00 07 be,a 400093cc <_Watchdog_Remove+0x80> 400093b4: c4 04 20 04 ld [ %l0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 400093b8: 05 10 00 56 sethi %hi(0x40015800), %g2 400093bc: c6 00 a3 00 ld [ %g2 + 0x300 ], %g3 ! 40015b00 <_Per_CPU_Information+0x8> 400093c0: 05 10 00 55 sethi %hi(0x40015400), %g2 400093c4: c6 20 a2 64 st %g3, [ %g2 + 0x264 ] ! 40015664 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 400093c8: c4 04 20 04 ld [ %l0 + 4 ], %g2 next->previous = previous; 400093cc: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 400093d0: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 400093d4: 03 10 00 55 sethi %hi(0x40015400), %g1 400093d8: c2 00 62 d0 ld [ %g1 + 0x2d0 ], %g1 ! 400156d0 <_Watchdog_Ticks_since_boot> 400093dc: c2 24 20 18 st %g1, [ %l0 + 0x18 ] _ISR_Enable( level ); 400093e0: 7f ff e2 3a call 40001cc8 400093e4: 01 00 00 00 nop return( previous_state ); } 400093e8: 81 c7 e0 08 ret 400093ec: 81 e8 00 00 restore =============================================================================== 4000aa24 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4000aa24: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4000aa28: 7f ff df 86 call 40002840 4000aa2c: a0 10 00 18 mov %i0, %l0 4000aa30: b0 10 00 08 mov %o0, %i0 printk( "Watchdog Chain: %s %p\n", name, header ); 4000aa34: 11 10 00 77 sethi %hi(0x4001dc00), %o0 4000aa38: 94 10 00 19 mov %i1, %o2 4000aa3c: 90 12 22 48 or %o0, 0x248, %o0 4000aa40: 7f ff e6 05 call 40004254 4000aa44: 92 10 00 10 mov %l0, %o1 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 4000aa48: 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 ); 4000aa4c: 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 ) ) { 4000aa50: 80 a4 40 19 cmp %l1, %i1 4000aa54: 02 80 00 0e be 4000aa8c <_Watchdog_Report_chain+0x68> 4000aa58: 11 10 00 77 sethi %hi(0x4001dc00), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4000aa5c: 92 10 00 11 mov %l1, %o1 4000aa60: 40 00 00 10 call 4000aaa0 <_Watchdog_Report> 4000aa64: 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 ) 4000aa68: 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 ) ; 4000aa6c: 80 a4 40 19 cmp %l1, %i1 4000aa70: 12 bf ff fc bne 4000aa60 <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 4000aa74: 92 10 00 11 mov %l1, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4000aa78: 11 10 00 77 sethi %hi(0x4001dc00), %o0 4000aa7c: 92 10 00 10 mov %l0, %o1 4000aa80: 7f ff e5 f5 call 40004254 4000aa84: 90 12 22 60 or %o0, 0x260, %o0 4000aa88: 30 80 00 03 b,a 4000aa94 <_Watchdog_Report_chain+0x70> } else { printk( "Chain is empty\n" ); 4000aa8c: 7f ff e5 f2 call 40004254 4000aa90: 90 12 22 70 or %o0, 0x270, %o0 } _ISR_Enable( level ); 4000aa94: 7f ff df 6f call 40002850 4000aa98: 81 e8 00 00 restore =============================================================================== 40006570 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 40006570: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 40006574: 21 10 00 61 sethi %hi(0x40018400), %l0 40006578: 40 00 04 6c call 40007728 4000657c: 90 14 21 14 or %l0, 0x114, %o0 ! 40018514 if (fcntl (fildes, F_GETFD) < 0) { 40006580: 90 10 00 18 mov %i0, %o0 40006584: 40 00 1c b3 call 4000d850 40006588: 92 10 20 01 mov 1, %o1 4000658c: 80 a2 20 00 cmp %o0, 0 40006590: 16 80 00 08 bge 400065b0 40006594: 80 a6 60 00 cmp %i1, 0 pthread_mutex_unlock(&aio_request_queue.mutex); 40006598: 40 00 04 85 call 400077ac 4000659c: 90 14 21 14 or %l0, 0x114, %o0 rtems_set_errno_and_return_minus_one (EBADF); 400065a0: 40 00 2a 05 call 40010db4 <__errno> 400065a4: 01 00 00 00 nop 400065a8: 10 80 00 4e b 400066e0 400065ac: 82 10 20 09 mov 9, %g1 ! 9 } /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { 400065b0: 32 80 00 2f bne,a 4000666c 400065b4: e2 06 40 00 ld [ %i1 ], %l1 AIO_printf ("Cancel all requests\n"); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 400065b8: 11 10 00 61 sethi %hi(0x40018400), %o0 400065bc: 92 10 00 18 mov %i0, %o1 400065c0: 90 12 21 5c or %o0, 0x15c, %o0 400065c4: 40 00 00 bc call 400068b4 400065c8: 94 10 20 00 clr %o2 if (r_chain == NULL) { 400065cc: a2 92 20 00 orcc %o0, 0, %l1 400065d0: 32 80 00 1a bne,a 40006638 400065d4: b2 04 60 1c add %l1, 0x1c, %i1 pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } return AIO_ALLDONE; } 400065d8: a0 14 21 14 or %l0, 0x114, %l0 r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { AIO_printf ("Request chain not on [WQ]\n"); if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 400065dc: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 400065e0: 82 04 20 58 add %l0, 0x58, %g1 400065e4: 80 a0 80 01 cmp %g2, %g1 400065e8: 02 80 00 48 be 40006708 <== NEVER TAKEN 400065ec: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 400065f0: 92 10 00 18 mov %i0, %o1 400065f4: 40 00 00 b0 call 400068b4 400065f8: 94 10 20 00 clr %o2 if (r_chain == NULL) { 400065fc: a2 92 20 00 orcc %o0, 0, %l1 40006600: 22 80 00 43 be,a 4000670c 40006604: 90 10 00 10 mov %l0, %o0 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40006608: 40 00 0a c3 call 40009114 <_Chain_Extract> 4000660c: b2 04 60 1c add %l1, 0x1c, %i1 } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40006610: 40 00 01 94 call 40006c60 40006614: 90 10 00 11 mov %l1, %o0 pthread_mutex_destroy (&r_chain->mutex); 40006618: 40 00 03 9b call 40007484 4000661c: 90 10 00 19 mov %i1, %o0 pthread_cond_destroy (&r_chain->mutex); 40006620: 40 00 02 bd call 40007114 40006624: 90 10 00 19 mov %i1, %o0 free (r_chain); 40006628: 7f ff f3 1b call 40003294 4000662c: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40006630: 10 80 00 0b b 4000665c 40006634: 90 10 00 10 mov %l0, %o0 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 40006638: 40 00 04 3c call 40007728 4000663c: 90 10 00 19 mov %i1, %o0 40006640: 40 00 0a b5 call 40009114 <_Chain_Extract> 40006644: 90 10 00 11 mov %l1, %o0 rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40006648: 40 00 01 86 call 40006c60 4000664c: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&r_chain->mutex); 40006650: 40 00 04 57 call 400077ac 40006654: 90 10 00 19 mov %i1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40006658: 90 14 21 14 or %l0, 0x114, %o0 4000665c: 40 00 04 54 call 400077ac 40006660: b0 10 20 00 clr %i0 return AIO_CANCELED; 40006664: 81 c7 e0 08 ret 40006668: 81 e8 00 00 restore } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { 4000666c: 80 a4 40 18 cmp %l1, %i0 40006670: 12 80 00 17 bne 400066cc 40006674: 90 14 21 14 or %l0, 0x114, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EINVAL); } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 40006678: 11 10 00 61 sethi %hi(0x40018400), %o0 4000667c: 92 10 00 11 mov %l1, %o1 40006680: 90 12 21 5c or %o0, 0x15c, %o0 40006684: 40 00 00 8c call 400068b4 40006688: 94 10 20 00 clr %o2 if (r_chain == NULL) { 4000668c: b0 92 20 00 orcc %o0, 0, %i0 40006690: 32 80 00 23 bne,a 4000671c 40006694: a2 06 20 1c add %i0, 0x1c, %l1 pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } return AIO_ALLDONE; } 40006698: a0 14 21 14 or %l0, 0x114, %l0 rtems_set_errno_and_return_minus_one (EINVAL); } 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)) { 4000669c: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 400066a0: 82 04 20 58 add %l0, 0x58, %g1 400066a4: 80 a0 80 01 cmp %g2, %g1 400066a8: 02 80 00 18 be 40006708 <== NEVER TAKEN 400066ac: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 400066b0: 92 10 00 11 mov %l1, %o1 400066b4: 40 00 00 80 call 400068b4 400066b8: 94 10 20 00 clr %o2 if (r_chain == NULL) { 400066bc: 80 a2 20 00 cmp %o0, 0 400066c0: 12 80 00 0b bne 400066ec 400066c4: 92 10 00 19 mov %i1, %o1 pthread_mutex_unlock (&aio_request_queue.mutex); 400066c8: 90 10 00 10 mov %l0, %o0 400066cc: 40 00 04 38 call 400077ac 400066d0: 01 00 00 00 nop rtems_set_errno_and_return_minus_one (EINVAL); 400066d4: 40 00 29 b8 call 40010db4 <__errno> 400066d8: 01 00 00 00 nop 400066dc: 82 10 20 16 mov 0x16, %g1 ! 16 400066e0: c2 22 00 00 st %g1, [ %o0 ] 400066e4: 81 c7 e0 08 ret 400066e8: 91 e8 3f ff restore %g0, -1, %o0 } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 400066ec: 40 00 01 71 call 40006cb0 400066f0: 90 02 20 08 add %o0, 8, %o0 400066f4: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&aio_request_queue.mutex); 400066f8: 40 00 04 2d call 400077ac 400066fc: 90 10 00 10 mov %l0, %o0 return result; 40006700: 81 c7 e0 08 ret 40006704: 81 e8 00 00 restore } else { pthread_mutex_unlock (&aio_request_queue.mutex); 40006708: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 4000670c: 40 00 04 28 call 400077ac 40006710: b0 10 20 02 mov 2, %i0 return AIO_ALLDONE; 40006714: 81 c7 e0 08 ret 40006718: 81 e8 00 00 restore } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 4000671c: 40 00 04 03 call 40007728 40006720: 90 10 00 11 mov %l1, %o0 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 40006724: 92 10 00 19 mov %i1, %o1 40006728: 40 00 01 62 call 40006cb0 4000672c: 90 06 20 08 add %i0, 8, %o0 40006730: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&r_chain->mutex); 40006734: 40 00 04 1e call 400077ac 40006738: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 4000673c: 40 00 04 1c call 400077ac 40006740: 90 14 21 14 or %l0, 0x114, %o0 return result; } return AIO_ALLDONE; } 40006744: 81 c7 e0 08 ret 40006748: 81 e8 00 00 restore =============================================================================== 40006754 : int aio_fsync( int op, struct aiocb *aiocbp ) { 40006754: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; if (op != O_SYNC) 40006758: 03 00 00 08 sethi %hi(0x2000), %g1 4000675c: 80 a6 00 01 cmp %i0, %g1 40006760: 12 80 00 10 bne 400067a0 40006764: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40006768: d0 06 40 00 ld [ %i1 ], %o0 4000676c: 40 00 1c 39 call 4000d850 40006770: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40006774: 90 0a 20 03 and %o0, 3, %o0 40006778: 90 02 3f ff add %o0, -1, %o0 4000677c: 80 a2 20 01 cmp %o0, 1 40006780: 18 80 00 08 bgu 400067a0 40006784: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40006788: 7f ff f4 43 call 40003894 4000678c: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40006790: 80 a2 20 00 cmp %o0, 0 40006794: 32 80 00 0b bne,a 400067c0 <== ALWAYS TAKEN 40006798: f2 22 20 14 st %i1, [ %o0 + 0x14 ] rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 4000679c: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED 400067a0: 82 10 3f ff mov -1, %g1 400067a4: e0 26 60 34 st %l0, [ %i1 + 0x34 ] 400067a8: c2 26 60 38 st %g1, [ %i1 + 0x38 ] 400067ac: 40 00 29 82 call 40010db4 <__errno> 400067b0: b0 10 3f ff mov -1, %i0 400067b4: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } 400067b8: 81 c7 e0 08 ret 400067bc: 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; 400067c0: 82 10 20 03 mov 3, %g1 400067c4: c2 26 60 30 st %g1, [ %i1 + 0x30 ] return rtems_aio_enqueue (req); 400067c8: 40 00 01 56 call 40006d20 400067cc: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006f50 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 40006f50: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40006f54: d0 06 00 00 ld [ %i0 ], %o0 40006f58: 40 00 1a 3e call 4000d850 40006f5c: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40006f60: 90 0a 20 03 and %o0, 3, %o0 40006f64: 80 a2 20 02 cmp %o0, 2 40006f68: 02 80 00 05 be 40006f7c 40006f6c: a0 10 00 18 mov %i0, %l0 40006f70: 80 a2 20 00 cmp %o0, 0 40006f74: 12 80 00 10 bne 40006fb4 <== ALWAYS TAKEN 40006f78: 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) 40006f7c: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40006f80: 80 a0 60 00 cmp %g1, 0 40006f84: 32 80 00 0c bne,a 40006fb4 40006f88: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40006f8c: c2 04 20 08 ld [ %l0 + 8 ], %g1 40006f90: 80 a0 60 00 cmp %g1, 0 40006f94: 26 80 00 08 bl,a 40006fb4 40006f98: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40006f9c: 7f ff f2 3e call 40003894 40006fa0: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40006fa4: 80 a2 20 00 cmp %o0, 0 40006fa8: 32 80 00 0b bne,a 40006fd4 <== ALWAYS TAKEN 40006fac: e0 22 20 14 st %l0, [ %o0 + 0x14 ] 40006fb0: a2 10 20 0b mov 0xb, %l1 <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40006fb4: 82 10 3f ff mov -1, %g1 40006fb8: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40006fbc: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40006fc0: 40 00 27 7d call 40010db4 <__errno> 40006fc4: b0 10 3f ff mov -1, %i0 40006fc8: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; return rtems_aio_enqueue (req); } 40006fcc: 81 c7 e0 08 ret 40006fd0: 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; 40006fd4: 82 10 20 01 mov 1, %g1 40006fd8: c2 24 20 30 st %g1, [ %l0 + 0x30 ] return rtems_aio_enqueue (req); 40006fdc: 7f ff ff 51 call 40006d20 40006fe0: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006ff0 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40006ff0: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40006ff4: d0 06 00 00 ld [ %i0 ], %o0 40006ff8: 40 00 1a 16 call 4000d850 40006ffc: 92 10 20 03 mov 3, %o1 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40007000: 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))) 40007004: 90 0a 20 03 and %o0, 3, %o0 40007008: 90 02 3f ff add %o0, -1, %o0 4000700c: 80 a2 20 01 cmp %o0, 1 40007010: 18 80 00 10 bgu 40007050 40007014: 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) 40007018: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 4000701c: 80 a0 60 00 cmp %g1, 0 40007020: 32 80 00 0c bne,a 40007050 40007024: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007028: c2 06 20 08 ld [ %i0 + 8 ], %g1 4000702c: 80 a0 60 00 cmp %g1, 0 40007030: 26 80 00 08 bl,a 40007050 40007034: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007038: 7f ff f2 17 call 40003894 4000703c: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007040: 80 a2 20 00 cmp %o0, 0 40007044: 32 80 00 0b bne,a 40007070 <== ALWAYS TAKEN 40007048: f0 22 20 14 st %i0, [ %o0 + 0x14 ] 4000704c: a2 10 20 0b mov 0xb, %l1 <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007050: 82 10 3f ff mov -1, %g1 40007054: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40007058: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 4000705c: 40 00 27 56 call 40010db4 <__errno> 40007060: b0 10 3f ff mov -1, %i0 40007064: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; return rtems_aio_enqueue (req); } 40007068: 81 c7 e0 08 ret 4000706c: 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; 40007070: 82 10 20 02 mov 2, %g1 40007074: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 40007078: 7f ff ff 2a call 40006d20 4000707c: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40005b84 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 40005b84: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40005b88: 90 96 60 00 orcc %i1, 0, %o0 40005b8c: 12 80 00 06 bne 40005ba4 40005b90: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); 40005b94: 40 00 26 3f call 4000f490 <__errno> 40005b98: 01 00 00 00 nop 40005b9c: 10 80 00 15 b 40005bf0 40005ba0: 82 10 20 16 mov 0x16, %g1 ! 16 if ( clock_id == CLOCK_REALTIME ) { 40005ba4: 12 80 00 05 bne 40005bb8 40005ba8: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); 40005bac: 40 00 07 d8 call 40007b0c <_TOD_Get> 40005bb0: b0 10 20 00 clr %i0 40005bb4: 30 80 00 16 b,a 40005c0c return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 40005bb8: 02 80 00 05 be 40005bcc <== NEVER TAKEN 40005bbc: 01 00 00 00 nop return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 40005bc0: 80 a6 20 02 cmp %i0, 2 40005bc4: 12 80 00 06 bne 40005bdc 40005bc8: 80 a6 20 03 cmp %i0, 3 _TOD_Get_uptime_as_timespec( tp ); 40005bcc: 40 00 07 ec call 40007b7c <_TOD_Get_uptime_as_timespec> 40005bd0: b0 10 20 00 clr %i0 return 0; 40005bd4: 81 c7 e0 08 ret 40005bd8: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 40005bdc: 12 80 00 08 bne 40005bfc 40005be0: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 40005be4: 40 00 26 2b call 4000f490 <__errno> 40005be8: 01 00 00 00 nop 40005bec: 82 10 20 58 mov 0x58, %g1 ! 58 40005bf0: c2 22 00 00 st %g1, [ %o0 ] 40005bf4: 81 c7 e0 08 ret 40005bf8: 91 e8 3f ff restore %g0, -1, %o0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40005bfc: 40 00 26 25 call 4000f490 <__errno> 40005c00: b0 10 3f ff mov -1, %i0 40005c04: 82 10 20 16 mov 0x16, %g1 40005c08: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40005c0c: 81 c7 e0 08 ret 40005c10: 81 e8 00 00 restore =============================================================================== 40005c14 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 40005c14: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40005c18: 90 96 60 00 orcc %i1, 0, %o0 40005c1c: 02 80 00 0b be 40005c48 <== NEVER TAKEN 40005c20: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40005c24: 80 a6 20 01 cmp %i0, 1 40005c28: 12 80 00 15 bne 40005c7c 40005c2c: 80 a6 20 02 cmp %i0, 2 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 40005c30: c4 02 00 00 ld [ %o0 ], %g2 40005c34: 03 08 76 b9 sethi %hi(0x21dae400), %g1 40005c38: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 40005c3c: 80 a0 80 01 cmp %g2, %g1 40005c40: 38 80 00 06 bgu,a 40005c58 40005c44: 03 10 00 7e sethi %hi(0x4001f800), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40005c48: 40 00 26 12 call 4000f490 <__errno> 40005c4c: 01 00 00 00 nop 40005c50: 10 80 00 13 b 40005c9c 40005c54: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40005c58: c4 00 60 40 ld [ %g1 + 0x40 ], %g2 40005c5c: 84 00 a0 01 inc %g2 40005c60: c4 20 60 40 st %g2, [ %g1 + 0x40 ] _Thread_Disable_dispatch(); _TOD_Set( tp ); 40005c64: 40 00 07 dc call 40007bd4 <_TOD_Set> 40005c68: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40005c6c: 40 00 0d cb call 40009398 <_Thread_Enable_dispatch> 40005c70: 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; 40005c74: 81 c7 e0 08 ret 40005c78: 81 e8 00 00 restore _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 40005c7c: 02 80 00 05 be 40005c90 40005c80: 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 ) 40005c84: 80 a6 20 03 cmp %i0, 3 40005c88: 12 80 00 08 bne 40005ca8 40005c8c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 40005c90: 40 00 26 00 call 4000f490 <__errno> 40005c94: 01 00 00 00 nop 40005c98: 82 10 20 58 mov 0x58, %g1 ! 58 40005c9c: c2 22 00 00 st %g1, [ %o0 ] 40005ca0: 81 c7 e0 08 ret 40005ca4: 91 e8 3f ff restore %g0, -1, %o0 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 40005ca8: 40 00 25 fa call 4000f490 <__errno> 40005cac: b0 10 3f ff mov -1, %i0 40005cb0: 82 10 20 16 mov 0x16, %g1 40005cb4: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40005cb8: 81 c7 e0 08 ret 40005cbc: 81 e8 00 00 restore =============================================================================== 40023c88 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 40023c88: 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() ) 40023c8c: 7f ff ff 37 call 40023968 40023c90: 01 00 00 00 nop 40023c94: 80 a6 00 08 cmp %i0, %o0 40023c98: 02 80 00 06 be 40023cb0 40023c9c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40023ca0: 7f ff bf 63 call 40013a2c <__errno> 40023ca4: 01 00 00 00 nop 40023ca8: 10 80 00 07 b 40023cc4 40023cac: 82 10 20 03 mov 3, %g1 ! 3 /* * Validate the signal passed. */ if ( !sig ) 40023cb0: 12 80 00 08 bne 40023cd0 40023cb4: a0 06 7f ff add %i1, -1, %l0 rtems_set_errno_and_return_minus_one( EINVAL ); 40023cb8: 7f ff bf 5d call 40013a2c <__errno> 40023cbc: 01 00 00 00 nop 40023cc0: 82 10 20 16 mov 0x16, %g1 ! 16 40023cc4: c2 22 00 00 st %g1, [ %o0 ] 40023cc8: 10 80 00 a6 b 40023f60 40023ccc: 90 10 3f ff mov -1, %o0 if ( !is_valid_signo(sig) ) 40023cd0: 80 a4 20 1f cmp %l0, 0x1f 40023cd4: 18 bf ff f9 bgu 40023cb8 40023cd8: 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 ) 40023cdc: 83 2e 60 02 sll %i1, 2, %g1 40023ce0: 85 2e 60 04 sll %i1, 4, %g2 40023ce4: 84 20 80 01 sub %g2, %g1, %g2 40023ce8: 03 10 00 9e sethi %hi(0x40027800), %g1 40023cec: 82 10 63 90 or %g1, 0x390, %g1 ! 40027b90 <_POSIX_signals_Vectors> 40023cf0: 82 00 40 02 add %g1, %g2, %g1 40023cf4: c2 00 60 08 ld [ %g1 + 8 ], %g1 40023cf8: 80 a0 60 01 cmp %g1, 1 40023cfc: 02 80 00 99 be 40023f60 40023d00: 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 ) ) 40023d04: 80 a6 60 04 cmp %i1, 4 40023d08: 02 80 00 06 be 40023d20 40023d0c: 80 a6 60 08 cmp %i1, 8 40023d10: 02 80 00 04 be 40023d20 40023d14: 80 a6 60 0b cmp %i1, 0xb 40023d18: 12 80 00 08 bne 40023d38 40023d1c: 82 10 20 01 mov 1, %g1 return pthread_kill( pthread_self(), sig ); 40023d20: 40 00 01 26 call 400241b8 40023d24: 01 00 00 00 nop 40023d28: 40 00 00 ea call 400240d0 40023d2c: 92 10 00 19 mov %i1, %o1 40023d30: 81 c7 e0 08 ret 40023d34: 91 e8 00 08 restore %g0, %o0, %o0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 40023d38: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 40023d3c: c2 27 bf f8 st %g1, [ %fp + -8 ] if ( !value ) { 40023d40: 80 a6 a0 00 cmp %i2, 0 40023d44: 12 80 00 04 bne 40023d54 40023d48: a1 28 40 10 sll %g1, %l0, %l0 siginfo->si_value.sival_int = 0; 40023d4c: 10 80 00 04 b 40023d5c 40023d50: c0 27 bf fc clr [ %fp + -4 ] } else { siginfo->si_value = *value; 40023d54: c2 06 80 00 ld [ %i2 ], %g1 40023d58: c2 27 bf fc st %g1, [ %fp + -4 ] 40023d5c: 03 10 00 9d sethi %hi(0x40027400), %g1 40023d60: c4 00 62 00 ld [ %g1 + 0x200 ], %g2 ! 40027600 <_Thread_Dispatch_disable_level> 40023d64: 84 00 a0 01 inc %g2 40023d68: c4 20 62 00 st %g2, [ %g1 + 0x200 ] /* * 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; 40023d6c: 03 10 00 9e sethi %hi(0x40027800), %g1 40023d70: d0 00 63 44 ld [ %g1 + 0x344 ], %o0 ! 40027b44 <_Per_CPU_Information+0xc> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 40023d74: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 40023d78: c2 00 60 d0 ld [ %g1 + 0xd0 ], %g1 40023d7c: 80 ac 00 01 andncc %l0, %g1, %g0 40023d80: 12 80 00 51 bne 40023ec4 40023d84: 03 10 00 9f sethi %hi(0x40027c00), %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 ); 40023d88: 05 10 00 9f sethi %hi(0x40027c00), %g2 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 40023d8c: c2 00 61 1c ld [ %g1 + 0x11c ], %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 ); 40023d90: 10 80 00 0b b 40023dbc 40023d94: 84 10 a1 20 or %g2, 0x120, %g2 !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 40023d98: 90 10 00 01 mov %g1, %o0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 40023d9c: 80 8c 00 04 btst %l0, %g4 40023da0: 12 80 00 49 bne 40023ec4 40023da4: 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) 40023da8: c6 00 e0 d0 ld [ %g3 + 0xd0 ], %g3 40023dac: 80 ac 00 03 andncc %l0, %g3, %g0 40023db0: 12 80 00 46 bne 40023ec8 40023db4: 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 ) { 40023db8: 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 ); 40023dbc: 80 a0 40 02 cmp %g1, %g2 40023dc0: 32 bf ff f6 bne,a 40023d98 40023dc4: c8 00 60 30 ld [ %g1 + 0x30 ], %g4 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 40023dc8: 03 10 00 9a sethi %hi(0x40026800), %g1 40023dcc: c6 08 62 e4 ldub [ %g1 + 0x2e4 ], %g3 ! 40026ae4 40023dd0: 05 10 00 9d sethi %hi(0x40027400), %g2 40023dd4: 86 00 e0 01 inc %g3 40023dd8: 84 10 a1 70 or %g2, 0x170, %g2 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 40023ddc: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 40023de0: 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); 40023de4: 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 ] ) 40023de8: c2 00 80 00 ld [ %g2 ], %g1 40023dec: 80 a0 60 00 cmp %g1, 0 40023df0: 22 80 00 2f be,a 40023eac <== NEVER TAKEN 40023df4: 84 00 a0 04 add %g2, 4, %g2 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 40023df8: 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++ ) { 40023dfc: 9a 10 20 01 mov 1, %o5 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 40023e00: f4 10 60 10 lduh [ %g1 + 0x10 ], %i2 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40023e04: 10 80 00 26 b 40023e9c 40023e08: de 00 60 1c ld [ %g1 + 0x1c ], %o7 the_thread = (Thread_Control *) object_table[ index ]; 40023e0c: c2 03 c0 01 ld [ %o7 + %g1 ], %g1 if ( !the_thread ) 40023e10: 80 a0 60 00 cmp %g1, 0 40023e14: 22 80 00 22 be,a 40023e9c 40023e18: 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 ) 40023e1c: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 40023e20: 80 a1 00 03 cmp %g4, %g3 40023e24: 38 80 00 1e bgu,a 40023e9c 40023e28: 9a 03 60 01 inc %o5 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 40023e2c: d6 00 61 58 ld [ %g1 + 0x158 ], %o3 40023e30: d6 02 e0 d0 ld [ %o3 + 0xd0 ], %o3 40023e34: 80 ac 00 0b andncc %l0, %o3, %g0 40023e38: 22 80 00 19 be,a 40023e9c 40023e3c: 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 ) { 40023e40: 80 a1 00 03 cmp %g4, %g3 40023e44: 2a 80 00 14 bcs,a 40023e94 40023e48: 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 ) ) { 40023e4c: 80 a2 20 00 cmp %o0, 0 40023e50: 22 80 00 13 be,a 40023e9c <== NEVER TAKEN 40023e54: 9a 03 60 01 inc %o5 <== NOT EXECUTED 40023e58: d4 02 20 10 ld [ %o0 + 0x10 ], %o2 40023e5c: 80 a2 a0 00 cmp %o2, 0 40023e60: 22 80 00 0f be,a 40023e9c <== NEVER TAKEN 40023e64: 9a 03 60 01 inc %o5 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 40023e68: d6 00 60 10 ld [ %g1 + 0x10 ], %o3 40023e6c: 80 a2 e0 00 cmp %o3, 0 40023e70: 22 80 00 09 be,a 40023e94 40023e74: 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) ) { 40023e78: 80 8a 80 0c btst %o2, %o4 40023e7c: 32 80 00 08 bne,a 40023e9c 40023e80: 9a 03 60 01 inc %o5 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 40023e84: 80 8a c0 0c btst %o3, %o4 40023e88: 22 80 00 05 be,a 40023e9c 40023e8c: 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 ) ) { 40023e90: 86 10 00 04 mov %g4, %g3 40023e94: 90 10 00 01 mov %g1, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40023e98: 9a 03 60 01 inc %o5 40023e9c: 80 a3 40 1a cmp %o5, %i2 40023ea0: 08 bf ff db bleu 40023e0c 40023ea4: 83 2b 60 02 sll %o5, 2, %g1 40023ea8: 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++) { 40023eac: 80 a0 80 09 cmp %g2, %o1 40023eb0: 32 bf ff cf bne,a 40023dec 40023eb4: c2 00 80 00 ld [ %g2 ], %g1 } } } } if ( interested ) { 40023eb8: 80 a2 20 00 cmp %o0, 0 40023ebc: 02 80 00 08 be 40023edc 40023ec0: 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 ) ) { 40023ec4: 92 10 00 19 mov %i1, %o1 40023ec8: 40 00 00 33 call 40023f94 <_POSIX_signals_Unblock_thread> 40023ecc: 94 07 bf f4 add %fp, -12, %o2 40023ed0: 80 8a 20 ff btst 0xff, %o0 40023ed4: 12 80 00 20 bne 40023f54 40023ed8: 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 ); 40023edc: 40 00 00 24 call 40023f6c <_POSIX_signals_Set_process_signals> 40023ee0: 90 10 00 10 mov %l0, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 40023ee4: 83 2e 60 02 sll %i1, 2, %g1 40023ee8: b3 2e 60 04 sll %i1, 4, %i1 40023eec: b2 26 40 01 sub %i1, %g1, %i1 40023ef0: 03 10 00 9e sethi %hi(0x40027800), %g1 40023ef4: 82 10 63 90 or %g1, 0x390, %g1 ! 40027b90 <_POSIX_signals_Vectors> 40023ef8: c2 00 40 19 ld [ %g1 + %i1 ], %g1 40023efc: 80 a0 60 02 cmp %g1, 2 40023f00: 12 80 00 15 bne 40023f54 40023f04: 11 10 00 9f sethi %hi(0x40027c00), %o0 psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 40023f08: 7f ff 9f b9 call 4000bdec <_Chain_Get> 40023f0c: 90 12 21 10 or %o0, 0x110, %o0 ! 40027d10 <_POSIX_signals_Inactive_siginfo> if ( !psiginfo ) { 40023f10: a0 92 20 00 orcc %o0, 0, %l0 40023f14: 12 80 00 08 bne 40023f34 40023f18: 92 07 bf f4 add %fp, -12, %o1 _Thread_Enable_dispatch(); 40023f1c: 7f ff a6 dc call 4000da8c <_Thread_Enable_dispatch> 40023f20: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 40023f24: 7f ff be c2 call 40013a2c <__errno> 40023f28: 01 00 00 00 nop 40023f2c: 10 bf ff 66 b 40023cc4 40023f30: 82 10 20 0b mov 0xb, %g1 ! b } psiginfo->Info = *siginfo; 40023f34: 90 04 20 08 add %l0, 8, %o0 40023f38: 7f ff c1 17 call 40014394 40023f3c: 94 10 20 0c mov 0xc, %o2 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 40023f40: 11 10 00 9f sethi %hi(0x40027c00), %o0 40023f44: 92 10 00 10 mov %l0, %o1 40023f48: 90 12 21 88 or %o0, 0x188, %o0 40023f4c: 7f ff 9f 92 call 4000bd94 <_Chain_Append> 40023f50: 90 02 00 19 add %o0, %i1, %o0 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 40023f54: 7f ff a6 ce call 4000da8c <_Thread_Enable_dispatch> 40023f58: 01 00 00 00 nop return 0; 40023f5c: 90 10 20 00 clr %o0 ! 0 } 40023f60: b0 10 00 08 mov %o0, %i0 40023f64: 81 c7 e0 08 ret 40023f68: 81 e8 00 00 restore =============================================================================== 4000b368 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 4000b368: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 4000b36c: 80 a0 60 00 cmp %g1, 0 4000b370: 02 80 00 0f be 4000b3ac 4000b374: 90 10 20 16 mov 0x16, %o0 4000b378: c4 00 40 00 ld [ %g1 ], %g2 4000b37c: 80 a0 a0 00 cmp %g2, 0 4000b380: 02 80 00 0b be 4000b3ac 4000b384: 80 a2 60 04 cmp %o1, 4 return EINVAL; switch ( policy ) { 4000b388: 18 80 00 09 bgu 4000b3ac 4000b38c: 90 10 20 86 mov 0x86, %o0 4000b390: 84 10 20 01 mov 1, %g2 4000b394: 85 28 80 09 sll %g2, %o1, %g2 4000b398: 80 88 a0 17 btst 0x17, %g2 4000b39c: 02 80 00 04 be 4000b3ac <== NEVER TAKEN 4000b3a0: 01 00 00 00 nop case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 4000b3a4: d2 20 60 14 st %o1, [ %g1 + 0x14 ] 4000b3a8: 90 10 20 00 clr %o0 return 0; default: return ENOTSUP; } } 4000b3ac: 81 c3 e0 08 retl =============================================================================== 400061d8 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 400061d8: 9d e3 bf 90 save %sp, -112, %sp 400061dc: a0 10 00 18 mov %i0, %l0 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 400061e0: 80 a4 20 00 cmp %l0, 0 400061e4: 02 80 00 1f be 40006260 400061e8: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( count == 0 ) 400061ec: 80 a6 a0 00 cmp %i2, 0 400061f0: 02 80 00 1c be 40006260 400061f4: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 400061f8: 32 80 00 06 bne,a 40006210 400061fc: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 40006200: b2 07 bf f0 add %fp, -16, %i1 40006204: 7f ff ff bd call 400060f8 40006208: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 4000620c: c2 06 40 00 ld [ %i1 ], %g1 40006210: 80 a0 60 00 cmp %g1, 0 40006214: 02 80 00 13 be 40006260 40006218: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 4000621c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006220: 80 a0 60 00 cmp %g1, 0 40006224: 12 80 00 0f bne 40006260 <== NEVER TAKEN 40006228: 03 10 00 5b sethi %hi(0x40016c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4000622c: c4 00 63 90 ld [ %g1 + 0x390 ], %g2 ! 40016f90 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 40006230: c0 27 bf f8 clr [ %fp + -8 ] the_attributes.maximum_count = count; 40006234: f4 27 bf fc st %i2, [ %fp + -4 ] 40006238: 84 00 a0 01 inc %g2 4000623c: c4 20 63 90 st %g2, [ %g1 + 0x390 ] * 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 ); 40006240: 25 10 00 5c sethi %hi(0x40017000), %l2 40006244: 40 00 08 64 call 400083d4 <_Objects_Allocate> 40006248: 90 14 a3 50 or %l2, 0x350, %o0 ! 40017350 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 4000624c: a2 92 20 00 orcc %o0, 0, %l1 40006250: 12 80 00 06 bne 40006268 40006254: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 40006258: 40 00 0c e9 call 400095fc <_Thread_Enable_dispatch> 4000625c: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40006260: 81 c7 e0 08 ret 40006264: 81 e8 00 00 restore } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 40006268: 40 00 05 cd call 4000799c <_CORE_barrier_Initialize> 4000626c: 92 07 bf f8 add %fp, -8, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006270: 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; } 40006274: a4 14 a3 50 or %l2, 0x350, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006278: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 4000627c: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006280: 85 28 a0 02 sll %g2, 2, %g2 40006284: 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; 40006288: c0 24 60 0c clr [ %l1 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 4000628c: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40006290: 40 00 0c db call 400095fc <_Thread_Enable_dispatch> 40006294: b0 10 20 00 clr %i0 return 0; } 40006298: 81 c7 e0 08 ret 4000629c: 81 e8 00 00 restore =============================================================================== 40005990 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 40005990: 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 ) 40005994: 80 a6 20 00 cmp %i0, 0 40005998: 02 80 00 14 be 400059e8 4000599c: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400059a0: 03 10 00 5c sethi %hi(0x40017000), %g1 400059a4: c4 00 63 40 ld [ %g1 + 0x340 ], %g2 ! 40017340 <_Thread_Dispatch_disable_level> 400059a8: 84 00 a0 01 inc %g2 400059ac: c4 20 63 40 st %g2, [ %g1 + 0x340 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 400059b0: 40 00 11 a8 call 4000a050 <_Workspace_Allocate> 400059b4: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 400059b8: 92 92 20 00 orcc %o0, 0, %o1 400059bc: 02 80 00 09 be 400059e0 <== NEVER TAKEN 400059c0: 01 00 00 00 nop thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 400059c4: 03 10 00 5e sethi %hi(0x40017800), %g1 400059c8: c2 00 60 84 ld [ %g1 + 0x84 ], %g1 ! 40017884 <_Per_CPU_Information+0xc> handler_stack = &thread_support->Cancellation_Handlers; 400059cc: d0 00 61 58 ld [ %g1 + 0x158 ], %o0 handler->routine = routine; 400059d0: f0 22 60 08 st %i0, [ %o1 + 8 ] handler->arg = arg; 400059d4: f2 22 60 0c st %i1, [ %o1 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 400059d8: 40 00 06 02 call 400071e0 <_Chain_Append> 400059dc: 90 02 20 e4 add %o0, 0xe4, %o0 } _Thread_Enable_dispatch(); 400059e0: 40 00 0d 0e call 40008e18 <_Thread_Enable_dispatch> 400059e4: 81 e8 00 00 restore 400059e8: 81 c7 e0 08 ret 400059ec: 81 e8 00 00 restore =============================================================================== 40006a98 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 40006a98: 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; 40006a9c: 80 a6 60 00 cmp %i1, 0 40006aa0: 12 80 00 04 bne 40006ab0 40006aa4: a0 10 00 18 mov %i0, %l0 else the_attr = &_POSIX_Condition_variables_Default_attributes; 40006aa8: 33 10 00 5b sethi %hi(0x40016c00), %i1 40006aac: b2 16 60 74 or %i1, 0x74, %i1 ! 40016c74 <_POSIX_Condition_variables_Default_attributes> /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 40006ab0: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006ab4: 80 a0 60 01 cmp %g1, 1 40006ab8: 02 80 00 11 be 40006afc <== NEVER TAKEN 40006abc: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !the_attr->is_initialized ) 40006ac0: c2 06 40 00 ld [ %i1 ], %g1 40006ac4: 80 a0 60 00 cmp %g1, 0 40006ac8: 02 80 00 0d be 40006afc 40006acc: 03 10 00 60 sethi %hi(0x40018000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006ad0: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 ! 40018160 <_Thread_Dispatch_disable_level> 40006ad4: 84 00 a0 01 inc %g2 40006ad8: c4 20 61 60 st %g2, [ %g1 + 0x160 ] RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 40006adc: 25 10 00 61 sethi %hi(0x40018400), %l2 40006ae0: 40 00 09 cf call 4000921c <_Objects_Allocate> 40006ae4: 90 14 a1 b8 or %l2, 0x1b8, %o0 ! 400185b8 <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 40006ae8: a2 92 20 00 orcc %o0, 0, %l1 40006aec: 32 80 00 06 bne,a 40006b04 40006af0: c2 06 60 04 ld [ %i1 + 4 ], %g1 _Thread_Enable_dispatch(); 40006af4: 40 00 0e 54 call 4000a444 <_Thread_Enable_dispatch> 40006af8: b0 10 20 0c mov 0xc, %i0 return ENOMEM; 40006afc: 81 c7 e0 08 ret 40006b00: 81 e8 00 00 restore the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40006b04: 90 04 60 18 add %l1, 0x18, %o0 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40006b08: c2 24 60 10 st %g1, [ %l1 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40006b0c: 92 10 20 00 clr %o1 40006b10: 15 04 00 02 sethi %hi(0x10000800), %o2 40006b14: 96 10 20 74 mov 0x74, %o3 40006b18: 40 00 10 45 call 4000ac2c <_Thread_queue_Initialize> 40006b1c: c0 24 60 14 clr [ %l1 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006b20: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 40006b24: a4 14 a1 b8 or %l2, 0x1b8, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006b28: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006b2c: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006b30: 85 28 a0 02 sll %g2, 2, %g2 40006b34: 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; 40006b38: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 40006b3c: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40006b40: 40 00 0e 41 call 4000a444 <_Thread_Enable_dispatch> 40006b44: b0 10 20 00 clr %i0 return 0; } 40006b48: 81 c7 e0 08 ret 40006b4c: 81 e8 00 00 restore =============================================================================== 400068fc : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 400068fc: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 40006900: 80 a0 60 00 cmp %g1, 0 40006904: 02 80 00 08 be 40006924 40006908: 90 10 20 16 mov 0x16, %o0 4000690c: c4 00 40 00 ld [ %g1 ], %g2 40006910: 80 a0 a0 00 cmp %g2, 0 40006914: 02 80 00 04 be 40006924 <== NEVER TAKEN 40006918: 01 00 00 00 nop return EINVAL; attr->is_initialized = false; 4000691c: c0 20 40 00 clr [ %g1 ] return 0; 40006920: 90 10 20 00 clr %o0 } 40006924: 81 c3 e0 08 retl =============================================================================== 40005e64 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 40005e64: 9d e3 bf 58 save %sp, -168, %sp 40005e68: a0 10 00 18 mov %i0, %l0 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 40005e6c: 80 a6 a0 00 cmp %i2, 0 40005e70: 02 80 00 66 be 40006008 40005e74: b0 10 20 0e mov 0xe, %i0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 40005e78: 80 a6 60 00 cmp %i1, 0 40005e7c: 32 80 00 05 bne,a 40005e90 40005e80: c2 06 40 00 ld [ %i1 ], %g1 40005e84: 33 10 00 74 sethi %hi(0x4001d000), %i1 40005e88: b2 16 61 3c or %i1, 0x13c, %i1 ! 4001d13c <_POSIX_Threads_Default_attributes> if ( !the_attr->is_initialized ) 40005e8c: c2 06 40 00 ld [ %i1 ], %g1 40005e90: 80 a0 60 00 cmp %g1, 0 40005e94: 02 80 00 5d be 40006008 40005e98: 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) ) 40005e9c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40005ea0: 80 a0 60 00 cmp %g1, 0 40005ea4: 02 80 00 07 be 40005ec0 40005ea8: 03 10 00 77 sethi %hi(0x4001dc00), %g1 40005eac: c4 06 60 08 ld [ %i1 + 8 ], %g2 40005eb0: c2 00 62 b4 ld [ %g1 + 0x2b4 ], %g1 40005eb4: 80 a0 80 01 cmp %g2, %g1 40005eb8: 0a 80 00 79 bcs 4000609c 40005ebc: 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 ) { 40005ec0: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 40005ec4: 80 a0 60 01 cmp %g1, 1 40005ec8: 02 80 00 06 be 40005ee0 40005ecc: 80 a0 60 02 cmp %g1, 2 40005ed0: 12 80 00 4e bne 40006008 40005ed4: b0 10 20 16 mov 0x16, %i0 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 40005ed8: 10 80 00 09 b 40005efc 40005edc: 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 ]; 40005ee0: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40005ee4: c2 00 61 64 ld [ %g1 + 0x164 ], %g1 ! 4001ed64 <_Per_CPU_Information+0xc> schedpolicy = api->schedpolicy; schedparam = api->schedparam; 40005ee8: 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 ]; 40005eec: d2 00 61 58 ld [ %g1 + 0x158 ], %o1 schedpolicy = api->schedpolicy; 40005ef0: e4 02 60 84 ld [ %o1 + 0x84 ], %l2 schedparam = api->schedparam; 40005ef4: 10 80 00 04 b 40005f04 40005ef8: 92 02 60 88 add %o1, 0x88, %o1 break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 40005efc: 90 07 bf dc add %fp, -36, %o0 40005f00: 92 06 60 18 add %i1, 0x18, %o1 40005f04: 40 00 26 b2 call 4000f9cc 40005f08: 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 ) 40005f0c: c2 06 60 0c ld [ %i1 + 0xc ], %g1 40005f10: 80 a0 60 00 cmp %g1, 0 40005f14: 12 80 00 3d bne 40006008 40005f18: b0 10 20 86 mov 0x86, %i0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 40005f1c: d0 07 bf dc ld [ %fp + -36 ], %o0 40005f20: 40 00 1a 51 call 4000c864 <_POSIX_Priority_Is_valid> 40005f24: b0 10 20 16 mov 0x16, %i0 40005f28: 80 8a 20 ff btst 0xff, %o0 40005f2c: 02 80 00 37 be 40006008 <== NEVER TAKEN 40005f30: 03 10 00 77 sethi %hi(0x4001dc00), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 40005f34: 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); 40005f38: e6 08 62 b8 ldub [ %g1 + 0x2b8 ], %l3 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 40005f3c: 90 10 00 12 mov %l2, %o0 40005f40: 92 07 bf dc add %fp, -36, %o1 40005f44: 94 07 bf fc add %fp, -4, %o2 40005f48: 40 00 1a 52 call 4000c890 <_POSIX_Thread_Translate_sched_param> 40005f4c: 96 07 bf f8 add %fp, -8, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 40005f50: b0 92 20 00 orcc %o0, 0, %i0 40005f54: 12 80 00 2d bne 40006008 40005f58: 2b 10 00 7a sethi %hi(0x4001e800), %l5 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 40005f5c: 40 00 06 0b call 40007788 <_API_Mutex_Lock> 40005f60: d0 05 60 c0 ld [ %l5 + 0xc0 ], %o0 ! 4001e8c0 <_RTEMS_Allocator_Mutex> * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 40005f64: 11 10 00 7a sethi %hi(0x4001e800), %o0 40005f68: 40 00 08 ae call 40008220 <_Objects_Allocate> 40005f6c: 90 12 22 60 or %o0, 0x260, %o0 ! 4001ea60 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 40005f70: a2 92 20 00 orcc %o0, 0, %l1 40005f74: 32 80 00 04 bne,a 40005f84 40005f78: c2 06 60 08 ld [ %i1 + 8 ], %g1 _RTEMS_Unlock_allocator(); 40005f7c: 10 80 00 21 b 40006000 40005f80: d0 05 60 c0 ld [ %l5 + 0xc0 ], %o0 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 40005f84: 05 10 00 77 sethi %hi(0x4001dc00), %g2 40005f88: d6 00 a2 b4 ld [ %g2 + 0x2b4 ], %o3 ! 4001deb4 40005f8c: 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( 40005f90: 80 a2 c0 01 cmp %o3, %g1 40005f94: 1a 80 00 03 bcc 40005fa0 40005f98: d4 06 60 04 ld [ %i1 + 4 ], %o2 40005f9c: 96 10 00 01 mov %g1, %o3 40005fa0: 82 10 20 01 mov 1, %g1 40005fa4: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40005fa8: c2 07 bf fc ld [ %fp + -4 ], %g1 40005fac: 9a 0c e0 ff and %l3, 0xff, %o5 40005fb0: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 40005fb4: c2 07 bf f8 ld [ %fp + -8 ], %g1 40005fb8: c0 27 bf d4 clr [ %fp + -44 ] 40005fbc: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40005fc0: 82 07 bf d4 add %fp, -44, %g1 40005fc4: c0 23 a0 68 clr [ %sp + 0x68 ] 40005fc8: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40005fcc: 27 10 00 7a sethi %hi(0x4001e800), %l3 40005fd0: 92 10 00 11 mov %l1, %o1 40005fd4: 90 14 e2 60 or %l3, 0x260, %o0 40005fd8: 98 10 20 00 clr %o4 40005fdc: 40 00 0d 53 call 40009528 <_Thread_Initialize> 40005fe0: 9a 23 40 14 sub %o5, %l4, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 40005fe4: 80 8a 20 ff btst 0xff, %o0 40005fe8: 12 80 00 0a bne 40006010 40005fec: 90 14 e2 60 or %l3, 0x260, %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 40005ff0: 40 00 09 63 call 4000857c <_Objects_Free> 40005ff4: 92 10 00 11 mov %l1, %o1 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 40005ff8: 03 10 00 7a sethi %hi(0x4001e800), %g1 40005ffc: d0 00 60 c0 ld [ %g1 + 0xc0 ], %o0 ! 4001e8c0 <_RTEMS_Allocator_Mutex> 40006000: 40 00 05 f8 call 400077e0 <_API_Mutex_Unlock> 40006004: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40006008: 81 c7 e0 08 ret 4000600c: 81 e8 00 00 restore } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40006010: e6 04 61 58 ld [ %l1 + 0x158 ], %l3 api->Attributes = *the_attr; 40006014: 92 10 00 19 mov %i1, %o1 40006018: 94 10 20 40 mov 0x40, %o2 4000601c: 40 00 26 6c call 4000f9cc 40006020: 90 10 00 13 mov %l3, %o0 api->detachstate = the_attr->detachstate; 40006024: c2 06 60 3c ld [ %i1 + 0x3c ], %g1 api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006028: 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; 4000602c: c2 24 e0 40 st %g1, [ %l3 + 0x40 ] api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006030: 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; 40006034: e4 24 e0 84 st %l2, [ %l3 + 0x84 ] api->schedparam = schedparam; 40006038: 40 00 26 65 call 4000f9cc 4000603c: 90 04 e0 88 add %l3, 0x88, %o0 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40006040: 90 10 00 11 mov %l1, %o0 40006044: 92 10 20 01 mov 1, %o1 40006048: 94 10 00 1a mov %i2, %o2 4000604c: 96 10 00 1b mov %i3, %o3 40006050: 40 00 0f 82 call 40009e58 <_Thread_Start> 40006054: 98 10 20 00 clr %o4 _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 40006058: 80 a4 a0 04 cmp %l2, 4 4000605c: 32 80 00 0a bne,a 40006084 40006060: c2 04 60 08 ld [ %l1 + 8 ], %g1 _Watchdog_Insert_ticks( 40006064: 40 00 0f fc call 4000a054 <_Timespec_To_ticks> 40006068: 90 04 e0 90 add %l3, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000606c: 92 04 e0 a8 add %l3, 0xa8, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006070: d0 24 e0 b4 st %o0, [ %l3 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006074: 11 10 00 7a sethi %hi(0x4001e800), %o0 40006078: 40 00 10 d0 call 4000a3b8 <_Watchdog_Insert> 4000607c: 90 12 20 e0 or %o0, 0xe0, %o0 ! 4001e8e0 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 40006080: c2 04 60 08 ld [ %l1 + 8 ], %g1 40006084: c2 24 00 00 st %g1, [ %l0 ] _RTEMS_Unlock_allocator(); 40006088: 03 10 00 7a sethi %hi(0x4001e800), %g1 4000608c: 40 00 05 d5 call 400077e0 <_API_Mutex_Unlock> 40006090: d0 00 60 c0 ld [ %g1 + 0xc0 ], %o0 ! 4001e8c0 <_RTEMS_Allocator_Mutex> return 0; 40006094: 81 c7 e0 08 ret 40006098: 81 e8 00 00 restore } 4000609c: 81 c7 e0 08 ret 400060a0: 81 e8 00 00 restore =============================================================================== 400240d0 : int pthread_kill( pthread_t thread, int sig ) { 400240d0: 9d e3 bf 98 save %sp, -104, %sp POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) 400240d4: 80 a6 60 00 cmp %i1, 0 400240d8: 02 80 00 06 be 400240f0 400240dc: 90 10 00 18 mov %i0, %o0 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 400240e0: a4 06 7f ff add %i1, -1, %l2 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 400240e4: 80 a4 a0 1f cmp %l2, 0x1f 400240e8: 08 80 00 08 bleu 40024108 400240ec: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); 400240f0: 7f ff be 4f call 40013a2c <__errno> 400240f4: b0 10 3f ff mov -1, %i0 ! ffffffff 400240f8: 82 10 20 16 mov 0x16, %g1 400240fc: c2 22 00 00 st %g1, [ %o0 ] 40024100: 81 c7 e0 08 ret 40024104: 81 e8 00 00 restore the_thread = _Thread_Get( thread, &location ); 40024108: 7f ff a6 6e call 4000dac0 <_Thread_Get> 4002410c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40024110: c2 07 bf fc ld [ %fp + -4 ], %g1 40024114: 80 a0 60 00 cmp %g1, 0 40024118: 12 80 00 22 bne 400241a0 <== NEVER TAKEN 4002411c: a2 10 00 08 mov %o0, %l1 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { 40024120: 85 2e 60 02 sll %i1, 2, %g2 40024124: 87 2e 60 04 sll %i1, 4, %g3 40024128: 86 20 c0 02 sub %g3, %g2, %g3 4002412c: 05 10 00 9e sethi %hi(0x40027800), %g2 40024130: 84 10 a3 90 or %g2, 0x390, %g2 ! 40027b90 <_POSIX_signals_Vectors> 40024134: 84 00 80 03 add %g2, %g3, %g2 40024138: c4 00 a0 08 ld [ %g2 + 8 ], %g2 4002413c: 80 a0 a0 01 cmp %g2, 1 40024140: 02 80 00 14 be 40024190 40024144: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); 40024148: c4 00 60 d4 ld [ %g1 + 0xd4 ], %g2 static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); 4002414c: a0 10 20 01 mov 1, %l0 (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); 40024150: 92 10 00 19 mov %i1, %o1 40024154: a5 2c 00 12 sll %l0, %l2, %l2 40024158: 94 10 20 00 clr %o2 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); 4002415c: a4 10 80 12 or %g2, %l2, %l2 (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); 40024160: 7f ff ff 8d call 40023f94 <_POSIX_signals_Unblock_thread> 40024164: e4 20 60 d4 st %l2, [ %g1 + 0xd4 ] if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40024168: 03 10 00 9e sethi %hi(0x40027800), %g1 4002416c: 82 10 63 38 or %g1, 0x338, %g1 ! 40027b38 <_Per_CPU_Information> 40024170: c4 00 60 08 ld [ %g1 + 8 ], %g2 40024174: 80 a0 a0 00 cmp %g2, 0 40024178: 02 80 00 06 be 40024190 4002417c: 01 00 00 00 nop 40024180: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40024184: 80 a4 40 02 cmp %l1, %g2 40024188: 22 80 00 02 be,a 40024190 4002418c: e0 28 60 18 stb %l0, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } _Thread_Enable_dispatch(); 40024190: 7f ff a6 3f call 4000da8c <_Thread_Enable_dispatch> 40024194: b0 10 20 00 clr %i0 return 0; 40024198: 81 c7 e0 08 ret 4002419c: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); 400241a0: 7f ff be 23 call 40013a2c <__errno> <== NOT EXECUTED 400241a4: b0 10 3f ff mov -1, %i0 <== NOT EXECUTED 400241a8: 82 10 20 03 mov 3, %g1 <== NOT EXECUTED 400241ac: c2 22 00 00 st %g1, [ %o0 ] <== NOT EXECUTED } 400241b0: 81 c7 e0 08 ret <== NOT EXECUTED 400241b4: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 400080a4 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 400080a4: 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 ); 400080a8: 92 07 bf fc add %fp, -4, %o1 400080ac: 40 00 00 37 call 40008188 <_POSIX_Absolute_timeout_to_ticks> 400080b0: 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 ); 400080b4: 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, 400080b8: 82 1a 20 03 xor %o0, 3, %g1 400080bc: 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 ); 400080c0: 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 ); 400080c4: a2 60 3f ff subx %g0, -1, %l1 400080c8: 90 10 00 18 mov %i0, %o0 400080cc: 7f ff ff bd call 40007fc0 <_POSIX_Mutex_Lock_support> 400080d0: 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) ) { 400080d4: 80 a4 60 00 cmp %l1, 0 400080d8: 12 80 00 0c bne 40008108 400080dc: 80 a2 20 10 cmp %o0, 0x10 400080e0: 12 80 00 0a bne 40008108 <== NEVER TAKEN 400080e4: 80 a4 20 00 cmp %l0, 0 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 400080e8: 02 80 00 07 be 40008104 <== NEVER TAKEN 400080ec: a0 04 3f ff add %l0, -1, %l0 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 400080f0: 80 a4 20 01 cmp %l0, 1 400080f4: 18 80 00 05 bgu 40008108 <== NEVER TAKEN 400080f8: 01 00 00 00 nop status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 400080fc: 10 80 00 03 b 40008108 40008100: 90 10 20 74 mov 0x74, %o0 ! 74 40008104: 90 10 20 16 mov 0x16, %o0 <== NOT EXECUTED } return lock_status; } 40008108: 81 c7 e0 08 ret 4000810c: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 4000577c : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 4000577c: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40005780: 80 a0 60 00 cmp %g1, 0 40005784: 02 80 00 0b be 400057b0 40005788: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 4000578c: c4 00 40 00 ld [ %g1 ], %g2 40005790: 80 a0 a0 00 cmp %g2, 0 40005794: 02 80 00 07 be 400057b0 40005798: 80 a2 60 00 cmp %o1, 0 return EINVAL; if ( !type ) 4000579c: 02 80 00 05 be 400057b0 <== NEVER TAKEN 400057a0: 01 00 00 00 nop return EINVAL; *type = attr->type; 400057a4: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 400057a8: 90 10 20 00 clr %o0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 400057ac: c2 22 40 00 st %g1, [ %o1 ] return 0; } 400057b0: 81 c3 e0 08 retl =============================================================================== 40007c80 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 40007c80: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40007c84: 80 a0 60 00 cmp %g1, 0 40007c88: 02 80 00 0a be 40007cb0 40007c8c: 90 10 20 16 mov 0x16, %o0 40007c90: c4 00 40 00 ld [ %g1 ], %g2 40007c94: 80 a0 a0 00 cmp %g2, 0 40007c98: 02 80 00 06 be 40007cb0 40007c9c: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40007ca0: 18 80 00 04 bgu 40007cb0 <== NEVER TAKEN 40007ca4: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40007ca8: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 40007cac: 90 10 20 00 clr %o0 default: return EINVAL; } } 40007cb0: 81 c3 e0 08 retl =============================================================================== 400057e8 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 400057e8: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 400057ec: 80 a0 60 00 cmp %g1, 0 400057f0: 02 80 00 0a be 40005818 400057f4: 90 10 20 16 mov 0x16, %o0 400057f8: c4 00 40 00 ld [ %g1 ], %g2 400057fc: 80 a0 a0 00 cmp %g2, 0 40005800: 02 80 00 06 be 40005818 <== NEVER TAKEN 40005804: 80 a2 60 03 cmp %o1, 3 return EINVAL; switch ( type ) { 40005808: 18 80 00 04 bgu 40005818 4000580c: 01 00 00 00 nop case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 40005810: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; 40005814: 90 10 20 00 clr %o0 default: return EINVAL; } } 40005818: 81 c3 e0 08 retl =============================================================================== 4000648c : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 4000648c: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 40006490: 80 a6 60 00 cmp %i1, 0 40006494: 02 80 00 1c be 40006504 40006498: a0 10 00 18 mov %i0, %l0 4000649c: 80 a6 20 00 cmp %i0, 0 400064a0: 22 80 00 17 be,a 400064fc 400064a4: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !once_control->init_executed ) { 400064a8: c2 06 20 04 ld [ %i0 + 4 ], %g1 400064ac: 80 a0 60 00 cmp %g1, 0 400064b0: 12 80 00 13 bne 400064fc 400064b4: b0 10 20 00 clr %i0 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 400064b8: 90 10 21 00 mov 0x100, %o0 400064bc: 92 10 21 00 mov 0x100, %o1 400064c0: 40 00 03 09 call 400070e4 400064c4: 94 07 bf fc add %fp, -4, %o2 if ( !once_control->init_executed ) { 400064c8: c2 04 20 04 ld [ %l0 + 4 ], %g1 400064cc: 80 a0 60 00 cmp %g1, 0 400064d0: 12 80 00 07 bne 400064ec <== NEVER TAKEN 400064d4: d0 07 bf fc ld [ %fp + -4 ], %o0 once_control->is_initialized = true; 400064d8: 82 10 20 01 mov 1, %g1 400064dc: c2 24 00 00 st %g1, [ %l0 ] once_control->init_executed = true; (*init_routine)(); 400064e0: 9f c6 40 00 call %i1 400064e4: c2 24 20 04 st %g1, [ %l0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 400064e8: d0 07 bf fc ld [ %fp + -4 ], %o0 400064ec: 92 10 21 00 mov 0x100, %o1 400064f0: 94 07 bf fc add %fp, -4, %o2 400064f4: 40 00 02 fc call 400070e4 400064f8: b0 10 20 00 clr %i0 400064fc: 81 c7 e0 08 ret 40006500: 81 e8 00 00 restore pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) return EINVAL; 40006504: b0 10 20 16 mov 0x16, %i0 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 40006508: 81 c7 e0 08 ret 4000650c: 81 e8 00 00 restore =============================================================================== 40006f5c : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 40006f5c: 9d e3 bf 90 save %sp, -112, %sp 40006f60: a0 10 00 18 mov %i0, %l0 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 40006f64: 80 a4 20 00 cmp %l0, 0 40006f68: 02 80 00 1c be 40006fd8 40006f6c: b0 10 20 16 mov 0x16, %i0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40006f70: 80 a6 60 00 cmp %i1, 0 40006f74: 32 80 00 06 bne,a 40006f8c 40006f78: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 40006f7c: b2 07 bf f4 add %fp, -12, %i1 40006f80: 40 00 02 6d call 40007934 40006f84: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40006f88: c2 06 40 00 ld [ %i1 ], %g1 40006f8c: 80 a0 60 00 cmp %g1, 0 40006f90: 02 80 00 12 be 40006fd8 <== NEVER TAKEN 40006f94: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40006f98: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006f9c: 80 a0 60 00 cmp %g1, 0 40006fa0: 12 80 00 0e bne 40006fd8 <== NEVER TAKEN 40006fa4: 03 10 00 65 sethi %hi(0x40019400), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006fa8: c4 00 63 00 ld [ %g1 + 0x300 ], %g2 ! 40019700 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 40006fac: c0 27 bf fc clr [ %fp + -4 ] 40006fb0: 84 00 a0 01 inc %g2 40006fb4: c4 20 63 00 st %g2, [ %g1 + 0x300 ] * 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 ); 40006fb8: 25 10 00 66 sethi %hi(0x40019800), %l2 40006fbc: 40 00 09 ed call 40009770 <_Objects_Allocate> 40006fc0: 90 14 a1 00 or %l2, 0x100, %o0 ! 40019900 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 40006fc4: a2 92 20 00 orcc %o0, 0, %l1 40006fc8: 12 80 00 06 bne 40006fe0 40006fcc: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 40006fd0: 40 00 0e 72 call 4000a998 <_Thread_Enable_dispatch> 40006fd4: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40006fd8: 81 c7 e0 08 ret 40006fdc: 81 e8 00 00 restore } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 40006fe0: 40 00 07 94 call 40008e30 <_CORE_RWLock_Initialize> 40006fe4: 92 07 bf fc add %fp, -4, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006fe8: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 40006fec: a4 14 a1 00 or %l2, 0x100, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006ff0: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006ff4: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006ff8: 85 28 a0 02 sll %g2, 2, %g2 40006ffc: 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; 40007000: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 40007004: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40007008: 40 00 0e 64 call 4000a998 <_Thread_Enable_dispatch> 4000700c: b0 10 20 00 clr %i0 return 0; } 40007010: 81 c7 e0 08 ret 40007014: 81 e8 00 00 restore =============================================================================== 40007088 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007088: 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; 4000708c: 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 ) 40007090: 80 a6 20 00 cmp %i0, 0 40007094: 02 80 00 2b be 40007140 40007098: 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 ); 4000709c: 40 00 1a d6 call 4000dbf4 <_POSIX_Absolute_timeout_to_ticks> 400070a0: 92 07 bf f8 add %fp, -8, %o1 400070a4: d2 06 00 00 ld [ %i0 ], %o1 400070a8: a2 10 00 08 mov %o0, %l1 400070ac: 94 07 bf fc add %fp, -4, %o2 400070b0: 11 10 00 66 sethi %hi(0x40019800), %o0 400070b4: 40 00 0a eb call 40009c60 <_Objects_Get> 400070b8: 90 12 21 00 or %o0, 0x100, %o0 ! 40019900 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 400070bc: c2 07 bf fc ld [ %fp + -4 ], %g1 400070c0: 80 a0 60 00 cmp %g1, 0 400070c4: 12 80 00 1f bne 40007140 400070c8: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 400070cc: 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, 400070d0: 82 1c 60 03 xor %l1, 3, %g1 400070d4: 90 02 20 10 add %o0, 0x10, %o0 400070d8: 80 a0 00 01 cmp %g0, %g1 400070dc: 98 10 20 00 clr %o4 400070e0: a4 60 3f ff subx %g0, -1, %l2 400070e4: 40 00 07 5e call 40008e5c <_CORE_RWLock_Obtain_for_reading> 400070e8: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 400070ec: 40 00 0e 2b call 4000a998 <_Thread_Enable_dispatch> 400070f0: 01 00 00 00 nop if ( !do_wait ) { 400070f4: 80 a4 a0 00 cmp %l2, 0 400070f8: 12 80 00 0d bne 4000712c 400070fc: 03 10 00 67 sethi %hi(0x40019c00), %g1 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 40007100: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 40019c44 <_Per_CPU_Information+0xc> 40007104: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007108: 80 a0 60 02 cmp %g1, 2 4000710c: 32 80 00 09 bne,a 40007130 40007110: 03 10 00 67 sethi %hi(0x40019c00), %g1 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40007114: 80 a4 60 00 cmp %l1, 0 40007118: 02 80 00 0a be 40007140 <== NEVER TAKEN 4000711c: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40007120: 80 a4 60 01 cmp %l1, 1 40007124: 08 80 00 07 bleu 40007140 <== ALWAYS TAKEN 40007128: 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 4000712c: 03 10 00 67 sethi %hi(0x40019c00), %g1 40007130: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 40019c44 <_Per_CPU_Information+0xc> status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 40007134: 40 00 00 35 call 40007208 <_POSIX_RWLock_Translate_core_RWLock_return_code> 40007138: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000713c: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40007140: 81 c7 e0 08 ret 40007144: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40007148 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007148: 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; 4000714c: 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 ) 40007150: 80 a6 20 00 cmp %i0, 0 40007154: 02 80 00 2b be 40007200 40007158: 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 ); 4000715c: 40 00 1a a6 call 4000dbf4 <_POSIX_Absolute_timeout_to_ticks> 40007160: 92 07 bf f8 add %fp, -8, %o1 40007164: d2 06 00 00 ld [ %i0 ], %o1 40007168: a2 10 00 08 mov %o0, %l1 4000716c: 94 07 bf fc add %fp, -4, %o2 40007170: 11 10 00 66 sethi %hi(0x40019800), %o0 40007174: 40 00 0a bb call 40009c60 <_Objects_Get> 40007178: 90 12 21 00 or %o0, 0x100, %o0 ! 40019900 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 4000717c: c2 07 bf fc ld [ %fp + -4 ], %g1 40007180: 80 a0 60 00 cmp %g1, 0 40007184: 12 80 00 1f bne 40007200 40007188: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 4000718c: 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, 40007190: 82 1c 60 03 xor %l1, 3, %g1 40007194: 90 02 20 10 add %o0, 0x10, %o0 40007198: 80 a0 00 01 cmp %g0, %g1 4000719c: 98 10 20 00 clr %o4 400071a0: a4 60 3f ff subx %g0, -1, %l2 400071a4: 40 00 07 62 call 40008f2c <_CORE_RWLock_Obtain_for_writing> 400071a8: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 400071ac: 40 00 0d fb call 4000a998 <_Thread_Enable_dispatch> 400071b0: 01 00 00 00 nop if ( !do_wait && 400071b4: 80 a4 a0 00 cmp %l2, 0 400071b8: 12 80 00 0d bne 400071ec 400071bc: 03 10 00 67 sethi %hi(0x40019c00), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 400071c0: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 40019c44 <_Per_CPU_Information+0xc> ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 400071c4: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 400071c8: 80 a0 60 02 cmp %g1, 2 400071cc: 32 80 00 09 bne,a 400071f0 400071d0: 03 10 00 67 sethi %hi(0x40019c00), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 400071d4: 80 a4 60 00 cmp %l1, 0 400071d8: 02 80 00 0a be 40007200 <== NEVER TAKEN 400071dc: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 400071e0: 80 a4 60 01 cmp %l1, 1 400071e4: 08 80 00 07 bleu 40007200 <== ALWAYS TAKEN 400071e8: 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 400071ec: 03 10 00 67 sethi %hi(0x40019c00), %g1 400071f0: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 40019c44 <_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( 400071f4: 40 00 00 05 call 40007208 <_POSIX_RWLock_Translate_core_RWLock_return_code> 400071f8: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 400071fc: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40007200: 81 c7 e0 08 ret 40007204: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 4000795c : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 4000795c: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40007960: 80 a0 60 00 cmp %g1, 0 40007964: 02 80 00 0a be 4000798c 40007968: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 4000796c: c4 00 40 00 ld [ %g1 ], %g2 40007970: 80 a0 a0 00 cmp %g2, 0 40007974: 02 80 00 06 be 4000798c 40007978: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 4000797c: 18 80 00 04 bgu 4000798c <== NEVER TAKEN 40007980: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40007984: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 40007988: 90 10 20 00 clr %o0 default: return EINVAL; } } 4000798c: 81 c3 e0 08 retl =============================================================================== 400088d8 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 400088d8: 9d e3 bf 90 save %sp, -112, %sp 400088dc: a0 10 00 18 mov %i0, %l0 int rc; /* * Check all the parameters */ if ( !param ) 400088e0: 80 a6 a0 00 cmp %i2, 0 400088e4: 02 80 00 3d be 400089d8 400088e8: b0 10 20 16 mov 0x16, %i0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 400088ec: 90 10 00 19 mov %i1, %o0 400088f0: 92 10 00 1a mov %i2, %o1 400088f4: 94 07 bf fc add %fp, -4, %o2 400088f8: 40 00 18 cf call 4000ec34 <_POSIX_Thread_Translate_sched_param> 400088fc: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 40008900: b0 92 20 00 orcc %o0, 0, %i0 40008904: 12 80 00 35 bne 400089d8 40008908: 90 10 00 10 mov %l0, %o0 return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); 4000890c: 40 00 0b 9b call 4000b778 <_Thread_Get> 40008910: 92 07 bf f4 add %fp, -12, %o1 switch ( location ) { 40008914: c2 07 bf f4 ld [ %fp + -12 ], %g1 40008918: 80 a0 60 00 cmp %g1, 0 4000891c: 12 80 00 31 bne 400089e0 40008920: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40008924: e0 02 21 58 ld [ %o0 + 0x158 ], %l0 if ( api->schedpolicy == SCHED_SPORADIC ) 40008928: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 4000892c: 80 a0 60 04 cmp %g1, 4 40008930: 32 80 00 05 bne,a 40008944 40008934: f2 24 20 84 st %i1, [ %l0 + 0x84 ] (void) _Watchdog_Remove( &api->Sporadic_timer ); 40008938: 40 00 0f f0 call 4000c8f8 <_Watchdog_Remove> 4000893c: 90 04 20 a8 add %l0, 0xa8, %o0 api->schedpolicy = policy; 40008940: f2 24 20 84 st %i1, [ %l0 + 0x84 ] api->schedparam = *param; 40008944: 90 04 20 88 add %l0, 0x88, %o0 40008948: 92 10 00 1a mov %i2, %o1 4000894c: 40 00 25 67 call 40011ee8 40008950: 94 10 20 1c mov 0x1c, %o2 the_thread->budget_algorithm = budget_algorithm; 40008954: c2 07 bf fc ld [ %fp + -4 ], %g1 the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40008958: 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; 4000895c: c2 24 60 7c st %g1, [ %l1 + 0x7c ] the_thread->budget_callout = budget_callout; 40008960: c2 07 bf f8 ld [ %fp + -8 ], %g1 switch ( api->schedpolicy ) { 40008964: 06 80 00 1b bl 400089d0 <== NEVER TAKEN 40008968: c2 24 60 80 st %g1, [ %l1 + 0x80 ] 4000896c: 80 a6 60 02 cmp %i1, 2 40008970: 04 80 00 07 ble 4000898c 40008974: 03 10 00 6b sethi %hi(0x4001ac00), %g1 40008978: 80 a6 60 04 cmp %i1, 4 4000897c: 12 80 00 15 bne 400089d0 <== NEVER TAKEN 40008980: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 40008984: 10 80 00 0d b 400089b8 40008988: 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; 4000898c: c2 00 61 44 ld [ %g1 + 0x144 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40008990: 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; 40008994: c2 24 60 78 st %g1, [ %l1 + 0x78 ] 40008998: 03 10 00 69 sethi %hi(0x4001a400), %g1 4000899c: d2 08 60 08 ldub [ %g1 + 8 ], %o1 ! 4001a408 400089a0: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 400089a4: 94 10 20 01 mov 1, %o2 400089a8: 92 22 40 01 sub %o1, %g1, %o1 400089ac: 40 00 0a 5a call 4000b314 <_Thread_Change_priority> 400089b0: d2 24 60 18 st %o1, [ %l1 + 0x18 ] the_thread, the_thread->real_priority, true ); break; 400089b4: 30 80 00 07 b,a 400089d0 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; _Watchdog_Remove( &api->Sporadic_timer ); 400089b8: 90 04 20 a8 add %l0, 0xa8, %o0 400089bc: 40 00 0f cf call 4000c8f8 <_Watchdog_Remove> 400089c0: c2 24 20 a4 st %g1, [ %l0 + 0xa4 ] _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 400089c4: 90 10 20 00 clr %o0 400089c8: 7f ff ff 7e call 400087c0 <_POSIX_Threads_Sporadic_budget_TSR> 400089cc: 92 10 00 11 mov %l1, %o1 break; } _Thread_Enable_dispatch(); 400089d0: 40 00 0b 5d call 4000b744 <_Thread_Enable_dispatch> 400089d4: 01 00 00 00 nop return 0; 400089d8: 81 c7 e0 08 ret 400089dc: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return ESRCH; 400089e0: b0 10 20 03 mov 3, %i0 } 400089e4: 81 c7 e0 08 ret 400089e8: 81 e8 00 00 restore =============================================================================== 40006108 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 40006108: 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() ) 4000610c: 03 10 00 5e sethi %hi(0x40017800), %g1 40006110: 82 10 60 78 or %g1, 0x78, %g1 ! 40017878 <_Per_CPU_Information> 40006114: c4 00 60 08 ld [ %g1 + 8 ], %g2 40006118: 80 a0 a0 00 cmp %g2, 0 4000611c: 12 80 00 18 bne 4000617c <== NEVER TAKEN 40006120: 01 00 00 00 nop 40006124: 05 10 00 5c sethi %hi(0x40017000), %g2 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40006128: c2 00 60 0c ld [ %g1 + 0xc ], %g1 4000612c: c6 00 a3 40 ld [ %g2 + 0x340 ], %g3 40006130: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 40006134: 86 00 e0 01 inc %g3 40006138: c6 20 a3 40 st %g3, [ %g2 + 0x340 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000613c: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 40006140: 80 a0 a0 00 cmp %g2, 0 40006144: 12 80 00 05 bne 40006158 <== NEVER TAKEN 40006148: 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)); 4000614c: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 40006150: 80 a0 00 01 cmp %g0, %g1 40006154: a0 40 20 00 addx %g0, 0, %l0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 40006158: 40 00 0b 30 call 40008e18 <_Thread_Enable_dispatch> 4000615c: 01 00 00 00 nop if ( cancel ) 40006160: 80 8c 20 ff btst 0xff, %l0 40006164: 02 80 00 06 be 4000617c 40006168: 01 00 00 00 nop _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 4000616c: 03 10 00 5e sethi %hi(0x40017800), %g1 40006170: f0 00 60 84 ld [ %g1 + 0x84 ], %i0 ! 40017884 <_Per_CPU_Information+0xc> 40006174: 40 00 18 ac call 4000c424 <_POSIX_Thread_Exit> 40006178: 93 e8 3f ff restore %g0, -1, %o1 4000617c: 81 c7 e0 08 ret 40006180: 81 e8 00 00 restore =============================================================================== 40006d20 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 40006d20: 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); 40006d24: 21 10 00 61 sethi %hi(0x40018400), %l0 40006d28: 40 00 02 80 call 40007728 40006d2c: 90 14 21 14 or %l0, 0x114, %o0 ! 40018514 if (result != 0) { 40006d30: a2 92 20 00 orcc %o0, 0, %l1 40006d34: 02 80 00 06 be 40006d4c <== ALWAYS TAKEN 40006d38: 01 00 00 00 nop free (req); 40006d3c: 7f ff f1 56 call 40003294 <== NOT EXECUTED 40006d40: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED return result; 40006d44: 81 c7 e0 08 ret <== NOT EXECUTED 40006d48: 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); 40006d4c: 40 00 04 82 call 40007f54 40006d50: a0 14 21 14 or %l0, 0x114, %l0 40006d54: 92 07 bf f8 add %fp, -8, %o1 40006d58: 40 00 03 87 call 40007b74 40006d5c: 94 07 bf dc add %fp, -36, %o2 req->caller_thread = pthread_self (); 40006d60: 40 00 04 7d call 40007f54 40006d64: 01 00 00 00 nop req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40006d68: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40006d6c: c6 07 bf dc ld [ %fp + -36 ], %g3 40006d70: 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 (); 40006d74: d0 26 20 10 st %o0, [ %i0 + 0x10 ] req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40006d78: 84 20 c0 02 sub %g3, %g2, %g2 40006d7c: c4 26 20 0c st %g2, [ %i0 + 0xc ] req->policy = policy; 40006d80: c4 07 bf f8 ld [ %fp + -8 ], %g2 40006d84: c4 26 20 08 st %g2, [ %i0 + 8 ] req->aiocbp->error_code = EINPROGRESS; 40006d88: 84 10 20 77 mov 0x77, %g2 40006d8c: c4 20 60 34 st %g2, [ %g1 + 0x34 ] req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 40006d90: c4 04 20 68 ld [ %l0 + 0x68 ], %g2 40006d94: 80 a0 a0 00 cmp %g2, 0 40006d98: 12 80 00 34 bne 40006e68 <== NEVER TAKEN 40006d9c: c0 20 60 38 clr [ %g1 + 0x38 ] 40006da0: c4 04 20 64 ld [ %l0 + 0x64 ], %g2 40006da4: 80 a0 a0 04 cmp %g2, 4 40006da8: 14 80 00 31 bg 40006e6c 40006dac: 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); 40006db0: 90 04 20 48 add %l0, 0x48, %o0 40006db4: 7f ff fe c0 call 400068b4 40006db8: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40006dbc: 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); 40006dc0: a4 10 00 08 mov %o0, %l2 if (r_chain->new_fd == 1) { 40006dc4: 80 a0 60 01 cmp %g1, 1 40006dc8: aa 02 20 08 add %o0, 8, %l5 40006dcc: a6 02 20 1c add %o0, 0x1c, %l3 40006dd0: 12 80 00 1d bne 40006e44 40006dd4: 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); 40006dd8: 90 10 00 15 mov %l5, %o0 40006ddc: 40 00 08 e7 call 40009178 <_Chain_Insert> 40006de0: 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); 40006de4: 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; 40006de8: c0 24 a0 18 clr [ %l2 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40006dec: 40 00 01 f7 call 400075c8 40006df0: 90 10 00 13 mov %l3, %o0 pthread_cond_init (&r_chain->cond, NULL); 40006df4: 92 10 20 00 clr %o1 40006df8: 40 00 00 fc call 400071e8 40006dfc: 90 10 00 14 mov %l4, %o0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 40006e00: 96 10 00 12 mov %l2, %o3 40006e04: 90 07 bf fc add %fp, -4, %o0 40006e08: 92 04 20 08 add %l0, 8, %o1 40006e0c: 15 10 00 1a sethi %hi(0x40006800), %o2 40006e10: 40 00 02 c9 call 40007934 40006e14: 94 12 a1 a8 or %o2, 0x1a8, %o2 ! 400069a8 rtems_aio_handle, (void *) r_chain); if (result != 0) { 40006e18: a4 92 20 00 orcc %o0, 0, %l2 40006e1c: 22 80 00 07 be,a 40006e38 <== ALWAYS TAKEN 40006e20: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 40006e24: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40006e28: 40 00 02 61 call 400077ac <== NOT EXECUTED 40006e2c: a2 10 00 12 mov %l2, %l1 <== NOT EXECUTED return result; 40006e30: 81 c7 e0 08 ret <== NOT EXECUTED 40006e34: 91 e8 00 11 restore %g0, %l1, %o0 <== NOT EXECUTED } ++aio_request_queue.active_threads; 40006e38: 82 00 60 01 inc %g1 40006e3c: 10 80 00 3f b 40006f38 40006e40: c2 24 20 64 st %g1, [ %l0 + 0x64 ] } else { /* put request in the fd chain it belongs to */ pthread_mutex_lock (&r_chain->mutex); 40006e44: 40 00 02 39 call 40007728 40006e48: 90 10 00 13 mov %l3, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40006e4c: 90 10 00 15 mov %l5, %o0 40006e50: 7f ff ff 6d call 40006c04 40006e54: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 40006e58: 40 00 01 12 call 400072a0 40006e5c: 90 10 00 14 mov %l4, %o0 pthread_mutex_unlock (&r_chain->mutex); 40006e60: 10 80 00 12 b 40006ea8 40006e64: 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, 40006e68: d2 00 40 00 ld [ %g1 ], %o1 <== NOT EXECUTED 40006e6c: 11 10 00 61 sethi %hi(0x40018400), %o0 40006e70: 94 10 20 00 clr %o2 40006e74: 7f ff fe 90 call 400068b4 40006e78: 90 12 21 5c or %o0, 0x15c, %o0 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 40006e7c: a0 92 20 00 orcc %o0, 0, %l0 40006e80: 02 80 00 0e be 40006eb8 40006e84: a4 04 20 1c add %l0, 0x1c, %l2 { pthread_mutex_lock (&r_chain->mutex); 40006e88: 40 00 02 28 call 40007728 40006e8c: 90 10 00 12 mov %l2, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40006e90: 90 04 20 08 add %l0, 8, %o0 40006e94: 7f ff ff 5c call 40006c04 40006e98: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 40006e9c: 40 00 01 01 call 400072a0 40006ea0: 90 04 20 20 add %l0, 0x20, %o0 pthread_mutex_unlock (&r_chain->mutex); 40006ea4: 90 10 00 12 mov %l2, %o0 40006ea8: 40 00 02 41 call 400077ac 40006eac: 01 00 00 00 nop if (aio_request_queue.idle_threads > 0) pthread_cond_signal (&aio_request_queue.new_req); } } pthread_mutex_unlock (&aio_request_queue.mutex); 40006eb0: 10 80 00 23 b 40006f3c 40006eb4: 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); 40006eb8: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40006ebc: 11 10 00 61 sethi %hi(0x40018400), %o0 40006ec0: d2 00 40 00 ld [ %g1 ], %o1 40006ec4: 90 12 21 68 or %o0, 0x168, %o0 40006ec8: 7f ff fe 7b call 400068b4 40006ecc: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40006ed0: 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); 40006ed4: a0 10 00 08 mov %o0, %l0 if (r_chain->new_fd == 1) { 40006ed8: 80 a0 60 01 cmp %g1, 1 40006edc: 12 80 00 0d bne 40006f10 40006ee0: 90 02 20 08 add %o0, 8, %o0 40006ee4: 40 00 08 a5 call 40009178 <_Chain_Insert> 40006ee8: 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); 40006eec: 90 04 20 1c add %l0, 0x1c, %o0 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; 40006ef0: c0 24 20 18 clr [ %l0 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40006ef4: 40 00 01 b5 call 400075c8 40006ef8: 92 10 20 00 clr %o1 pthread_cond_init (&r_chain->cond, NULL); 40006efc: 90 04 20 20 add %l0, 0x20, %o0 40006f00: 40 00 00 ba call 400071e8 40006f04: 92 10 20 00 clr %o1 } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); if (aio_request_queue.idle_threads > 0) 40006f08: 10 80 00 05 b 40006f1c 40006f0c: 11 10 00 61 sethi %hi(0x40018400), %o0 r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); pthread_cond_init (&r_chain->cond, NULL); } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); 40006f10: 7f ff ff 3d call 40006c04 40006f14: 92 10 00 18 mov %i0, %o1 if (aio_request_queue.idle_threads > 0) 40006f18: 11 10 00 61 sethi %hi(0x40018400), %o0 40006f1c: 90 12 21 14 or %o0, 0x114, %o0 ! 40018514 40006f20: c2 02 20 68 ld [ %o0 + 0x68 ], %g1 40006f24: 80 a0 60 00 cmp %g1, 0 40006f28: 24 80 00 05 ble,a 40006f3c <== ALWAYS TAKEN 40006f2c: 11 10 00 61 sethi %hi(0x40018400), %o0 pthread_cond_signal (&aio_request_queue.new_req); 40006f30: 40 00 00 dc call 400072a0 <== NOT EXECUTED 40006f34: 90 02 20 04 add %o0, 4, %o0 ! 40018404 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); 40006f38: 11 10 00 61 sethi %hi(0x40018400), %o0 40006f3c: 40 00 02 1c call 400077ac 40006f40: 90 12 21 14 or %o0, 0x114, %o0 ! 40018514 return 0; } 40006f44: b0 10 00 11 mov %l1, %i0 40006f48: 81 c7 e0 08 ret 40006f4c: 81 e8 00 00 restore =============================================================================== 400069a8 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 400069a8: 9d e3 bf 78 save %sp, -136, %sp struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 400069ac: 21 10 00 61 sethi %hi(0x40018400), %l0 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 400069b0: a4 07 bf f4 add %fp, -12, %l2 struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 400069b4: a0 14 21 14 or %l0, 0x114, %l0 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); 400069b8: aa 07 bf fc add %fp, -4, %l5 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)) { 400069bc: ae 04 20 58 add %l0, 0x58, %l7 --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 400069c0: ac 04 20 04 add %l0, 4, %l6 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); 400069c4: a6 07 bf d8 add %fp, -40, %l3 default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 400069c8: a8 10 3f ff mov -1, %l4 /* 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); 400069cc: ba 06 20 1c add %i0, 0x1c, %i5 400069d0: 40 00 03 56 call 40007728 400069d4: 90 10 00 1d mov %i5, %o0 if (result != 0) 400069d8: 80 a2 20 00 cmp %o0, 0 400069dc: 12 80 00 87 bne 40006bf8 <== NEVER TAKEN 400069e0: 82 06 20 0c add %i0, 0xc, %g1 } } AIO_printf ("Thread finished\n"); return NULL; } 400069e4: e2 06 20 08 ld [ %i0 + 8 ], %l1 /* 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)) { 400069e8: 80 a4 40 01 cmp %l1, %g1 400069ec: 02 80 00 3a be 40006ad4 400069f0: 01 00 00 00 nop 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); 400069f4: 40 00 05 58 call 40007f54 400069f8: 01 00 00 00 nop 400069fc: 92 10 00 15 mov %l5, %o1 40006a00: 40 00 04 5d call 40007b74 40006a04: 94 10 00 13 mov %l3, %o2 param.sched_priority = req->priority; 40006a08: c2 04 60 0c ld [ %l1 + 0xc ], %g1 pthread_setschedparam (pthread_self(), req->policy, ¶m); 40006a0c: 40 00 05 52 call 40007f54 40006a10: c2 27 bf d8 st %g1, [ %fp + -40 ] 40006a14: d2 04 60 08 ld [ %l1 + 8 ], %o1 40006a18: 40 00 05 53 call 40007f64 40006a1c: 94 10 00 13 mov %l3, %o2 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40006a20: 40 00 09 bd call 40009114 <_Chain_Extract> 40006a24: 90 10 00 11 mov %l1, %o0 rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 40006a28: 40 00 03 61 call 400077ac 40006a2c: 90 10 00 1d mov %i5, %o0 switch (req->aiocbp->aio_lio_opcode) { 40006a30: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 40006a34: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 40006a38: 80 a0 a0 02 cmp %g2, 2 40006a3c: 22 80 00 10 be,a 40006a7c 40006a40: c4 18 60 08 ldd [ %g1 + 8 ], %g2 40006a44: 80 a0 a0 03 cmp %g2, 3 40006a48: 02 80 00 15 be 40006a9c <== NEVER TAKEN 40006a4c: 80 a0 a0 01 cmp %g2, 1 40006a50: 32 80 00 19 bne,a 40006ab4 <== NEVER TAKEN 40006a54: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED case LIO_READ: AIO_printf ("read\n"); result = pread (req->aiocbp->aio_fildes, 40006a58: c4 18 60 08 ldd [ %g1 + 8 ], %g2 40006a5c: d0 00 40 00 ld [ %g1 ], %o0 40006a60: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 40006a64: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 40006a68: 96 10 00 02 mov %g2, %o3 40006a6c: 40 00 2c 06 call 40011a84 40006a70: 98 10 00 03 mov %g3, %o4 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 40006a74: 10 80 00 0d b 40006aa8 40006a78: 80 a2 3f ff cmp %o0, -1 case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, 40006a7c: d0 00 40 00 ld [ %g1 ], %o0 40006a80: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 40006a84: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 40006a88: 96 10 00 02 mov %g2, %o3 40006a8c: 40 00 2c 3a call 40011b74 40006a90: 98 10 00 03 mov %g3, %o4 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 40006a94: 10 80 00 05 b 40006aa8 40006a98: 80 a2 3f ff cmp %o0, -1 case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); 40006a9c: 40 00 1b dd call 4000da10 <== NOT EXECUTED 40006aa0: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { 40006aa4: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED 40006aa8: 32 80 00 08 bne,a 40006ac8 <== ALWAYS TAKEN 40006aac: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 req->aiocbp->return_value = -1; 40006ab0: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED req->aiocbp->error_code = errno; 40006ab4: 40 00 28 c0 call 40010db4 <__errno> <== NOT EXECUTED 40006ab8: e8 24 60 38 st %l4, [ %l1 + 0x38 ] <== NOT EXECUTED 40006abc: c2 02 00 00 ld [ %o0 ], %g1 <== NOT EXECUTED 40006ac0: 10 bf ff c3 b 400069cc <== NOT EXECUTED 40006ac4: c2 24 60 34 st %g1, [ %l1 + 0x34 ] <== NOT EXECUTED } else { req->aiocbp->return_value = result; 40006ac8: d0 20 60 38 st %o0, [ %g1 + 0x38 ] req->aiocbp->error_code = 0; 40006acc: 10 bf ff c0 b 400069cc 40006ad0: c0 20 60 34 clr [ %g1 + 0x34 ] struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); 40006ad4: 40 00 03 36 call 400077ac 40006ad8: 90 10 00 1d mov %i5, %o0 pthread_mutex_lock (&aio_request_queue.mutex); 40006adc: 40 00 03 13 call 40007728 40006ae0: 90 10 00 10 mov %l0, %o0 if (rtems_chain_is_empty (chain)) 40006ae4: c2 06 20 08 ld [ %i0 + 8 ], %g1 40006ae8: 80 a0 40 11 cmp %g1, %l1 40006aec: 12 80 00 3f bne 40006be8 <== NEVER TAKEN 40006af0: 92 10 00 12 mov %l2, %o1 { clock_gettime (CLOCK_REALTIME, &timeout); 40006af4: 40 00 01 64 call 40007084 40006af8: 90 10 20 01 mov 1, %o0 timeout.tv_sec += 3; 40006afc: c2 07 bf f4 ld [ %fp + -12 ], %g1 timeout.tv_nsec = 0; 40006b00: c0 27 bf f8 clr [ %fp + -8 ] pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40006b04: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40006b08: a2 06 20 20 add %i0, 0x20, %l1 pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40006b0c: c2 27 bf f4 st %g1, [ %fp + -12 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40006b10: 90 10 00 11 mov %l1, %o0 40006b14: 92 10 00 10 mov %l0, %o1 40006b18: 40 00 02 01 call 4000731c 40006b1c: 94 10 00 12 mov %l2, %o2 &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) { 40006b20: 80 a2 20 74 cmp %o0, 0x74 40006b24: 12 80 00 31 bne 40006be8 <== NEVER TAKEN 40006b28: 01 00 00 00 nop 40006b2c: 40 00 09 7a call 40009114 <_Chain_Extract> 40006b30: 90 10 00 18 mov %i0, %o0 rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 40006b34: 40 00 02 54 call 40007484 40006b38: 90 10 00 1d mov %i5, %o0 pthread_cond_destroy (&r_chain->cond); 40006b3c: 40 00 01 76 call 40007114 40006b40: 90 10 00 11 mov %l1, %o0 free (r_chain); 40006b44: 7f ff f1 d4 call 40003294 40006b48: 90 10 00 18 mov %i0, %o0 /* 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)) { 40006b4c: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 40006b50: 80 a0 40 17 cmp %g1, %l7 40006b54: 12 80 00 1b bne 40006bc0 40006b58: c2 04 20 68 ld [ %l0 + 0x68 ], %g1 AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); 40006b5c: 92 10 00 12 mov %l2, %o1 /* 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_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; 40006b60: 82 00 60 01 inc %g1 40006b64: c2 24 20 68 st %g1, [ %l0 + 0x68 ] --aio_request_queue.active_threads; 40006b68: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 clock_gettime (CLOCK_REALTIME, &timeout); 40006b6c: 90 10 20 01 mov 1, %o0 signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; 40006b70: 82 00 7f ff add %g1, -1, %g1 clock_gettime (CLOCK_REALTIME, &timeout); 40006b74: 40 00 01 44 call 40007084 40006b78: c2 24 20 64 st %g1, [ %l0 + 0x64 ] timeout.tv_sec += 3; 40006b7c: c2 07 bf f4 ld [ %fp + -12 ], %g1 timeout.tv_nsec = 0; 40006b80: c0 27 bf f8 clr [ %fp + -8 ] AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40006b84: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40006b88: 90 10 00 16 mov %l6, %o0 AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40006b8c: c2 27 bf f4 st %g1, [ %fp + -12 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40006b90: 92 10 00 10 mov %l0, %o1 40006b94: 40 00 01 e2 call 4000731c 40006b98: 94 10 00 12 mov %l2, %o2 &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { 40006b9c: 80 a2 20 74 cmp %o0, 0x74 40006ba0: 12 80 00 08 bne 40006bc0 <== NEVER TAKEN 40006ba4: c2 04 20 68 ld [ %l0 + 0x68 ], %g1 AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; pthread_mutex_unlock (&aio_request_queue.mutex); 40006ba8: 90 10 00 10 mov %l0, %o0 /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; 40006bac: 82 00 7f ff add %g1, -1, %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 40006bb0: 40 00 02 ff call 400077ac 40006bb4: c2 24 20 68 st %g1, [ %l0 + 0x68 ] return NULL; 40006bb8: 81 c7 e0 08 ret 40006bbc: 91 e8 20 00 restore %g0, 0, %o0 } } AIO_printf ("Thread finished\n"); return NULL; } 40006bc0: f0 04 20 54 ld [ %l0 + 0x54 ], %i0 } } /* Otherwise move this chain to the working chain and start the loop all over again */ AIO_printf ("Work on idle\n"); --aio_request_queue.idle_threads; 40006bc4: 82 00 7f ff add %g1, -1, %g1 40006bc8: c2 24 20 68 st %g1, [ %l0 + 0x68 ] ++aio_request_queue.active_threads; 40006bcc: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 40006bd0: 90 10 00 18 mov %i0, %o0 40006bd4: 82 00 60 01 inc %g1 40006bd8: 40 00 09 4f call 40009114 <_Chain_Extract> 40006bdc: c2 24 20 64 st %g1, [ %l0 + 0x64 ] node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = (rtems_aio_request_chain *) node; rtems_aio_move_to_work (r_chain); 40006be0: 7f ff ff 61 call 40006964 40006be4: 90 10 00 18 mov %i0, %o0 } } /* 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); 40006be8: 40 00 02 f1 call 400077ac 40006bec: 90 10 00 10 mov %l0, %o0 /* 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); 40006bf0: 10 bf ff 78 b 400069d0 40006bf4: ba 06 20 1c add %i0, 0x1c, %i5 } } AIO_printf ("Thread finished\n"); return NULL; } 40006bf8: b0 10 20 00 clr %i0 <== NOT EXECUTED 40006bfc: 81 c7 e0 08 ret <== NOT EXECUTED 40006c00: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 400067d4 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 400067d4: 9d e3 bf a0 save %sp, -96, %sp int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 400067d8: 21 10 00 61 sethi %hi(0x40018400), %l0 400067dc: 40 00 04 3c call 400078cc 400067e0: 90 14 21 1c or %l0, 0x11c, %o0 ! 4001851c if (result != 0) 400067e4: b0 92 20 00 orcc %o0, 0, %i0 400067e8: 12 80 00 31 bne 400068ac <== NEVER TAKEN 400067ec: 90 14 21 1c or %l0, 0x11c, %o0 return result; result = 400067f0: 40 00 04 43 call 400078fc 400067f4: 92 10 20 00 clr %o1 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 400067f8: 80 a2 20 00 cmp %o0, 0 400067fc: 22 80 00 05 be,a 40006810 <== ALWAYS TAKEN 40006800: 11 10 00 61 sethi %hi(0x40018400), %o0 pthread_attr_destroy (&aio_request_queue.attr); 40006804: 40 00 04 26 call 4000789c <== NOT EXECUTED 40006808: 90 14 21 1c or %l0, 0x11c, %o0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 4000680c: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 40006810: 92 10 20 00 clr %o1 40006814: 40 00 03 6d call 400075c8 40006818: 90 12 21 14 or %o0, 0x114, %o0 if (result != 0) 4000681c: 80 a2 20 00 cmp %o0, 0 40006820: 22 80 00 06 be,a 40006838 <== ALWAYS TAKEN 40006824: 11 10 00 61 sethi %hi(0x40018400), %o0 pthread_attr_destroy (&aio_request_queue.attr); 40006828: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 4000682c: 40 00 04 1c call 4000789c <== NOT EXECUTED 40006830: 90 12 21 1c or %o0, 0x11c, %o0 ! 4001851c <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 40006834: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 40006838: 92 10 20 00 clr %o1 4000683c: 40 00 02 6b call 400071e8 40006840: 90 12 21 18 or %o0, 0x118, %o0 if (result != 0) { 40006844: b0 92 20 00 orcc %o0, 0, %i0 40006848: 02 80 00 09 be 4000686c <== ALWAYS TAKEN 4000684c: 03 10 00 61 sethi %hi(0x40018400), %g1 pthread_mutex_destroy (&aio_request_queue.mutex); 40006850: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 40006854: 40 00 03 0c call 40007484 <== NOT EXECUTED 40006858: 90 12 21 14 or %o0, 0x114, %o0 ! 40018514 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 4000685c: 11 10 00 61 sethi %hi(0x40018400), %o0 <== NOT EXECUTED 40006860: 40 00 04 0f call 4000789c <== NOT EXECUTED 40006864: 90 12 21 1c or %o0, 0x11c, %o0 ! 4001851c <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40006868: 03 10 00 61 sethi %hi(0x40018400), %g1 <== NOT EXECUTED 4000686c: 82 10 61 14 or %g1, 0x114, %g1 ! 40018514 40006870: 84 00 60 4c add %g1, 0x4c, %g2 40006874: c4 20 60 48 st %g2, [ %g1 + 0x48 ] head->previous = NULL; tail->previous = head; 40006878: 84 00 60 48 add %g1, 0x48, %g2 4000687c: 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; 40006880: 84 00 60 58 add %g1, 0x58, %g2 40006884: c4 20 60 54 st %g2, [ %g1 + 0x54 ] head->previous = NULL; tail->previous = head; 40006888: 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; 4000688c: c0 20 60 4c clr [ %g1 + 0x4c ] tail->previous = head; 40006890: 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; 40006894: 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; 40006898: 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; 4000689c: c0 20 60 64 clr [ %g1 + 0x64 ] aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 400068a0: 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; 400068a4: c0 20 60 68 clr [ %g1 + 0x68 ] aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 400068a8: c4 20 60 60 st %g2, [ %g1 + 0x60 ] return result; } 400068ac: 81 c7 e0 08 ret 400068b0: 81 e8 00 00 restore =============================================================================== 40006c04 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 40006c04: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 40006c08: c2 06 00 00 ld [ %i0 ], %g1 40006c0c: 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)) { 40006c10: 80 a0 40 03 cmp %g1, %g3 40006c14: 02 80 00 10 be 40006c54 <== NEVER TAKEN 40006c18: 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; 40006c1c: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 while (req->aiocbp->aio_reqprio > prio && 40006c20: 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; 40006c24: c8 01 20 18 ld [ %g4 + 0x18 ], %g4 while (req->aiocbp->aio_reqprio > prio && 40006c28: 10 80 00 04 b 40006c38 40006c2c: 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; 40006c30: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 <== NOT EXECUTED 40006c34: 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 && 40006c38: 80 a3 40 04 cmp %o5, %g4 40006c3c: 04 80 00 04 ble 40006c4c <== ALWAYS TAKEN 40006c40: 80 a0 40 03 cmp %g1, %g3 40006c44: 32 bf ff fb bne,a 40006c30 <== NOT EXECUTED 40006c48: 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 ); 40006c4c: f0 00 60 04 ld [ %g1 + 4 ], %i0 40006c50: b2 10 00 02 mov %g2, %i1 40006c54: 40 00 09 49 call 40009178 <_Chain_Insert> 40006c58: 81 e8 00 00 restore =============================================================================== 40006964 : } } AIO_printf ("Thread finished\n"); return NULL; } 40006964: 05 10 00 61 sethi %hi(0x40018400), %g2 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { 40006968: 92 10 00 08 mov %o0, %o1 } } AIO_printf ("Thread finished\n"); return NULL; } 4000696c: 84 10 a1 14 or %g2, 0x114, %g2 rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 40006970: c6 02 20 14 ld [ %o0 + 0x14 ], %g3 } } AIO_printf ("Thread finished\n"); return NULL; } 40006974: c2 00 a0 48 ld [ %g2 + 0x48 ], %g1 40006978: 84 00 a0 4c add %g2, 0x4c, %g2 rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 4000697c: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 40006980: 80 a1 00 03 cmp %g4, %g3 40006984: 16 80 00 04 bge 40006994 40006988: 80 a0 40 02 cmp %g1, %g2 4000698c: 32 bf ff fc bne,a 4000697c <== ALWAYS TAKEN 40006990: c2 00 40 00 ld [ %g1 ], %g1 40006994: d0 00 60 04 ld [ %g1 + 4 ], %o0 40006998: 82 13 c0 00 mov %o7, %g1 4000699c: 40 00 09 f7 call 40009178 <_Chain_Insert> 400069a0: 9e 10 40 00 mov %g1, %o7 =============================================================================== 40006cb0 : * 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) { 40006cb0: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 40006cb4: e0 06 00 00 ld [ %i0 ], %l0 40006cb8: 82 06 20 04 add %i0, 4, %g1 * AIO_CANCELED - if request was canceled */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { if (rtems_chain_is_empty (chain)) 40006cbc: 80 a4 00 01 cmp %l0, %g1 40006cc0: 12 80 00 07 bne 40006cdc 40006cc4: b0 10 20 02 mov 2, %i0 40006cc8: 30 80 00 14 b,a 40006d18 } } AIO_printf ("Thread finished\n"); return NULL; } 40006ccc: e0 02 00 00 ld [ %o0 ], %l0 <== 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) { 40006cd0: 80 a4 00 01 cmp %l0, %g1 <== NOT EXECUTED 40006cd4: 02 80 00 0f be 40006d10 <== NOT EXECUTED 40006cd8: b0 10 20 01 mov 1, %i0 <== NOT EXECUTED 40006cdc: c4 04 20 14 ld [ %l0 + 0x14 ], %g2 40006ce0: 80 a0 80 19 cmp %g2, %i1 40006ce4: 12 bf ff fa bne 40006ccc <== NEVER TAKEN 40006ce8: 90 10 00 10 mov %l0, %o0 40006cec: 40 00 09 0a call 40009114 <_Chain_Extract> 40006cf0: b0 10 20 00 clr %i0 if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 40006cf4: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40006cf8: 84 10 20 8c mov 0x8c, %g2 40006cfc: c4 20 60 34 st %g2, [ %g1 + 0x34 ] current->aiocbp->return_value = -1; 40006d00: 84 10 3f ff mov -1, %g2 free (current); 40006d04: 90 10 00 10 mov %l0, %o0 40006d08: 7f ff f1 63 call 40003294 40006d0c: c4 20 60 38 st %g2, [ %g1 + 0x38 ] } return AIO_CANCELED; 40006d10: 81 c7 e0 08 ret 40006d14: 81 e8 00 00 restore } 40006d18: 81 c7 e0 08 ret 40006d1c: 81 e8 00 00 restore =============================================================================== 40006ac8 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 40006ac8: 9d e3 bf 98 save %sp, -104, %sp 40006acc: 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( 40006ad0: 10 80 00 09 b 40006af4 40006ad4: a4 07 bf fc add %fp, -4, %l2 40006ad8: 92 10 20 00 clr %o1 40006adc: 94 10 00 1a mov %i2, %o2 40006ae0: 7f ff fc fc call 40005ed0 40006ae4: 96 10 00 12 mov %l2, %o3 ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 40006ae8: 80 a2 20 00 cmp %o0, 0 40006aec: 32 80 00 09 bne,a 40006b10 <== ALWAYS TAKEN 40006af0: 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 ); 40006af4: 40 00 01 81 call 400070f8 <_Chain_Get> 40006af8: 90 10 00 10 mov %l0, %o0 sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 40006afc: a2 92 20 00 orcc %o0, 0, %l1 40006b00: 02 bf ff f6 be 40006ad8 40006b04: 90 10 00 19 mov %i1, %o0 40006b08: 90 10 20 00 clr %o0 timeout, &out ); } *node_ptr = node; 40006b0c: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 40006b10: 81 c7 e0 08 ret 40006b14: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40008ce0 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 40008ce0: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 40008ce4: 80 a6 20 00 cmp %i0, 0 40008ce8: 02 80 00 1a be 40008d50 <== NEVER TAKEN 40008cec: 21 10 00 81 sethi %hi(0x40020400), %l0 40008cf0: a0 14 23 6c or %l0, 0x36c, %l0 ! 4002076c <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 40008cf4: 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 ]; 40008cf8: c2 04 00 00 ld [ %l0 ], %g1 40008cfc: e4 00 60 04 ld [ %g1 + 4 ], %l2 if ( !information ) 40008d00: 80 a4 a0 00 cmp %l2, 0 40008d04: 12 80 00 0b bne 40008d30 40008d08: a2 10 20 01 mov 1, %l1 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40008d0c: 10 80 00 0e b 40008d44 40008d10: a0 04 20 04 add %l0, 4, %l0 the_thread = (Thread_Control *)information->local_table[ i ]; 40008d14: 83 2c 60 02 sll %l1, 2, %g1 40008d18: d0 00 80 01 ld [ %g2 + %g1 ], %o0 if ( !the_thread ) 40008d1c: 80 a2 20 00 cmp %o0, 0 40008d20: 02 80 00 04 be 40008d30 <== NEVER TAKEN 40008d24: a2 04 60 01 inc %l1 continue; (*routine)(the_thread); 40008d28: 9f c6 00 00 call %i0 40008d2c: 01 00 00 00 nop information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40008d30: c2 14 a0 10 lduh [ %l2 + 0x10 ], %g1 40008d34: 80 a4 40 01 cmp %l1, %g1 40008d38: 28 bf ff f7 bleu,a 40008d14 40008d3c: c4 04 a0 1c ld [ %l2 + 0x1c ], %g2 40008d40: 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++ ) { 40008d44: 80 a4 00 13 cmp %l0, %l3 40008d48: 32 bf ff ed bne,a 40008cfc 40008d4c: c2 04 00 00 ld [ %l0 ], %g1 40008d50: 81 c7 e0 08 ret 40008d54: 81 e8 00 00 restore =============================================================================== 40013eec : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 40013eec: 9d e3 bf a0 save %sp, -96, %sp 40013ef0: a0 10 00 18 mov %i0, %l0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 40013ef4: 80 a4 20 00 cmp %l0, 0 40013ef8: 02 80 00 1f be 40013f74 40013efc: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !starting_address ) 40013f00: 80 a6 60 00 cmp %i1, 0 40013f04: 02 80 00 1c be 40013f74 40013f08: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !id ) 40013f0c: 80 a7 60 00 cmp %i5, 0 40013f10: 02 80 00 19 be 40013f74 <== NEVER TAKEN 40013f14: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 40013f18: 02 80 00 32 be 40013fe0 40013f1c: 80 a6 a0 00 cmp %i2, 0 40013f20: 02 80 00 30 be 40013fe0 40013f24: 80 a6 80 1b cmp %i2, %i3 40013f28: 0a 80 00 13 bcs 40013f74 40013f2c: b0 10 20 08 mov 8, %i0 40013f30: 80 8e e0 07 btst 7, %i3 40013f34: 12 80 00 10 bne 40013f74 40013f38: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 40013f3c: 12 80 00 0e bne 40013f74 40013f40: b0 10 20 09 mov 9, %i0 40013f44: 03 10 00 fa sethi %hi(0x4003e800), %g1 40013f48: c4 00 63 d0 ld [ %g1 + 0x3d0 ], %g2 ! 4003ebd0 <_Thread_Dispatch_disable_level> 40013f4c: 84 00 a0 01 inc %g2 40013f50: c4 20 63 d0 st %g2, [ %g1 + 0x3d0 ] * 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 ); 40013f54: 25 10 00 fa sethi %hi(0x4003e800), %l2 40013f58: 40 00 12 8f call 40018994 <_Objects_Allocate> 40013f5c: 90 14 a1 e4 or %l2, 0x1e4, %o0 ! 4003e9e4 <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 40013f60: a2 92 20 00 orcc %o0, 0, %l1 40013f64: 12 80 00 06 bne 40013f7c 40013f68: 92 10 00 1b mov %i3, %o1 _Thread_Enable_dispatch(); 40013f6c: 40 00 17 52 call 40019cb4 <_Thread_Enable_dispatch> 40013f70: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 40013f74: 81 c7 e0 08 ret 40013f78: 81 e8 00 00 restore _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 40013f7c: f2 24 60 10 st %i1, [ %l1 + 0x10 ] the_partition->length = length; 40013f80: f4 24 60 14 st %i2, [ %l1 + 0x14 ] the_partition->buffer_size = buffer_size; 40013f84: f6 24 60 18 st %i3, [ %l1 + 0x18 ] the_partition->attribute_set = attribute_set; 40013f88: f8 24 60 1c st %i4, [ %l1 + 0x1c ] the_partition->number_of_used_blocks = 0; 40013f8c: c0 24 60 20 clr [ %l1 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 40013f90: 40 00 65 53 call 4002d4dc <.udiv> 40013f94: 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, 40013f98: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 40013f9c: 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, 40013fa0: 96 10 00 1b mov %i3, %o3 40013fa4: a6 04 60 24 add %l1, 0x24, %l3 40013fa8: 40 00 0c 78 call 40017188 <_Chain_Initialize> 40013fac: 90 10 00 13 mov %l3, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40013fb0: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40013fb4: a4 14 a1 e4 or %l2, 0x1e4, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40013fb8: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40013fbc: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40013fc0: 85 28 a0 02 sll %g2, 2, %g2 40013fc4: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40013fc8: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 40013fcc: c2 27 40 00 st %g1, [ %i5 ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 40013fd0: 40 00 17 39 call 40019cb4 <_Thread_Enable_dispatch> 40013fd4: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40013fd8: 81 c7 e0 08 ret 40013fdc: 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; 40013fe0: b0 10 20 08 mov 8, %i0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40013fe4: 81 c7 e0 08 ret 40013fe8: 81 e8 00 00 restore =============================================================================== 40006ef4 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 40006ef4: 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 ); 40006ef8: 11 10 00 7e sethi %hi(0x4001f800), %o0 40006efc: 92 10 00 18 mov %i0, %o1 40006f00: 90 12 22 6c or %o0, 0x26c, %o0 40006f04: 40 00 09 0a call 4000932c <_Objects_Get> 40006f08: 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 ) { 40006f0c: c2 07 bf fc ld [ %fp + -4 ], %g1 40006f10: 80 a0 60 00 cmp %g1, 0 40006f14: 12 80 00 66 bne 400070ac 40006f18: a0 10 00 08 mov %o0, %l0 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40006f1c: 25 10 00 80 sethi %hi(0x40020000), %l2 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 40006f20: c4 02 20 40 ld [ %o0 + 0x40 ], %g2 40006f24: a4 14 a1 08 or %l2, 0x108, %l2 40006f28: c2 04 a0 0c ld [ %l2 + 0xc ], %g1 40006f2c: 80 a0 80 01 cmp %g2, %g1 40006f30: 02 80 00 06 be 40006f48 40006f34: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 40006f38: 40 00 0c 77 call 4000a114 <_Thread_Enable_dispatch> 40006f3c: b0 10 20 17 mov 0x17, %i0 return RTEMS_NOT_OWNER_OF_RESOURCE; 40006f40: 81 c7 e0 08 ret 40006f44: 81 e8 00 00 restore } if ( length == RTEMS_PERIOD_STATUS ) { 40006f48: 12 80 00 0e bne 40006f80 40006f4c: 01 00 00 00 nop switch ( the_period->state ) { 40006f50: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40006f54: 80 a0 60 04 cmp %g1, 4 40006f58: 18 80 00 06 bgu 40006f70 <== NEVER TAKEN 40006f5c: b0 10 20 00 clr %i0 40006f60: 83 28 60 02 sll %g1, 2, %g1 40006f64: 05 10 00 76 sethi %hi(0x4001d800), %g2 40006f68: 84 10 a3 a4 or %g2, 0x3a4, %g2 ! 4001dba4 40006f6c: 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(); 40006f70: 40 00 0c 69 call 4000a114 <_Thread_Enable_dispatch> 40006f74: 01 00 00 00 nop return( return_value ); 40006f78: 81 c7 e0 08 ret 40006f7c: 81 e8 00 00 restore } _ISR_Disable( level ); 40006f80: 7f ff ef 13 call 40002bcc 40006f84: 01 00 00 00 nop 40006f88: a6 10 00 08 mov %o0, %l3 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 40006f8c: e2 04 20 38 ld [ %l0 + 0x38 ], %l1 40006f90: 80 a4 60 00 cmp %l1, 0 40006f94: 12 80 00 15 bne 40006fe8 40006f98: 80 a4 60 02 cmp %l1, 2 _ISR_Enable( level ); 40006f9c: 7f ff ef 10 call 40002bdc 40006fa0: 01 00 00 00 nop /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 40006fa4: 7f ff ff 7a call 40006d8c <_Rate_monotonic_Initiate_statistics> 40006fa8: 90 10 00 10 mov %l0, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40006fac: 82 10 20 02 mov 2, %g1 40006fb0: c2 24 20 38 st %g1, [ %l0 + 0x38 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40006fb4: 03 10 00 1c sethi %hi(0x40007000), %g1 40006fb8: 82 10 63 7c or %g1, 0x37c, %g1 ! 4000737c <_Rate_monotonic_Timeout> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40006fbc: c0 24 20 18 clr [ %l0 + 0x18 ] the_watchdog->routine = routine; 40006fc0: c2 24 20 2c st %g1, [ %l0 + 0x2c ] the_watchdog->id = id; 40006fc4: f0 24 20 30 st %i0, [ %l0 + 0x30 ] the_watchdog->user_data = user_data; 40006fc8: c0 24 20 34 clr [ %l0 + 0x34 ] _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 40006fcc: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006fd0: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006fd4: 11 10 00 7f sethi %hi(0x4001fc00), %o0 40006fd8: 92 04 20 10 add %l0, 0x10, %o1 40006fdc: 40 00 10 60 call 4000b15c <_Watchdog_Insert> 40006fe0: 90 12 20 90 or %o0, 0x90, %o0 40006fe4: 30 80 00 1b b,a 40007050 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 40006fe8: 12 80 00 1e bne 40007060 40006fec: 80 a4 60 04 cmp %l1, 4 /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 40006ff0: 7f ff ff 83 call 40006dfc <_Rate_monotonic_Update_statistics> 40006ff4: 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; 40006ff8: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 40006ffc: 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; 40007000: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 40007004: 7f ff ee f6 call 40002bdc 40007008: 90 10 00 13 mov %l3, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 4000700c: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40007010: c2 04 20 08 ld [ %l0 + 8 ], %g1 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40007014: 13 00 00 10 sethi %hi(0x4000), %o1 40007018: 40 00 0e 69 call 4000a9bc <_Thread_Set_state> 4000701c: c2 22 20 20 st %g1, [ %o0 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 40007020: 7f ff ee eb call 40002bcc 40007024: 01 00 00 00 nop local_state = the_period->state; 40007028: e6 04 20 38 ld [ %l0 + 0x38 ], %l3 the_period->state = RATE_MONOTONIC_ACTIVE; 4000702c: e2 24 20 38 st %l1, [ %l0 + 0x38 ] _ISR_Enable( level ); 40007030: 7f ff ee eb call 40002bdc 40007034: 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 ) 40007038: 80 a4 e0 03 cmp %l3, 3 4000703c: 12 80 00 05 bne 40007050 40007040: 01 00 00 00 nop _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40007044: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40007048: 40 00 0b 6c call 40009df8 <_Thread_Clear_state> 4000704c: 13 00 00 10 sethi %hi(0x4000), %o1 _Thread_Enable_dispatch(); 40007050: 40 00 0c 31 call 4000a114 <_Thread_Enable_dispatch> 40007054: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40007058: 81 c7 e0 08 ret 4000705c: 81 e8 00 00 restore } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 40007060: 12 bf ff b8 bne 40006f40 <== NEVER TAKEN 40007064: b0 10 20 04 mov 4, %i0 /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 40007068: 7f ff ff 65 call 40006dfc <_Rate_monotonic_Update_statistics> 4000706c: 90 10 00 10 mov %l0, %o0 _ISR_Enable( level ); 40007070: 7f ff ee db call 40002bdc 40007074: 90 10 00 13 mov %l3, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40007078: 82 10 20 02 mov 2, %g1 4000707c: 92 04 20 10 add %l0, 0x10, %o1 40007080: 11 10 00 7f sethi %hi(0x4001fc00), %o0 40007084: 90 12 20 90 or %o0, 0x90, %o0 ! 4001fc90 <_Watchdog_Ticks_chain> 40007088: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; 4000708c: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007090: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007094: 40 00 10 32 call 4000b15c <_Watchdog_Insert> 40007098: b0 10 20 06 mov 6, %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 4000709c: 40 00 0c 1e call 4000a114 <_Thread_Enable_dispatch> 400070a0: 01 00 00 00 nop return RTEMS_TIMEOUT; 400070a4: 81 c7 e0 08 ret 400070a8: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 400070ac: b0 10 20 04 mov 4, %i0 } 400070b0: 81 c7 e0 08 ret 400070b4: 81 e8 00 00 restore =============================================================================== 400070b8 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 400070b8: 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 ) 400070bc: 80 a6 60 00 cmp %i1, 0 400070c0: 02 80 00 79 be 400072a4 <== NEVER TAKEN 400070c4: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 400070c8: 13 10 00 76 sethi %hi(0x4001d800), %o1 400070cc: 9f c6 40 00 call %i1 400070d0: 92 12 63 b8 or %o1, 0x3b8, %o1 ! 4001dbb8 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 400070d4: 90 10 00 18 mov %i0, %o0 400070d8: 13 10 00 76 sethi %hi(0x4001d800), %o1 400070dc: 9f c6 40 00 call %i1 400070e0: 92 12 63 d8 or %o1, 0x3d8, %o1 ! 4001dbd8 (*print)( context, "--- Wall times are in seconds ---\n" ); 400070e4: 90 10 00 18 mov %i0, %o0 400070e8: 13 10 00 77 sethi %hi(0x4001dc00), %o1 400070ec: 9f c6 40 00 call %i1 400070f0: 92 12 60 00 mov %o1, %o1 ! 4001dc00 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 400070f4: 90 10 00 18 mov %i0, %o0 400070f8: 13 10 00 77 sethi %hi(0x4001dc00), %o1 400070fc: 9f c6 40 00 call %i1 40007100: 92 12 60 28 or %o1, 0x28, %o1 ! 4001dc28 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 40007104: 90 10 00 18 mov %i0, %o0 40007108: 13 10 00 77 sethi %hi(0x4001dc00), %o1 4000710c: 9f c6 40 00 call %i1 40007110: 92 12 60 78 or %o1, 0x78, %o1 ! 4001dc78 /* * 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 ; 40007114: 3b 10 00 7e sethi %hi(0x4001f800), %i5 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007118: 2b 10 00 77 sethi %hi(0x4001dc00), %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 ; 4000711c: 82 17 62 6c or %i5, 0x26c, %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, 40007120: 27 10 00 77 sethi %hi(0x4001dc00), %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, 40007124: 35 10 00 77 sethi %hi(0x4001dc00), %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 ; 40007128: e0 00 60 08 ld [ %g1 + 8 ], %l0 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 4000712c: 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 ); 40007130: ac 07 bf d8 add %fp, -40, %l6 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007134: a4 07 bf f8 add %fp, -8, %l2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007138: aa 15 60 c8 or %l5, 0xc8, %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; 4000713c: a8 07 bf b8 add %fp, -72, %l4 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 40007140: a2 07 bf f0 add %fp, -16, %l1 (*print)( context, 40007144: a6 14 e0 e0 or %l3, 0xe0, %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; 40007148: 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 ; 4000714c: 10 80 00 52 b 40007294 40007150: b4 16 a1 00 or %i2, 0x100, %i2 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 40007154: 40 00 1a 30 call 4000da14 40007158: 92 10 00 17 mov %l7, %o1 if ( status != RTEMS_SUCCESSFUL ) 4000715c: 80 a2 20 00 cmp %o0, 0 40007160: 32 80 00 4c bne,a 40007290 40007164: 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 ); 40007168: 92 10 00 16 mov %l6, %o1 4000716c: 40 00 1a 57 call 4000dac8 40007170: 90 10 00 10 mov %l0, %o0 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007174: d0 07 bf d8 ld [ %fp + -40 ], %o0 40007178: 92 10 20 05 mov 5, %o1 4000717c: 40 00 00 ae call 40007434 40007180: 94 10 00 12 mov %l2, %o2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007184: d8 1f bf a0 ldd [ %fp + -96 ], %o4 40007188: 92 10 00 15 mov %l5, %o1 4000718c: 90 10 00 18 mov %i0, %o0 40007190: 94 10 00 10 mov %l0, %o2 40007194: 9f c6 40 00 call %i1 40007198: 96 10 00 12 mov %l2, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 4000719c: d2 07 bf a0 ld [ %fp + -96 ], %o1 400071a0: 80 a2 60 00 cmp %o1, 0 400071a4: 12 80 00 08 bne 400071c4 400071a8: 94 10 00 11 mov %l1, %o2 (*print)( context, "\n" ); 400071ac: 90 10 00 18 mov %i0, %o0 400071b0: 13 10 00 73 sethi %hi(0x4001cc00), %o1 400071b4: 9f c6 40 00 call %i1 400071b8: 92 12 62 58 or %o1, 0x258, %o1 ! 4001ce58 <_rodata_start+0x158> continue; 400071bc: 10 80 00 35 b 40007290 400071c0: 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 ); 400071c4: 40 00 0e c3 call 4000acd0 <_Timespec_Divide_by_integer> 400071c8: 90 10 00 14 mov %l4, %o0 (*print)( context, 400071cc: d0 07 bf ac ld [ %fp + -84 ], %o0 400071d0: 40 00 48 e5 call 40019564 <.div> 400071d4: 92 10 23 e8 mov 0x3e8, %o1 400071d8: 96 10 00 08 mov %o0, %o3 400071dc: d0 07 bf b4 ld [ %fp + -76 ], %o0 400071e0: d6 27 bf 9c st %o3, [ %fp + -100 ] 400071e4: 40 00 48 e0 call 40019564 <.div> 400071e8: 92 10 23 e8 mov 0x3e8, %o1 400071ec: c2 07 bf f0 ld [ %fp + -16 ], %g1 400071f0: b6 10 00 08 mov %o0, %i3 400071f4: d0 07 bf f4 ld [ %fp + -12 ], %o0 400071f8: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 400071fc: 40 00 48 da call 40019564 <.div> 40007200: 92 10 23 e8 mov 0x3e8, %o1 40007204: d8 07 bf b0 ld [ %fp + -80 ], %o4 40007208: d6 07 bf 9c ld [ %fp + -100 ], %o3 4000720c: d4 07 bf a8 ld [ %fp + -88 ], %o2 40007210: 9a 10 00 1b mov %i3, %o5 40007214: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40007218: 92 10 00 13 mov %l3, %o1 4000721c: 9f c6 40 00 call %i1 40007220: 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); 40007224: d2 07 bf a0 ld [ %fp + -96 ], %o1 40007228: 94 10 00 11 mov %l1, %o2 4000722c: 40 00 0e a9 call 4000acd0 <_Timespec_Divide_by_integer> 40007230: 90 10 00 1c mov %i4, %o0 (*print)( context, 40007234: d0 07 bf c4 ld [ %fp + -60 ], %o0 40007238: 40 00 48 cb call 40019564 <.div> 4000723c: 92 10 23 e8 mov 0x3e8, %o1 40007240: 96 10 00 08 mov %o0, %o3 40007244: d0 07 bf cc ld [ %fp + -52 ], %o0 40007248: d6 27 bf 9c st %o3, [ %fp + -100 ] 4000724c: 40 00 48 c6 call 40019564 <.div> 40007250: 92 10 23 e8 mov 0x3e8, %o1 40007254: c2 07 bf f0 ld [ %fp + -16 ], %g1 40007258: b6 10 00 08 mov %o0, %i3 4000725c: d0 07 bf f4 ld [ %fp + -12 ], %o0 40007260: 92 10 23 e8 mov 0x3e8, %o1 40007264: 40 00 48 c0 call 40019564 <.div> 40007268: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 4000726c: d4 07 bf c0 ld [ %fp + -64 ], %o2 40007270: d6 07 bf 9c ld [ %fp + -100 ], %o3 40007274: d8 07 bf c8 ld [ %fp + -56 ], %o4 40007278: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 4000727c: 92 10 00 1a mov %i2, %o1 40007280: 90 10 00 18 mov %i0, %o0 40007284: 9f c6 40 00 call %i1 40007288: 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++ ) { 4000728c: 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 ; 40007290: 82 17 62 6c or %i5, 0x26c, %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 ; 40007294: c2 00 60 0c ld [ %g1 + 0xc ], %g1 40007298: 80 a4 00 01 cmp %l0, %g1 4000729c: 08 bf ff ae bleu 40007154 400072a0: 90 10 00 10 mov %l0, %o0 400072a4: 81 c7 e0 08 ret 400072a8: 81 e8 00 00 restore =============================================================================== 40015490 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 40015490: 9d e3 bf 98 save %sp, -104, %sp 40015494: 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 ) 40015498: 80 a6 60 00 cmp %i1, 0 4001549c: 02 80 00 2e be 40015554 400154a0: b0 10 20 0a mov 0xa, %i0 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 400154a4: 40 00 12 11 call 40019ce8 <_Thread_Get> 400154a8: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 400154ac: c2 07 bf fc ld [ %fp + -4 ], %g1 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 400154b0: a2 10 00 08 mov %o0, %l1 switch ( location ) { 400154b4: 80 a0 60 00 cmp %g1, 0 400154b8: 12 80 00 27 bne 40015554 400154bc: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 400154c0: e0 02 21 54 ld [ %o0 + 0x154 ], %l0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 400154c4: c2 04 20 0c ld [ %l0 + 0xc ], %g1 400154c8: 80 a0 60 00 cmp %g1, 0 400154cc: 02 80 00 24 be 4001555c 400154d0: 01 00 00 00 nop if ( asr->is_enabled ) { 400154d4: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 400154d8: 80 a0 60 00 cmp %g1, 0 400154dc: 02 80 00 15 be 40015530 400154e0: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 400154e4: 7f ff e7 e0 call 4000f464 400154e8: 01 00 00 00 nop *signal_set |= signals; 400154ec: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 400154f0: b2 10 40 19 or %g1, %i1, %i1 400154f4: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _ISR_Enable( _level ); 400154f8: 7f ff e7 df call 4000f474 400154fc: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40015500: 03 10 00 fc sethi %hi(0x4003f000), %g1 40015504: 82 10 61 10 or %g1, 0x110, %g1 ! 4003f110 <_Per_CPU_Information> 40015508: c4 00 60 08 ld [ %g1 + 8 ], %g2 4001550c: 80 a0 a0 00 cmp %g2, 0 40015510: 02 80 00 0f be 4001554c 40015514: 01 00 00 00 nop 40015518: c4 00 60 0c ld [ %g1 + 0xc ], %g2 4001551c: 80 a4 40 02 cmp %l1, %g2 40015520: 12 80 00 0b bne 4001554c <== NEVER TAKEN 40015524: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 40015528: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 4001552c: 30 80 00 08 b,a 4001554c rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 40015530: 7f ff e7 cd call 4000f464 40015534: 01 00 00 00 nop *signal_set |= signals; 40015538: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4001553c: b2 10 40 19 or %g1, %i1, %i1 40015540: f2 24 20 18 st %i1, [ %l0 + 0x18 ] _ISR_Enable( _level ); 40015544: 7f ff e7 cc call 4000f474 40015548: 01 00 00 00 nop } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 4001554c: 40 00 11 da call 40019cb4 <_Thread_Enable_dispatch> 40015550: b0 10 20 00 clr %i0 ! 0 return RTEMS_SUCCESSFUL; 40015554: 81 c7 e0 08 ret 40015558: 81 e8 00 00 restore } _Thread_Enable_dispatch(); 4001555c: 40 00 11 d6 call 40019cb4 <_Thread_Enable_dispatch> 40015560: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; 40015564: 81 c7 e0 08 ret 40015568: 81 e8 00 00 restore =============================================================================== 4000dcc0 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4000dcc0: 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 ) 4000dcc4: 80 a6 a0 00 cmp %i2, 0 4000dcc8: 02 80 00 5a be 4000de30 4000dccc: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4000dcd0: 03 10 00 56 sethi %hi(0x40015800), %g1 4000dcd4: e2 00 63 04 ld [ %g1 + 0x304 ], %l1 ! 40015b04 <_Per_CPU_Information+0xc> api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000dcd8: 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 ]; 4000dcdc: e0 04 61 54 ld [ %l1 + 0x154 ], %l0 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000dce0: 80 a0 00 01 cmp %g0, %g1 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000dce4: 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; 4000dce8: a4 60 3f ff subx %g0, -1, %l2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000dcec: 80 a0 60 00 cmp %g1, 0 4000dcf0: 02 80 00 03 be 4000dcfc 4000dcf4: a5 2c a0 08 sll %l2, 8, %l2 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4000dcf8: a4 14 a2 00 or %l2, 0x200, %l2 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000dcfc: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 4000dd00: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000dd04: 7f ff ef 1f call 40009980 <_CPU_ISR_Get_level> 4000dd08: 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; 4000dd0c: a7 2c e0 0a sll %l3, 0xa, %l3 4000dd10: a6 14 c0 08 or %l3, %o0, %l3 old_mode |= _ISR_Get_level(); 4000dd14: a4 14 c0 12 or %l3, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000dd18: 80 8e 61 00 btst 0x100, %i1 4000dd1c: 02 80 00 06 be 4000dd34 4000dd20: 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; 4000dd24: 82 0e 21 00 and %i0, 0x100, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4000dd28: 80 a0 00 01 cmp %g0, %g1 4000dd2c: 82 60 3f ff subx %g0, -1, %g1 4000dd30: c2 2c 60 74 stb %g1, [ %l1 + 0x74 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 4000dd34: 80 8e 62 00 btst 0x200, %i1 4000dd38: 02 80 00 0b be 4000dd64 4000dd3c: 80 8e 60 0f btst 0xf, %i1 if ( _Modes_Is_timeslice(mode_set) ) { 4000dd40: 80 8e 22 00 btst 0x200, %i0 4000dd44: 22 80 00 07 be,a 4000dd60 4000dd48: c0 24 60 7c clr [ %l1 + 0x7c ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000dd4c: 82 10 20 01 mov 1, %g1 4000dd50: c2 24 60 7c st %g1, [ %l1 + 0x7c ] executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000dd54: 03 10 00 55 sethi %hi(0x40015400), %g1 4000dd58: c2 00 61 24 ld [ %g1 + 0x124 ], %g1 ! 40015524 <_Thread_Ticks_per_timeslice> 4000dd5c: c2 24 60 78 st %g1, [ %l1 + 0x78 ] } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4000dd60: 80 8e 60 0f btst 0xf, %i1 4000dd64: 02 80 00 06 be 4000dd7c 4000dd68: 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 ); 4000dd6c: 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 ) ); 4000dd70: 7f ff cf d6 call 40001cc8 4000dd74: 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 ) { 4000dd78: 80 8e 64 00 btst 0x400, %i1 4000dd7c: 02 80 00 14 be 4000ddcc 4000dd80: 88 10 20 00 clr %g4 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4000dd84: 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; 4000dd88: 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( 4000dd8c: 80 a0 00 18 cmp %g0, %i0 4000dd90: 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 ) { 4000dd94: 80 a0 40 02 cmp %g1, %g2 4000dd98: 22 80 00 0e be,a 4000ddd0 4000dd9c: 03 10 00 55 sethi %hi(0x40015400), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4000dda0: 7f ff cf c6 call 40001cb8 4000dda4: c2 2c 20 08 stb %g1, [ %l0 + 8 ] _signals = information->signals_pending; 4000dda8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 information->signals_pending = information->signals_posted; 4000ddac: c4 04 20 14 ld [ %l0 + 0x14 ], %g2 information->signals_posted = _signals; 4000ddb0: 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; 4000ddb4: c4 24 20 18 st %g2, [ %l0 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 4000ddb8: 7f ff cf c4 call 40001cc8 4000ddbc: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 4000ddc0: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4000ddc4: 80 a0 00 01 cmp %g0, %g1 4000ddc8: 88 40 20 00 addx %g0, 0, %g4 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4000ddcc: 03 10 00 55 sethi %hi(0x40015400), %g1 4000ddd0: c4 00 63 18 ld [ %g1 + 0x318 ], %g2 ! 40015718 <_System_state_Current> 4000ddd4: 80 a0 a0 03 cmp %g2, 3 4000ddd8: 12 80 00 16 bne 4000de30 4000dddc: 82 10 20 00 clr %g1 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000dde0: 07 10 00 56 sethi %hi(0x40015800), %g3 if ( are_signals_pending || 4000dde4: 80 89 20 ff btst 0xff, %g4 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000dde8: 86 10 e2 f8 or %g3, 0x2f8, %g3 if ( are_signals_pending || 4000ddec: 12 80 00 0a bne 4000de14 4000ddf0: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 4000ddf4: c6 00 e0 10 ld [ %g3 + 0x10 ], %g3 4000ddf8: 80 a0 80 03 cmp %g2, %g3 4000ddfc: 02 80 00 0d be 4000de30 4000de00: 01 00 00 00 nop (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 4000de04: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 4000de08: 80 a0 a0 00 cmp %g2, 0 4000de0c: 02 80 00 09 be 4000de30 <== NEVER TAKEN 4000de10: 01 00 00 00 nop _Thread_Dispatch_necessary = true; 4000de14: 84 10 20 01 mov 1, %g2 ! 1 4000de18: 03 10 00 56 sethi %hi(0x40015800), %g1 4000de1c: 82 10 62 f8 or %g1, 0x2f8, %g1 ! 40015af8 <_Per_CPU_Information> 4000de20: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 4000de24: 7f ff e9 0f call 40008260 <_Thread_Dispatch> 4000de28: 01 00 00 00 nop } return RTEMS_SUCCESSFUL; 4000de2c: 82 10 20 00 clr %g1 ! 0 } 4000de30: 81 c7 e0 08 ret 4000de34: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 4000a704 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4000a704: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4000a708: 80 a6 60 00 cmp %i1, 0 4000a70c: 02 80 00 07 be 4000a728 4000a710: 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 ) ); 4000a714: 03 10 00 64 sethi %hi(0x40019000), %g1 4000a718: c2 08 63 b4 ldub [ %g1 + 0x3b4 ], %g1 ! 400193b4 4000a71c: 80 a6 40 01 cmp %i1, %g1 4000a720: 18 80 00 1c bgu 4000a790 4000a724: b0 10 20 13 mov 0x13, %i0 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4000a728: 80 a6 a0 00 cmp %i2, 0 4000a72c: 02 80 00 19 be 4000a790 4000a730: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4000a734: 40 00 09 43 call 4000cc40 <_Thread_Get> 4000a738: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000a73c: c2 07 bf fc ld [ %fp + -4 ], %g1 4000a740: 80 a0 60 00 cmp %g1, 0 4000a744: 12 80 00 13 bne 4000a790 4000a748: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4000a74c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4000a750: 80 a6 60 00 cmp %i1, 0 4000a754: 02 80 00 0d be 4000a788 4000a758: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 4000a75c: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4000a760: 80 a0 60 00 cmp %g1, 0 4000a764: 02 80 00 06 be 4000a77c 4000a768: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 4000a76c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000a770: 80 a0 40 19 cmp %g1, %i1 4000a774: 08 80 00 05 bleu 4000a788 <== ALWAYS TAKEN 4000a778: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4000a77c: 92 10 00 19 mov %i1, %o1 4000a780: 40 00 08 17 call 4000c7dc <_Thread_Change_priority> 4000a784: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 4000a788: 40 00 09 21 call 4000cc0c <_Thread_Enable_dispatch> 4000a78c: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 4000a790: 81 c7 e0 08 ret 4000a794: 81 e8 00 00 restore =============================================================================== 40015e9c : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 40015e9c: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 40015ea0: 11 10 00 fd sethi %hi(0x4003f400), %o0 40015ea4: 92 10 00 18 mov %i0, %o1 40015ea8: 90 12 21 44 or %o0, 0x144, %o0 40015eac: 40 00 0c 08 call 40018ecc <_Objects_Get> 40015eb0: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40015eb4: c2 07 bf fc ld [ %fp + -4 ], %g1 40015eb8: 80 a0 60 00 cmp %g1, 0 40015ebc: 12 80 00 0c bne 40015eec 40015ec0: 01 00 00 00 nop case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 40015ec4: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40015ec8: 80 a0 60 04 cmp %g1, 4 40015ecc: 02 80 00 04 be 40015edc <== NEVER TAKEN 40015ed0: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 40015ed4: 40 00 14 40 call 4001afd4 <_Watchdog_Remove> 40015ed8: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 40015edc: 40 00 0f 76 call 40019cb4 <_Thread_Enable_dispatch> 40015ee0: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40015ee4: 81 c7 e0 08 ret 40015ee8: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40015eec: 81 c7 e0 08 ret 40015ef0: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 40016384 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 40016384: 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; 40016388: 03 10 00 fd sethi %hi(0x4003f400), %g1 4001638c: e2 00 61 84 ld [ %g1 + 0x184 ], %l1 ! 4003f584 <_Timer_server> rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 40016390: 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 ) 40016394: 80 a4 60 00 cmp %l1, 0 40016398: 02 80 00 33 be 40016464 4001639c: b0 10 20 0e mov 0xe, %i0 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 400163a0: 03 10 00 fa sethi %hi(0x4003e800), %g1 400163a4: c2 08 63 e0 ldub [ %g1 + 0x3e0 ], %g1 ! 4003ebe0 <_TOD_Is_set> 400163a8: 80 a0 60 00 cmp %g1, 0 400163ac: 02 80 00 2e be 40016464 <== NEVER TAKEN 400163b0: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; if ( !routine ) 400163b4: 80 a6 a0 00 cmp %i2, 0 400163b8: 02 80 00 2b be 40016464 400163bc: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 400163c0: 90 10 00 19 mov %i1, %o0 400163c4: 7f ff f4 07 call 400133e0 <_TOD_Validate> 400163c8: b0 10 20 14 mov 0x14, %i0 400163cc: 80 8a 20 ff btst 0xff, %o0 400163d0: 02 80 00 27 be 4001646c 400163d4: 01 00 00 00 nop return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 400163d8: 7f ff f3 ce call 40013310 <_TOD_To_seconds> 400163dc: 90 10 00 19 mov %i1, %o0 if ( seconds <= _TOD_Seconds_since_epoch() ) 400163e0: 27 10 00 fb sethi %hi(0x4003ec00), %l3 400163e4: c2 04 e0 58 ld [ %l3 + 0x58 ], %g1 ! 4003ec58 <_TOD_Now> 400163e8: 80 a2 00 01 cmp %o0, %g1 400163ec: 08 80 00 1e bleu 40016464 400163f0: a4 10 00 08 mov %o0, %l2 400163f4: 11 10 00 fd sethi %hi(0x4003f400), %o0 400163f8: 92 10 00 10 mov %l0, %o1 400163fc: 90 12 21 44 or %o0, 0x144, %o0 40016400: 40 00 0a b3 call 40018ecc <_Objects_Get> 40016404: 94 07 bf fc add %fp, -4, %o2 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40016408: c2 07 bf fc ld [ %fp + -4 ], %g1 4001640c: b2 10 00 08 mov %o0, %i1 40016410: 80 a0 60 00 cmp %g1, 0 40016414: 12 80 00 14 bne 40016464 40016418: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 4001641c: 40 00 12 ee call 4001afd4 <_Watchdog_Remove> 40016420: 90 02 20 10 add %o0, 0x10, %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 40016424: 82 10 20 03 mov 3, %g1 40016428: 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(); 4001642c: c2 04 e0 58 ld [ %l3 + 0x58 ], %g1 (*timer_server->schedule_operation)( timer_server, the_timer ); 40016430: 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(); 40016434: a4 24 80 01 sub %l2, %g1, %l2 (*timer_server->schedule_operation)( timer_server, the_timer ); 40016438: c2 04 60 04 ld [ %l1 + 4 ], %g1 4001643c: 92 10 00 19 mov %i1, %o1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40016440: c0 26 60 18 clr [ %i1 + 0x18 ] the_watchdog->routine = routine; 40016444: f4 26 60 2c st %i2, [ %i1 + 0x2c ] the_watchdog->id = id; 40016448: e0 26 60 30 st %l0, [ %i1 + 0x30 ] the_watchdog->user_data = user_data; 4001644c: 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(); 40016450: e4 26 60 1c st %l2, [ %i1 + 0x1c ] (*timer_server->schedule_operation)( timer_server, the_timer ); 40016454: 9f c0 40 00 call %g1 40016458: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 4001645c: 40 00 0e 16 call 40019cb4 <_Thread_Enable_dispatch> 40016460: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40016464: 81 c7 e0 08 ret 40016468: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4001646c: 81 c7 e0 08 ret 40016470: 81 e8 00 00 restore =============================================================================== 40006520 : #include int sched_get_priority_max( int policy ) { 40006520: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 40006524: 80 a6 20 04 cmp %i0, 4 40006528: 18 80 00 06 bgu 40006540 4000652c: 82 10 20 01 mov 1, %g1 40006530: b1 28 40 18 sll %g1, %i0, %i0 40006534: 80 8e 20 17 btst 0x17, %i0 40006538: 12 80 00 08 bne 40006558 <== ALWAYS TAKEN 4000653c: 03 10 00 77 sethi %hi(0x4001dc00), %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40006540: 40 00 22 c9 call 4000f064 <__errno> 40006544: b0 10 3f ff mov -1, %i0 40006548: 82 10 20 16 mov 0x16, %g1 4000654c: c2 22 00 00 st %g1, [ %o0 ] 40006550: 81 c7 e0 08 ret 40006554: 81 e8 00 00 restore } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 40006558: f0 08 62 b8 ldub [ %g1 + 0x2b8 ], %i0 } 4000655c: 81 c7 e0 08 ret 40006560: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 40006564 : #include int sched_get_priority_min( int policy ) { 40006564: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 40006568: 80 a6 20 04 cmp %i0, 4 4000656c: 18 80 00 06 bgu 40006584 40006570: 82 10 20 01 mov 1, %g1 40006574: 83 28 40 18 sll %g1, %i0, %g1 40006578: 80 88 60 17 btst 0x17, %g1 4000657c: 12 80 00 06 bne 40006594 <== ALWAYS TAKEN 40006580: b0 10 20 01 mov 1, %i0 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40006584: 40 00 22 b8 call 4000f064 <__errno> 40006588: b0 10 3f ff mov -1, %i0 4000658c: 82 10 20 16 mov 0x16, %g1 40006590: c2 22 00 00 st %g1, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40006594: 81 c7 e0 08 ret 40006598: 81 e8 00 00 restore =============================================================================== 4000659c : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 4000659c: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 400065a0: 80 a6 20 00 cmp %i0, 0 400065a4: 02 80 00 0b be 400065d0 <== NEVER TAKEN 400065a8: 80 a6 60 00 cmp %i1, 0 400065ac: 7f ff f2 4e call 40002ee4 400065b0: 01 00 00 00 nop 400065b4: 80 a6 00 08 cmp %i0, %o0 400065b8: 02 80 00 06 be 400065d0 400065bc: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 400065c0: 40 00 22 a9 call 4000f064 <__errno> 400065c4: 01 00 00 00 nop 400065c8: 10 80 00 07 b 400065e4 400065cc: 82 10 20 03 mov 3, %g1 ! 3 if ( !interval ) 400065d0: 12 80 00 08 bne 400065f0 400065d4: 03 10 00 79 sethi %hi(0x4001e400), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 400065d8: 40 00 22 a3 call 4000f064 <__errno> 400065dc: 01 00 00 00 nop 400065e0: 82 10 20 16 mov 0x16, %g1 ! 16 400065e4: c2 22 00 00 st %g1, [ %o0 ] 400065e8: 81 c7 e0 08 ret 400065ec: 91 e8 3f ff restore %g0, -1, %o0 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 400065f0: d0 00 63 84 ld [ %g1 + 0x384 ], %o0 400065f4: 92 10 00 19 mov %i1, %o1 400065f8: 40 00 0e 70 call 40009fb8 <_Timespec_From_ticks> 400065fc: b0 10 20 00 clr %i0 return 0; } 40006600: 81 c7 e0 08 ret 40006604: 81 e8 00 00 restore =============================================================================== 40008f48 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 40008f48: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40008f4c: 03 10 00 8e sethi %hi(0x40023800), %g1 40008f50: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 ! 40023830 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40008f54: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 40008f58: 84 00 a0 01 inc %g2 40008f5c: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 40008f60: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40008f64: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 40008f68: c4 20 60 30 st %g2, [ %g1 + 0x30 ] POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 40008f6c: a2 8e 62 00 andcc %i1, 0x200, %l1 40008f70: 02 80 00 05 be 40008f84 40008f74: a0 10 20 00 clr %l0 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 40008f78: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 40008f7c: 82 07 a0 54 add %fp, 0x54, %g1 40008f80: c2 27 bf fc st %g1, [ %fp + -4 ] va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 40008f84: 90 10 00 18 mov %i0, %o0 40008f88: 40 00 1a 63 call 4000f914 <_POSIX_Semaphore_Name_to_id> 40008f8c: 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 ) { 40008f90: a4 92 20 00 orcc %o0, 0, %l2 40008f94: 22 80 00 0e be,a 40008fcc 40008f98: 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) ) ) { 40008f9c: 80 a4 a0 02 cmp %l2, 2 40008fa0: 12 80 00 04 bne 40008fb0 <== NEVER TAKEN 40008fa4: 80 a4 60 00 cmp %l1, 0 40008fa8: 12 80 00 21 bne 4000902c 40008fac: 94 10 00 10 mov %l0, %o2 _Thread_Enable_dispatch(); 40008fb0: 40 00 0b e4 call 4000bf40 <_Thread_Enable_dispatch> 40008fb4: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 40008fb8: 40 00 25 e2 call 40012740 <__errno> 40008fbc: 01 00 00 00 nop 40008fc0: e4 22 00 00 st %l2, [ %o0 ] 40008fc4: 81 c7 e0 08 ret 40008fc8: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 40008fcc: 80 a6 6a 00 cmp %i1, 0xa00 40008fd0: 12 80 00 0a bne 40008ff8 40008fd4: d2 07 bf f8 ld [ %fp + -8 ], %o1 _Thread_Enable_dispatch(); 40008fd8: 40 00 0b da call 4000bf40 <_Thread_Enable_dispatch> 40008fdc: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 40008fe0: 40 00 25 d8 call 40012740 <__errno> 40008fe4: 01 00 00 00 nop 40008fe8: 82 10 20 11 mov 0x11, %g1 ! 11 40008fec: c2 22 00 00 st %g1, [ %o0 ] 40008ff0: 81 c7 e0 08 ret 40008ff4: 81 e8 00 00 restore 40008ff8: 94 07 bf f0 add %fp, -16, %o2 40008ffc: 11 10 00 8e sethi %hi(0x40023800), %o0 40009000: 40 00 08 64 call 4000b190 <_Objects_Get> 40009004: 90 12 22 f0 or %o0, 0x2f0, %o0 ! 40023af0 <_POSIX_Semaphore_Information> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 40009008: 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 ); 4000900c: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 40009010: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 40009014: 40 00 0b cb call 4000bf40 <_Thread_Enable_dispatch> 40009018: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 4000901c: 40 00 0b c9 call 4000bf40 <_Thread_Enable_dispatch> 40009020: 01 00 00 00 nop goto return_id; 40009024: 10 80 00 0c b 40009054 40009028: 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( 4000902c: 90 10 00 18 mov %i0, %o0 40009030: 92 10 20 00 clr %o1 40009034: 40 00 19 e1 call 4000f7b8 <_POSIX_Semaphore_Create_support> 40009038: 96 07 bf f4 add %fp, -12, %o3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 4000903c: 40 00 0b c1 call 4000bf40 <_Thread_Enable_dispatch> 40009040: a0 10 00 08 mov %o0, %l0 if ( status == -1 ) 40009044: 80 a4 3f ff cmp %l0, -1 40009048: 02 bf ff ea be 40008ff0 4000904c: 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; 40009050: f0 07 bf f4 ld [ %fp + -12 ], %i0 40009054: b0 06 20 08 add %i0, 8, %i0 #endif return id; } 40009058: 81 c7 e0 08 ret 4000905c: 81 e8 00 00 restore =============================================================================== 40006490 : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 40006490: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 40006494: 90 96 a0 00 orcc %i2, 0, %o0 40006498: 02 80 00 0a be 400064c0 4000649c: a0 10 00 18 mov %i0, %l0 *oact = _POSIX_signals_Vectors[ sig ]; 400064a0: 83 2e 20 02 sll %i0, 2, %g1 400064a4: 85 2e 20 04 sll %i0, 4, %g2 400064a8: 82 20 80 01 sub %g2, %g1, %g1 400064ac: 13 10 00 7f sethi %hi(0x4001fc00), %o1 400064b0: 94 10 20 0c mov 0xc, %o2 400064b4: 92 12 61 d0 or %o1, 0x1d0, %o1 400064b8: 40 00 26 55 call 4000fe0c 400064bc: 92 02 40 01 add %o1, %g1, %o1 if ( !sig ) 400064c0: 80 a4 20 00 cmp %l0, 0 400064c4: 02 80 00 09 be 400064e8 400064c8: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 400064cc: 82 04 3f ff add %l0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 400064d0: 80 a0 60 1f cmp %g1, 0x1f 400064d4: 18 80 00 05 bgu 400064e8 400064d8: 01 00 00 00 nop * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 400064dc: 80 a4 20 09 cmp %l0, 9 400064e0: 12 80 00 08 bne 40006500 400064e4: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 400064e8: 40 00 23 ea call 4000f490 <__errno> 400064ec: b0 10 3f ff mov -1, %i0 400064f0: 82 10 20 16 mov 0x16, %g1 400064f4: c2 22 00 00 st %g1, [ %o0 ] 400064f8: 81 c7 e0 08 ret 400064fc: 81 e8 00 00 restore /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 40006500: 02 bf ff fe be 400064f8 <== NEVER TAKEN 40006504: 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 ); 40006508: 7f ff ef 7e call 40002300 4000650c: 01 00 00 00 nop 40006510: a2 10 00 08 mov %o0, %l1 if ( act->sa_handler == SIG_DFL ) { 40006514: c2 06 60 08 ld [ %i1 + 8 ], %g1 40006518: 25 10 00 7f sethi %hi(0x4001fc00), %l2 4000651c: 80 a0 60 00 cmp %g1, 0 40006520: a4 14 a1 d0 or %l2, 0x1d0, %l2 40006524: a7 2c 20 02 sll %l0, 2, %l3 40006528: 12 80 00 08 bne 40006548 4000652c: a9 2c 20 04 sll %l0, 4, %l4 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 40006530: a6 25 00 13 sub %l4, %l3, %l3 40006534: 13 10 00 78 sethi %hi(0x4001e000), %o1 40006538: 90 04 80 13 add %l2, %l3, %o0 4000653c: 92 12 63 c0 or %o1, 0x3c0, %o1 40006540: 10 80 00 07 b 4000655c 40006544: 92 02 40 13 add %o1, %l3, %o1 } else { _POSIX_signals_Clear_process_signals( sig ); 40006548: 40 00 18 0b call 4000c574 <_POSIX_signals_Clear_process_signals> 4000654c: 90 10 00 10 mov %l0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 40006550: a6 25 00 13 sub %l4, %l3, %l3 40006554: 92 10 00 19 mov %i1, %o1 40006558: 90 04 80 13 add %l2, %l3, %o0 4000655c: 40 00 26 2c call 4000fe0c 40006560: 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; 40006564: 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 ); 40006568: 7f ff ef 6a call 40002310 4000656c: 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; } 40006570: 81 c7 e0 08 ret 40006574: 81 e8 00 00 restore =============================================================================== 40006944 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 40006944: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 40006948: a0 96 20 00 orcc %i0, 0, %l0 4000694c: 02 80 00 0f be 40006988 40006950: 01 00 00 00 nop /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 40006954: 80 a6 a0 00 cmp %i2, 0 40006958: 02 80 00 12 be 400069a0 4000695c: a8 10 20 00 clr %l4 if ( !_Timespec_Is_valid( timeout ) ) 40006960: 40 00 0e a0 call 4000a3e0 <_Timespec_Is_valid> 40006964: 90 10 00 1a mov %i2, %o0 40006968: 80 8a 20 ff btst 0xff, %o0 4000696c: 02 80 00 07 be 40006988 40006970: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 40006974: 40 00 0e be call 4000a46c <_Timespec_To_ticks> 40006978: 90 10 00 1a mov %i2, %o0 if ( !interval ) 4000697c: a8 92 20 00 orcc %o0, 0, %l4 40006980: 12 80 00 09 bne 400069a4 <== ALWAYS TAKEN 40006984: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 40006988: 40 00 24 87 call 4000fba4 <__errno> 4000698c: b0 10 3f ff mov -1, %i0 40006990: 82 10 20 16 mov 0x16, %g1 40006994: c2 22 00 00 st %g1, [ %o0 ] 40006998: 81 c7 e0 08 ret 4000699c: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 400069a0: 80 a6 60 00 cmp %i1, 0 400069a4: 22 80 00 02 be,a 400069ac 400069a8: b2 07 bf f4 add %fp, -12, %i1 the_thread = _Thread_Executing; 400069ac: 31 10 00 81 sethi %hi(0x40020400), %i0 400069b0: b0 16 21 68 or %i0, 0x168, %i0 ! 40020568 <_Per_CPU_Information> 400069b4: e6 06 20 0c ld [ %i0 + 0xc ], %l3 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 400069b8: 7f ff ef 2d call 4000266c 400069bc: e4 04 e1 58 ld [ %l3 + 0x158 ], %l2 400069c0: a2 10 00 08 mov %o0, %l1 if ( *set & api->signals_pending ) { 400069c4: c4 04 00 00 ld [ %l0 ], %g2 400069c8: c2 04 a0 d4 ld [ %l2 + 0xd4 ], %g1 400069cc: 80 88 80 01 btst %g2, %g1 400069d0: 22 80 00 13 be,a 40006a1c 400069d4: 03 10 00 81 sethi %hi(0x40020400), %g1 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 400069d8: 7f ff ff c3 call 400068e4 <_POSIX_signals_Get_lowest> 400069dc: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( 400069e0: 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 ); 400069e4: 92 10 00 08 mov %o0, %o1 400069e8: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 400069ec: 96 10 20 00 clr %o3 400069f0: 90 10 00 12 mov %l2, %o0 400069f4: 40 00 18 d7 call 4000cd50 <_POSIX_signals_Clear_signals> 400069f8: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 400069fc: 7f ff ef 20 call 4000267c 40006a00: 90 10 00 11 mov %l1, %o0 the_info->si_code = SI_USER; 40006a04: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 40006a08: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 40006a0c: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 40006a10: f0 06 40 00 ld [ %i1 ], %i0 40006a14: 81 c7 e0 08 ret 40006a18: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 40006a1c: c2 00 63 b4 ld [ %g1 + 0x3b4 ], %g1 40006a20: 80 88 80 01 btst %g2, %g1 40006a24: 22 80 00 13 be,a 40006a70 40006a28: 82 10 3f ff mov -1, %g1 signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40006a2c: 7f ff ff ae call 400068e4 <_POSIX_signals_Get_lowest> 40006a30: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40006a34: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40006a38: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40006a3c: 96 10 20 01 mov 1, %o3 40006a40: 90 10 00 12 mov %l2, %o0 40006a44: 92 10 00 18 mov %i0, %o1 40006a48: 40 00 18 c2 call 4000cd50 <_POSIX_signals_Clear_signals> 40006a4c: 98 10 20 00 clr %o4 _ISR_Enable( level ); 40006a50: 7f ff ef 0b call 4000267c 40006a54: 90 10 00 11 mov %l1, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 40006a58: 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; 40006a5c: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 40006a60: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 40006a64: c0 26 60 08 clr [ %i1 + 8 ] return signo; 40006a68: 81 c7 e0 08 ret 40006a6c: 81 e8 00 00 restore } the_info->si_signo = -1; 40006a70: c2 26 40 00 st %g1, [ %i1 ] 40006a74: 03 10 00 80 sethi %hi(0x40020000), %g1 40006a78: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 ! 40020030 <_Thread_Dispatch_disable_level> 40006a7c: 84 00 a0 01 inc %g2 40006a80: c4 20 60 30 st %g2, [ %g1 + 0x30 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 40006a84: 82 10 20 04 mov 4, %g1 40006a88: c2 24 e0 34 st %g1, [ %l3 + 0x34 ] the_thread->Wait.option = *set; 40006a8c: c2 04 00 00 ld [ %l0 ], %g1 the_thread->Wait.return_argument = the_info; 40006a90: 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; 40006a94: 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; 40006a98: a2 10 20 01 mov 1, %l1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 40006a9c: 2b 10 00 81 sethi %hi(0x40020400), %l5 40006aa0: aa 15 63 4c or %l5, 0x34c, %l5 ! 4002074c <_POSIX_signals_Wait_queue> 40006aa4: ea 24 e0 44 st %l5, [ %l3 + 0x44 ] 40006aa8: 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 ); 40006aac: 7f ff ee f4 call 4000267c 40006ab0: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 40006ab4: 90 10 00 15 mov %l5, %o0 40006ab8: 92 10 00 14 mov %l4, %o1 40006abc: 15 10 00 28 sethi %hi(0x4000a000), %o2 40006ac0: 40 00 0c 9c call 40009d30 <_Thread_queue_Enqueue_with_handler> 40006ac4: 94 12 a0 b8 or %o2, 0xb8, %o2 ! 4000a0b8 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 40006ac8: 40 00 0b 6a call 40009870 <_Thread_Enable_dispatch> 40006acc: 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 ); 40006ad0: d2 06 40 00 ld [ %i1 ], %o1 40006ad4: 90 10 00 12 mov %l2, %o0 40006ad8: 94 10 00 19 mov %i1, %o2 40006adc: 96 10 20 00 clr %o3 40006ae0: 40 00 18 9c call 4000cd50 <_POSIX_signals_Clear_signals> 40006ae4: 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) 40006ae8: c2 06 20 0c ld [ %i0 + 0xc ], %g1 40006aec: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40006af0: 80 a0 60 04 cmp %g1, 4 40006af4: 12 80 00 09 bne 40006b18 40006af8: 01 00 00 00 nop || !(*set & signo_to_mask( the_info->si_signo )) ) { 40006afc: f0 06 40 00 ld [ %i1 ], %i0 40006b00: 82 06 3f ff add %i0, -1, %g1 40006b04: a3 2c 40 01 sll %l1, %g1, %l1 40006b08: c2 04 00 00 ld [ %l0 ], %g1 40006b0c: 80 8c 40 01 btst %l1, %g1 40006b10: 12 80 00 08 bne 40006b30 40006b14: 01 00 00 00 nop errno = _Thread_Executing->Wait.return_code; 40006b18: 40 00 24 23 call 4000fba4 <__errno> 40006b1c: b0 10 3f ff mov -1, %i0 ! ffffffff 40006b20: 03 10 00 81 sethi %hi(0x40020400), %g1 40006b24: c2 00 61 74 ld [ %g1 + 0x174 ], %g1 ! 40020574 <_Per_CPU_Information+0xc> 40006b28: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40006b2c: c2 22 00 00 st %g1, [ %o0 ] return -1; } return the_info->si_signo; } 40006b30: 81 c7 e0 08 ret 40006b34: 81 e8 00 00 restore =============================================================================== 40008a98 : int sigwait( const sigset_t *set, int *sig ) { 40008a98: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 40008a9c: 92 10 20 00 clr %o1 40008aa0: 90 10 00 18 mov %i0, %o0 40008aa4: 7f ff ff 7b call 40008890 40008aa8: 94 10 20 00 clr %o2 if ( status != -1 ) { 40008aac: 80 a2 3f ff cmp %o0, -1 40008ab0: 02 80 00 07 be 40008acc 40008ab4: 80 a6 60 00 cmp %i1, 0 if ( sig ) 40008ab8: 02 80 00 03 be 40008ac4 <== NEVER TAKEN 40008abc: b0 10 20 00 clr %i0 *sig = status; 40008ac0: d0 26 40 00 st %o0, [ %i1 ] 40008ac4: 81 c7 e0 08 ret 40008ac8: 81 e8 00 00 restore return 0; } return errno; 40008acc: 40 00 23 1e call 40011744 <__errno> 40008ad0: 01 00 00 00 nop 40008ad4: f0 02 00 00 ld [ %o0 ], %i0 } 40008ad8: 81 c7 e0 08 ret 40008adc: 81 e8 00 00 restore =============================================================================== 400057e0 : */ long sysconf( int name ) { 400057e0: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 400057e4: 80 a6 20 02 cmp %i0, 2 400057e8: 12 80 00 09 bne 4000580c 400057ec: 80 a6 20 04 cmp %i0, 4 return (TOD_MICROSECONDS_PER_SECOND / 400057f0: 03 10 00 57 sethi %hi(0x40015c00), %g1 400057f4: d2 00 63 88 ld [ %g1 + 0x388 ], %o1 ! 40015f88 400057f8: 11 00 03 d0 sethi %hi(0xf4000), %o0 400057fc: 40 00 33 8c call 4001262c <.udiv> 40005800: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 40005804: 81 c7 e0 08 ret 40005808: 91 e8 00 08 restore %g0, %o0, %o0 rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 4000580c: 12 80 00 05 bne 40005820 40005810: 80 a6 20 33 cmp %i0, 0x33 return rtems_libio_number_iops; 40005814: 03 10 00 57 sethi %hi(0x40015c00), %g1 40005818: 10 80 00 0f b 40005854 4000581c: d0 00 62 74 ld [ %g1 + 0x274 ], %o0 ! 40015e74 if ( name == _SC_GETPW_R_SIZE_MAX ) 40005820: 02 80 00 0d be 40005854 40005824: 90 10 24 00 mov 0x400, %o0 return 1024; if ( name == _SC_PAGESIZE ) 40005828: 80 a6 20 08 cmp %i0, 8 4000582c: 02 80 00 0a be 40005854 40005830: 90 02 2c 00 add %o0, 0xc00, %o0 return PAGE_SIZE; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 40005834: 80 a6 22 03 cmp %i0, 0x203 40005838: 02 80 00 07 be 40005854 <== NEVER TAKEN 4000583c: 90 10 20 00 clr %o0 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40005840: 40 00 23 df call 4000e7bc <__errno> 40005844: 01 00 00 00 nop 40005848: 82 10 20 16 mov 0x16, %g1 ! 16 4000584c: c2 22 00 00 st %g1, [ %o0 ] 40005850: 90 10 3f ff mov -1, %o0 } 40005854: b0 10 00 08 mov %o0, %i0 40005858: 81 c7 e0 08 ret 4000585c: 81 e8 00 00 restore =============================================================================== 40005b6c : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 40005b6c: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 40005b70: 80 a6 20 01 cmp %i0, 1 40005b74: 12 80 00 15 bne 40005bc8 40005b78: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 40005b7c: 80 a6 a0 00 cmp %i2, 0 40005b80: 02 80 00 12 be 40005bc8 40005b84: 01 00 00 00 nop /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 40005b88: 80 a6 60 00 cmp %i1, 0 40005b8c: 02 80 00 13 be 40005bd8 40005b90: 03 10 00 79 sethi %hi(0x4001e400), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 40005b94: c2 06 40 00 ld [ %i1 ], %g1 40005b98: 82 00 7f ff add %g1, -1, %g1 40005b9c: 80 a0 60 01 cmp %g1, 1 40005ba0: 18 80 00 0a bgu 40005bc8 <== NEVER TAKEN 40005ba4: 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 ) 40005ba8: c2 06 60 04 ld [ %i1 + 4 ], %g1 40005bac: 80 a0 60 00 cmp %g1, 0 40005bb0: 02 80 00 06 be 40005bc8 <== NEVER TAKEN 40005bb4: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 40005bb8: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 40005bbc: 80 a0 60 1f cmp %g1, 0x1f 40005bc0: 28 80 00 06 bleu,a 40005bd8 <== ALWAYS TAKEN 40005bc4: 03 10 00 79 sethi %hi(0x4001e400), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40005bc8: 40 00 25 18 call 4000f028 <__errno> 40005bcc: 01 00 00 00 nop 40005bd0: 10 80 00 10 b 40005c10 40005bd4: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40005bd8: c4 00 62 a0 ld [ %g1 + 0x2a0 ], %g2 40005bdc: 84 00 a0 01 inc %g2 40005be0: c4 20 62 a0 st %g2, [ %g1 + 0x2a0 ] * 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 ); 40005be4: 11 10 00 7a sethi %hi(0x4001e800), %o0 40005be8: 40 00 07 e8 call 40007b88 <_Objects_Allocate> 40005bec: 90 12 21 a0 or %o0, 0x1a0, %o0 ! 4001e9a0 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 40005bf0: 80 a2 20 00 cmp %o0, 0 40005bf4: 12 80 00 0a bne 40005c1c 40005bf8: 82 10 20 02 mov 2, %g1 _Thread_Enable_dispatch(); 40005bfc: 40 00 0c 6d call 40008db0 <_Thread_Enable_dispatch> 40005c00: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 40005c04: 40 00 25 09 call 4000f028 <__errno> 40005c08: 01 00 00 00 nop 40005c0c: 82 10 20 0b mov 0xb, %g1 ! b 40005c10: c2 22 00 00 st %g1, [ %o0 ] 40005c14: 81 c7 e0 08 ret 40005c18: 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; 40005c1c: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 40005c20: 03 10 00 7a sethi %hi(0x4001e800), %g1 40005c24: c2 00 63 e4 ld [ %g1 + 0x3e4 ], %g1 ! 4001ebe4 <_Per_CPU_Information+0xc> if ( evp != NULL ) { 40005c28: 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; 40005c2c: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 40005c30: 02 80 00 08 be 40005c50 40005c34: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 40005c38: c2 06 40 00 ld [ %i1 ], %g1 40005c3c: c2 22 20 40 st %g1, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 40005c40: c2 06 60 04 ld [ %i1 + 4 ], %g1 40005c44: c2 22 20 44 st %g1, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 40005c48: c2 06 60 08 ld [ %i1 + 8 ], %g1 40005c4c: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40005c50: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40005c54: 07 10 00 7a sethi %hi(0x4001e800), %g3 40005c58: c6 00 e1 bc ld [ %g3 + 0x1bc ], %g3 ! 4001e9bc <_POSIX_Timer_Information+0x1c> } ptimer->overrun = 0; 40005c5c: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 40005c60: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 40005c64: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 40005c68: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 40005c6c: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40005c70: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 40005c74: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 40005c78: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 40005c7c: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40005c80: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40005c84: 85 28 a0 02 sll %g2, 2, %g2 40005c88: 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; 40005c8c: 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; 40005c90: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 40005c94: 40 00 0c 47 call 40008db0 <_Thread_Enable_dispatch> 40005c98: b0 10 20 00 clr %i0 return 0; } 40005c9c: 81 c7 e0 08 ret 40005ca0: 81 e8 00 00 restore =============================================================================== 40005ca4 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 40005ca4: 9d e3 bf 80 save %sp, -128, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 40005ca8: 80 a6 a0 00 cmp %i2, 0 40005cac: 02 80 00 22 be 40005d34 <== NEVER TAKEN 40005cb0: 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) ) ) { 40005cb4: 40 00 0f 2c call 40009964 <_Timespec_Is_valid> 40005cb8: 90 06 a0 08 add %i2, 8, %o0 40005cbc: 80 8a 20 ff btst 0xff, %o0 40005cc0: 02 80 00 1d be 40005d34 40005cc4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 40005cc8: 40 00 0f 27 call 40009964 <_Timespec_Is_valid> 40005ccc: 90 10 00 1a mov %i2, %o0 40005cd0: 80 8a 20 ff btst 0xff, %o0 40005cd4: 02 80 00 18 be 40005d34 <== NEVER TAKEN 40005cd8: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40005cdc: 80 a6 60 00 cmp %i1, 0 40005ce0: 02 80 00 05 be 40005cf4 40005ce4: 90 07 bf e4 add %fp, -28, %o0 40005ce8: 80 a6 60 04 cmp %i1, 4 40005cec: 12 80 00 12 bne 40005d34 40005cf0: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 40005cf4: 92 10 00 1a mov %i2, %o1 40005cf8: 40 00 27 40 call 4000f9f8 40005cfc: 94 10 20 10 mov 0x10, %o2 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 40005d00: 80 a6 60 04 cmp %i1, 4 40005d04: 12 80 00 16 bne 40005d5c 40005d08: 92 10 00 18 mov %i0, %o1 struct timespec now; _TOD_Get( &now ); 40005d0c: b2 07 bf f4 add %fp, -12, %i1 40005d10: 40 00 06 2e call 400075c8 <_TOD_Get> 40005d14: 90 10 00 19 mov %i1, %o0 /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 40005d18: a0 07 bf ec add %fp, -20, %l0 40005d1c: 90 10 00 19 mov %i1, %o0 40005d20: 40 00 0f 00 call 40009920 <_Timespec_Greater_than> 40005d24: 92 10 00 10 mov %l0, %o1 40005d28: 80 8a 20 ff btst 0xff, %o0 40005d2c: 02 80 00 08 be 40005d4c 40005d30: 90 10 00 19 mov %i1, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); 40005d34: 40 00 24 bd call 4000f028 <__errno> 40005d38: b0 10 3f ff mov -1, %i0 40005d3c: 82 10 20 16 mov 0x16, %g1 40005d40: c2 22 00 00 st %g1, [ %o0 ] 40005d44: 81 c7 e0 08 ret 40005d48: 81 e8 00 00 restore _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 40005d4c: 92 10 00 10 mov %l0, %o1 40005d50: 40 00 0f 16 call 400099a8 <_Timespec_Subtract> 40005d54: 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 ); 40005d58: 92 10 00 18 mov %i0, %o1 40005d5c: 11 10 00 7a sethi %hi(0x4001e800), %o0 40005d60: 94 07 bf fc add %fp, -4, %o2 40005d64: 40 00 08 c5 call 40008078 <_Objects_Get> 40005d68: 90 12 21 a0 or %o0, 0x1a0, %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 ) { 40005d6c: c2 07 bf fc ld [ %fp + -4 ], %g1 40005d70: 80 a0 60 00 cmp %g1, 0 40005d74: 12 80 00 39 bne 40005e58 40005d78: 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 ) { 40005d7c: c2 07 bf ec ld [ %fp + -20 ], %g1 40005d80: 80 a0 60 00 cmp %g1, 0 40005d84: 12 80 00 14 bne 40005dd4 40005d88: c2 07 bf f0 ld [ %fp + -16 ], %g1 40005d8c: 80 a0 60 00 cmp %g1, 0 40005d90: 12 80 00 11 bne 40005dd4 40005d94: 01 00 00 00 nop /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 40005d98: 40 00 10 3b call 40009e84 <_Watchdog_Remove> 40005d9c: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 40005da0: 80 a6 e0 00 cmp %i3, 0 40005da4: 02 80 00 05 be 40005db8 40005da8: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40005dac: 92 06 20 54 add %i0, 0x54, %o1 40005db0: 40 00 27 12 call 4000f9f8 40005db4: 94 10 20 10 mov 0x10, %o2 /* The new data are set */ ptimer->timer_data = normalize; 40005db8: 90 06 20 54 add %i0, 0x54, %o0 40005dbc: 92 07 bf e4 add %fp, -28, %o1 40005dc0: 40 00 27 0e call 4000f9f8 40005dc4: 94 10 20 10 mov 0x10, %o2 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 40005dc8: 82 10 20 04 mov 4, %g1 40005dcc: 10 80 00 1f b 40005e48 40005dd0: 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 ); 40005dd4: 40 00 0f 07 call 400099f0 <_Timespec_To_ticks> 40005dd8: 90 10 00 1a mov %i2, %o0 40005ddc: d0 26 20 64 st %o0, [ %i0 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 40005de0: 40 00 0f 04 call 400099f0 <_Timespec_To_ticks> 40005de4: 90 07 bf ec add %fp, -20, %o0 activated = _POSIX_Timer_Insert_helper( 40005de8: 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 ); 40005dec: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 40005df0: 17 10 00 17 sethi %hi(0x40005c00), %o3 40005df4: 90 06 20 10 add %i0, 0x10, %o0 40005df8: 96 12 e2 70 or %o3, 0x270, %o3 40005dfc: 40 00 19 e6 call 4000c594 <_POSIX_Timer_Insert_helper> 40005e00: 98 10 00 18 mov %i0, %o4 initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 40005e04: 80 8a 20 ff btst 0xff, %o0 40005e08: 02 80 00 10 be 40005e48 40005e0c: 01 00 00 00 nop /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 40005e10: 80 a6 e0 00 cmp %i3, 0 40005e14: 02 80 00 05 be 40005e28 40005e18: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40005e1c: 92 06 20 54 add %i0, 0x54, %o1 40005e20: 40 00 26 f6 call 4000f9f8 40005e24: 94 10 20 10 mov 0x10, %o2 ptimer->timer_data = normalize; 40005e28: 90 06 20 54 add %i0, 0x54, %o0 40005e2c: 92 07 bf e4 add %fp, -28, %o1 40005e30: 40 00 26 f2 call 4000f9f8 40005e34: 94 10 20 10 mov 0x10, %o2 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40005e38: 82 10 20 03 mov 3, %g1 _TOD_Get( &ptimer->time ); 40005e3c: 90 06 20 6c add %i0, 0x6c, %o0 40005e40: 40 00 05 e2 call 400075c8 <_TOD_Get> 40005e44: c2 2e 20 3c stb %g1, [ %i0 + 0x3c ] _Thread_Enable_dispatch(); 40005e48: 40 00 0b da call 40008db0 <_Thread_Enable_dispatch> 40005e4c: b0 10 20 00 clr %i0 return 0; 40005e50: 81 c7 e0 08 ret 40005e54: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 40005e58: 40 00 24 74 call 4000f028 <__errno> 40005e5c: b0 10 3f ff mov -1, %i0 40005e60: 82 10 20 16 mov 0x16, %g1 40005e64: c2 22 00 00 st %g1, [ %o0 ] } 40005e68: 81 c7 e0 08 ret 40005e6c: 81 e8 00 00 restore =============================================================================== 40005a84 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 40005a84: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 40005a88: 23 10 00 60 sethi %hi(0x40018000), %l1 40005a8c: a2 14 60 78 or %l1, 0x78, %l1 ! 40018078 <_POSIX_signals_Ualarm_timer> 40005a90: c2 04 60 1c ld [ %l1 + 0x1c ], %g1 40005a94: 80 a0 60 00 cmp %g1, 0 40005a98: 12 80 00 0a bne 40005ac0 40005a9c: a0 10 00 18 mov %i0, %l0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40005aa0: 03 10 00 16 sethi %hi(0x40005800), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40005aa4: c0 24 60 08 clr [ %l1 + 8 ] the_watchdog->routine = routine; 40005aa8: 82 10 62 54 or %g1, 0x254, %g1 the_watchdog->id = id; 40005aac: c0 24 60 20 clr [ %l1 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40005ab0: c2 24 60 1c st %g1, [ %l1 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 40005ab4: c0 24 60 24 clr [ %l1 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 40005ab8: 10 80 00 1b b 40005b24 40005abc: 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 ); 40005ac0: 40 00 0f cb call 400099ec <_Watchdog_Remove> 40005ac4: 90 10 00 11 mov %l1, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 40005ac8: 90 02 3f fe add %o0, -2, %o0 40005acc: 80 a2 20 01 cmp %o0, 1 40005ad0: 18 80 00 15 bgu 40005b24 <== NEVER TAKEN 40005ad4: 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); 40005ad8: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40005adc: d0 04 60 14 ld [ %l1 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40005ae0: 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); 40005ae4: 90 02 00 01 add %o0, %g1, %o0 40005ae8: c2 04 60 18 ld [ %l1 + 0x18 ], %g1 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40005aec: 40 00 0e 4c call 4000941c <_Timespec_From_ticks> 40005af0: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40005af4: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 40005af8: 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; 40005afc: b1 28 60 08 sll %g1, 8, %i0 40005b00: 85 28 60 03 sll %g1, 3, %g2 40005b04: 84 26 00 02 sub %i0, %g2, %g2 remaining += tp.tv_nsec / 1000; 40005b08: 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; 40005b0c: b1 28 a0 06 sll %g2, 6, %i0 40005b10: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 40005b14: 40 00 37 b1 call 400139d8 <.div> 40005b18: 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; 40005b1c: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 40005b20: 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 ) { 40005b24: 80 a4 20 00 cmp %l0, 0 40005b28: 02 80 00 1a be 40005b90 40005b2c: 23 00 03 d0 sethi %hi(0xf4000), %l1 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40005b30: 90 10 00 10 mov %l0, %o0 40005b34: 40 00 37 a7 call 400139d0 <.udiv> 40005b38: 92 14 62 40 or %l1, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005b3c: 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; 40005b40: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40005b44: 40 00 38 4f call 40013c80 <.urem> 40005b48: 90 10 00 10 mov %l0, %o0 40005b4c: 85 2a 20 07 sll %o0, 7, %g2 40005b50: 83 2a 20 02 sll %o0, 2, %g1 40005b54: 82 20 80 01 sub %g2, %g1, %g1 40005b58: 90 00 40 08 add %g1, %o0, %o0 40005b5c: 91 2a 20 03 sll %o0, 3, %o0 ticks = _Timespec_To_ticks( &tp ); 40005b60: 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; 40005b64: d0 27 bf fc st %o0, [ %fp + -4 ] ticks = _Timespec_To_ticks( &tp ); 40005b68: 40 00 0e 54 call 400094b8 <_Timespec_To_ticks> 40005b6c: 90 10 00 10 mov %l0, %o0 if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 40005b70: 40 00 0e 52 call 400094b8 <_Timespec_To_ticks> 40005b74: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40005b78: 13 10 00 60 sethi %hi(0x40018000), %o1 40005b7c: 92 12 60 78 or %o1, 0x78, %o1 ! 40018078 <_POSIX_signals_Ualarm_timer> 40005b80: d0 22 60 0c st %o0, [ %o1 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40005b84: 11 10 00 5e sethi %hi(0x40017800), %o0 40005b88: 40 00 0f 3d call 4000987c <_Watchdog_Insert> 40005b8c: 90 12 20 30 or %o0, 0x30, %o0 ! 40017830 <_Watchdog_Ticks_chain> } return remaining; } 40005b90: 81 c7 e0 08 ret 40005b94: 81 e8 00 00 restore