=============================================================================== 40009e0c <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 40009e0c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 40009e10: 03 10 00 6a sethi %hi(0x4001a800), %g1 * Otherwise, we have to block. * If locked for reading and no waiters, then OK to read. * If any thread is waiting, then we wait. */ _ISR_Disable( level ); 40009e14: 7f ff e6 1b call 40003680 40009e18: e0 00 63 a4 ld [ %g1 + 0x3a4 ], %l0 ! 4001aba4 <_Per_CPU_Information+0xc> 40009e1c: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 40009e20: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 40009e24: 80 a0 60 00 cmp %g1, 0 40009e28: 12 80 00 08 bne 40009e48 <_CORE_RWLock_Release+0x3c> 40009e2c: 80 a0 60 01 cmp %g1, 1 _ISR_Enable( level ); 40009e30: 7f ff e6 18 call 40003690 40009e34: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 40009e38: 82 10 20 02 mov 2, %g1 40009e3c: c2 24 20 34 st %g1, [ %l0 + 0x34 ] 40009e40: 81 c7 e0 08 ret 40009e44: 81 e8 00 00 restore return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 40009e48: 32 80 00 0b bne,a 40009e74 <_CORE_RWLock_Release+0x68> 40009e4c: c0 24 20 34 clr [ %l0 + 0x34 ] the_rwlock->number_of_readers -= 1; 40009e50: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40009e54: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 40009e58: 80 a0 60 00 cmp %g1, 0 40009e5c: 02 80 00 05 be 40009e70 <_CORE_RWLock_Release+0x64> 40009e60: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 40009e64: 7f ff e6 0b call 40003690 40009e68: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 40009e6c: 30 80 00 24 b,a 40009efc <_CORE_RWLock_Release+0xf0> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 40009e70: 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; 40009e74: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 40009e78: 7f ff e6 06 call 40003690 40009e7c: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 40009e80: 40 00 07 29 call 4000bb24 <_Thread_queue_Dequeue> 40009e84: 90 10 00 18 mov %i0, %o0 if ( next ) { 40009e88: 80 a2 20 00 cmp %o0, 0 40009e8c: 22 80 00 1c be,a 40009efc <_CORE_RWLock_Release+0xf0> 40009e90: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 40009e94: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 40009e98: 80 a0 60 01 cmp %g1, 1 40009e9c: 32 80 00 05 bne,a 40009eb0 <_CORE_RWLock_Release+0xa4> 40009ea0: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 40009ea4: 82 10 20 02 mov 2, %g1 return CORE_RWLOCK_SUCCESSFUL; 40009ea8: 10 80 00 14 b 40009ef8 <_CORE_RWLock_Release+0xec> 40009eac: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 40009eb0: 82 00 60 01 inc %g1 40009eb4: c2 26 20 48 st %g1, [ %i0 + 0x48 ] the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 40009eb8: 82 10 20 01 mov 1, %g1 40009ebc: 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 ); 40009ec0: 40 00 08 61 call 4000c044 <_Thread_queue_First> 40009ec4: 90 10 00 18 mov %i0, %o0 if ( !next || 40009ec8: 92 92 20 00 orcc %o0, 0, %o1 40009ecc: 22 80 00 0c be,a 40009efc <_CORE_RWLock_Release+0xf0> 40009ed0: b0 10 20 00 clr %i0 40009ed4: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 40009ed8: 80 a0 60 01 cmp %g1, 1 40009edc: 02 80 00 07 be 40009ef8 <_CORE_RWLock_Release+0xec> <== NEVER TAKEN 40009ee0: 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; 40009ee4: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40009ee8: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 40009eec: 40 00 08 06 call 4000bf04 <_Thread_queue_Extract> 40009ef0: c2 26 20 48 st %g1, [ %i0 + 0x48 ] } 40009ef4: 30 bf ff f3 b,a 40009ec0 <_CORE_RWLock_Release+0xb4> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 40009ef8: b0 10 20 00 clr %i0 40009efc: 81 c7 e0 08 ret 40009f00: 81 e8 00 00 restore =============================================================================== 40009f04 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 40009f04: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009f08: 90 10 00 18 mov %i0, %o0 40009f0c: 40 00 06 46 call 4000b824 <_Thread_Get> 40009f10: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009f14: c2 07 bf fc ld [ %fp + -4 ], %g1 40009f18: 80 a0 60 00 cmp %g1, 0 40009f1c: 12 80 00 08 bne 40009f3c <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 40009f20: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40009f24: 40 00 08 8b call 4000c150 <_Thread_queue_Process_timeout> 40009f28: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40009f2c: 03 10 00 69 sethi %hi(0x4001a400), %g1 40009f30: c4 00 62 60 ld [ %g1 + 0x260 ], %g2 ! 4001a660 <_Thread_Dispatch_disable_level> 40009f34: 84 00 bf ff add %g2, -1, %g2 40009f38: c4 20 62 60 st %g2, [ %g1 + 0x260 ] 40009f3c: 81 c7 e0 08 ret 40009f40: 81 e8 00 00 restore =============================================================================== 4001082c <_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 ) { 4001082c: 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; 40010830: f4 26 20 44 st %i2, [ %i0 + 0x44 ] the_message_queue->number_of_pending_messages = 0; 40010834: c0 26 20 48 clr [ %i0 + 0x48 ] the_message_queue->maximum_message_size = maximum_message_size; 40010838: 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; 4001083c: c0 26 20 60 clr [ %i0 + 0x60 ] the_message_queue->notify_argument = the_argument; 40010840: 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 ) { 40010844: 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)) { 40010848: 80 8e e0 03 btst 3, %i3 4001084c: 02 80 00 07 be 40010868 <_CORE_message_queue_Initialize+0x3c> 40010850: a4 10 00 1b mov %i3, %l2 allocated_message_size += sizeof(uint32_t); 40010854: a4 06 e0 04 add %i3, 4, %l2 allocated_message_size &= ~(sizeof(uint32_t) - 1); 40010858: a4 0c bf fc and %l2, -4, %l2 } if (allocated_message_size < maximum_message_size) 4001085c: 80 a4 80 1b cmp %l2, %i3 40010860: 0a 80 00 22 bcs 400108e8 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 40010864: 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)); 40010868: 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 * 4001086c: 92 10 00 1a mov %i2, %o1 40010870: 90 10 00 11 mov %l1, %o0 40010874: 40 00 42 94 call 400212c4 <.umul> 40010878: b0 10 20 00 clr %i0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 4001087c: 80 a2 00 12 cmp %o0, %l2 40010880: 0a 80 00 1a bcs 400108e8 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 40010884: 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 ); 40010888: 40 00 0c 3a call 40013970 <_Workspace_Allocate> 4001088c: 01 00 00 00 nop return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 40010890: d0 24 20 5c st %o0, [ %l0 + 0x5c ] _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 40010894: 80 a2 20 00 cmp %o0, 0 40010898: 02 80 00 14 be 400108e8 <_CORE_message_queue_Initialize+0xbc> 4001089c: 92 10 00 08 mov %o0, %o1 /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 400108a0: 90 04 20 68 add %l0, 0x68, %o0 400108a4: 94 10 00 1a mov %i2, %o2 400108a8: 40 00 16 73 call 40016274 <_Chain_Initialize> 400108ac: 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 ); 400108b0: 82 04 20 54 add %l0, 0x54, %g1 head->next = tail; 400108b4: 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 ); 400108b8: 82 04 20 50 add %l0, 0x50, %g1 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 400108bc: c0 24 20 54 clr [ %l0 + 0x54 ] tail->previous = head; 400108c0: 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( 400108c4: c2 06 40 00 ld [ %i1 ], %g1 400108c8: 90 10 00 10 mov %l0, %o0 400108cc: 82 18 60 01 xor %g1, 1, %g1 400108d0: 80 a0 00 01 cmp %g0, %g1 400108d4: 94 10 20 80 mov 0x80, %o2 400108d8: 92 60 3f ff subx %g0, -1, %o1 400108dc: 96 10 20 06 mov 6, %o3 400108e0: 40 00 09 9c call 40012f50 <_Thread_queue_Initialize> 400108e4: b0 10 20 01 mov 1, %i0 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 400108e8: 81 c7 e0 08 ret 400108ec: 81 e8 00 00 restore =============================================================================== 400108f0 <_CORE_message_queue_Seize>: void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 400108f0: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 400108f4: 27 10 00 9d sethi %hi(0x40027400), %l3 400108f8: a6 14 e1 f8 or %l3, 0x1f8, %l3 ! 400275f8 <_Per_CPU_Information> 400108fc: e4 04 e0 0c ld [ %l3 + 0xc ], %l2 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 40010900: 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; 40010904: c0 24 a0 34 clr [ %l2 + 0x34 ] _ISR_Disable( level ); 40010908: 7f ff da a2 call 40007390 4001090c: a2 10 00 19 mov %i1, %l1 40010910: 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 ); } 40010914: 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 ); 40010918: 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)) 4001091c: 80 a6 40 02 cmp %i1, %g2 40010920: 02 80 00 24 be 400109b0 <_CORE_message_queue_Seize+0xc0> 40010924: 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; 40010928: c4 06 40 00 ld [ %i1 ], %g2 head->next = new_first; 4001092c: 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 ) { 40010930: 80 a6 60 00 cmp %i1, 0 40010934: 02 80 00 1f be 400109b0 <_CORE_message_queue_Seize+0xc0> <== NEVER TAKEN 40010938: c6 20 a0 04 st %g3, [ %g2 + 4 ] the_message_queue->number_of_pending_messages -= 1; 4001093c: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40010940: 82 00 7f ff add %g1, -1, %g1 40010944: c2 26 20 48 st %g1, [ %i0 + 0x48 ] _ISR_Enable( level ); 40010948: 7f ff da 96 call 400073a0 4001094c: a2 06 60 10 add %i1, 0x10, %l1 *size_p = the_message->Contents.size; 40010950: d4 06 60 0c ld [ %i1 + 0xc ], %o2 _Thread_Executing->Wait.count = 40010954: 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; 40010958: d4 26 c0 00 st %o2, [ %i3 ] _Thread_Executing->Wait.count = 4001095c: c4 06 60 08 ld [ %i1 + 8 ], %g2 40010960: c4 20 60 24 st %g2, [ %g1 + 0x24 ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 40010964: 92 10 00 11 mov %l1, %o1 40010968: 40 00 21 e9 call 4001910c 4001096c: 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 ); 40010970: 40 00 08 6b call 40012b1c <_Thread_queue_Dequeue> 40010974: 90 10 00 18 mov %i0, %o0 if ( !the_thread ) { 40010978: 82 92 20 00 orcc %o0, 0, %g1 4001097c: 32 80 00 04 bne,a 4001098c <_CORE_message_queue_Seize+0x9c> 40010980: 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 ); 40010984: 7f ff ff 7a call 4001076c <_Chain_Append> 40010988: 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; 4001098c: d4 00 60 30 ld [ %g1 + 0x30 ], %o2 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 40010990: 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; 40010994: c4 26 60 08 st %g2, [ %i1 + 8 ] 40010998: d4 26 60 0c st %o2, [ %i1 + 0xc ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4001099c: 40 00 21 dc call 4001910c 400109a0: 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( 400109a4: f4 06 60 08 ld [ %i1 + 8 ], %i2 400109a8: 40 00 16 41 call 400162ac <_CORE_message_queue_Insert_message> 400109ac: 81 e8 00 00 restore return; } #endif } if ( !wait ) { 400109b0: 80 8f 20 ff btst 0xff, %i4 400109b4: 32 80 00 08 bne,a 400109d4 <_CORE_message_queue_Seize+0xe4> 400109b8: 84 10 20 01 mov 1, %g2 _ISR_Enable( level ); 400109bc: 7f ff da 79 call 400073a0 400109c0: 90 10 00 01 mov %g1, %o0 executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 400109c4: 82 10 20 04 mov 4, %g1 400109c8: 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 ); } 400109cc: 81 c7 e0 08 ret 400109d0: 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; 400109d4: 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; 400109d8: e0 24 a0 44 st %l0, [ %l2 + 0x44 ] executing->Wait.id = id; 400109dc: e2 24 a0 20 st %l1, [ %l2 + 0x20 ] executing->Wait.return_argument_second.mutable_object = buffer; 400109e0: f4 24 a0 2c st %i2, [ %l2 + 0x2c ] executing->Wait.return_argument = size_p; 400109e4: f6 24 a0 28 st %i3, [ %l2 + 0x28 ] /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 400109e8: 90 10 00 01 mov %g1, %o0 400109ec: 7f ff da 6d call 400073a0 400109f0: 35 10 00 4c sethi %hi(0x40013000), %i2 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 400109f4: b0 10 00 10 mov %l0, %i0 400109f8: b2 10 00 1d mov %i5, %i1 400109fc: 40 00 08 ab call 40012ca8 <_Thread_queue_Enqueue_with_handler> 40010a00: 95 ee a0 30 restore %i2, 0x30, %o2 =============================================================================== 4000769c <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 4000769c: 9d e3 bf a0 save %sp, -96, %sp _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 400076a0: 03 10 00 59 sethi %hi(0x40016400), %g1 400076a4: c2 00 61 20 ld [ %g1 + 0x120 ], %g1 ! 40016520 <_Thread_Dispatch_disable_level> 400076a8: 80 a0 60 00 cmp %g1, 0 400076ac: 02 80 00 0d be 400076e0 <_CORE_mutex_Seize+0x44> 400076b0: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 400076b4: 80 8e a0 ff btst 0xff, %i2 400076b8: 02 80 00 0b be 400076e4 <_CORE_mutex_Seize+0x48> <== NEVER TAKEN 400076bc: 90 10 00 18 mov %i0, %o0 400076c0: 03 10 00 59 sethi %hi(0x40016400), %g1 400076c4: c2 00 62 78 ld [ %g1 + 0x278 ], %g1 ! 40016678 <_System_state_Current> 400076c8: 80 a0 60 01 cmp %g1, 1 400076cc: 08 80 00 05 bleu 400076e0 <_CORE_mutex_Seize+0x44> 400076d0: 90 10 20 00 clr %o0 400076d4: 92 10 20 00 clr %o1 400076d8: 40 00 01 da call 40007e40 <_Internal_error_Occurred> 400076dc: 94 10 20 12 mov 0x12, %o2 400076e0: 90 10 00 18 mov %i0, %o0 400076e4: 40 00 15 64 call 4000cc74 <_CORE_mutex_Seize_interrupt_trylock> 400076e8: 92 07 a0 54 add %fp, 0x54, %o1 400076ec: 80 a2 20 00 cmp %o0, 0 400076f0: 02 80 00 0a be 40007718 <_CORE_mutex_Seize+0x7c> 400076f4: 80 8e a0 ff btst 0xff, %i2 400076f8: 35 10 00 5a sethi %hi(0x40016800), %i2 400076fc: 12 80 00 09 bne 40007720 <_CORE_mutex_Seize+0x84> 40007700: b4 16 a2 58 or %i2, 0x258, %i2 ! 40016a58 <_Per_CPU_Information> 40007704: 7f ff e9 a0 call 40001d84 40007708: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 4000770c: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 40007710: 84 10 20 01 mov 1, %g2 40007714: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 40007718: 81 c7 e0 08 ret 4000771c: 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; 40007720: 82 10 20 01 mov 1, %g1 40007724: c2 26 20 30 st %g1, [ %i0 + 0x30 ] 40007728: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 4000772c: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 40007730: f2 20 60 20 st %i1, [ %g1 + 0x20 ] 40007734: 03 10 00 59 sethi %hi(0x40016400), %g1 40007738: c4 00 61 20 ld [ %g1 + 0x120 ], %g2 ! 40016520 <_Thread_Dispatch_disable_level> 4000773c: 84 00 a0 01 inc %g2 40007740: c4 20 61 20 st %g2, [ %g1 + 0x120 ] 40007744: 7f ff e9 90 call 40001d84 40007748: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 4000774c: 90 10 00 18 mov %i0, %o0 40007750: 7f ff ff ba call 40007638 <_CORE_mutex_Seize_interrupt_blocking> 40007754: 92 10 00 1b mov %i3, %o1 40007758: 81 c7 e0 08 ret 4000775c: 81 e8 00 00 restore =============================================================================== 400078dc <_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 ) { 400078dc: 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)) ) { 400078e0: 90 10 00 18 mov %i0, %o0 400078e4: 40 00 07 06 call 400094fc <_Thread_queue_Dequeue> 400078e8: a0 10 00 18 mov %i0, %l0 400078ec: 80 a2 20 00 cmp %o0, 0 400078f0: 12 80 00 0e bne 40007928 <_CORE_semaphore_Surrender+0x4c> 400078f4: 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 ); 400078f8: 7f ff e9 1f call 40001d74 400078fc: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 40007900: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40007904: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 40007908: 80 a0 40 02 cmp %g1, %g2 4000790c: 1a 80 00 05 bcc 40007920 <_CORE_semaphore_Surrender+0x44> <== NEVER TAKEN 40007910: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 40007914: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 40007918: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 4000791c: c2 24 20 48 st %g1, [ %l0 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 40007920: 7f ff e9 19 call 40001d84 40007924: 01 00 00 00 nop } return status; } 40007928: 81 c7 e0 08 ret 4000792c: 81 e8 00 00 restore =============================================================================== 40006624 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 40006624: 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 ]; 40006628: e2 06 21 54 ld [ %i0 + 0x154 ], %l1 option_set = (rtems_option) the_thread->Wait.option; 4000662c: e4 06 20 30 ld [ %i0 + 0x30 ], %l2 _ISR_Disable( level ); 40006630: 7f ff ed d1 call 40001d74 40006634: a0 10 00 18 mov %i0, %l0 40006638: b0 10 00 08 mov %o0, %i0 pending_events = api->pending_events; 4000663c: c4 04 40 00 ld [ %l1 ], %g2 event_condition = (rtems_event_set) the_thread->Wait.count; 40006640: 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 ) ) { 40006644: 82 88 c0 02 andcc %g3, %g2, %g1 40006648: 12 80 00 03 bne 40006654 <_Event_Surrender+0x30> 4000664c: 09 10 00 5a sethi %hi(0x40016800), %g4 _ISR_Enable( level ); 40006650: 30 80 00 42 b,a 40006758 <_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() && 40006654: 88 11 22 58 or %g4, 0x258, %g4 ! 40016a58 <_Per_CPU_Information> 40006658: da 01 20 08 ld [ %g4 + 8 ], %o5 4000665c: 80 a3 60 00 cmp %o5, 0 40006660: 22 80 00 1d be,a 400066d4 <_Event_Surrender+0xb0> 40006664: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 40006668: c8 01 20 0c ld [ %g4 + 0xc ], %g4 4000666c: 80 a4 00 04 cmp %l0, %g4 40006670: 32 80 00 19 bne,a 400066d4 <_Event_Surrender+0xb0> 40006674: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 40006678: 09 10 00 5b sethi %hi(0x40016c00), %g4 4000667c: da 01 22 50 ld [ %g4 + 0x250 ], %o5 ! 40016e50 <_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 ) && 40006680: 80 a3 60 02 cmp %o5, 2 40006684: 02 80 00 07 be 400066a0 <_Event_Surrender+0x7c> <== NEVER TAKEN 40006688: 80 a0 40 03 cmp %g1, %g3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 4000668c: c8 01 22 50 ld [ %g4 + 0x250 ], %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) || 40006690: 80 a1 20 01 cmp %g4, 1 40006694: 32 80 00 10 bne,a 400066d4 <_Event_Surrender+0xb0> 40006698: 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) ) { 4000669c: 80 a0 40 03 cmp %g1, %g3 400066a0: 02 80 00 04 be 400066b0 <_Event_Surrender+0x8c> 400066a4: 80 8c a0 02 btst 2, %l2 400066a8: 02 80 00 0a be 400066d0 <_Event_Surrender+0xac> <== NEVER TAKEN 400066ac: 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) ); 400066b0: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 400066b4: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 400066b8: 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; 400066bc: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 400066c0: c2 20 80 00 st %g1, [ %g2 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 400066c4: 84 10 20 03 mov 3, %g2 400066c8: 03 10 00 5b sethi %hi(0x40016c00), %g1 400066cc: c4 20 62 50 st %g2, [ %g1 + 0x250 ] ! 40016e50 <_Event_Sync_state> } _ISR_Enable( level ); 400066d0: 30 80 00 22 b,a 40006758 <_Event_Surrender+0x134> } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 400066d4: 80 89 21 00 btst 0x100, %g4 400066d8: 02 80 00 20 be 40006758 <_Event_Surrender+0x134> 400066dc: 80 a0 40 03 cmp %g1, %g3 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 400066e0: 02 80 00 04 be 400066f0 <_Event_Surrender+0xcc> 400066e4: 80 8c a0 02 btst 2, %l2 400066e8: 02 80 00 1c be 40006758 <_Event_Surrender+0x134> <== NEVER TAKEN 400066ec: 01 00 00 00 nop 400066f0: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 400066f4: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 400066f8: 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; 400066fc: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006700: c2 20 80 00 st %g1, [ %g2 ] _ISR_Flash( level ); 40006704: 7f ff ed a0 call 40001d84 40006708: 90 10 00 18 mov %i0, %o0 4000670c: 7f ff ed 9a call 40001d74 40006710: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 40006714: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 40006718: 80 a0 60 02 cmp %g1, 2 4000671c: 02 80 00 06 be 40006734 <_Event_Surrender+0x110> 40006720: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 40006724: 7f ff ed 98 call 40001d84 40006728: 90 10 00 18 mov %i0, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 4000672c: 10 80 00 08 b 4000674c <_Event_Surrender+0x128> 40006730: 33 04 00 ff sethi %hi(0x1003fc00), %i1 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 40006734: c2 24 20 50 st %g1, [ %l0 + 0x50 ] _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 40006738: 7f ff ed 93 call 40001d84 4000673c: 90 10 00 18 mov %i0, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 40006740: 40 00 0e 99 call 4000a1a4 <_Watchdog_Remove> 40006744: 90 04 20 48 add %l0, 0x48, %o0 40006748: 33 04 00 ff sethi %hi(0x1003fc00), %i1 4000674c: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 40006750: 40 00 09 d7 call 40008eac <_Thread_Clear_state> 40006754: 91 e8 00 10 restore %g0, %l0, %o0 _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 40006758: 7f ff ed 8b call 40001d84 4000675c: 81 e8 00 00 restore =============================================================================== 40006764 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 40006764: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 40006768: 90 10 00 18 mov %i0, %o0 4000676c: 40 00 0a a4 call 400091fc <_Thread_Get> 40006770: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40006774: c2 07 bf fc ld [ %fp + -4 ], %g1 40006778: 80 a0 60 00 cmp %g1, 0 4000677c: 12 80 00 1c bne 400067ec <_Event_Timeout+0x88> <== NEVER TAKEN 40006780: 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 ); 40006784: 7f ff ed 7c call 40001d74 40006788: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 4000678c: 03 10 00 5a sethi %hi(0x40016800), %g1 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 40006790: c2 00 62 64 ld [ %g1 + 0x264 ], %g1 ! 40016a64 <_Per_CPU_Information+0xc> 40006794: 80 a4 00 01 cmp %l0, %g1 40006798: 12 80 00 09 bne 400067bc <_Event_Timeout+0x58> 4000679c: c0 24 20 24 clr [ %l0 + 0x24 ] if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 400067a0: 03 10 00 5b sethi %hi(0x40016c00), %g1 400067a4: c4 00 62 50 ld [ %g1 + 0x250 ], %g2 ! 40016e50 <_Event_Sync_state> 400067a8: 80 a0 a0 01 cmp %g2, 1 400067ac: 32 80 00 05 bne,a 400067c0 <_Event_Timeout+0x5c> 400067b0: 82 10 20 06 mov 6, %g1 _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 400067b4: 84 10 20 02 mov 2, %g2 400067b8: c4 20 62 50 st %g2, [ %g1 + 0x250 ] } the_thread->Wait.return_code = RTEMS_TIMEOUT; 400067bc: 82 10 20 06 mov 6, %g1 400067c0: c2 24 20 34 st %g1, [ %l0 + 0x34 ] _ISR_Enable( level ); 400067c4: 7f ff ed 70 call 40001d84 400067c8: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 400067cc: 90 10 00 10 mov %l0, %o0 400067d0: 13 04 00 ff sethi %hi(0x1003fc00), %o1 400067d4: 40 00 09 b6 call 40008eac <_Thread_Clear_state> 400067d8: 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; 400067dc: 03 10 00 59 sethi %hi(0x40016400), %g1 400067e0: c4 00 61 20 ld [ %g1 + 0x120 ], %g2 ! 40016520 <_Thread_Dispatch_disable_level> 400067e4: 84 00 bf ff add %g2, -1, %g2 400067e8: c4 20 61 20 st %g2, [ %g1 + 0x120 ] 400067ec: 81 c7 e0 08 ret 400067f0: 81 e8 00 00 restore =============================================================================== 4000d2e4 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000d2e4: 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; 4000d2e8: c0 27 bf fc clr [ %fp + -4 ] Heap_Block *extend_last_block = NULL; 4000d2ec: 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 ) { 4000d2f0: a0 10 00 18 mov %i0, %l0 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4000d2f4: 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; 4000d2f8: e6 06 20 10 ld [ %i0 + 0x10 ], %l3 uintptr_t const min_block_size = heap->min_block_size; 4000d2fc: 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; 4000d300: a2 06 40 1a add %i1, %i2, %l1 uintptr_t const free_size = stats->free_size; 4000d304: 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 ) { 4000d308: 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 ) { 4000d30c: 80 a4 40 19 cmp %l1, %i1 4000d310: 0a 80 00 9f bcs 4000d58c <_Heap_Extend+0x2a8> 4000d314: b0 10 20 00 clr %i0 return false; } extend_area_ok = _Heap_Get_first_and_last_block( 4000d318: 90 10 00 19 mov %i1, %o0 4000d31c: 94 10 00 13 mov %l3, %o2 4000d320: 98 07 bf fc add %fp, -4, %o4 4000d324: 7f ff ea e3 call 40007eb0 <_Heap_Get_first_and_last_block> 4000d328: 9a 07 bf f8 add %fp, -8, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4000d32c: 80 8a 20 ff btst 0xff, %o0 4000d330: 02 80 00 97 be 4000d58c <_Heap_Extend+0x2a8> 4000d334: aa 10 00 12 mov %l2, %l5 4000d338: ba 10 20 00 clr %i5 4000d33c: b8 10 20 00 clr %i4 4000d340: b0 10 20 00 clr %i0 4000d344: ae 10 20 00 clr %l7 4000d348: 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 ( 4000d34c: 80 a0 40 11 cmp %g1, %l1 4000d350: 1a 80 00 05 bcc 4000d364 <_Heap_Extend+0x80> 4000d354: ec 05 40 00 ld [ %l5 ], %l6 4000d358: 80 a6 40 16 cmp %i1, %l6 4000d35c: 2a 80 00 8c bcs,a 4000d58c <_Heap_Extend+0x2a8> 4000d360: 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 ) { 4000d364: 80 a4 40 01 cmp %l1, %g1 4000d368: 02 80 00 06 be 4000d380 <_Heap_Extend+0x9c> 4000d36c: 80 a4 40 16 cmp %l1, %l6 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4000d370: 2a 80 00 05 bcs,a 4000d384 <_Heap_Extend+0xa0> 4000d374: b8 10 00 15 mov %l5, %i4 4000d378: 10 80 00 04 b 4000d388 <_Heap_Extend+0xa4> 4000d37c: 90 10 00 16 mov %l6, %o0 4000d380: ae 10 00 15 mov %l5, %l7 4000d384: 90 10 00 16 mov %l6, %o0 4000d388: 40 00 17 70 call 40013148 <.urem> 4000d38c: 92 10 00 13 mov %l3, %o1 4000d390: b4 05 bf f8 add %l6, -8, %i2 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000d394: 80 a5 80 19 cmp %l6, %i1 4000d398: 12 80 00 05 bne 4000d3ac <_Heap_Extend+0xc8> 4000d39c: 90 26 80 08 sub %i2, %o0, %o0 start_block->prev_size = extend_area_end; 4000d3a0: 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 ) 4000d3a4: 10 80 00 04 b 4000d3b4 <_Heap_Extend+0xd0> 4000d3a8: b0 10 00 08 mov %o0, %i0 merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4000d3ac: 2a 80 00 02 bcs,a 4000d3b4 <_Heap_Extend+0xd0> 4000d3b0: 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; 4000d3b4: ea 02 20 04 ld [ %o0 + 4 ], %l5 4000d3b8: 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); 4000d3bc: 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 ); 4000d3c0: 80 a5 40 12 cmp %l5, %l2 4000d3c4: 12 bf ff e2 bne 4000d34c <_Heap_Extend+0x68> 4000d3c8: 82 10 00 15 mov %l5, %g1 if ( extend_area_begin < heap->area_begin ) { 4000d3cc: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000d3d0: 80 a6 40 01 cmp %i1, %g1 4000d3d4: 3a 80 00 04 bcc,a 4000d3e4 <_Heap_Extend+0x100> 4000d3d8: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 4000d3dc: 10 80 00 05 b 4000d3f0 <_Heap_Extend+0x10c> 4000d3e0: f2 24 20 18 st %i1, [ %l0 + 0x18 ] } else if ( heap->area_end < extend_area_end ) { 4000d3e4: 80 a0 40 11 cmp %g1, %l1 4000d3e8: 2a 80 00 02 bcs,a 4000d3f0 <_Heap_Extend+0x10c> 4000d3ec: 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; 4000d3f0: c4 07 bf fc ld [ %fp + -4 ], %g2 4000d3f4: c2 07 bf f8 ld [ %fp + -8 ], %g1 extend_first_block->prev_size = extend_area_end; 4000d3f8: 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 = 4000d3fc: 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; 4000d400: 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; 4000d404: 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 = 4000d408: 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 ) { 4000d40c: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 4000d410: 80 a0 c0 02 cmp %g3, %g2 4000d414: 08 80 00 04 bleu 4000d424 <_Heap_Extend+0x140> 4000d418: c0 20 60 04 clr [ %g1 + 4 ] heap->first_block = extend_first_block; 4000d41c: 10 80 00 06 b 4000d434 <_Heap_Extend+0x150> 4000d420: c4 24 20 20 st %g2, [ %l0 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 4000d424: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 4000d428: 80 a0 80 01 cmp %g2, %g1 4000d42c: 2a 80 00 02 bcs,a 4000d434 <_Heap_Extend+0x150> 4000d430: c2 24 20 24 st %g1, [ %l0 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000d434: 80 a5 e0 00 cmp %l7, 0 4000d438: 02 80 00 14 be 4000d488 <_Heap_Extend+0x1a4> 4000d43c: 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; 4000d440: 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; 4000d444: 92 10 00 12 mov %l2, %o1 4000d448: 40 00 17 40 call 40013148 <.urem> 4000d44c: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 4000d450: 80 a2 20 00 cmp %o0, 0 4000d454: 02 80 00 04 be 4000d464 <_Heap_Extend+0x180> 4000d458: c2 05 c0 00 ld [ %l7 ], %g1 return value - remainder + alignment; 4000d45c: b2 06 40 12 add %i1, %l2, %i1 4000d460: 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 = 4000d464: 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; 4000d468: 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 = 4000d46c: 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; 4000d470: 82 10 60 01 or %g1, 1, %g1 _Heap_Free_block( heap, new_first_block ); 4000d474: 90 10 00 10 mov %l0, %o0 4000d478: 7f ff ff 90 call 4000d2b8 <_Heap_Free_block> 4000d47c: c2 22 60 04 st %g1, [ %o1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000d480: 10 80 00 09 b 4000d4a4 <_Heap_Extend+0x1c0> 4000d484: 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 ) { 4000d488: 80 a7 20 00 cmp %i4, 0 4000d48c: 02 80 00 05 be 4000d4a0 <_Heap_Extend+0x1bc> 4000d490: 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; 4000d494: b8 27 00 01 sub %i4, %g1, %i4 4000d498: 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 = 4000d49c: f8 20 60 04 st %i4, [ %g1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000d4a0: 80 a6 20 00 cmp %i0, 0 4000d4a4: 02 80 00 15 be 4000d4f8 <_Heap_Extend+0x214> 4000d4a8: 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); 4000d4ac: 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( 4000d4b0: a2 24 40 18 sub %l1, %i0, %l1 4000d4b4: 40 00 17 25 call 40013148 <.urem> 4000d4b8: 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) 4000d4bc: c4 06 20 04 ld [ %i0 + 4 ], %g2 4000d4c0: 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 = 4000d4c4: 82 04 40 18 add %l1, %i0, %g1 (last_block->size_and_flag - last_block_new_size) 4000d4c8: 84 20 80 11 sub %g2, %l1, %g2 | HEAP_PREV_BLOCK_USED; 4000d4cc: 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 = 4000d4d0: 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; 4000d4d4: 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 ); 4000d4d8: 90 10 00 10 mov %l0, %o0 4000d4dc: 82 08 60 01 and %g1, 1, %g1 4000d4e0: 92 10 00 18 mov %i0, %o1 block->size_and_flag = size | flag; 4000d4e4: a2 14 40 01 or %l1, %g1, %l1 4000d4e8: 7f ff ff 74 call 4000d2b8 <_Heap_Free_block> 4000d4ec: e2 26 20 04 st %l1, [ %i0 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d4f0: 10 80 00 0f b 4000d52c <_Heap_Extend+0x248> 4000d4f4: 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 ) { 4000d4f8: 80 a7 60 00 cmp %i5, 0 4000d4fc: 02 80 00 0b be 4000d528 <_Heap_Extend+0x244> 4000d500: 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; 4000d504: c4 07 60 04 ld [ %i5 + 4 ], %g2 _Heap_Link_above( 4000d508: 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 ); 4000d50c: 86 20 c0 1d sub %g3, %i5, %g3 4000d510: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000d514: 84 10 c0 02 or %g3, %g2, %g2 4000d518: c4 27 60 04 st %g2, [ %i5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4000d51c: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000d520: 84 10 a0 01 or %g2, 1, %g2 4000d524: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d528: 80 a6 20 00 cmp %i0, 0 4000d52c: 32 80 00 09 bne,a 4000d550 <_Heap_Extend+0x26c> 4000d530: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000d534: 80 a5 e0 00 cmp %l7, 0 4000d538: 32 80 00 06 bne,a 4000d550 <_Heap_Extend+0x26c> 4000d53c: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 4000d540: d2 07 bf fc ld [ %fp + -4 ], %o1 4000d544: 7f ff ff 5d call 4000d2b8 <_Heap_Free_block> 4000d548: 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 4000d54c: 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( 4000d550: 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; 4000d554: 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( 4000d558: 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; 4000d55c: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000d560: 84 10 c0 02 or %g3, %g2, %g2 4000d564: c4 20 60 04 st %g2, [ %g1 + 4 ] } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000d568: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 4000d56c: 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; 4000d570: a8 20 40 14 sub %g1, %l4, %l4 /* Statistics */ stats->size += extended_size; 4000d574: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 if ( extended_size_ptr != NULL ) 4000d578: 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; 4000d57c: 82 00 40 14 add %g1, %l4, %g1 if ( extended_size_ptr != NULL ) 4000d580: 02 80 00 03 be 4000d58c <_Heap_Extend+0x2a8> <== NEVER TAKEN 4000d584: c2 24 20 2c st %g1, [ %l0 + 0x2c ] *extended_size_ptr = extended_size; 4000d588: e8 26 c0 00 st %l4, [ %i3 ] 4000d58c: 81 c7 e0 08 ret 4000d590: 81 e8 00 00 restore =============================================================================== 4000cfe4 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4000cfe4: 9d e3 bf a0 save %sp, -96, %sp 4000cfe8: a0 10 00 18 mov %i0, %l0 4000cfec: 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 ) { 4000cff0: 80 a6 60 00 cmp %i1, 0 4000cff4: 02 80 00 78 be 4000d1d4 <_Heap_Free+0x1f0> 4000cff8: b0 10 20 01 mov 1, %i0 4000cffc: d2 04 20 10 ld [ %l0 + 0x10 ], %o1 4000d000: 40 00 17 14 call 40012c50 <.urem> 4000d004: 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 4000d008: 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); 4000d00c: 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; 4000d010: 80 a2 00 0c cmp %o0, %o4 4000d014: 0a 80 00 05 bcs 4000d028 <_Heap_Free+0x44> 4000d018: 82 10 20 00 clr %g1 4000d01c: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000d020: 80 a0 40 08 cmp %g1, %o0 4000d024: 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 ) ) { 4000d028: 80 a0 60 00 cmp %g1, 0 4000d02c: 02 80 00 6a be 4000d1d4 <_Heap_Free+0x1f0> 4000d030: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000d034: 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; 4000d038: 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); 4000d03c: 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; 4000d040: 80 a0 40 0c cmp %g1, %o4 4000d044: 0a 80 00 05 bcs 4000d058 <_Heap_Free+0x74> <== NEVER TAKEN 4000d048: 86 10 20 00 clr %g3 4000d04c: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 4000d050: 80 a0 c0 01 cmp %g3, %g1 4000d054: 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 ) ) { 4000d058: 80 a0 e0 00 cmp %g3, 0 4000d05c: 02 80 00 5e be 4000d1d4 <_Heap_Free+0x1f0> <== NEVER TAKEN 4000d060: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000d064: c8 00 60 04 ld [ %g1 + 4 ], %g4 return false; } _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_prev_used( next_block ) ) { 4000d068: 80 89 20 01 btst 1, %g4 4000d06c: 02 80 00 5a be 4000d1d4 <_Heap_Free+0x1f0> <== NEVER TAKEN 4000d070: 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 4000d074: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4000d078: 80 a0 40 09 cmp %g1, %o1 4000d07c: 02 80 00 07 be 4000d098 <_Heap_Free+0xb4> 4000d080: 96 10 20 00 clr %o3 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000d084: 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; 4000d088: c6 00 e0 04 ld [ %g3 + 4 ], %g3 4000d08c: 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 )); 4000d090: 80 a0 00 03 cmp %g0, %g3 4000d094: 96 60 3f ff subx %g0, -1, %o3 if ( !_Heap_Is_prev_used( block ) ) { 4000d098: 80 8b 60 01 btst 1, %o5 4000d09c: 12 80 00 26 bne 4000d134 <_Heap_Free+0x150> 4000d0a0: 80 8a e0 ff btst 0xff, %o3 uintptr_t const prev_size = block->prev_size; 4000d0a4: 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); 4000d0a8: 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; 4000d0ac: 80 a0 c0 0c cmp %g3, %o4 4000d0b0: 0a 80 00 04 bcs 4000d0c0 <_Heap_Free+0xdc> <== NEVER TAKEN 4000d0b4: 94 10 20 00 clr %o2 4000d0b8: 80 a2 40 03 cmp %o1, %g3 4000d0bc: 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 ) ) { 4000d0c0: 80 a2 a0 00 cmp %o2, 0 4000d0c4: 02 80 00 44 be 4000d1d4 <_Heap_Free+0x1f0> <== NEVER TAKEN 4000d0c8: 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; 4000d0cc: 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) ) { 4000d0d0: 80 8b 20 01 btst 1, %o4 4000d0d4: 02 80 00 40 be 4000d1d4 <_Heap_Free+0x1f0> <== NEVER TAKEN 4000d0d8: 80 8a e0 ff btst 0xff, %o3 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4000d0dc: 22 80 00 0f be,a 4000d118 <_Heap_Free+0x134> 4000d0e0: 9a 00 80 0d add %g2, %o5, %o5 uintptr_t const size = block_size + prev_size + next_block_size; 4000d0e4: 88 00 80 04 add %g2, %g4, %g4 4000d0e8: 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; 4000d0ec: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = block->prev; 4000d0f0: c2 00 60 0c ld [ %g1 + 0xc ], %g1 prev->next = next; 4000d0f4: c8 20 60 08 st %g4, [ %g1 + 8 ] next->prev = prev; 4000d0f8: c2 21 20 0c st %g1, [ %g4 + 0xc ] _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4000d0fc: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 4000d100: 82 00 7f ff add %g1, -1, %g1 4000d104: 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; 4000d108: 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; 4000d10c: 82 13 60 01 or %o5, 1, %g1 4000d110: 10 80 00 27 b 4000d1ac <_Heap_Free+0x1c8> 4000d114: 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; 4000d118: 88 13 60 01 or %o5, 1, %g4 4000d11c: c8 20 e0 04 st %g4, [ %g3 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000d120: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = size; 4000d124: 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; 4000d128: 86 08 ff fe and %g3, -2, %g3 4000d12c: 10 80 00 20 b 4000d1ac <_Heap_Free+0x1c8> 4000d130: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4000d134: 22 80 00 0d be,a 4000d168 <_Heap_Free+0x184> 4000d138: c6 04 20 08 ld [ %l0 + 8 ], %g3 uintptr_t const size = block_size + next_block_size; 4000d13c: 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; 4000d140: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = old_block->prev; 4000d144: c2 00 60 0c ld [ %g1 + 0xc ], %g1 new_block->next = next; 4000d148: c8 22 20 08 st %g4, [ %o0 + 8 ] new_block->prev = prev; 4000d14c: c2 22 20 0c st %g1, [ %o0 + 0xc ] next->prev = new_block; prev->next = new_block; 4000d150: 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; 4000d154: d0 21 20 0c st %o0, [ %g4 + 0xc ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000d158: 82 10 e0 01 or %g3, 1, %g1 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4000d15c: 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; 4000d160: 10 80 00 13 b 4000d1ac <_Heap_Free+0x1c8> 4000d164: c2 22 20 04 st %g1, [ %o0 + 4 ] ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 4000d168: e0 22 20 0c st %l0, [ %o0 + 0xc ] Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4000d16c: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4000d170: 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; 4000d174: 86 10 a0 01 or %g2, 1, %g3 4000d178: c6 22 20 04 st %g3, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000d17c: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = block_size; 4000d180: 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; 4000d184: 86 08 ff fe and %g3, -2, %g3 4000d188: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000d18c: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 if ( stats->max_free_blocks < stats->free_blocks ) { 4000d190: 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; 4000d194: 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; 4000d198: d0 24 20 08 st %o0, [ %l0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 4000d19c: 80 a0 c0 01 cmp %g3, %g1 4000d1a0: 1a 80 00 03 bcc 4000d1ac <_Heap_Free+0x1c8> 4000d1a4: c2 24 20 38 st %g1, [ %l0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 4000d1a8: c2 24 20 3c st %g1, [ %l0 + 0x3c ] } } /* Statistics */ --stats->used_blocks; 4000d1ac: c2 04 20 40 ld [ %l0 + 0x40 ], %g1 ++stats->frees; stats->free_size += block_size; return( true ); 4000d1b0: b0 10 20 01 mov 1, %i0 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000d1b4: 82 00 7f ff add %g1, -1, %g1 4000d1b8: c2 24 20 40 st %g1, [ %l0 + 0x40 ] ++stats->frees; 4000d1bc: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 4000d1c0: 82 00 60 01 inc %g1 4000d1c4: c2 24 20 50 st %g1, [ %l0 + 0x50 ] stats->free_size += block_size; 4000d1c8: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 4000d1cc: 84 00 40 02 add %g1, %g2, %g2 4000d1d0: c4 24 20 30 st %g2, [ %l0 + 0x30 ] return( true ); } 4000d1d4: 81 c7 e0 08 ret 4000d1d8: 81 e8 00 00 restore =============================================================================== 40014594 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 40014594: 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); 40014598: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 4001459c: 7f ff f9 ad call 40012c50 <.urem> 400145a0: 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 400145a4: 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); 400145a8: a2 06 7f f8 add %i1, -8, %l1 400145ac: 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); 400145b0: 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; 400145b4: 80 a2 00 02 cmp %o0, %g2 400145b8: 0a 80 00 05 bcs 400145cc <_Heap_Size_of_alloc_area+0x38> 400145bc: 82 10 20 00 clr %g1 400145c0: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 400145c4: 80 a0 40 08 cmp %g1, %o0 400145c8: 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 ) ) { 400145cc: 80 a0 60 00 cmp %g1, 0 400145d0: 02 80 00 15 be 40014624 <_Heap_Size_of_alloc_area+0x90> 400145d4: 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; 400145d8: e2 02 20 04 ld [ %o0 + 4 ], %l1 400145dc: 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); 400145e0: 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; 400145e4: 80 a4 40 02 cmp %l1, %g2 400145e8: 0a 80 00 05 bcs 400145fc <_Heap_Size_of_alloc_area+0x68> <== NEVER TAKEN 400145ec: 82 10 20 00 clr %g1 400145f0: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 400145f4: 80 a0 40 11 cmp %g1, %l1 400145f8: 82 60 3f ff subx %g0, -1, %g1 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 400145fc: 80 a0 60 00 cmp %g1, 0 40014600: 02 80 00 09 be 40014624 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 40014604: 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; 40014608: c2 04 60 04 ld [ %l1 + 4 ], %g1 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 4001460c: 80 88 60 01 btst 1, %g1 40014610: 02 80 00 05 be 40014624 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 40014614: a2 24 40 19 sub %l1, %i1, %l1 return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; 40014618: 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; 4001461c: a2 04 60 04 add %l1, 4, %l1 40014620: e2 26 80 00 st %l1, [ %i2 ] return true; } 40014624: 81 c7 e0 08 ret 40014628: 81 e8 00 00 restore =============================================================================== 40008cf8 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40008cf8: 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; 40008cfc: 23 10 00 23 sethi %hi(0x40008c00), %l1 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40008d00: a0 10 00 18 mov %i0, %l0 uintptr_t const page_size = heap->page_size; 40008d04: e4 06 20 10 ld [ %i0 + 0x10 ], %l2 uintptr_t const min_block_size = heap->min_block_size; 40008d08: e8 06 20 14 ld [ %i0 + 0x14 ], %l4 Heap_Block *const first_block = heap->first_block; 40008d0c: e6 06 20 20 ld [ %i0 + 0x20 ], %l3 Heap_Block *const last_block = heap->last_block; 40008d10: 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; 40008d14: 80 8e a0 ff btst 0xff, %i2 40008d18: 02 80 00 04 be 40008d28 <_Heap_Walk+0x30> 40008d1c: a2 14 60 a4 or %l1, 0xa4, %l1 40008d20: 23 10 00 23 sethi %hi(0x40008c00), %l1 40008d24: a2 14 60 ac or %l1, 0xac, %l1 ! 40008cac <_Heap_Walk_print> if ( !_System_state_Is_up( _System_state_Get() ) ) { 40008d28: 03 10 00 63 sethi %hi(0x40018c00), %g1 40008d2c: c2 00 61 68 ld [ %g1 + 0x168 ], %g1 ! 40018d68 <_System_state_Current> 40008d30: 80 a0 60 03 cmp %g1, 3 40008d34: 12 80 01 2d bne 400091e8 <_Heap_Walk+0x4f0> 40008d38: 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)( 40008d3c: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40008d40: da 04 20 18 ld [ %l0 + 0x18 ], %o5 40008d44: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40008d48: c2 04 20 08 ld [ %l0 + 8 ], %g1 40008d4c: e6 23 a0 60 st %l3, [ %sp + 0x60 ] 40008d50: c2 23 a0 68 st %g1, [ %sp + 0x68 ] 40008d54: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40008d58: ea 23 a0 64 st %l5, [ %sp + 0x64 ] 40008d5c: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40008d60: 90 10 00 19 mov %i1, %o0 40008d64: 92 10 20 00 clr %o1 40008d68: 15 10 00 58 sethi %hi(0x40016000), %o2 40008d6c: 96 10 00 12 mov %l2, %o3 40008d70: 94 12 a2 d0 or %o2, 0x2d0, %o2 40008d74: 9f c4 40 00 call %l1 40008d78: 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 ) { 40008d7c: 80 a4 a0 00 cmp %l2, 0 40008d80: 12 80 00 07 bne 40008d9c <_Heap_Walk+0xa4> 40008d84: 80 8c a0 07 btst 7, %l2 (*printer)( source, true, "page size is zero\n" ); 40008d88: 15 10 00 58 sethi %hi(0x40016000), %o2 40008d8c: 90 10 00 19 mov %i1, %o0 40008d90: 92 10 20 01 mov 1, %o1 40008d94: 10 80 00 38 b 40008e74 <_Heap_Walk+0x17c> 40008d98: 94 12 a3 68 or %o2, 0x368, %o2 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 40008d9c: 22 80 00 08 be,a 40008dbc <_Heap_Walk+0xc4> 40008da0: 90 10 00 14 mov %l4, %o0 (*printer)( 40008da4: 15 10 00 58 sethi %hi(0x40016000), %o2 40008da8: 90 10 00 19 mov %i1, %o0 40008dac: 92 10 20 01 mov 1, %o1 40008db0: 94 12 a3 80 or %o2, 0x380, %o2 40008db4: 10 80 01 0b b 400091e0 <_Heap_Walk+0x4e8> 40008db8: 96 10 00 12 mov %l2, %o3 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008dbc: 7f ff e3 4f call 40001af8 <.urem> 40008dc0: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 40008dc4: 80 a2 20 00 cmp %o0, 0 40008dc8: 22 80 00 08 be,a 40008de8 <_Heap_Walk+0xf0> 40008dcc: 90 04 e0 08 add %l3, 8, %o0 (*printer)( 40008dd0: 15 10 00 58 sethi %hi(0x40016000), %o2 40008dd4: 90 10 00 19 mov %i1, %o0 40008dd8: 92 10 20 01 mov 1, %o1 40008ddc: 94 12 a3 a0 or %o2, 0x3a0, %o2 40008de0: 10 80 01 00 b 400091e0 <_Heap_Walk+0x4e8> 40008de4: 96 10 00 14 mov %l4, %o3 40008de8: 7f ff e3 44 call 40001af8 <.urem> 40008dec: 92 10 00 12 mov %l2, %o1 ); return false; } if ( 40008df0: 80 a2 20 00 cmp %o0, 0 40008df4: 22 80 00 08 be,a 40008e14 <_Heap_Walk+0x11c> 40008df8: c2 04 e0 04 ld [ %l3 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 40008dfc: 15 10 00 58 sethi %hi(0x40016000), %o2 40008e00: 90 10 00 19 mov %i1, %o0 40008e04: 92 10 20 01 mov 1, %o1 40008e08: 94 12 a3 c8 or %o2, 0x3c8, %o2 40008e0c: 10 80 00 f5 b 400091e0 <_Heap_Walk+0x4e8> 40008e10: 96 10 00 13 mov %l3, %o3 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 40008e14: 80 88 60 01 btst 1, %g1 40008e18: 32 80 00 07 bne,a 40008e34 <_Heap_Walk+0x13c> 40008e1c: ec 05 60 04 ld [ %l5 + 4 ], %l6 (*printer)( 40008e20: 15 10 00 59 sethi %hi(0x40016400), %o2 40008e24: 90 10 00 19 mov %i1, %o0 40008e28: 92 10 20 01 mov 1, %o1 40008e2c: 10 80 00 12 b 40008e74 <_Heap_Walk+0x17c> 40008e30: 94 12 a0 00 mov %o2, %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; 40008e34: 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); 40008e38: 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; 40008e3c: c2 05 a0 04 ld [ %l6 + 4 ], %g1 ); return false; } if ( _Heap_Is_free( last_block ) ) { 40008e40: 80 88 60 01 btst 1, %g1 40008e44: 12 80 00 07 bne 40008e60 <_Heap_Walk+0x168> 40008e48: 80 a5 80 13 cmp %l6, %l3 (*printer)( 40008e4c: 15 10 00 59 sethi %hi(0x40016400), %o2 40008e50: 90 10 00 19 mov %i1, %o0 40008e54: 92 10 20 01 mov 1, %o1 40008e58: 10 80 00 07 b 40008e74 <_Heap_Walk+0x17c> 40008e5c: 94 12 a0 30 or %o2, 0x30, %o2 ); return false; } if ( 40008e60: 02 80 00 08 be 40008e80 <_Heap_Walk+0x188> 40008e64: 15 10 00 59 sethi %hi(0x40016400), %o2 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40008e68: 90 10 00 19 mov %i1, %o0 40008e6c: 92 10 20 01 mov 1, %o1 40008e70: 94 12 a0 48 or %o2, 0x48, %o2 40008e74: 9f c4 40 00 call %l1 40008e78: b0 10 20 00 clr %i0 40008e7c: 30 80 00 db b,a 400091e8 <_Heap_Walk+0x4f0> block = next_block; } while ( block != first_block ); return true; } 40008e80: 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; 40008e84: fa 04 20 10 ld [ %l0 + 0x10 ], %i5 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); 40008e88: ae 10 00 10 mov %l0, %l7 40008e8c: 10 80 00 32 b 40008f54 <_Heap_Walk+0x25c> 40008e90: 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; 40008e94: 80 a0 80 1c cmp %g2, %i4 40008e98: 18 80 00 05 bgu 40008eac <_Heap_Walk+0x1b4> 40008e9c: 82 10 20 00 clr %g1 40008ea0: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 40008ea4: 80 a0 40 1c cmp %g1, %i4 40008ea8: 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 ) ) { 40008eac: 80 a0 60 00 cmp %g1, 0 40008eb0: 32 80 00 08 bne,a 40008ed0 <_Heap_Walk+0x1d8> 40008eb4: 90 07 20 08 add %i4, 8, %o0 (*printer)( 40008eb8: 15 10 00 59 sethi %hi(0x40016400), %o2 40008ebc: 96 10 00 1c mov %i4, %o3 40008ec0: 90 10 00 19 mov %i1, %o0 40008ec4: 92 10 20 01 mov 1, %o1 40008ec8: 10 80 00 c6 b 400091e0 <_Heap_Walk+0x4e8> 40008ecc: 94 12 a0 78 or %o2, 0x78, %o2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008ed0: 7f ff e3 0a call 40001af8 <.urem> 40008ed4: 92 10 00 1d mov %i5, %o1 ); return false; } if ( 40008ed8: 80 a2 20 00 cmp %o0, 0 40008edc: 22 80 00 08 be,a 40008efc <_Heap_Walk+0x204> 40008ee0: c2 07 20 04 ld [ %i4 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 40008ee4: 15 10 00 59 sethi %hi(0x40016400), %o2 40008ee8: 96 10 00 1c mov %i4, %o3 40008eec: 90 10 00 19 mov %i1, %o0 40008ef0: 92 10 20 01 mov 1, %o1 40008ef4: 10 80 00 bb b 400091e0 <_Heap_Walk+0x4e8> 40008ef8: 94 12 a0 98 or %o2, 0x98, %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; 40008efc: 82 08 7f fe and %g1, -2, %g1 block = next_block; } while ( block != first_block ); return true; } 40008f00: 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; 40008f04: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 40008f08: 80 88 60 01 btst 1, %g1 40008f0c: 22 80 00 08 be,a 40008f2c <_Heap_Walk+0x234> 40008f10: d8 07 20 0c ld [ %i4 + 0xc ], %o4 (*printer)( 40008f14: 15 10 00 59 sethi %hi(0x40016400), %o2 40008f18: 96 10 00 1c mov %i4, %o3 40008f1c: 90 10 00 19 mov %i1, %o0 40008f20: 92 10 20 01 mov 1, %o1 40008f24: 10 80 00 af b 400091e0 <_Heap_Walk+0x4e8> 40008f28: 94 12 a0 c8 or %o2, 0xc8, %o2 ); return false; } if ( free_block->prev != prev_block ) { 40008f2c: 80 a3 00 17 cmp %o4, %l7 40008f30: 22 80 00 08 be,a 40008f50 <_Heap_Walk+0x258> 40008f34: ae 10 00 1c mov %i4, %l7 (*printer)( 40008f38: 15 10 00 59 sethi %hi(0x40016400), %o2 40008f3c: 96 10 00 1c mov %i4, %o3 40008f40: 90 10 00 19 mov %i1, %o0 40008f44: 92 10 20 01 mov 1, %o1 40008f48: 10 80 00 49 b 4000906c <_Heap_Walk+0x374> 40008f4c: 94 12 a0 e8 or %o2, 0xe8, %o2 return false; } prev_block = free_block; free_block = free_block->next; 40008f50: 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 ) { 40008f54: 80 a7 00 10 cmp %i4, %l0 40008f58: 32 bf ff cf bne,a 40008e94 <_Heap_Walk+0x19c> 40008f5c: c4 04 20 20 ld [ %l0 + 0x20 ], %g2 40008f60: 35 10 00 59 sethi %hi(0x40016400), %i2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 40008f64: 31 10 00 59 sethi %hi(0x40016400), %i0 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40008f68: b4 16 a2 a8 or %i2, 0x2a8, %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)( 40008f6c: b0 16 22 90 or %i0, 0x290, %i0 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40008f70: 37 10 00 59 sethi %hi(0x40016400), %i3 block = next_block; } while ( block != first_block ); return true; } 40008f74: 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; 40008f78: 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; 40008f7c: 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); 40008f80: 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; 40008f84: 80 a0 c0 1d cmp %g3, %i5 40008f88: 18 80 00 05 bgu 40008f9c <_Heap_Walk+0x2a4> <== NEVER TAKEN 40008f8c: 84 10 20 00 clr %g2 40008f90: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 40008f94: 80 a0 80 1d cmp %g2, %i5 40008f98: 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 ) ) { 40008f9c: 80 a0 a0 00 cmp %g2, 0 40008fa0: 12 80 00 07 bne 40008fbc <_Heap_Walk+0x2c4> 40008fa4: 84 1d 80 15 xor %l6, %l5, %g2 (*printer)( 40008fa8: 15 10 00 59 sethi %hi(0x40016400), %o2 40008fac: 90 10 00 19 mov %i1, %o0 40008fb0: 92 10 20 01 mov 1, %o1 40008fb4: 10 80 00 2c b 40009064 <_Heap_Walk+0x36c> 40008fb8: 94 12 a1 20 or %o2, 0x120, %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; 40008fbc: 80 a0 00 02 cmp %g0, %g2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008fc0: c2 27 bf fc st %g1, [ %fp + -4 ] 40008fc4: b8 40 20 00 addx %g0, 0, %i4 40008fc8: 90 10 00 17 mov %l7, %o0 40008fcc: 7f ff e2 cb call 40001af8 <.urem> 40008fd0: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 40008fd4: 80 a2 20 00 cmp %o0, 0 40008fd8: 02 80 00 0c be 40009008 <_Heap_Walk+0x310> 40008fdc: c2 07 bf fc ld [ %fp + -4 ], %g1 40008fe0: 80 8f 20 ff btst 0xff, %i4 40008fe4: 02 80 00 0a be 4000900c <_Heap_Walk+0x314> 40008fe8: 80 a5 c0 14 cmp %l7, %l4 (*printer)( 40008fec: 15 10 00 59 sethi %hi(0x40016400), %o2 40008ff0: 90 10 00 19 mov %i1, %o0 40008ff4: 92 10 20 01 mov 1, %o1 40008ff8: 94 12 a1 50 or %o2, 0x150, %o2 40008ffc: 96 10 00 16 mov %l6, %o3 40009000: 10 80 00 1b b 4000906c <_Heap_Walk+0x374> 40009004: 98 10 00 17 mov %l7, %o4 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 40009008: 80 a5 c0 14 cmp %l7, %l4 4000900c: 1a 80 00 0d bcc 40009040 <_Heap_Walk+0x348> 40009010: 80 a7 40 16 cmp %i5, %l6 40009014: 80 8f 20 ff btst 0xff, %i4 40009018: 02 80 00 0a be 40009040 <_Heap_Walk+0x348> <== NEVER TAKEN 4000901c: 80 a7 40 16 cmp %i5, %l6 (*printer)( 40009020: 15 10 00 59 sethi %hi(0x40016400), %o2 40009024: 90 10 00 19 mov %i1, %o0 40009028: 92 10 20 01 mov 1, %o1 4000902c: 94 12 a1 80 or %o2, 0x180, %o2 40009030: 96 10 00 16 mov %l6, %o3 40009034: 98 10 00 17 mov %l7, %o4 40009038: 10 80 00 3f b 40009134 <_Heap_Walk+0x43c> 4000903c: 9a 10 00 14 mov %l4, %o5 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 40009040: 38 80 00 0e bgu,a 40009078 <_Heap_Walk+0x380> 40009044: b8 08 60 01 and %g1, 1, %i4 40009048: 80 8f 20 ff btst 0xff, %i4 4000904c: 02 80 00 0b be 40009078 <_Heap_Walk+0x380> 40009050: b8 08 60 01 and %g1, 1, %i4 (*printer)( 40009054: 15 10 00 59 sethi %hi(0x40016400), %o2 40009058: 90 10 00 19 mov %i1, %o0 4000905c: 92 10 20 01 mov 1, %o1 40009060: 94 12 a1 b0 or %o2, 0x1b0, %o2 40009064: 96 10 00 16 mov %l6, %o3 40009068: 98 10 00 1d mov %i5, %o4 4000906c: 9f c4 40 00 call %l1 40009070: b0 10 20 00 clr %i0 40009074: 30 80 00 5d b,a 400091e8 <_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; 40009078: c2 07 60 04 ld [ %i5 + 4 ], %g1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 4000907c: 80 88 60 01 btst 1, %g1 40009080: 12 80 00 3f bne 4000917c <_Heap_Walk+0x484> 40009084: 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 ? 40009088: 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)( 4000908c: c2 04 20 08 ld [ %l0 + 8 ], %g1 40009090: 05 10 00 58 sethi %hi(0x40016000), %g2 block = next_block; } while ( block != first_block ); return true; } 40009094: 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)( 40009098: 80 a3 40 01 cmp %o5, %g1 4000909c: 02 80 00 07 be 400090b8 <_Heap_Walk+0x3c0> 400090a0: 86 10 a2 90 or %g2, 0x290, %g3 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 400090a4: 80 a3 40 10 cmp %o5, %l0 400090a8: 12 80 00 04 bne 400090b8 <_Heap_Walk+0x3c0> 400090ac: 86 16 e2 58 or %i3, 0x258, %g3 400090b0: 19 10 00 58 sethi %hi(0x40016000), %o4 400090b4: 86 13 22 a0 or %o4, 0x2a0, %g3 ! 400162a0 <_Status_Object_name_errors_to_status+0x48> block->next, block->next == last_free_block ? 400090b8: 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)( 400090bc: 19 10 00 58 sethi %hi(0x40016000), %o4 400090c0: 80 a0 80 04 cmp %g2, %g4 400090c4: 02 80 00 07 be 400090e0 <_Heap_Walk+0x3e8> 400090c8: 82 13 22 b0 or %o4, 0x2b0, %g1 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 400090cc: 80 a0 80 10 cmp %g2, %l0 400090d0: 12 80 00 04 bne 400090e0 <_Heap_Walk+0x3e8> 400090d4: 82 16 e2 58 or %i3, 0x258, %g1 400090d8: 09 10 00 58 sethi %hi(0x40016000), %g4 400090dc: 82 11 22 c0 or %g4, 0x2c0, %g1 ! 400162c0 <_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)( 400090e0: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 400090e4: c4 23 a0 60 st %g2, [ %sp + 0x60 ] 400090e8: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 400090ec: 90 10 00 19 mov %i1, %o0 400090f0: 92 10 20 00 clr %o1 400090f4: 15 10 00 59 sethi %hi(0x40016400), %o2 400090f8: 96 10 00 16 mov %l6, %o3 400090fc: 94 12 a1 e8 or %o2, 0x1e8, %o2 40009100: 9f c4 40 00 call %l1 40009104: 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 ) { 40009108: da 07 40 00 ld [ %i5 ], %o5 4000910c: 80 a5 c0 0d cmp %l7, %o5 40009110: 02 80 00 0c be 40009140 <_Heap_Walk+0x448> 40009114: 80 a7 20 00 cmp %i4, 0 (*printer)( 40009118: 15 10 00 59 sethi %hi(0x40016400), %o2 4000911c: fa 23 a0 5c st %i5, [ %sp + 0x5c ] 40009120: 90 10 00 19 mov %i1, %o0 40009124: 92 10 20 01 mov 1, %o1 40009128: 94 12 a2 20 or %o2, 0x220, %o2 4000912c: 96 10 00 16 mov %l6, %o3 40009130: 98 10 00 17 mov %l7, %o4 40009134: 9f c4 40 00 call %l1 40009138: b0 10 20 00 clr %i0 4000913c: 30 80 00 2b b,a 400091e8 <_Heap_Walk+0x4f0> ); return false; } if ( !prev_used ) { 40009140: 32 80 00 0a bne,a 40009168 <_Heap_Walk+0x470> 40009144: c2 04 20 08 ld [ %l0 + 8 ], %g1 (*printer)( 40009148: 15 10 00 59 sethi %hi(0x40016400), %o2 4000914c: 90 10 00 19 mov %i1, %o0 40009150: 92 10 20 01 mov 1, %o1 40009154: 10 80 00 22 b 400091dc <_Heap_Walk+0x4e4> 40009158: 94 12 a2 60 or %o2, 0x260, %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 ) { 4000915c: 02 80 00 19 be 400091c0 <_Heap_Walk+0x4c8> 40009160: 80 a7 40 13 cmp %i5, %l3 return true; } free_block = free_block->next; 40009164: 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 ) { 40009168: 80 a0 40 10 cmp %g1, %l0 4000916c: 12 bf ff fc bne 4000915c <_Heap_Walk+0x464> 40009170: 80 a0 40 16 cmp %g1, %l6 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 40009174: 10 80 00 17 b 400091d0 <_Heap_Walk+0x4d8> 40009178: 15 10 00 59 sethi %hi(0x40016400), %o2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 4000917c: 22 80 00 0a be,a 400091a4 <_Heap_Walk+0x4ac> 40009180: da 05 80 00 ld [ %l6 ], %o5 (*printer)( 40009184: 90 10 00 19 mov %i1, %o0 40009188: 92 10 20 00 clr %o1 4000918c: 94 10 00 18 mov %i0, %o2 40009190: 96 10 00 16 mov %l6, %o3 40009194: 9f c4 40 00 call %l1 40009198: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 4000919c: 10 80 00 09 b 400091c0 <_Heap_Walk+0x4c8> 400091a0: 80 a7 40 13 cmp %i5, %l3 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 400091a4: 90 10 00 19 mov %i1, %o0 400091a8: 92 10 20 00 clr %o1 400091ac: 94 10 00 1a mov %i2, %o2 400091b0: 96 10 00 16 mov %l6, %o3 400091b4: 9f c4 40 00 call %l1 400091b8: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 400091bc: 80 a7 40 13 cmp %i5, %l3 400091c0: 12 bf ff 6d bne 40008f74 <_Heap_Walk+0x27c> 400091c4: ac 10 00 1d mov %i5, %l6 return true; } 400091c8: 81 c7 e0 08 ret 400091cc: 91 e8 20 01 restore %g0, 1, %o0 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 400091d0: 90 10 00 19 mov %i1, %o0 400091d4: 92 10 20 01 mov 1, %o1 400091d8: 94 12 a2 d0 or %o2, 0x2d0, %o2 400091dc: 96 10 00 16 mov %l6, %o3 400091e0: 9f c4 40 00 call %l1 400091e4: b0 10 20 00 clr %i0 400091e8: 81 c7 e0 08 ret 400091ec: 81 e8 00 00 restore =============================================================================== 40007e40 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40007e40: 9d e3 bf a0 save %sp, -96, %sp _Internal_errors_What_happened.the_source = the_source; 40007e44: 05 10 00 59 sethi %hi(0x40016400), %g2 40007e48: 82 10 a1 b4 or %g2, 0x1b4, %g1 ! 400165b4 <_Internal_errors_What_happened> void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40007e4c: 90 10 00 18 mov %i0, %o0 40007e50: 94 10 00 1a mov %i2, %o2 _Internal_errors_What_happened.the_source = the_source; 40007e54: f0 20 a1 b4 st %i0, [ %g2 + 0x1b4 ] _Internal_errors_What_happened.is_internal = is_internal; 40007e58: f2 28 60 04 stb %i1, [ %g1 + 4 ] _Internal_errors_What_happened.the_error = the_error; 40007e5c: f4 20 60 08 st %i2, [ %g1 + 8 ] _User_extensions_Fatal( the_source, is_internal, the_error ); 40007e60: 40 00 08 17 call 40009ebc <_User_extensions_Fatal> 40007e64: 92 0e 60 ff and %i1, 0xff, %o1 RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 40007e68: 84 10 20 05 mov 5, %g2 <== NOT EXECUTED 40007e6c: 03 10 00 59 sethi %hi(0x40016400), %g1 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 40007e70: 7f ff e7 c1 call 40001d74 <== NOT EXECUTED 40007e74: c4 20 62 78 st %g2, [ %g1 + 0x278 ] ! 40016678 <_System_state_Current><== NOT EXECUTED 40007e78: 82 10 00 08 mov %o0, %g1 <== NOT EXECUTED 40007e7c: 30 80 00 00 b,a 40007e7c <_Internal_error_Occurred+0x3c> <== NOT EXECUTED =============================================================================== 40007ef0 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007ef0: 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 ) 40007ef4: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007ef8: 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 ) 40007efc: 80 a0 60 00 cmp %g1, 0 40007f00: 02 80 00 20 be 40007f80 <_Objects_Allocate+0x90> <== NEVER TAKEN 40007f04: 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 ); 40007f08: a2 04 20 20 add %l0, 0x20, %l1 40007f0c: 7f ff fd 8b call 40007538 <_Chain_Get> 40007f10: 90 10 00 11 mov %l1, %o0 if ( information->auto_extend ) { 40007f14: c2 0c 20 12 ldub [ %l0 + 0x12 ], %g1 40007f18: 80 a0 60 00 cmp %g1, 0 40007f1c: 02 80 00 19 be 40007f80 <_Objects_Allocate+0x90> 40007f20: 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 ) { 40007f24: 80 a2 20 00 cmp %o0, 0 40007f28: 32 80 00 0a bne,a 40007f50 <_Objects_Allocate+0x60> 40007f2c: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 _Objects_Extend_information( information ); 40007f30: 40 00 00 1e call 40007fa8 <_Objects_Extend_information> 40007f34: 90 10 00 10 mov %l0, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 40007f38: 7f ff fd 80 call 40007538 <_Chain_Get> 40007f3c: 90 10 00 11 mov %l1, %o0 } if ( the_object ) { 40007f40: b0 92 20 00 orcc %o0, 0, %i0 40007f44: 02 80 00 0f be 40007f80 <_Objects_Allocate+0x90> 40007f48: 01 00 00 00 nop uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 40007f4c: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 40007f50: d0 16 20 0a lduh [ %i0 + 0xa ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 40007f54: d2 14 20 14 lduh [ %l0 + 0x14 ], %o1 40007f58: 40 00 2a 92 call 400129a0 <.udiv> 40007f5c: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 40007f60: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 40007f64: 91 2a 20 02 sll %o0, 2, %o0 40007f68: c4 00 40 08 ld [ %g1 + %o0 ], %g2 40007f6c: 84 00 bf ff add %g2, -1, %g2 40007f70: c4 20 40 08 st %g2, [ %g1 + %o0 ] information->inactive--; 40007f74: c2 14 20 2c lduh [ %l0 + 0x2c ], %g1 40007f78: 82 00 7f ff add %g1, -1, %g1 40007f7c: c2 34 20 2c sth %g1, [ %l0 + 0x2c ] ); } #endif return the_object; } 40007f80: 81 c7 e0 08 ret 40007f84: 81 e8 00 00 restore =============================================================================== 400082f8 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 400082f8: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 400082fc: b3 2e 60 10 sll %i1, 0x10, %i1 40008300: b3 36 60 10 srl %i1, 0x10, %i1 40008304: 80 a6 60 00 cmp %i1, 0 40008308: 02 80 00 17 be 40008364 <_Objects_Get_information+0x6c> 4000830c: 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 ); 40008310: 40 00 13 b3 call 4000d1dc <_Objects_API_maximum_class> 40008314: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 40008318: 80 a2 20 00 cmp %o0, 0 4000831c: 02 80 00 12 be 40008364 <_Objects_Get_information+0x6c> 40008320: 80 a6 40 08 cmp %i1, %o0 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 40008324: 18 80 00 10 bgu 40008364 <_Objects_Get_information+0x6c> 40008328: 03 10 00 59 sethi %hi(0x40016400), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 4000832c: b1 2e 20 02 sll %i0, 2, %i0 40008330: 82 10 60 88 or %g1, 0x88, %g1 40008334: c2 00 40 18 ld [ %g1 + %i0 ], %g1 40008338: 80 a0 60 00 cmp %g1, 0 4000833c: 02 80 00 0a be 40008364 <_Objects_Get_information+0x6c> <== NEVER TAKEN 40008340: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 40008344: e0 00 40 19 ld [ %g1 + %i1 ], %l0 if ( !info ) 40008348: 80 a4 20 00 cmp %l0, 0 4000834c: 02 80 00 06 be 40008364 <_Objects_Get_information+0x6c> <== NEVER TAKEN 40008350: 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 ) 40008354: c2 14 20 10 lduh [ %l0 + 0x10 ], %g1 return NULL; 40008358: 80 a0 00 01 cmp %g0, %g1 4000835c: 82 60 20 00 subx %g0, 0, %g1 40008360: a0 0c 00 01 and %l0, %g1, %l0 #endif return info; } 40008364: 81 c7 e0 08 ret 40008368: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40019cdc <_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; 40019cdc: c2 02 20 08 ld [ %o0 + 8 ], %g1 if ( information->maximum >= index ) { 40019ce0: 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; 40019ce4: 82 22 40 01 sub %o1, %g1, %g1 40019ce8: 82 00 60 01 inc %g1 if ( information->maximum >= index ) { 40019cec: 80 a0 80 01 cmp %g2, %g1 40019cf0: 0a 80 00 09 bcs 40019d14 <_Objects_Get_no_protection+0x38> 40019cf4: 83 28 60 02 sll %g1, 2, %g1 if ( (the_object = information->local_table[ index ]) != NULL ) { 40019cf8: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 40019cfc: d0 00 80 01 ld [ %g2 + %g1 ], %o0 40019d00: 80 a2 20 00 cmp %o0, 0 40019d04: 02 80 00 05 be 40019d18 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 40019d08: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 40019d0c: 81 c3 e0 08 retl 40019d10: 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; 40019d14: 82 10 20 01 mov 1, %g1 return NULL; 40019d18: 90 10 20 00 clr %o0 } 40019d1c: 81 c3 e0 08 retl 40019d20: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 40009bd4 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 40009bd4: 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; 40009bd8: 92 96 20 00 orcc %i0, 0, %o1 40009bdc: 12 80 00 06 bne 40009bf4 <_Objects_Id_to_name+0x20> 40009be0: 83 32 60 18 srl %o1, 0x18, %g1 40009be4: 03 10 00 82 sethi %hi(0x40020800), %g1 40009be8: c2 00 62 14 ld [ %g1 + 0x214 ], %g1 ! 40020a14 <_Per_CPU_Information+0xc> 40009bec: d2 00 60 08 ld [ %g1 + 8 ], %o1 40009bf0: 83 32 60 18 srl %o1, 0x18, %g1 40009bf4: 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 ) 40009bf8: 84 00 7f ff add %g1, -1, %g2 40009bfc: 80 a0 a0 02 cmp %g2, 2 40009c00: 18 80 00 16 bgu 40009c58 <_Objects_Id_to_name+0x84> 40009c04: 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 ] ) 40009c08: 10 80 00 16 b 40009c60 <_Objects_Id_to_name+0x8c> 40009c0c: 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 ]; 40009c10: 85 28 a0 02 sll %g2, 2, %g2 40009c14: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 40009c18: 80 a2 20 00 cmp %o0, 0 40009c1c: 02 80 00 0f be 40009c58 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40009c20: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 40009c24: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 40009c28: 80 a0 60 00 cmp %g1, 0 40009c2c: 12 80 00 0b bne 40009c58 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40009c30: 01 00 00 00 nop return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 40009c34: 7f ff ff cb call 40009b60 <_Objects_Get> 40009c38: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 40009c3c: 80 a2 20 00 cmp %o0, 0 40009c40: 02 80 00 06 be 40009c58 <_Objects_Id_to_name+0x84> 40009c44: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 40009c48: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 40009c4c: 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(); 40009c50: 40 00 03 68 call 4000a9f0 <_Thread_Enable_dispatch> 40009c54: c2 26 40 00 st %g1, [ %i1 ] return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 40009c58: 81 c7 e0 08 ret 40009c5c: 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 ] ) 40009c60: 05 10 00 81 sethi %hi(0x40020400), %g2 40009c64: 84 10 a0 38 or %g2, 0x38, %g2 ! 40020438 <_Objects_Information_table> 40009c68: c2 00 80 01 ld [ %g2 + %g1 ], %g1 40009c6c: 80 a0 60 00 cmp %g1, 0 40009c70: 12 bf ff e8 bne 40009c10 <_Objects_Id_to_name+0x3c> 40009c74: 85 32 60 1b srl %o1, 0x1b, %g2 40009c78: 30 bf ff f8 b,a 40009c58 <_Objects_Id_to_name+0x84> =============================================================================== 4000bbac <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4000bbac: 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( 4000bbb0: 11 10 00 a3 sethi %hi(0x40028c00), %o0 4000bbb4: 92 10 00 18 mov %i0, %o1 4000bbb8: 90 12 21 8c or %o0, 0x18c, %o0 4000bbbc: 40 00 0c 94 call 4000ee0c <_Objects_Get> 4000bbc0: 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 ) { 4000bbc4: c2 07 bf fc ld [ %fp + -4 ], %g1 4000bbc8: 80 a0 60 00 cmp %g1, 0 4000bbcc: 12 80 00 3f bne 4000bcc8 <_POSIX_Message_queue_Receive_support+0x11c> 4000bbd0: 01 00 00 00 nop case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 4000bbd4: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000bbd8: 84 08 60 03 and %g1, 3, %g2 4000bbdc: 80 a0 a0 01 cmp %g2, 1 4000bbe0: 32 80 00 08 bne,a 4000bc00 <_POSIX_Message_queue_Receive_support+0x54> 4000bbe4: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 _Thread_Enable_dispatch(); 4000bbe8: 40 00 0f f5 call 4000fbbc <_Thread_Enable_dispatch> 4000bbec: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EBADF ); 4000bbf0: 40 00 2a 06 call 40016408 <__errno> 4000bbf4: 01 00 00 00 nop 4000bbf8: 10 80 00 0b b 4000bc24 <_POSIX_Message_queue_Receive_support+0x78> 4000bbfc: 82 10 20 09 mov 9, %g1 ! 9 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 4000bc00: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 4000bc04: 80 a6 80 02 cmp %i2, %g2 4000bc08: 1a 80 00 09 bcc 4000bc2c <_POSIX_Message_queue_Receive_support+0x80> 4000bc0c: 84 10 3f ff mov -1, %g2 _Thread_Enable_dispatch(); 4000bc10: 40 00 0f eb call 4000fbbc <_Thread_Enable_dispatch> 4000bc14: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EMSGSIZE ); 4000bc18: 40 00 29 fc call 40016408 <__errno> 4000bc1c: 01 00 00 00 nop 4000bc20: 82 10 20 7a mov 0x7a, %g1 ! 7a 4000bc24: 10 80 00 27 b 4000bcc0 <_POSIX_Message_queue_Receive_support+0x114> 4000bc28: 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; 4000bc2c: c4 27 bf f8 st %g2, [ %fp + -8 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000bc30: 80 8f 20 ff btst 0xff, %i4 4000bc34: 02 80 00 06 be 4000bc4c <_POSIX_Message_queue_Receive_support+0xa0><== NEVER TAKEN 4000bc38: 98 10 20 00 clr %o4 do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000bc3c: 05 00 00 10 sethi %hi(0x4000), %g2 4000bc40: 82 08 40 02 and %g1, %g2, %g1 4000bc44: 80 a0 00 01 cmp %g0, %g1 4000bc48: 98 60 3f ff subx %g0, -1, %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4000bc4c: 9a 10 00 1d mov %i5, %o5 4000bc50: 90 02 20 1c add %o0, 0x1c, %o0 4000bc54: 92 10 00 18 mov %i0, %o1 4000bc58: 94 10 00 19 mov %i1, %o2 4000bc5c: 96 07 bf f8 add %fp, -8, %o3 4000bc60: 40 00 08 3c call 4000dd50 <_CORE_message_queue_Seize> 4000bc64: 98 0b 20 01 and %o4, 1, %o4 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 4000bc68: 40 00 0f d5 call 4000fbbc <_Thread_Enable_dispatch> 4000bc6c: 3b 10 00 a3 sethi %hi(0x40028c00), %i5 *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4000bc70: ba 17 61 f8 or %i5, 0x1f8, %i5 ! 40028df8 <_Per_CPU_Information> 4000bc74: 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); 4000bc78: c6 00 60 24 ld [ %g1 + 0x24 ], %g3 if ( !_Thread_Executing->Wait.return_code ) 4000bc7c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 4000bc80: 85 38 e0 1f sra %g3, 0x1f, %g2 4000bc84: 86 18 80 03 xor %g2, %g3, %g3 4000bc88: 84 20 c0 02 sub %g3, %g2, %g2 4000bc8c: 80 a0 60 00 cmp %g1, 0 4000bc90: 12 80 00 05 bne 4000bca4 <_POSIX_Message_queue_Receive_support+0xf8> 4000bc94: c4 26 c0 00 st %g2, [ %i3 ] return length_out; 4000bc98: f0 07 bf f8 ld [ %fp + -8 ], %i0 4000bc9c: 81 c7 e0 08 ret 4000bca0: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one( 4000bca4: 40 00 29 d9 call 40016408 <__errno> 4000bca8: 01 00 00 00 nop 4000bcac: c2 07 60 0c ld [ %i5 + 0xc ], %g1 4000bcb0: b8 10 00 08 mov %o0, %i4 4000bcb4: 40 00 00 9c call 4000bf24 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000bcb8: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000bcbc: d0 27 00 00 st %o0, [ %i4 ] 4000bcc0: 81 c7 e0 08 ret 4000bcc4: 91 e8 3f ff restore %g0, -1, %o0 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000bcc8: 40 00 29 d0 call 40016408 <__errno> 4000bccc: b0 10 3f ff mov -1, %i0 4000bcd0: 82 10 20 09 mov 9, %g1 4000bcd4: c2 22 00 00 st %g1, [ %o0 ] } 4000bcd8: 81 c7 e0 08 ret 4000bcdc: 81 e8 00 00 restore =============================================================================== 4000c250 <_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 ]; 4000c250: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000c254: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 4000c258: 80 a0 a0 00 cmp %g2, 0 4000c25c: 12 80 00 12 bne 4000c2a4 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54><== NEVER TAKEN 4000c260: 01 00 00 00 nop 4000c264: c4 00 60 dc ld [ %g1 + 0xdc ], %g2 4000c268: 80 a0 a0 01 cmp %g2, 1 4000c26c: 12 80 00 0e bne 4000c2a4 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000c270: 01 00 00 00 nop thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 4000c274: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 4000c278: 80 a0 60 00 cmp %g1, 0 4000c27c: 02 80 00 0a be 4000c2a4 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000c280: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000c284: 03 10 00 5e sethi %hi(0x40017800), %g1 4000c288: c4 00 61 70 ld [ %g1 + 0x170 ], %g2 ! 40017970 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 4000c28c: 92 10 3f ff mov -1, %o1 4000c290: 84 00 bf ff add %g2, -1, %g2 4000c294: c4 20 61 70 st %g2, [ %g1 + 0x170 ] 4000c298: 82 13 c0 00 mov %o7, %g1 4000c29c: 40 00 01 f8 call 4000ca7c <_POSIX_Thread_Exit> 4000c2a0: 9e 10 40 00 mov %g1, %o7 } else _Thread_Enable_dispatch(); 4000c2a4: 82 13 c0 00 mov %o7, %g1 4000c2a8: 7f ff f4 9d call 4000951c <_Thread_Enable_dispatch> 4000c2ac: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000d6e8 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4000d6e8: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4000d6ec: d0 06 40 00 ld [ %i1 ], %o0 4000d6f0: 7f ff ff f3 call 4000d6bc <_POSIX_Priority_Is_valid> 4000d6f4: a0 10 00 18 mov %i0, %l0 4000d6f8: 80 8a 20 ff btst 0xff, %o0 4000d6fc: 02 80 00 11 be 4000d740 <_POSIX_Thread_Translate_sched_param+0x58><== NEVER TAKEN 4000d700: b0 10 20 16 mov 0x16, %i0 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4000d704: c0 26 80 00 clr [ %i2 ] *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 4000d708: 80 a4 20 00 cmp %l0, 0 4000d70c: 12 80 00 06 bne 4000d724 <_POSIX_Thread_Translate_sched_param+0x3c> 4000d710: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000d714: 82 10 20 01 mov 1, %g1 4000d718: c2 26 80 00 st %g1, [ %i2 ] return 0; 4000d71c: 81 c7 e0 08 ret 4000d720: 91 e8 20 00 restore %g0, 0, %o0 } if ( policy == SCHED_FIFO ) { 4000d724: 80 a4 20 01 cmp %l0, 1 4000d728: 02 80 00 06 be 4000d740 <_POSIX_Thread_Translate_sched_param+0x58> 4000d72c: b0 10 20 00 clr %i0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 4000d730: 80 a4 20 02 cmp %l0, 2 4000d734: 32 80 00 05 bne,a 4000d748 <_POSIX_Thread_Translate_sched_param+0x60> 4000d738: 80 a4 20 04 cmp %l0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 4000d73c: e0 26 80 00 st %l0, [ %i2 ] return 0; 4000d740: 81 c7 e0 08 ret 4000d744: 81 e8 00 00 restore } if ( policy == SCHED_SPORADIC ) { 4000d748: 12 bf ff fe bne 4000d740 <_POSIX_Thread_Translate_sched_param+0x58> 4000d74c: b0 10 20 16 mov 0x16, %i0 if ( (param->sched_ss_repl_period.tv_sec == 0) && 4000d750: c2 06 60 08 ld [ %i1 + 8 ], %g1 4000d754: 80 a0 60 00 cmp %g1, 0 4000d758: 32 80 00 07 bne,a 4000d774 <_POSIX_Thread_Translate_sched_param+0x8c> 4000d75c: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d760: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000d764: 80 a0 60 00 cmp %g1, 0 4000d768: 02 80 00 1d be 4000d7dc <_POSIX_Thread_Translate_sched_param+0xf4> 4000d76c: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4000d770: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d774: 80 a0 60 00 cmp %g1, 0 4000d778: 12 80 00 06 bne 4000d790 <_POSIX_Thread_Translate_sched_param+0xa8> 4000d77c: 01 00 00 00 nop 4000d780: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000d784: 80 a0 60 00 cmp %g1, 0 4000d788: 02 bf ff ee be 4000d740 <_POSIX_Thread_Translate_sched_param+0x58> 4000d78c: 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 ) < 4000d790: 7f ff f5 c7 call 4000aeac <_Timespec_To_ticks> 4000d794: 90 06 60 08 add %i1, 8, %o0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; 4000d798: 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 ) < 4000d79c: a0 10 00 08 mov %o0, %l0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 4000d7a0: 7f ff f5 c3 call 4000aeac <_Timespec_To_ticks> 4000d7a4: 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 ) < 4000d7a8: 80 a4 00 08 cmp %l0, %o0 4000d7ac: 0a 80 00 0c bcs 4000d7dc <_POSIX_Thread_Translate_sched_param+0xf4> 4000d7b0: 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 ) ) 4000d7b4: 7f ff ff c2 call 4000d6bc <_POSIX_Priority_Is_valid> 4000d7b8: d0 06 60 04 ld [ %i1 + 4 ], %o0 4000d7bc: 80 8a 20 ff btst 0xff, %o0 4000d7c0: 02 bf ff e0 be 4000d740 <_POSIX_Thread_Translate_sched_param+0x58> 4000d7c4: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4000d7c8: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; 4000d7cc: 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; 4000d7d0: 03 10 00 1c sethi %hi(0x40007000), %g1 4000d7d4: 82 10 62 48 or %g1, 0x248, %g1 ! 40007248 <_POSIX_Threads_Sporadic_budget_callout> 4000d7d8: c2 26 c0 00 st %g1, [ %i3 ] return 0; } return EINVAL; } 4000d7dc: 81 c7 e0 08 ret 4000d7e0: 81 e8 00 00 restore =============================================================================== 40006f88 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 40006f88: 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; 40006f8c: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40006f90: 82 10 60 9c or %g1, 0x9c, %g1 ! 4001ec9c maximum = Configuration_POSIX_API.number_of_initialization_threads; 40006f94: e6 00 60 30 ld [ %g1 + 0x30 ], %l3 if ( !user_threads || maximum == 0 ) 40006f98: 80 a4 e0 00 cmp %l3, 0 40006f9c: 02 80 00 1d be 40007010 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 40006fa0: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 40006fa4: 80 a4 60 00 cmp %l1, 0 40006fa8: 02 80 00 1a be 40007010 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 40006fac: 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 ); 40006fb0: 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( 40006fb4: 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 ); 40006fb8: 40 00 1a 0b call 4000d7e4 40006fbc: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 40006fc0: 92 10 20 02 mov 2, %o1 40006fc4: 40 00 1a 14 call 4000d814 40006fc8: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 40006fcc: d2 04 60 04 ld [ %l1 + 4 ], %o1 40006fd0: 40 00 1a 20 call 4000d850 40006fd4: 90 10 00 10 mov %l0, %o0 status = pthread_create( 40006fd8: d4 04 40 00 ld [ %l1 ], %o2 40006fdc: 90 10 00 14 mov %l4, %o0 40006fe0: 92 10 00 10 mov %l0, %o1 40006fe4: 7f ff ff 36 call 40006cbc 40006fe8: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 40006fec: 94 92 20 00 orcc %o0, 0, %o2 40006ff0: 22 80 00 05 be,a 40007004 <_POSIX_Threads_Initialize_user_threads_body+0x7c> 40006ff4: a4 04 a0 01 inc %l2 _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 40006ff8: 90 10 20 02 mov 2, %o0 40006ffc: 40 00 07 f3 call 40008fc8 <_Internal_error_Occurred> 40007000: 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++ ) { 40007004: 80 a4 80 13 cmp %l2, %l3 40007008: 0a bf ff ec bcs 40006fb8 <_POSIX_Threads_Initialize_user_threads_body+0x30><== NEVER TAKEN 4000700c: a2 04 60 08 add %l1, 8, %l1 40007010: 81 c7 e0 08 ret 40007014: 81 e8 00 00 restore =============================================================================== 4000c590 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 4000c590: 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 ]; 4000c594: 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 ); 4000c598: 40 00 03 ce call 4000d4d0 <_Timespec_To_ticks> 4000c59c: 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); 4000c5a0: 03 10 00 56 sethi %hi(0x40015800), %g1 4000c5a4: d2 08 62 34 ldub [ %g1 + 0x234 ], %o1 ! 40015a34 4000c5a8: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->cpu_time_budget = ticks; 4000c5ac: d0 26 60 78 st %o0, [ %i1 + 0x78 ] 4000c5b0: 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 ) { 4000c5b4: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 4000c5b8: 80 a0 60 00 cmp %g1, 0 4000c5bc: 12 80 00 08 bne 4000c5dc <_POSIX_Threads_Sporadic_budget_TSR+0x4c><== NEVER TAKEN 4000c5c0: 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 ) { 4000c5c4: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000c5c8: 80 a0 40 09 cmp %g1, %o1 4000c5cc: 08 80 00 04 bleu 4000c5dc <_POSIX_Threads_Sporadic_budget_TSR+0x4c> 4000c5d0: 90 10 00 19 mov %i1, %o0 _Thread_Change_priority( the_thread, new_priority, true ); 4000c5d4: 7f ff f1 f1 call 40008d98 <_Thread_Change_priority> 4000c5d8: 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 ); 4000c5dc: 40 00 03 bd call 4000d4d0 <_Timespec_To_ticks> 4000c5e0: 90 04 20 90 add %l0, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000c5e4: 31 10 00 59 sethi %hi(0x40016400), %i0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000c5e8: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000c5ec: b0 16 21 e0 or %i0, 0x1e0, %i0 4000c5f0: 7f ff f6 91 call 4000a034 <_Watchdog_Insert> 4000c5f4: 93 ec 20 a8 restore %l0, 0xa8, %o1 =============================================================================== 4000c5fc <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000c5fc: 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 */ 4000c600: 86 10 3f ff mov -1, %g3 4000c604: c4 00 a0 8c ld [ %g2 + 0x8c ], %g2 4000c608: c6 22 20 78 st %g3, [ %o0 + 0x78 ] 4000c60c: 07 10 00 56 sethi %hi(0x40015800), %g3 4000c610: d2 08 e2 34 ldub [ %g3 + 0x234 ], %o1 ! 40015a34 4000c614: 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 ) { 4000c618: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 4000c61c: 80 a0 a0 00 cmp %g2, 0 4000c620: 12 80 00 09 bne 4000c644 <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000c624: 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 ) { 4000c628: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000c62c: 80 a0 40 09 cmp %g1, %o1 4000c630: 1a 80 00 05 bcc 4000c644 <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000c634: 94 10 20 01 mov 1, %o2 _Thread_Change_priority( the_thread, new_priority, true ); 4000c638: 82 13 c0 00 mov %o7, %g1 4000c63c: 7f ff f1 d7 call 40008d98 <_Thread_Change_priority> 4000c640: 9e 10 40 00 mov %g1, %o7 4000c644: 81 c3 e0 08 retl <== NOT EXECUTED =============================================================================== 40006cc8 <_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) { 40006cc8: 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; 40006ccc: c2 06 60 68 ld [ %i1 + 0x68 ], %g1 40006cd0: 82 00 60 01 inc %g1 40006cd4: c2 26 60 68 st %g1, [ %i1 + 0x68 ] /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 40006cd8: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 40006cdc: 80 a0 60 00 cmp %g1, 0 40006ce0: 32 80 00 07 bne,a 40006cfc <_POSIX_Timer_TSR+0x34> 40006ce4: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40006ce8: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 40006cec: 80 a0 60 00 cmp %g1, 0 40006cf0: 02 80 00 0f be 40006d2c <_POSIX_Timer_TSR+0x64> <== NEVER TAKEN 40006cf4: 82 10 20 04 mov 4, %g1 ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 40006cf8: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40006cfc: d4 06 60 08 ld [ %i1 + 8 ], %o2 40006d00: 90 06 60 10 add %i1, 0x10, %o0 40006d04: 17 10 00 1b sethi %hi(0x40006c00), %o3 40006d08: 98 10 00 19 mov %i1, %o4 40006d0c: 40 00 19 b8 call 4000d3ec <_POSIX_Timer_Insert_helper> 40006d10: 96 12 e0 c8 or %o3, 0xc8, %o3 ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 40006d14: 80 8a 20 ff btst 0xff, %o0 40006d18: 02 80 00 0a be 40006d40 <_POSIX_Timer_TSR+0x78> <== NEVER TAKEN 40006d1c: 01 00 00 00 nop return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 40006d20: 40 00 05 c0 call 40008420 <_TOD_Get> 40006d24: 90 06 60 6c add %i1, 0x6c, %o0 40006d28: 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 ) ) { 40006d2c: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 40006d30: d2 06 60 44 ld [ %i1 + 0x44 ], %o1 40006d34: 40 00 18 99 call 4000cf98 40006d38: 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; 40006d3c: c0 26 60 68 clr [ %i1 + 0x68 ] 40006d40: 81 c7 e0 08 ret 40006d44: 81 e8 00 00 restore =============================================================================== 4000e8ac <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000e8ac: 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, 4000e8b0: 98 10 20 01 mov 1, %o4 4000e8b4: 90 10 00 18 mov %i0, %o0 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000e8b8: 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, 4000e8bc: a2 07 bf f4 add %fp, -12, %l1 4000e8c0: 92 10 00 19 mov %i1, %o1 4000e8c4: 94 10 00 11 mov %l1, %o2 4000e8c8: 96 0e a0 ff and %i2, 0xff, %o3 4000e8cc: 40 00 00 2c call 4000e97c <_POSIX_signals_Clear_signals> 4000e8d0: b0 10 20 00 clr %i0 4000e8d4: 80 8a 20 ff btst 0xff, %o0 4000e8d8: 02 80 00 27 be 4000e974 <_POSIX_signals_Check_signal+0xc8> 4000e8dc: 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 ) 4000e8e0: 2b 10 00 5a sethi %hi(0x40016800), %l5 4000e8e4: a9 2e 60 04 sll %i1, 4, %l4 4000e8e8: aa 15 62 b0 or %l5, 0x2b0, %l5 4000e8ec: a8 25 00 01 sub %l4, %g1, %l4 4000e8f0: 82 05 40 14 add %l5, %l4, %g1 4000e8f4: e4 00 60 08 ld [ %g1 + 8 ], %l2 4000e8f8: 80 a4 a0 01 cmp %l2, 1 4000e8fc: 02 80 00 1e be 4000e974 <_POSIX_signals_Check_signal+0xc8><== NEVER TAKEN 4000e900: 90 07 bf cc add %fp, -52, %o0 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 4000e904: e6 04 20 d0 ld [ %l0 + 0xd0 ], %l3 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000e908: c2 00 60 04 ld [ %g1 + 4 ], %g1 4000e90c: 82 10 40 13 or %g1, %l3, %g1 4000e910: 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, 4000e914: 03 10 00 5a sethi %hi(0x40016800), %g1 4000e918: d2 00 62 64 ld [ %g1 + 0x264 ], %o1 ! 40016a64 <_Per_CPU_Information+0xc> 4000e91c: 94 10 20 28 mov 0x28, %o2 4000e920: 40 00 04 2e call 4000f9d8 4000e924: 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 ) { 4000e928: c2 05 40 14 ld [ %l5 + %l4 ], %g1 4000e92c: 80 a0 60 02 cmp %g1, 2 4000e930: 12 80 00 07 bne 4000e94c <_POSIX_signals_Check_signal+0xa0> 4000e934: 90 10 00 19 mov %i1, %o0 case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 4000e938: 92 10 00 11 mov %l1, %o1 4000e93c: 9f c4 80 00 call %l2 4000e940: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 4000e944: 10 80 00 05 b 4000e958 <_POSIX_signals_Check_signal+0xac> 4000e948: 03 10 00 5a sethi %hi(0x40016800), %g1 default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 4000e94c: 9f c4 80 00 call %l2 4000e950: 90 10 00 19 mov %i1, %o0 } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 4000e954: 03 10 00 5a sethi %hi(0x40016800), %g1 4000e958: d0 00 62 64 ld [ %g1 + 0x264 ], %o0 ! 40016a64 <_Per_CPU_Information+0xc> 4000e95c: 92 07 bf cc add %fp, -52, %o1 4000e960: 90 02 20 20 add %o0, 0x20, %o0 4000e964: 94 10 20 28 mov 0x28, %o2 4000e968: 40 00 04 1c call 4000f9d8 4000e96c: b0 10 20 01 mov 1, %i0 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 4000e970: e6 24 20 d0 st %l3, [ %l0 + 0xd0 ] return true; } 4000e974: 81 c7 e0 08 ret 4000e978: 81 e8 00 00 restore =============================================================================== 4000efdc <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 4000efdc: 9d e3 bf a0 save %sp, -96, %sp clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4000efe0: 7f ff cb 65 call 40001d74 4000efe4: 01 00 00 00 nop if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4000efe8: 85 2e 20 04 sll %i0, 4, %g2 4000efec: 83 2e 20 02 sll %i0, 2, %g1 4000eff0: 82 20 80 01 sub %g2, %g1, %g1 4000eff4: 05 10 00 5a sethi %hi(0x40016800), %g2 4000eff8: 84 10 a2 b0 or %g2, 0x2b0, %g2 ! 40016ab0 <_POSIX_signals_Vectors> 4000effc: c4 00 80 01 ld [ %g2 + %g1 ], %g2 4000f000: 80 a0 a0 02 cmp %g2, 2 4000f004: 12 80 00 0a bne 4000f02c <_POSIX_signals_Clear_process_signals+0x50> 4000f008: 84 10 20 01 mov 1, %g2 } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } 4000f00c: 05 10 00 5b sethi %hi(0x40016c00), %g2 4000f010: 84 10 a0 a8 or %g2, 0xa8, %g2 ! 40016ca8 <_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 ); 4000f014: 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 ] ) ) 4000f018: c2 00 80 01 ld [ %g2 + %g1 ], %g1 4000f01c: 86 00 e0 04 add %g3, 4, %g3 4000f020: 80 a0 40 03 cmp %g1, %g3 4000f024: 12 80 00 08 bne 4000f044 <_POSIX_signals_Clear_process_signals+0x68><== NEVER TAKEN 4000f028: 84 10 20 01 mov 1, %g2 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 4000f02c: 03 10 00 5b sethi %hi(0x40016c00), %g1 4000f030: b0 06 3f ff add %i0, -1, %i0 4000f034: b1 28 80 18 sll %g2, %i0, %i0 4000f038: c4 00 60 a4 ld [ %g1 + 0xa4 ], %g2 4000f03c: b0 28 80 18 andn %g2, %i0, %i0 4000f040: f0 20 60 a4 st %i0, [ %g1 + 0xa4 ] } _ISR_Enable( level ); 4000f044: 7f ff cb 50 call 40001d84 4000f048: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 4000773c <_POSIX_signals_Get_lowest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 4000773c: 82 10 20 1b mov 0x1b, %g1 ! 1b 40007740: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 40007744: 86 00 7f ff add %g1, -1, %g3 40007748: 87 28 80 03 sll %g2, %g3, %g3 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 4000774c: 80 88 c0 08 btst %g3, %o0 40007750: 12 80 00 11 bne 40007794 <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 40007754: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40007758: 82 00 60 01 inc %g1 4000775c: 80 a0 60 20 cmp %g1, 0x20 40007760: 12 bf ff fa bne 40007748 <_POSIX_signals_Get_lowest+0xc> 40007764: 86 00 7f ff add %g1, -1, %g3 40007768: 82 10 20 01 mov 1, %g1 4000776c: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 40007770: 86 00 7f ff add %g1, -1, %g3 40007774: 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 ) ) { 40007778: 80 88 c0 08 btst %g3, %o0 4000777c: 12 80 00 06 bne 40007794 <_POSIX_signals_Get_lowest+0x58> 40007780: 01 00 00 00 nop */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 40007784: 82 00 60 01 inc %g1 40007788: 80 a0 60 1b cmp %g1, 0x1b 4000778c: 12 bf ff fa bne 40007774 <_POSIX_signals_Get_lowest+0x38> <== ALWAYS TAKEN 40007790: 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; } 40007794: 81 c3 e0 08 retl 40007798: 90 10 00 01 mov %g1, %o0 =============================================================================== 40024df0 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 40024df0: 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 ) ) { 40024df4: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 40024df8: 1b 04 00 20 sethi %hi(0x10008000), %o5 40024dfc: 84 06 7f ff add %i1, -1, %g2 40024e00: 86 10 20 01 mov 1, %g3 40024e04: 98 08 40 0d and %g1, %o5, %o4 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 40024e08: a0 10 00 18 mov %i0, %l0 40024e0c: 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 ]; 40024e10: 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 ) ) { 40024e14: 80 a3 00 0d cmp %o4, %o5 40024e18: 12 80 00 1b bne 40024e84 <_POSIX_signals_Unblock_thread+0x94> 40024e1c: 85 28 c0 02 sll %g3, %g2, %g2 if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 40024e20: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 40024e24: 80 88 80 01 btst %g2, %g1 40024e28: 12 80 00 07 bne 40024e44 <_POSIX_signals_Unblock_thread+0x54> 40024e2c: 82 10 20 04 mov 4, %g1 40024e30: c2 01 20 d0 ld [ %g4 + 0xd0 ], %g1 40024e34: 80 a8 80 01 andncc %g2, %g1, %g0 40024e38: 02 80 00 11 be 40024e7c <_POSIX_signals_Unblock_thread+0x8c> 40024e3c: b0 10 20 00 clr %i0 the_thread->Wait.return_code = EINTR; 40024e40: 82 10 20 04 mov 4, %g1 40024e44: c2 24 20 34 st %g1, [ %l0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 40024e48: 80 a2 60 00 cmp %o1, 0 40024e4c: 12 80 00 07 bne 40024e68 <_POSIX_signals_Unblock_thread+0x78> 40024e50: d0 04 20 28 ld [ %l0 + 0x28 ], %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 40024e54: 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; 40024e58: f2 22 00 00 st %i1, [ %o0 ] the_info->si_code = SI_USER; 40024e5c: c2 22 20 04 st %g1, [ %o0 + 4 ] the_info->si_value.sival_int = 0; 40024e60: 10 80 00 04 b 40024e70 <_POSIX_signals_Unblock_thread+0x80> 40024e64: c0 22 20 08 clr [ %o0 + 8 ] } else { *the_info = *info; 40024e68: 7f ff c0 e2 call 400151f0 40024e6c: 94 10 20 0c mov 0xc, %o2 } _Thread_queue_Extract_with_proxy( the_thread ); 40024e70: 90 10 00 10 mov %l0, %o0 40024e74: 7f ff a8 62 call 4000effc <_Thread_queue_Extract_with_proxy> 40024e78: b0 10 20 01 mov 1, %i0 return true; 40024e7c: 81 c7 e0 08 ret 40024e80: 81 e8 00 00 restore } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 40024e84: c8 01 20 d0 ld [ %g4 + 0xd0 ], %g4 40024e88: 80 a8 80 04 andncc %g2, %g4, %g0 40024e8c: 02 bf ff fc be 40024e7c <_POSIX_signals_Unblock_thread+0x8c> 40024e90: 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 ) ) { 40024e94: 05 04 00 00 sethi %hi(0x10000000), %g2 40024e98: 80 88 40 02 btst %g1, %g2 40024e9c: 02 80 00 17 be 40024ef8 <_POSIX_signals_Unblock_thread+0x108> 40024ea0: 80 a0 60 00 cmp %g1, 0 the_thread->Wait.return_code = EINTR; 40024ea4: 84 10 20 04 mov 4, %g2 40024ea8: 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) ) 40024eac: 05 00 00 ef sethi %hi(0x3bc00), %g2 40024eb0: 84 10 a2 e0 or %g2, 0x2e0, %g2 ! 3bee0 40024eb4: 80 88 40 02 btst %g1, %g2 40024eb8: 02 80 00 06 be 40024ed0 <_POSIX_signals_Unblock_thread+0xe0> 40024ebc: 80 88 60 08 btst 8, %g1 _Thread_queue_Extract_with_proxy( the_thread ); 40024ec0: 7f ff a8 4f call 4000effc <_Thread_queue_Extract_with_proxy> 40024ec4: 90 10 00 10 mov %l0, %o0 40024ec8: 81 c7 e0 08 ret 40024ecc: 81 e8 00 00 restore else if ( _States_Is_delaying(the_thread->current_state) ) { 40024ed0: 02 80 00 15 be 40024f24 <_POSIX_signals_Unblock_thread+0x134><== NEVER TAKEN 40024ed4: 01 00 00 00 nop (void) _Watchdog_Remove( &the_thread->Timer ); 40024ed8: 7f ff aa 7b call 4000f8c4 <_Watchdog_Remove> 40024edc: 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 ); 40024ee0: 90 10 00 10 mov %l0, %o0 40024ee4: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40024ee8: 7f ff a5 b9 call 4000e5cc <_Thread_Clear_state> 40024eec: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 40024ef0: 81 c7 e0 08 ret 40024ef4: 81 e8 00 00 restore _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 40024ef8: 12 bf ff e1 bne 40024e7c <_POSIX_signals_Unblock_thread+0x8c><== NEVER TAKEN 40024efc: 03 10 00 a2 sethi %hi(0x40028800), %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40024f00: 82 10 62 98 or %g1, 0x298, %g1 ! 40028a98 <_Per_CPU_Information> 40024f04: c4 00 60 08 ld [ %g1 + 8 ], %g2 40024f08: 80 a0 a0 00 cmp %g2, 0 40024f0c: 02 80 00 06 be 40024f24 <_POSIX_signals_Unblock_thread+0x134> 40024f10: 01 00 00 00 nop 40024f14: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40024f18: 80 a4 00 02 cmp %l0, %g2 40024f1c: 22 bf ff d8 be,a 40024e7c <_POSIX_signals_Unblock_thread+0x8c><== ALWAYS TAKEN 40024f20: c6 28 60 18 stb %g3, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } } return false; } 40024f24: 81 c7 e0 08 ret 40024f28: 81 e8 00 00 restore =============================================================================== 400081d4 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 400081d4: 9d e3 bf 98 save %sp, -104, %sp 400081d8: 11 10 00 82 sethi %hi(0x40020800), %o0 400081dc: 92 10 00 18 mov %i0, %o1 400081e0: 90 12 21 cc or %o0, 0x1cc, %o0 400081e4: 40 00 07 e8 call 4000a184 <_Objects_Get> 400081e8: 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 ) { 400081ec: c2 07 bf fc ld [ %fp + -4 ], %g1 400081f0: 80 a0 60 00 cmp %g1, 0 400081f4: 12 80 00 24 bne 40008284 <_Rate_monotonic_Timeout+0xb0> <== NEVER TAKEN 400081f8: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: the_thread = the_period->owner; 400081fc: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 40008200: 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); 40008204: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 40008208: 80 88 80 01 btst %g2, %g1 4000820c: 22 80 00 0b be,a 40008238 <_Rate_monotonic_Timeout+0x64> 40008210: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 40008214: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 40008218: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000821c: 80 a0 80 01 cmp %g2, %g1 40008220: 32 80 00 06 bne,a 40008238 <_Rate_monotonic_Timeout+0x64> 40008224: 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 ); 40008228: 13 04 00 ff sethi %hi(0x1003fc00), %o1 4000822c: 40 00 0a 89 call 4000ac50 <_Thread_Clear_state> 40008230: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 40008234: 30 80 00 06 b,a 4000824c <_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 ) { 40008238: 80 a0 60 01 cmp %g1, 1 4000823c: 12 80 00 0d bne 40008270 <_Rate_monotonic_Timeout+0x9c> 40008240: 82 10 20 04 mov 4, %g1 the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 40008244: 82 10 20 03 mov 3, %g1 40008248: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 4000824c: 7f ff fe 66 call 40007be4 <_Rate_monotonic_Initiate_statistics> 40008250: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40008254: c2 04 20 3c ld [ %l0 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40008258: 11 10 00 82 sethi %hi(0x40020800), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000825c: c2 24 20 1c st %g1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40008260: 90 12 23 f0 or %o0, 0x3f0, %o0 40008264: 40 00 0f 54 call 4000bfb4 <_Watchdog_Insert> 40008268: 92 04 20 10 add %l0, 0x10, %o1 4000826c: 30 80 00 02 b,a 40008274 <_Rate_monotonic_Timeout+0xa0> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 40008270: 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; 40008274: 03 10 00 82 sethi %hi(0x40020800), %g1 40008278: c4 00 63 30 ld [ %g1 + 0x330 ], %g2 ! 40020b30 <_Thread_Dispatch_disable_level> 4000827c: 84 00 bf ff add %g2, -1, %g2 40008280: c4 20 63 30 st %g2, [ %g1 + 0x330 ] 40008284: 81 c7 e0 08 ret 40008288: 81 e8 00 00 restore =============================================================================== 4000878c <_Scheduler_priority_Block>: #include void _Scheduler_priority_Block( Thread_Control *the_thread ) { 4000878c: 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; 40008790: c4 06 20 8c ld [ %i0 + 0x8c ], %g2 ready = sched_info->ready_chain; 40008794: c2 00 80 00 ld [ %g2 ], %g1 if ( _Chain_Has_only_one_node( ready ) ) { 40008798: c8 00 40 00 ld [ %g1 ], %g4 4000879c: c6 00 60 08 ld [ %g1 + 8 ], %g3 400087a0: 80 a1 00 03 cmp %g4, %g3 400087a4: 32 80 00 16 bne,a 400087fc <_Scheduler_priority_Block+0x70> 400087a8: c4 06 00 00 ld [ %i0 ], %g2 Chain_Node *tail = _Chain_Tail( the_chain ); 400087ac: 86 00 60 04 add %g1, 4, %g3 head->next = tail; 400087b0: 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; 400087b4: c6 00 a0 04 ld [ %g2 + 4 ], %g3 head->previous = NULL; 400087b8: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 400087bc: c2 20 60 08 st %g1, [ %g1 + 8 ] 400087c0: c2 10 a0 0e lduh [ %g2 + 0xe ], %g1 400087c4: c8 10 c0 00 lduh [ %g3 ], %g4 400087c8: 82 09 00 01 and %g4, %g1, %g1 400087cc: c2 30 c0 00 sth %g1, [ %g3 ] if ( *the_priority_map->minor == 0 ) 400087d0: 83 28 60 10 sll %g1, 0x10, %g1 400087d4: 80 a0 60 00 cmp %g1, 0 400087d8: 32 80 00 0d bne,a 4000880c <_Scheduler_priority_Block+0x80> 400087dc: 03 10 00 5a sethi %hi(0x40016800), %g1 _Priority_Major_bit_map &= the_priority_map->block_major; 400087e0: 03 10 00 5a sethi %hi(0x40016800), %g1 400087e4: c4 10 a0 0c lduh [ %g2 + 0xc ], %g2 400087e8: c6 10 62 80 lduh [ %g1 + 0x280 ], %g3 400087ec: 84 08 80 03 and %g2, %g3, %g2 400087f0: c4 30 62 80 sth %g2, [ %g1 + 0x280 ] RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); 400087f4: 10 80 00 06 b 4000880c <_Scheduler_priority_Block+0x80> 400087f8: 03 10 00 5a sethi %hi(0x40016800), %g1 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 400087fc: c2 06 20 04 ld [ %i0 + 4 ], %g1 next->previous = previous; 40008800: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 40008804: c4 20 40 00 st %g2, [ %g1 ] 40008808: 03 10 00 5a sethi %hi(0x40016800), %g1 _Scheduler_priority_Ready_queue_extract( the_thread ); /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) 4000880c: c2 00 62 68 ld [ %g1 + 0x268 ], %g1 ! 40016a68 <_Per_CPU_Information+0x10> 40008810: 80 a6 00 01 cmp %i0, %g1 40008814: 32 80 00 33 bne,a 400088e0 <_Scheduler_priority_Block+0x154> 40008818: 03 10 00 5a sethi %hi(0x40016800), %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 4000881c: 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( 40008820: c6 00 61 60 ld [ %g1 + 0x160 ], %g3 ! 40015960 <_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 ); 40008824: 03 10 00 5a sethi %hi(0x40016800), %g1 40008828: c4 10 62 80 lduh [ %g1 + 0x280 ], %g2 ! 40016a80 <_Priority_Major_bit_map> 4000882c: 03 10 00 53 sethi %hi(0x40014c00), %g1 40008830: 85 28 a0 10 sll %g2, 0x10, %g2 40008834: 89 30 a0 10 srl %g2, 0x10, %g4 40008838: 80 a1 20 ff cmp %g4, 0xff 4000883c: 18 80 00 05 bgu 40008850 <_Scheduler_priority_Block+0xc4> 40008840: 82 10 63 38 or %g1, 0x338, %g1 40008844: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 40008848: 10 80 00 04 b 40008858 <_Scheduler_priority_Block+0xcc> 4000884c: 84 00 a0 08 add %g2, 8, %g2 40008850: 85 30 a0 18 srl %g2, 0x18, %g2 40008854: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40008858: 83 28 a0 10 sll %g2, 0x10, %g1 4000885c: 09 10 00 5a sethi %hi(0x40016800), %g4 40008860: 83 30 60 0f srl %g1, 0xf, %g1 40008864: 88 11 22 90 or %g4, 0x290, %g4 40008868: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 4000886c: 03 10 00 53 sethi %hi(0x40014c00), %g1 40008870: 89 29 20 10 sll %g4, 0x10, %g4 40008874: 9b 31 20 10 srl %g4, 0x10, %o5 40008878: 80 a3 60 ff cmp %o5, 0xff 4000887c: 18 80 00 05 bgu 40008890 <_Scheduler_priority_Block+0x104> 40008880: 82 10 63 38 or %g1, 0x338, %g1 40008884: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 40008888: 10 80 00 04 b 40008898 <_Scheduler_priority_Block+0x10c> 4000888c: 82 00 60 08 add %g1, 8, %g1 40008890: 89 31 20 18 srl %g4, 0x18, %g4 40008894: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 40008898: 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) + 4000889c: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 400088a0: 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) + 400088a4: 85 30 a0 0c srl %g2, 0xc, %g2 400088a8: 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 ] ) ) 400088ac: 89 28 a0 02 sll %g2, 2, %g4 400088b0: 83 28 a0 04 sll %g2, 4, %g1 400088b4: 82 20 40 04 sub %g1, %g4, %g1 _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } 400088b8: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 400088bc: 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 ); 400088c0: 86 01 20 04 add %g4, 4, %g3 400088c4: 80 a0 80 03 cmp %g2, %g3 400088c8: 02 80 00 03 be 400088d4 <_Scheduler_priority_Block+0x148> <== NEVER TAKEN 400088cc: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 400088d0: 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( 400088d4: 05 10 00 5a sethi %hi(0x40016800), %g2 400088d8: c2 20 a2 68 st %g1, [ %g2 + 0x268 ] ! 40016a68 <_Per_CPU_Information+0x10> RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 400088dc: 03 10 00 5a sethi %hi(0x40016800), %g1 400088e0: 82 10 62 58 or %g1, 0x258, %g1 ! 40016a58 <_Per_CPU_Information> /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) 400088e4: c4 00 60 0c ld [ %g1 + 0xc ], %g2 400088e8: 80 a6 00 02 cmp %i0, %g2 400088ec: 12 80 00 03 bne 400088f8 <_Scheduler_priority_Block+0x16c> 400088f0: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 400088f4: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 400088f8: 81 c7 e0 08 ret 400088fc: 81 e8 00 00 restore =============================================================================== 40008ab0 <_Scheduler_priority_Schedule>: #include #include #include void _Scheduler_priority_Schedule(void) { 40008ab0: 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 40008ab4: 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( 40008ab8: c6 00 61 60 ld [ %g1 + 0x160 ], %g3 ! 40015960 <_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 ); 40008abc: 03 10 00 5a sethi %hi(0x40016800), %g1 40008ac0: c4 10 62 80 lduh [ %g1 + 0x280 ], %g2 ! 40016a80 <_Priority_Major_bit_map> 40008ac4: 03 10 00 53 sethi %hi(0x40014c00), %g1 40008ac8: 85 28 a0 10 sll %g2, 0x10, %g2 40008acc: 89 30 a0 10 srl %g2, 0x10, %g4 40008ad0: 80 a1 20 ff cmp %g4, 0xff 40008ad4: 18 80 00 05 bgu 40008ae8 <_Scheduler_priority_Schedule+0x38> 40008ad8: 82 10 63 38 or %g1, 0x338, %g1 40008adc: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 40008ae0: 10 80 00 04 b 40008af0 <_Scheduler_priority_Schedule+0x40> 40008ae4: 84 00 a0 08 add %g2, 8, %g2 40008ae8: 85 30 a0 18 srl %g2, 0x18, %g2 40008aec: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40008af0: 83 28 a0 10 sll %g2, 0x10, %g1 40008af4: 09 10 00 5a sethi %hi(0x40016800), %g4 40008af8: 83 30 60 0f srl %g1, 0xf, %g1 40008afc: 88 11 22 90 or %g4, 0x290, %g4 40008b00: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 40008b04: 03 10 00 53 sethi %hi(0x40014c00), %g1 40008b08: 89 29 20 10 sll %g4, 0x10, %g4 40008b0c: 9b 31 20 10 srl %g4, 0x10, %o5 40008b10: 80 a3 60 ff cmp %o5, 0xff 40008b14: 18 80 00 05 bgu 40008b28 <_Scheduler_priority_Schedule+0x78> 40008b18: 82 10 63 38 or %g1, 0x338, %g1 40008b1c: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 40008b20: 10 80 00 04 b 40008b30 <_Scheduler_priority_Schedule+0x80> 40008b24: 82 00 60 08 add %g1, 8, %g1 40008b28: 89 31 20 18 srl %g4, 0x18, %g4 40008b2c: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 40008b30: 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) + 40008b34: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 40008b38: 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) + 40008b3c: 85 30 a0 0c srl %g2, 0xc, %g2 40008b40: 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 ] ) ) 40008b44: 89 28 a0 02 sll %g2, 2, %g4 40008b48: 83 28 a0 04 sll %g2, 4, %g1 40008b4c: 82 20 40 04 sub %g1, %g4, %g1 _Scheduler_priority_Schedule_body(); } 40008b50: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 40008b54: 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 ); 40008b58: 86 01 20 04 add %g4, 4, %g3 40008b5c: 80 a0 80 03 cmp %g2, %g3 40008b60: 02 80 00 03 be 40008b6c <_Scheduler_priority_Schedule+0xbc><== NEVER TAKEN 40008b64: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 40008b68: 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( 40008b6c: 05 10 00 5a sethi %hi(0x40016800), %g2 40008b70: c2 20 a2 68 st %g1, [ %g2 + 0x268 ] ! 40016a68 <_Per_CPU_Information+0x10> 40008b74: 81 c7 e0 08 ret 40008b78: 81 e8 00 00 restore =============================================================================== 40007c08 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40007c08: 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(); 40007c0c: 03 10 00 82 sethi %hi(0x40020800), %g1 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40007c10: 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(); 40007c14: d2 00 60 84 ld [ %g1 + 0x84 ], %o1 if ((!the_tod) || 40007c18: 80 a4 20 00 cmp %l0, 0 40007c1c: 02 80 00 2b be 40007cc8 <_TOD_Validate+0xc0> <== NEVER TAKEN 40007c20: b0 10 20 00 clr %i0 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 40007c24: 11 00 03 d0 sethi %hi(0xf4000), %o0 40007c28: 40 00 4b 94 call 4001aa78 <.udiv> 40007c2c: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 40007c30: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40007c34: 80 a0 40 08 cmp %g1, %o0 40007c38: 1a 80 00 24 bcc 40007cc8 <_TOD_Validate+0xc0> 40007c3c: 01 00 00 00 nop (the_tod->ticks >= ticks_per_second) || 40007c40: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40007c44: 80 a0 60 3b cmp %g1, 0x3b 40007c48: 18 80 00 20 bgu 40007cc8 <_TOD_Validate+0xc0> 40007c4c: 01 00 00 00 nop (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 40007c50: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40007c54: 80 a0 60 3b cmp %g1, 0x3b 40007c58: 18 80 00 1c bgu 40007cc8 <_TOD_Validate+0xc0> 40007c5c: 01 00 00 00 nop (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 40007c60: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40007c64: 80 a0 60 17 cmp %g1, 0x17 40007c68: 18 80 00 18 bgu 40007cc8 <_TOD_Validate+0xc0> 40007c6c: 01 00 00 00 nop (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 40007c70: 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) || 40007c74: 80 a0 60 00 cmp %g1, 0 40007c78: 02 80 00 14 be 40007cc8 <_TOD_Validate+0xc0> <== NEVER TAKEN 40007c7c: 80 a0 60 0c cmp %g1, 0xc (the_tod->month == 0) || 40007c80: 18 80 00 12 bgu 40007cc8 <_TOD_Validate+0xc0> 40007c84: 01 00 00 00 nop (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 40007c88: 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) || 40007c8c: 80 a0 e7 c3 cmp %g3, 0x7c3 40007c90: 08 80 00 0e bleu 40007cc8 <_TOD_Validate+0xc0> 40007c94: 01 00 00 00 nop (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 40007c98: 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) || 40007c9c: 80 a0 a0 00 cmp %g2, 0 40007ca0: 02 80 00 0a be 40007cc8 <_TOD_Validate+0xc0> <== NEVER TAKEN 40007ca4: 80 88 e0 03 btst 3, %g3 40007ca8: 07 10 00 7c sethi %hi(0x4001f000), %g3 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 40007cac: 12 80 00 03 bne 40007cb8 <_TOD_Validate+0xb0> 40007cb0: 86 10 e3 98 or %g3, 0x398, %g3 ! 4001f398 <_TOD_Days_per_month> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 40007cb4: 82 00 60 0d add %g1, 0xd, %g1 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 40007cb8: 83 28 60 02 sll %g1, 2, %g1 40007cbc: 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( 40007cc0: 80 a0 40 02 cmp %g1, %g2 40007cc4: b0 60 3f ff subx %g0, -1, %i0 if ( the_tod->day > days_in_month ) return false; return true; } 40007cc8: 81 c7 e0 08 ret 40007ccc: 81 e8 00 00 restore =============================================================================== 40008d98 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 40008d98: 9d e3 bf a0 save %sp, -96, %sp States_Control state, original_state; /* * Save original state */ original_state = the_thread->current_state; 40008d9c: 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 ); 40008da0: 40 00 03 46 call 40009ab8 <_Thread_Set_transient> 40008da4: 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 ) 40008da8: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40008dac: 80 a0 40 19 cmp %g1, %i1 40008db0: 02 80 00 05 be 40008dc4 <_Thread_Change_priority+0x2c> 40008db4: a0 10 00 18 mov %i0, %l0 _Thread_Set_priority( the_thread, new_priority ); 40008db8: 90 10 00 18 mov %i0, %o0 40008dbc: 40 00 03 25 call 40009a50 <_Thread_Set_priority> 40008dc0: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 40008dc4: 7f ff e3 ec call 40001d74 40008dc8: 01 00 00 00 nop 40008dcc: 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; 40008dd0: f2 04 20 10 ld [ %l0 + 0x10 ], %i1 if ( state != STATES_TRANSIENT ) { 40008dd4: 80 a6 60 04 cmp %i1, 4 40008dd8: 02 80 00 10 be 40008e18 <_Thread_Change_priority+0x80> 40008ddc: 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 ) ) 40008de0: 80 a4 60 00 cmp %l1, 0 40008de4: 12 80 00 03 bne 40008df0 <_Thread_Change_priority+0x58> <== NEVER TAKEN 40008de8: 82 0e 7f fb and %i1, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 40008dec: c2 24 20 10 st %g1, [ %l0 + 0x10 ] _ISR_Enable( level ); 40008df0: 7f ff e3 e5 call 40001d84 40008df4: 90 10 00 18 mov %i0, %o0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 40008df8: 03 00 00 ef sethi %hi(0x3bc00), %g1 40008dfc: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 40008e00: 80 8e 40 01 btst %i1, %g1 40008e04: 02 80 00 28 be 40008ea4 <_Thread_Change_priority+0x10c> 40008e08: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 40008e0c: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 40008e10: 40 00 02 e3 call 4000999c <_Thread_queue_Requeue> 40008e14: 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 ) ) { 40008e18: 80 a4 60 00 cmp %l1, 0 40008e1c: 12 80 00 0b bne 40008e48 <_Thread_Change_priority+0xb0> <== NEVER TAKEN 40008e20: 03 10 00 56 sethi %hi(0x40015800), %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 ); 40008e24: c0 24 20 10 clr [ %l0 + 0x10 ] if ( prepend_it ) 40008e28: 80 8e a0 ff btst 0xff, %i2 40008e2c: 02 80 00 04 be 40008e3c <_Thread_Change_priority+0xa4> 40008e30: 82 10 61 60 or %g1, 0x160, %g1 */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue_first( the_thread ); 40008e34: 10 80 00 03 b 40008e40 <_Thread_Change_priority+0xa8> 40008e38: c2 00 60 28 ld [ %g1 + 0x28 ], %g1 */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue( the_thread ); 40008e3c: c2 00 60 24 ld [ %g1 + 0x24 ], %g1 40008e40: 9f c0 40 00 call %g1 40008e44: 90 10 00 10 mov %l0, %o0 _Scheduler_Enqueue_first( the_thread ); else _Scheduler_Enqueue( the_thread ); } _ISR_Flash( level ); 40008e48: 7f ff e3 cf call 40001d84 40008e4c: 90 10 00 18 mov %i0, %o0 40008e50: 7f ff e3 c9 call 40001d74 40008e54: 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(); 40008e58: 03 10 00 56 sethi %hi(0x40015800), %g1 40008e5c: c2 00 61 68 ld [ %g1 + 0x168 ], %g1 ! 40015968 <_Scheduler+0x8> 40008e60: 9f c0 40 00 call %g1 40008e64: 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 ); 40008e68: 03 10 00 5a sethi %hi(0x40016800), %g1 40008e6c: 82 10 62 58 or %g1, 0x258, %g1 ! 40016a58 <_Per_CPU_Information> 40008e70: 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() && 40008e74: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40008e78: 80 a0 80 03 cmp %g2, %g3 40008e7c: 02 80 00 08 be 40008e9c <_Thread_Change_priority+0x104> 40008e80: 01 00 00 00 nop 40008e84: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 40008e88: 80 a0 a0 00 cmp %g2, 0 40008e8c: 02 80 00 04 be 40008e9c <_Thread_Change_priority+0x104> 40008e90: 01 00 00 00 nop _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 40008e94: 84 10 20 01 mov 1, %g2 ! 1 40008e98: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] _ISR_Enable( level ); 40008e9c: 7f ff e3 ba call 40001d84 40008ea0: 81 e8 00 00 restore 40008ea4: 81 c7 e0 08 ret 40008ea8: 81 e8 00 00 restore =============================================================================== 40009078 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 40009078: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 4000907c: 90 10 00 18 mov %i0, %o0 40009080: 40 00 00 5f call 400091fc <_Thread_Get> 40009084: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009088: c2 07 bf fc ld [ %fp + -4 ], %g1 4000908c: 80 a0 60 00 cmp %g1, 0 40009090: 12 80 00 08 bne 400090b0 <_Thread_Delay_ended+0x38> <== NEVER TAKEN 40009094: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 40009098: 7f ff ff 85 call 40008eac <_Thread_Clear_state> 4000909c: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 400090a0: 03 10 00 59 sethi %hi(0x40016400), %g1 400090a4: c4 00 61 20 ld [ %g1 + 0x120 ], %g2 ! 40016520 <_Thread_Dispatch_disable_level> 400090a8: 84 00 bf ff add %g2, -1, %g2 400090ac: c4 20 61 20 st %g2, [ %g1 + 0x120 ] 400090b0: 81 c7 e0 08 ret 400090b4: 81 e8 00 00 restore =============================================================================== 400090b8 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 400090b8: 9d e3 bf 90 save %sp, -112, %sp Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 400090bc: 2b 10 00 5a sethi %hi(0x40016800), %l5 400090c0: 82 15 62 58 or %l5, 0x258, %g1 ! 40016a58 <_Per_CPU_Information> _ISR_Disable( level ); 400090c4: 7f ff e3 2c call 40001d74 400090c8: e2 00 60 0c ld [ %g1 + 0xc ], %l1 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 400090cc: 25 10 00 59 sethi %hi(0x40016400), %l2 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 400090d0: 39 10 00 59 sethi %hi(0x40016400), %i4 400090d4: 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; 400090d8: 2f 10 00 59 sethi %hi(0x40016400), %l7 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 400090dc: a8 07 bf f8 add %fp, -8, %l4 _Timestamp_Subtract( 400090e0: a6 07 bf f0 add %fp, -16, %l3 400090e4: a4 14 a1 cc or %l2, 0x1cc, %l2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 400090e8: 10 80 00 2b b 40009194 <_Thread_Dispatch+0xdc> 400090ec: 2d 10 00 59 sethi %hi(0x40016400), %l6 heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 400090f0: fa 27 21 20 st %i5, [ %i4 + 0x120 ] _Thread_Dispatch_necessary = false; 400090f4: 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 ) 400090f8: 80 a4 00 11 cmp %l0, %l1 400090fc: 02 80 00 2b be 400091a8 <_Thread_Dispatch+0xf0> 40009100: 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 ) 40009104: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40009108: 80 a0 60 01 cmp %g1, 1 4000910c: 12 80 00 03 bne 40009118 <_Thread_Dispatch+0x60> 40009110: c2 05 e0 84 ld [ %l7 + 0x84 ], %g1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 40009114: c2 24 20 78 st %g1, [ %l0 + 0x78 ] _ISR_Enable( level ); 40009118: 7f ff e3 1b call 40001d84 4000911c: 01 00 00 00 nop #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 40009120: 40 00 0f 22 call 4000cda8 <_TOD_Get_uptime> 40009124: 90 10 00 14 mov %l4, %o0 _Timestamp_Subtract( 40009128: 90 10 00 12 mov %l2, %o0 4000912c: 92 10 00 14 mov %l4, %o1 40009130: 40 00 03 02 call 40009d38 <_Timespec_Subtract> 40009134: 94 10 00 13 mov %l3, %o2 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 40009138: 90 04 60 84 add %l1, 0x84, %o0 4000913c: 40 00 02 e6 call 40009cd4 <_Timespec_Add_to> 40009140: 92 10 00 13 mov %l3, %o1 _Thread_Time_of_last_context_switch = uptime; 40009144: c2 07 bf f8 ld [ %fp + -8 ], %g1 40009148: c2 24 80 00 st %g1, [ %l2 ] 4000914c: c2 07 bf fc ld [ %fp + -4 ], %g1 40009150: c2 24 a0 04 st %g1, [ %l2 + 4 ] #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 40009154: c2 05 a1 a4 ld [ %l6 + 0x1a4 ], %g1 40009158: 80 a0 60 00 cmp %g1, 0 4000915c: 02 80 00 06 be 40009174 <_Thread_Dispatch+0xbc> <== NEVER TAKEN 40009160: 90 10 00 11 mov %l1, %o0 executing->libc_reent = *_Thread_libc_reent; 40009164: c4 00 40 00 ld [ %g1 ], %g2 40009168: c4 24 61 50 st %g2, [ %l1 + 0x150 ] *_Thread_libc_reent = heir->libc_reent; 4000916c: c4 04 21 50 ld [ %l0 + 0x150 ], %g2 40009170: c4 20 40 00 st %g2, [ %g1 ] } _User_extensions_Thread_switch( executing, heir ); 40009174: 40 00 03 a1 call 40009ff8 <_User_extensions_Thread_switch> 40009178: 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 ); 4000917c: 90 04 60 c8 add %l1, 0xc8, %o0 40009180: 40 00 04 92 call 4000a3c8 <_CPU_Context_switch> 40009184: 92 04 20 c8 add %l0, 0xc8, %o1 if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; 40009188: 82 15 62 58 or %l5, 0x258, %g1 _ISR_Disable( level ); 4000918c: 7f ff e2 fa call 40001d74 40009190: 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 ) { 40009194: 82 15 62 58 or %l5, 0x258, %g1 40009198: c4 08 60 18 ldub [ %g1 + 0x18 ], %g2 4000919c: 80 a0 a0 00 cmp %g2, 0 400091a0: 32 bf ff d4 bne,a 400090f0 <_Thread_Dispatch+0x38> 400091a4: e0 00 60 10 ld [ %g1 + 0x10 ], %l0 _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 400091a8: 03 10 00 59 sethi %hi(0x40016400), %g1 400091ac: c0 20 61 20 clr [ %g1 + 0x120 ] ! 40016520 <_Thread_Dispatch_disable_level> _ISR_Enable( level ); 400091b0: 7f ff e2 f5 call 40001d84 400091b4: 01 00 00 00 nop _API_extensions_Run_postswitch(); 400091b8: 7f ff f8 80 call 400073b8 <_API_extensions_Run_postswitch> 400091bc: 01 00 00 00 nop } 400091c0: 81 c7 e0 08 ret 400091c4: 81 e8 00 00 restore =============================================================================== 4000ee68 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 4000ee68: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 4000ee6c: 03 10 00 5a sethi %hi(0x40016800), %g1 4000ee70: e0 00 62 64 ld [ %g1 + 0x264 ], %l0 ! 40016a64 <_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(); 4000ee74: 3f 10 00 3b sethi %hi(0x4000ec00), %i7 4000ee78: be 17 e2 68 or %i7, 0x268, %i7 ! 4000ee68 <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4000ee7c: d0 04 20 ac ld [ %l0 + 0xac ], %o0 _ISR_Set_level(level); 4000ee80: 7f ff cb c1 call 40001d84 4000ee84: 91 2a 20 08 sll %o0, 8, %o0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000ee88: 03 10 00 58 sethi %hi(0x40016000), %g1 doneConstructors = 1; 4000ee8c: 84 10 20 01 mov 1, %g2 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000ee90: e2 08 61 a8 ldub [ %g1 + 0x1a8 ], %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 ); 4000ee94: 90 10 00 10 mov %l0, %o0 4000ee98: 7f ff eb e8 call 40009e38 <_User_extensions_Thread_begin> 4000ee9c: c4 28 61 a8 stb %g2, [ %g1 + 0x1a8 ] /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4000eea0: 7f ff e8 ca call 400091c8 <_Thread_Enable_dispatch> 4000eea4: 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) */ { 4000eea8: 80 a4 60 00 cmp %l1, 0 4000eeac: 32 80 00 05 bne,a 4000eec0 <_Thread_Handler+0x58> 4000eeb0: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 INIT_NAME (); 4000eeb4: 40 00 1a 97 call 40015910 <_init> 4000eeb8: 01 00 00 00 nop } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000eebc: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000eec0: 80 a0 60 00 cmp %g1, 0 4000eec4: 12 80 00 05 bne 4000eed8 <_Thread_Handler+0x70> 4000eec8: 80 a0 60 01 cmp %g1, 1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4000eecc: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000eed0: 10 80 00 06 b 4000eee8 <_Thread_Handler+0x80> 4000eed4: 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 ) { 4000eed8: 12 80 00 07 bne 4000eef4 <_Thread_Handler+0x8c> <== NEVER TAKEN 4000eedc: 01 00 00 00 nop executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 4000eee0: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000eee4: d0 04 20 98 ld [ %l0 + 0x98 ], %o0 4000eee8: 9f c0 40 00 call %g1 4000eeec: 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 = 4000eef0: 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 ); 4000eef4: 7f ff eb e2 call 40009e7c <_User_extensions_Thread_exitted> 4000eef8: 90 10 00 10 mov %l0, %o0 _Internal_error_Occurred( 4000eefc: 90 10 20 00 clr %o0 4000ef00: 92 10 20 01 mov 1, %o1 4000ef04: 7f ff e3 cf call 40007e40 <_Internal_error_Occurred> 4000ef08: 94 10 20 05 mov 5, %o2 =============================================================================== 400092a8 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 400092a8: 9d e3 bf a0 save %sp, -96, %sp 400092ac: 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; 400092b0: c0 26 61 54 clr [ %i1 + 0x154 ] 400092b4: c0 26 61 58 clr [ %i1 + 0x158 ] extensions_area = NULL; the_thread->libc_reent = NULL; 400092b8: 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 ) { 400092bc: e0 07 a0 60 ld [ %fp + 0x60 ], %l0 400092c0: 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 ) { 400092c4: 80 a6 a0 00 cmp %i2, 0 400092c8: 12 80 00 0d bne 400092fc <_Thread_Initialize+0x54> 400092cc: e4 0f a0 5f ldub [ %fp + 0x5f ], %l2 actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 400092d0: 90 10 00 19 mov %i1, %o0 400092d4: 40 00 02 09 call 40009af8 <_Thread_Stack_Allocate> 400092d8: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 400092dc: 80 a2 00 1b cmp %o0, %i3 400092e0: 0a 80 00 5f bcs 4000945c <_Thread_Initialize+0x1b4> 400092e4: 80 a2 20 00 cmp %o0, 0 400092e8: 02 80 00 5d be 4000945c <_Thread_Initialize+0x1b4> <== NEVER TAKEN 400092ec: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 400092f0: f4 06 60 c0 ld [ %i1 + 0xc0 ], %i2 the_thread->Start.core_allocated_stack = true; 400092f4: 10 80 00 04 b 40009304 <_Thread_Initialize+0x5c> 400092f8: c2 2e 60 b4 stb %g1, [ %i1 + 0xb4 ] } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 400092fc: c0 2e 60 b4 clrb [ %i1 + 0xb4 ] 40009300: 90 10 00 1b mov %i3, %o0 void *starting_address, size_t size ) { the_stack->area = starting_address; the_stack->size = size; 40009304: d0 26 60 b8 st %o0, [ %i1 + 0xb8 ] #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 40009308: 03 10 00 59 sethi %hi(0x40016400), %g1 4000930c: d0 00 61 b0 ld [ %g1 + 0x1b0 ], %o0 ! 400165b0 <_Thread_Maximum_extensions> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 40009310: f4 26 60 bc st %i2, [ %i1 + 0xbc ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40009314: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 40009318: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 4000931c: c0 26 60 68 clr [ %i1 + 0x68 ] the_watchdog->user_data = user_data; 40009320: c0 26 60 6c clr [ %i1 + 0x6c ] 40009324: 80 a2 20 00 cmp %o0, 0 40009328: 02 80 00 08 be 40009348 <_Thread_Initialize+0xa0> 4000932c: b6 10 20 00 clr %i3 extensions_area = _Workspace_Allocate( 40009330: 90 02 20 01 inc %o0 40009334: 40 00 04 07 call 4000a350 <_Workspace_Allocate> 40009338: 91 2a 20 02 sll %o0, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 4000933c: b6 92 20 00 orcc %o0, 0, %i3 40009340: 22 80 00 38 be,a 40009420 <_Thread_Initialize+0x178> 40009344: 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 ) { 40009348: 80 a6 e0 00 cmp %i3, 0 4000934c: 02 80 00 0b be 40009378 <_Thread_Initialize+0xd0> 40009350: f6 26 61 5c st %i3, [ %i1 + 0x15c ] for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 40009354: 03 10 00 59 sethi %hi(0x40016400), %g1 40009358: c4 00 61 b0 ld [ %g1 + 0x1b0 ], %g2 ! 400165b0 <_Thread_Maximum_extensions> 4000935c: 10 80 00 04 b 4000936c <_Thread_Initialize+0xc4> 40009360: 82 10 20 00 clr %g1 40009364: 82 00 60 01 inc %g1 the_thread->extensions[i] = NULL; 40009368: 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++ ) 4000936c: 80 a0 40 02 cmp %g1, %g2 40009370: 08 bf ff fd bleu 40009364 <_Thread_Initialize+0xbc> 40009374: 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; 40009378: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 4000937c: e4 2e 60 a0 stb %l2, [ %i1 + 0xa0 ] the_thread->Start.budget_algorithm = budget_algorithm; 40009380: e0 26 60 a4 st %l0, [ %i1 + 0xa4 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 40009384: 80 a4 20 02 cmp %l0, 2 40009388: 12 80 00 05 bne 4000939c <_Thread_Initialize+0xf4> 4000938c: 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; 40009390: 03 10 00 59 sethi %hi(0x40016400), %g1 40009394: c2 00 60 84 ld [ %g1 + 0x84 ], %g1 ! 40016484 <_Thread_Ticks_per_timeslice> 40009398: c2 26 60 78 st %g1, [ %i1 + 0x78 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 4000939c: c2 07 a0 68 ld [ %fp + 0x68 ], %g1 the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; 400093a0: c0 26 60 44 clr [ %i1 + 0x44 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 400093a4: c2 26 60 ac st %g1, [ %i1 + 0xac ] the_thread->current_state = STATES_DORMANT; 400093a8: 82 10 20 01 mov 1, %g1 400093ac: c2 26 60 10 st %g1, [ %i1 + 0x10 ] */ RTEMS_INLINE_ROUTINE void* _Scheduler_Allocate( Thread_Control *the_thread ) { return _Scheduler.Operations.allocate( the_thread ); 400093b0: 03 10 00 56 sethi %hi(0x40015800), %g1 400093b4: c2 00 61 78 ld [ %g1 + 0x178 ], %g1 ! 40015978 <_Scheduler+0x18> the_thread->Wait.queue = NULL; the_thread->resource_count = 0; 400093b8: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 400093bc: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; 400093c0: fa 26 60 b0 st %i5, [ %i1 + 0xb0 ] 400093c4: 9f c0 40 00 call %g1 400093c8: 90 10 00 19 mov %i1, %o0 sched =_Scheduler_Allocate( the_thread ); if ( !sched ) 400093cc: a0 92 20 00 orcc %o0, 0, %l0 400093d0: 22 80 00 15 be,a 40009424 <_Thread_Initialize+0x17c> 400093d4: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 goto failed; _Thread_Set_priority( the_thread, priority ); 400093d8: 90 10 00 19 mov %i1, %o0 400093dc: 40 00 01 9d call 40009a50 <_Thread_Set_priority> 400093e0: 92 10 00 1d mov %i5, %o1 _Workspace_Free( sched ); _Thread_Stack_Free( the_thread ); return false; } 400093e4: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 400093e8: 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 ); 400093ec: c0 26 60 84 clr [ %i1 + 0x84 ] 400093f0: c0 26 60 88 clr [ %i1 + 0x88 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400093f4: 83 28 60 02 sll %g1, 2, %g1 400093f8: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 400093fc: 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 ); 40009400: 90 10 00 19 mov %i1, %o0 40009404: 40 00 02 c0 call 40009f04 <_User_extensions_Thread_create> 40009408: b0 10 20 01 mov 1, %i0 if ( extension_status ) 4000940c: 80 8a 20 ff btst 0xff, %o0 40009410: 22 80 00 05 be,a 40009424 <_Thread_Initialize+0x17c> 40009414: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 40009418: 81 c7 e0 08 ret 4000941c: 81 e8 00 00 restore return true; failed: _Workspace_Free( the_thread->libc_reent ); 40009420: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 40009424: 40 00 03 d4 call 4000a374 <_Workspace_Free> 40009428: b0 10 20 00 clr %i0 for ( i=0 ; i <= THREAD_API_LAST ; i++ ) _Workspace_Free( the_thread->API_Extensions[i] ); 4000942c: 40 00 03 d2 call 4000a374 <_Workspace_Free> 40009430: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 40009434: 40 00 03 d0 call 4000a374 <_Workspace_Free> 40009438: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 _Workspace_Free( extensions_area ); 4000943c: 40 00 03 ce call 4000a374 <_Workspace_Free> 40009440: 90 10 00 1b mov %i3, %o0 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Workspace_Free( fp_area ); #endif _Workspace_Free( sched ); 40009444: 40 00 03 cc call 4000a374 <_Workspace_Free> 40009448: 90 10 00 10 mov %l0, %o0 _Thread_Stack_Free( the_thread ); 4000944c: 40 00 01 c2 call 40009b54 <_Thread_Stack_Free> 40009450: 90 10 00 19 mov %i1, %o0 return false; 40009454: 81 c7 e0 08 ret 40009458: 81 e8 00 00 restore } 4000945c: 81 c7 e0 08 ret 40009460: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000d2b8 <_Thread_Resume>: */ void _Thread_Resume( Thread_Control *the_thread, bool force ) { 4000d2b8: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 4000d2bc: 7f ff d2 f2 call 40001e84 4000d2c0: a0 10 00 18 mov %i0, %l0 4000d2c4: b0 10 00 08 mov %o0, %i0 current_state = the_thread->current_state; 4000d2c8: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 if ( current_state & STATES_SUSPENDED ) { 4000d2cc: 80 88 60 02 btst 2, %g1 4000d2d0: 02 80 00 09 be 4000d2f4 <_Thread_Resume+0x3c> <== NEVER TAKEN 4000d2d4: 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 ) ) { 4000d2d8: 80 a0 60 00 cmp %g1, 0 4000d2dc: 12 80 00 06 bne 4000d2f4 <_Thread_Resume+0x3c> 4000d2e0: c2 24 20 10 st %g1, [ %l0 + 0x10 ] */ RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Thread_Control *the_thread ) { _Scheduler.Operations.unblock( the_thread ); 4000d2e4: 03 10 00 66 sethi %hi(0x40019800), %g1 4000d2e8: c2 00 60 24 ld [ %g1 + 0x24 ], %g1 ! 40019824 <_Scheduler+0x14> 4000d2ec: 9f c0 40 00 call %g1 4000d2f0: 90 10 00 10 mov %l0, %o0 _Scheduler_Unblock( the_thread ); } } _ISR_Enable( level ); 4000d2f4: 7f ff d2 e8 call 40001e94 4000d2f8: 81 e8 00 00 restore =============================================================================== 40009c24 <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 40009c24: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing; executing = _Thread_Executing; 40009c28: 03 10 00 5a sethi %hi(0x40016800), %g1 40009c2c: e0 00 62 64 ld [ %g1 + 0x264 ], %l0 ! 40016a64 <_Per_CPU_Information+0xc> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 40009c30: c2 0c 20 74 ldub [ %l0 + 0x74 ], %g1 40009c34: 80 a0 60 00 cmp %g1, 0 40009c38: 02 80 00 25 be 40009ccc <_Thread_Tickle_timeslice+0xa8> 40009c3c: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 40009c40: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40009c44: 80 a0 60 00 cmp %g1, 0 40009c48: 12 80 00 21 bne 40009ccc <_Thread_Tickle_timeslice+0xa8> 40009c4c: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 40009c50: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40009c54: 80 a0 60 01 cmp %g1, 1 40009c58: 0a 80 00 14 bcs 40009ca8 <_Thread_Tickle_timeslice+0x84> 40009c5c: 80 a0 60 02 cmp %g1, 2 40009c60: 28 80 00 07 bleu,a 40009c7c <_Thread_Tickle_timeslice+0x58> 40009c64: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 40009c68: 80 a0 60 03 cmp %g1, 3 40009c6c: 12 80 00 18 bne 40009ccc <_Thread_Tickle_timeslice+0xa8> <== NEVER TAKEN 40009c70: 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 ) 40009c74: 10 80 00 0f b 40009cb0 <_Thread_Tickle_timeslice+0x8c> 40009c78: 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 ) { 40009c7c: 82 00 7f ff add %g1, -1, %g1 40009c80: 80 a0 60 00 cmp %g1, 0 40009c84: 14 80 00 09 bg 40009ca8 <_Thread_Tickle_timeslice+0x84> 40009c88: 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(); 40009c8c: 03 10 00 56 sethi %hi(0x40015800), %g1 40009c90: c2 00 61 6c ld [ %g1 + 0x16c ], %g1 ! 4001596c <_Scheduler+0xc> 40009c94: 9f c0 40 00 call %g1 40009c98: 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; 40009c9c: 03 10 00 59 sethi %hi(0x40016400), %g1 40009ca0: c2 00 60 84 ld [ %g1 + 0x84 ], %g1 ! 40016484 <_Thread_Ticks_per_timeslice> 40009ca4: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 40009ca8: 81 c7 e0 08 ret 40009cac: 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 ) 40009cb0: 82 00 7f ff add %g1, -1, %g1 40009cb4: 80 a0 60 00 cmp %g1, 0 40009cb8: 12 bf ff fc bne 40009ca8 <_Thread_Tickle_timeslice+0x84> 40009cbc: c2 24 20 78 st %g1, [ %l0 + 0x78 ] (*executing->budget_callout)( executing ); 40009cc0: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 40009cc4: 9f c0 40 00 call %g1 40009cc8: 90 10 00 10 mov %l0, %o0 40009ccc: 81 c7 e0 08 ret 40009cd0: 81 e8 00 00 restore =============================================================================== 4000999c <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 4000999c: 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 ) 400099a0: 80 a6 20 00 cmp %i0, 0 400099a4: 02 80 00 19 be 40009a08 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 400099a8: 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 ) { 400099ac: e2 06 20 34 ld [ %i0 + 0x34 ], %l1 400099b0: 80 a4 60 01 cmp %l1, 1 400099b4: 12 80 00 15 bne 40009a08 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 400099b8: 01 00 00 00 nop Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 400099bc: 7f ff e0 ee call 40001d74 400099c0: 01 00 00 00 nop 400099c4: a0 10 00 08 mov %o0, %l0 400099c8: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 400099cc: 03 00 00 ef sethi %hi(0x3bc00), %g1 400099d0: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 400099d4: 80 88 80 01 btst %g2, %g1 400099d8: 02 80 00 0a be 40009a00 <_Thread_queue_Requeue+0x64> <== NEVER TAKEN 400099dc: 90 10 00 18 mov %i0, %o0 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 400099e0: 92 10 00 19 mov %i1, %o1 400099e4: 94 10 20 01 mov 1, %o2 400099e8: 40 00 0e 5d call 4000d35c <_Thread_queue_Extract_priority_helper> 400099ec: e2 26 20 30 st %l1, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 400099f0: 90 10 00 18 mov %i0, %o0 400099f4: 92 10 00 19 mov %i1, %o1 400099f8: 7f ff ff 49 call 4000971c <_Thread_queue_Enqueue_priority> 400099fc: 94 07 bf fc add %fp, -4, %o2 } _ISR_Enable( level ); 40009a00: 7f ff e0 e1 call 40001d84 40009a04: 90 10 00 10 mov %l0, %o0 40009a08: 81 c7 e0 08 ret 40009a0c: 81 e8 00 00 restore =============================================================================== 40009a10 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 40009a10: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009a14: 90 10 00 18 mov %i0, %o0 40009a18: 7f ff fd f9 call 400091fc <_Thread_Get> 40009a1c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009a20: c2 07 bf fc ld [ %fp + -4 ], %g1 40009a24: 80 a0 60 00 cmp %g1, 0 40009a28: 12 80 00 08 bne 40009a48 <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 40009a2c: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40009a30: 40 00 0e 83 call 4000d43c <_Thread_queue_Process_timeout> 40009a34: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40009a38: 03 10 00 59 sethi %hi(0x40016400), %g1 40009a3c: c4 00 61 20 ld [ %g1 + 0x120 ], %g2 ! 40016520 <_Thread_Dispatch_disable_level> 40009a40: 84 00 bf ff add %g2, -1, %g2 40009a44: c4 20 61 20 st %g2, [ %g1 + 0x120 ] 40009a48: 81 c7 e0 08 ret 40009a4c: 81 e8 00 00 restore =============================================================================== 4001738c <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 4001738c: 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; 40017390: 39 10 00 ff sethi %hi(0x4003fc00), %i4 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40017394: b6 07 bf f4 add %fp, -12, %i3 40017398: ae 07 bf f8 add %fp, -8, %l7 4001739c: a4 07 bf e8 add %fp, -24, %l2 400173a0: a6 07 bf ec add %fp, -20, %l3 400173a4: ee 27 bf f4 st %l7, [ %fp + -12 ] head->previous = NULL; 400173a8: c0 27 bf f8 clr [ %fp + -8 ] tail->previous = head; 400173ac: 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; 400173b0: e6 27 bf e8 st %l3, [ %fp + -24 ] head->previous = NULL; 400173b4: c0 27 bf ec clr [ %fp + -20 ] tail->previous = head; 400173b8: 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 ); 400173bc: 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(); 400173c0: 3b 10 00 fe sethi %hi(0x4003f800), %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 ); 400173c4: 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 ); 400173c8: 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 ); 400173cc: 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; 400173d0: 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; 400173d4: c2 07 20 60 ld [ %i4 + 0x60 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 400173d8: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 400173dc: 94 10 00 12 mov %l2, %o2 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 400173e0: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 400173e4: 90 10 00 14 mov %l4, %o0 400173e8: 40 00 12 01 call 4001bbec <_Watchdog_Adjust_to_chain> 400173ec: 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; 400173f0: 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(); 400173f4: e0 07 63 d8 ld [ %i5 + 0x3d8 ], %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 ) { 400173f8: 80 a4 00 0a cmp %l0, %o2 400173fc: 08 80 00 06 bleu 40017414 <_Timer_server_Body+0x88> 40017400: 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 ); 40017404: 90 10 00 11 mov %l1, %o0 40017408: 40 00 11 f9 call 4001bbec <_Watchdog_Adjust_to_chain> 4001740c: 94 10 00 12 mov %l2, %o2 40017410: 30 80 00 06 b,a 40017428 <_Timer_server_Body+0x9c> } else if ( snapshot < last_snapshot ) { 40017414: 1a 80 00 05 bcc 40017428 <_Timer_server_Body+0x9c> 40017418: 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 ); 4001741c: 92 10 20 01 mov 1, %o1 40017420: 40 00 11 cb call 4001bb4c <_Watchdog_Adjust> 40017424: 94 22 80 10 sub %o2, %l0, %o2 } watchdogs->last_snapshot = snapshot; 40017428: 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 ); 4001742c: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 40017430: 40 00 02 dd call 40017fa4 <_Chain_Get> 40017434: 01 00 00 00 nop if ( timer == NULL ) { 40017438: 92 92 20 00 orcc %o0, 0, %o1 4001743c: 02 80 00 0c be 4001746c <_Timer_server_Body+0xe0> 40017440: 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 ) { 40017444: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 40017448: 80 a0 60 01 cmp %g1, 1 4001744c: 02 80 00 05 be 40017460 <_Timer_server_Body+0xd4> 40017450: 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 ) { 40017454: 80 a0 60 03 cmp %g1, 3 40017458: 12 bf ff f5 bne 4001742c <_Timer_server_Body+0xa0> <== NEVER TAKEN 4001745c: 90 10 00 11 mov %l1, %o0 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 40017460: 40 00 12 17 call 4001bcbc <_Watchdog_Insert> 40017464: 92 02 60 10 add %o1, 0x10, %o1 40017468: 30 bf ff f1 b,a 4001742c <_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 ); 4001746c: 7f ff e0 2d call 4000f520 40017470: 01 00 00 00 nop tmp = ts->insert_chain; 40017474: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 if ( _Chain_Is_empty( insert_chain ) ) { 40017478: c2 07 bf f4 ld [ %fp + -12 ], %g1 4001747c: 80 a0 40 17 cmp %g1, %l7 40017480: 12 80 00 04 bne 40017490 <_Timer_server_Body+0x104> <== NEVER TAKEN 40017484: a0 10 20 01 mov 1, %l0 ts->insert_chain = NULL; 40017488: c0 26 20 78 clr [ %i0 + 0x78 ] do_loop = false; 4001748c: a0 10 20 00 clr %l0 } _ISR_Enable( level ); 40017490: 7f ff e0 28 call 4000f530 40017494: 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 ) { 40017498: 80 8c 20 ff btst 0xff, %l0 4001749c: 12 bf ff ce bne 400173d4 <_Timer_server_Body+0x48> <== NEVER TAKEN 400174a0: 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 ) ) { 400174a4: 80 a0 40 13 cmp %g1, %l3 400174a8: 02 80 00 18 be 40017508 <_Timer_server_Body+0x17c> 400174ac: 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 ); 400174b0: 7f ff e0 1c call 4000f520 400174b4: 01 00 00 00 nop 400174b8: 84 10 00 08 mov %o0, %g2 initialized = false; } #endif return status; } 400174bc: 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)) 400174c0: 80 a4 00 13 cmp %l0, %l3 400174c4: 02 80 00 0e be 400174fc <_Timer_server_Body+0x170> 400174c8: 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; 400174cc: c2 04 00 00 ld [ %l0 ], %g1 head->next = new_first; 400174d0: 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 ) { 400174d4: 02 80 00 0a be 400174fc <_Timer_server_Body+0x170> <== NEVER TAKEN 400174d8: e4 20 60 04 st %l2, [ %g1 + 4 ] watchdog->state = WATCHDOG_INACTIVE; 400174dc: c0 24 20 08 clr [ %l0 + 8 ] _ISR_Enable( level ); 400174e0: 7f ff e0 14 call 4000f530 400174e4: 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 ); 400174e8: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 400174ec: d0 04 20 20 ld [ %l0 + 0x20 ], %o0 400174f0: 9f c0 40 00 call %g1 400174f4: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 } 400174f8: 30 bf ff ee b,a 400174b0 <_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 ); 400174fc: 7f ff e0 0d call 4000f530 40017500: 90 10 00 02 mov %g2, %o0 40017504: 30 bf ff b3 b,a 400173d0 <_Timer_server_Body+0x44> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 40017508: c0 2e 20 7c clrb [ %i0 + 0x7c ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); 4001750c: 7f ff ff 70 call 400172cc <_Thread_Disable_dispatch> 40017510: 01 00 00 00 nop _Thread_Set_state( ts->thread, STATES_DELAYING ); 40017514: d0 06 00 00 ld [ %i0 ], %o0 40017518: 40 00 0f d4 call 4001b468 <_Thread_Set_state> 4001751c: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 40017520: 7f ff ff 71 call 400172e4 <_Timer_server_Reset_interval_system_watchdog> 40017524: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 40017528: 7f ff ff 84 call 40017338 <_Timer_server_Reset_tod_system_watchdog> 4001752c: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 40017530: 40 00 0d 77 call 4001ab0c <_Thread_Enable_dispatch> 40017534: 01 00 00 00 nop ts->active = true; 40017538: 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 ); 4001753c: 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; 40017540: 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 ); 40017544: 40 00 12 3a call 4001be2c <_Watchdog_Remove> 40017548: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 4001754c: 40 00 12 38 call 4001be2c <_Watchdog_Remove> 40017550: 90 10 00 15 mov %l5, %o0 40017554: 30 bf ff 9f b,a 400173d0 <_Timer_server_Body+0x44> =============================================================================== 40017558 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 40017558: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 4001755c: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 40017560: 80 a0 60 00 cmp %g1, 0 40017564: 12 80 00 49 bne 40017688 <_Timer_server_Schedule_operation_method+0x130> 40017568: 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(); 4001756c: 7f ff ff 58 call 400172cc <_Thread_Disable_dispatch> 40017570: 01 00 00 00 nop if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 40017574: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 40017578: 80 a0 60 01 cmp %g1, 1 4001757c: 12 80 00 1f bne 400175f8 <_Timer_server_Schedule_operation_method+0xa0> 40017580: 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 ); 40017584: 7f ff df e7 call 4000f520 40017588: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 4001758c: 03 10 00 ff sethi %hi(0x4003fc00), %g1 40017590: c4 00 60 60 ld [ %g1 + 0x60 ], %g2 ! 4003fc60 <_Watchdog_Ticks_since_boot> initialized = false; } #endif return status; } 40017594: 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; 40017598: 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 ); 4001759c: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 400175a0: 80 a0 40 03 cmp %g1, %g3 400175a4: 02 80 00 08 be 400175c4 <_Timer_server_Schedule_operation_method+0x6c> 400175a8: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 400175ac: da 00 60 10 ld [ %g1 + 0x10 ], %o5 if (delta_interval > delta) { 400175b0: 80 a3 40 04 cmp %o5, %g4 400175b4: 08 80 00 03 bleu 400175c0 <_Timer_server_Schedule_operation_method+0x68> 400175b8: 86 10 20 00 clr %g3 delta_interval -= delta; 400175bc: 86 23 40 04 sub %o5, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 400175c0: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 400175c4: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 400175c8: 7f ff df da call 4000f530 400175cc: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 400175d0: 90 06 20 30 add %i0, 0x30, %o0 400175d4: 40 00 11 ba call 4001bcbc <_Watchdog_Insert> 400175d8: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 400175dc: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 400175e0: 80 a0 60 00 cmp %g1, 0 400175e4: 12 80 00 27 bne 40017680 <_Timer_server_Schedule_operation_method+0x128> 400175e8: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 400175ec: 7f ff ff 3e call 400172e4 <_Timer_server_Reset_interval_system_watchdog> 400175f0: 90 10 00 18 mov %i0, %o0 400175f4: 30 80 00 23 b,a 40017680 <_Timer_server_Schedule_operation_method+0x128> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 400175f8: 12 80 00 22 bne 40017680 <_Timer_server_Schedule_operation_method+0x128> 400175fc: 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 ); 40017600: 7f ff df c8 call 4000f520 40017604: 01 00 00 00 nop initialized = false; } #endif return status; } 40017608: 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; 4001760c: 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(); 40017610: 03 10 00 fe sethi %hi(0x4003f800), %g1 40017614: 86 06 20 6c add %i0, 0x6c, %g3 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 40017618: 80 a0 80 03 cmp %g2, %g3 4001761c: 02 80 00 0d be 40017650 <_Timer_server_Schedule_operation_method+0xf8> 40017620: c2 00 63 d8 ld [ %g1 + 0x3d8 ], %g1 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 40017624: c8 00 a0 10 ld [ %g2 + 0x10 ], %g4 if ( snapshot > last_snapshot ) { 40017628: 80 a0 40 0d cmp %g1, %o5 } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 4001762c: 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 ) { 40017630: 08 80 00 07 bleu 4001764c <_Timer_server_Schedule_operation_method+0xf4> 40017634: 86 20 c0 01 sub %g3, %g1, %g3 /* * We advanced in time. */ delta = snapshot - last_snapshot; 40017638: 9a 20 40 0d sub %g1, %o5, %o5 if (delta_interval > delta) { 4001763c: 80 a1 00 0d cmp %g4, %o5 40017640: 08 80 00 03 bleu 4001764c <_Timer_server_Schedule_operation_method+0xf4><== NEVER TAKEN 40017644: 86 10 20 00 clr %g3 delta_interval -= delta; 40017648: 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; 4001764c: c6 20 a0 10 st %g3, [ %g2 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 40017650: c2 26 20 74 st %g1, [ %i0 + 0x74 ] _ISR_Enable( level ); 40017654: 7f ff df b7 call 4000f530 40017658: 01 00 00 00 nop _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 4001765c: 90 06 20 68 add %i0, 0x68, %o0 40017660: 40 00 11 97 call 4001bcbc <_Watchdog_Insert> 40017664: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 40017668: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 4001766c: 80 a0 60 00 cmp %g1, 0 40017670: 12 80 00 04 bne 40017680 <_Timer_server_Schedule_operation_method+0x128> 40017674: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 40017678: 7f ff ff 30 call 40017338 <_Timer_server_Reset_tod_system_watchdog> 4001767c: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 40017680: 40 00 0d 23 call 4001ab0c <_Thread_Enable_dispatch> 40017684: 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 ); 40017688: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 4001768c: 40 00 02 30 call 40017f4c <_Chain_Append> 40017690: 81 e8 00 00 restore =============================================================================== 40009ebc <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40009ebc: 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 ); } } 40009ec0: 23 10 00 59 sethi %hi(0x40016400), %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 ); 40009ec4: b2 0e 60 ff and %i1, 0xff, %i1 } } 40009ec8: a2 14 63 08 or %l1, 0x308, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 40009ecc: 10 80 00 09 b 40009ef0 <_User_extensions_Fatal+0x34> 40009ed0: 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 ) 40009ed4: 80 a0 60 00 cmp %g1, 0 40009ed8: 02 80 00 05 be 40009eec <_User_extensions_Fatal+0x30> 40009edc: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 40009ee0: 92 10 00 19 mov %i1, %o1 40009ee4: 9f c0 40 00 call %g1 40009ee8: 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 ) { 40009eec: 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 ); 40009ef0: 80 a4 00 11 cmp %l0, %l1 40009ef4: 32 bf ff f8 bne,a 40009ed4 <_User_extensions_Fatal+0x18> <== ALWAYS TAKEN 40009ef8: 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 ); } } 40009efc: 81 c7 e0 08 ret <== NOT EXECUTED 40009f00: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40009d80 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 40009d80: 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; 40009d84: 03 10 00 56 sethi %hi(0x40015800), %g1 40009d88: 82 10 62 38 or %g1, 0x238, %g1 ! 40015a38 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40009d8c: 05 10 00 59 sethi %hi(0x40016400), %g2 initial_extensions = Configuration.User_extension_table; 40009d90: 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; 40009d94: e4 00 60 38 ld [ %g1 + 0x38 ], %l2 40009d98: 82 10 a3 08 or %g2, 0x308, %g1 40009d9c: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40009da0: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 40009da4: 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; 40009da8: c6 20 a3 08 st %g3, [ %g2 + 0x308 ] 40009dac: 05 10 00 59 sethi %hi(0x40016400), %g2 40009db0: 82 10 a1 24 or %g2, 0x124, %g1 ! 40016524 <_User_extensions_Switches_list> 40009db4: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40009db8: c0 20 60 04 clr [ %g1 + 4 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40009dbc: c6 20 a1 24 st %g3, [ %g2 + 0x124 ] initial_extensions = Configuration.User_extension_table; _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 40009dc0: 80 a4 e0 00 cmp %l3, 0 40009dc4: 02 80 00 1b be 40009e30 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 40009dc8: c2 20 60 08 st %g1, [ %g1 + 8 ] extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) 40009dcc: 83 2c a0 02 sll %l2, 2, %g1 40009dd0: a1 2c a0 04 sll %l2, 4, %l0 40009dd4: a0 24 00 01 sub %l0, %g1, %l0 40009dd8: a0 04 00 12 add %l0, %l2, %l0 40009ddc: 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( 40009de0: 40 00 01 6c call 4000a390 <_Workspace_Allocate_or_fatal_error> 40009de4: 90 10 00 10 mov %l0, %o0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40009de8: 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( 40009dec: a2 10 00 08 mov %o0, %l1 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40009df0: 92 10 20 00 clr %o1 40009df4: 40 00 17 32 call 4000fabc 40009df8: a0 10 20 00 clr %l0 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 40009dfc: 10 80 00 0b b 40009e28 <_User_extensions_Handler_initialization+0xa8> 40009e00: 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; 40009e04: 90 04 60 14 add %l1, 0x14, %o0 40009e08: 92 04 c0 09 add %l3, %o1, %o1 40009e0c: 40 00 16 f3 call 4000f9d8 40009e10: 94 10 20 20 mov 0x20, %o2 _User_extensions_Add_set( extension ); 40009e14: 90 10 00 11 mov %l1, %o0 40009e18: 40 00 0d ca call 4000d540 <_User_extensions_Add_set> 40009e1c: a0 04 20 01 inc %l0 _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; 40009e20: 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++ ) { 40009e24: 80 a4 00 12 cmp %l0, %l2 40009e28: 0a bf ff f7 bcs 40009e04 <_User_extensions_Handler_initialization+0x84> 40009e2c: 93 2c 20 05 sll %l0, 5, %o1 40009e30: 81 c7 e0 08 ret 40009e34: 81 e8 00 00 restore =============================================================================== 4000c070 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4000c070: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 4000c074: 7f ff db 4b call 40002da0 4000c078: a0 10 00 18 mov %i0, %l0 } } _ISR_Enable( level ); } 4000c07c: 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 ); 4000c080: 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 ) ) { 4000c084: 80 a0 40 11 cmp %g1, %l1 4000c088: 02 80 00 1f be 4000c104 <_Watchdog_Adjust+0x94> 4000c08c: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 4000c090: 02 80 00 1a be 4000c0f8 <_Watchdog_Adjust+0x88> 4000c094: a4 10 20 01 mov 1, %l2 4000c098: 80 a6 60 01 cmp %i1, 1 4000c09c: 12 80 00 1a bne 4000c104 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000c0a0: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4000c0a4: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000c0a8: 10 80 00 07 b 4000c0c4 <_Watchdog_Adjust+0x54> 4000c0ac: b4 00 80 1a add %g2, %i2, %i2 break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { 4000c0b0: f2 00 60 10 ld [ %g1 + 0x10 ], %i1 4000c0b4: 80 a6 80 19 cmp %i2, %i1 4000c0b8: 3a 80 00 05 bcc,a 4000c0cc <_Watchdog_Adjust+0x5c> 4000c0bc: e4 20 60 10 st %l2, [ %g1 + 0x10 ] _Watchdog_First( header )->delta_interval -= units; 4000c0c0: b4 26 40 1a sub %i1, %i2, %i2 break; 4000c0c4: 10 80 00 10 b 4000c104 <_Watchdog_Adjust+0x94> 4000c0c8: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; _ISR_Enable( level ); 4000c0cc: 7f ff db 39 call 40002db0 4000c0d0: 01 00 00 00 nop _Watchdog_Tickle( header ); 4000c0d4: 40 00 00 94 call 4000c324 <_Watchdog_Tickle> 4000c0d8: 90 10 00 10 mov %l0, %o0 _ISR_Disable( level ); 4000c0dc: 7f ff db 31 call 40002da0 4000c0e0: 01 00 00 00 nop if ( _Chain_Is_empty( header ) ) 4000c0e4: c2 04 00 00 ld [ %l0 ], %g1 4000c0e8: 80 a0 40 11 cmp %g1, %l1 4000c0ec: 02 80 00 06 be 4000c104 <_Watchdog_Adjust+0x94> 4000c0f0: 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; 4000c0f4: 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 ) { 4000c0f8: 80 a6 a0 00 cmp %i2, 0 4000c0fc: 32 bf ff ed bne,a 4000c0b0 <_Watchdog_Adjust+0x40> <== ALWAYS TAKEN 4000c100: c2 04 00 00 ld [ %l0 ], %g1 } break; } } _ISR_Enable( level ); 4000c104: 7f ff db 2b call 40002db0 4000c108: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 4000a1a4 <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 4000a1a4: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 4000a1a8: 7f ff de f3 call 40001d74 4000a1ac: a0 10 00 18 mov %i0, %l0 previous_state = the_watchdog->state; 4000a1b0: f0 06 20 08 ld [ %i0 + 8 ], %i0 switch ( previous_state ) { 4000a1b4: 80 a6 20 01 cmp %i0, 1 4000a1b8: 22 80 00 1d be,a 4000a22c <_Watchdog_Remove+0x88> 4000a1bc: c0 24 20 08 clr [ %l0 + 8 ] 4000a1c0: 0a 80 00 1c bcs 4000a230 <_Watchdog_Remove+0x8c> 4000a1c4: 03 10 00 59 sethi %hi(0x40016400), %g1 4000a1c8: 80 a6 20 03 cmp %i0, 3 4000a1cc: 18 80 00 19 bgu 4000a230 <_Watchdog_Remove+0x8c> <== NEVER TAKEN 4000a1d0: 01 00 00 00 nop 4000a1d4: c2 04 00 00 ld [ %l0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 4000a1d8: c0 24 20 08 clr [ %l0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 4000a1dc: c4 00 40 00 ld [ %g1 ], %g2 4000a1e0: 80 a0 a0 00 cmp %g2, 0 4000a1e4: 02 80 00 07 be 4000a200 <_Watchdog_Remove+0x5c> 4000a1e8: 05 10 00 59 sethi %hi(0x40016400), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 4000a1ec: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 4000a1f0: c4 04 20 10 ld [ %l0 + 0x10 ], %g2 4000a1f4: 84 00 c0 02 add %g3, %g2, %g2 4000a1f8: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 4000a1fc: 05 10 00 59 sethi %hi(0x40016400), %g2 4000a200: c4 00 a2 2c ld [ %g2 + 0x22c ], %g2 ! 4001662c <_Watchdog_Sync_count> 4000a204: 80 a0 a0 00 cmp %g2, 0 4000a208: 22 80 00 07 be,a 4000a224 <_Watchdog_Remove+0x80> 4000a20c: c4 04 20 04 ld [ %l0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 4000a210: 05 10 00 5a sethi %hi(0x40016800), %g2 4000a214: c6 00 a2 60 ld [ %g2 + 0x260 ], %g3 ! 40016a60 <_Per_CPU_Information+0x8> 4000a218: 05 10 00 59 sethi %hi(0x40016400), %g2 4000a21c: c6 20 a1 c4 st %g3, [ %g2 + 0x1c4 ] ! 400165c4 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4000a220: c4 04 20 04 ld [ %l0 + 4 ], %g2 next->previous = previous; 4000a224: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 4000a228: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000a22c: 03 10 00 59 sethi %hi(0x40016400), %g1 4000a230: c2 00 62 30 ld [ %g1 + 0x230 ], %g1 ! 40016630 <_Watchdog_Ticks_since_boot> 4000a234: c2 24 20 18 st %g1, [ %l0 + 0x18 ] _ISR_Enable( level ); 4000a238: 7f ff de d3 call 40001d84 4000a23c: 01 00 00 00 nop return( previous_state ); } 4000a240: 81 c7 e0 08 ret 4000a244: 81 e8 00 00 restore =============================================================================== 4000b87c <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4000b87c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4000b880: 7f ff dc 1f call 400028fc 4000b884: a0 10 00 18 mov %i0, %l0 4000b888: b0 10 00 08 mov %o0, %i0 printk( "Watchdog Chain: %s %p\n", name, header ); 4000b88c: 11 10 00 7b sethi %hi(0x4001ec00), %o0 4000b890: 94 10 00 19 mov %i1, %o2 4000b894: 90 12 20 50 or %o0, 0x50, %o0 4000b898: 7f ff e6 05 call 400050ac 4000b89c: 92 10 00 10 mov %l0, %o1 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 4000b8a0: 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 ); 4000b8a4: 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 ) ) { 4000b8a8: 80 a4 40 19 cmp %l1, %i1 4000b8ac: 02 80 00 0e be 4000b8e4 <_Watchdog_Report_chain+0x68> 4000b8b0: 11 10 00 7b sethi %hi(0x4001ec00), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4000b8b4: 92 10 00 11 mov %l1, %o1 4000b8b8: 40 00 00 10 call 4000b8f8 <_Watchdog_Report> 4000b8bc: 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 ) 4000b8c0: 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 ) ; 4000b8c4: 80 a4 40 19 cmp %l1, %i1 4000b8c8: 12 bf ff fc bne 4000b8b8 <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 4000b8cc: 92 10 00 11 mov %l1, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4000b8d0: 11 10 00 7b sethi %hi(0x4001ec00), %o0 4000b8d4: 92 10 00 10 mov %l0, %o1 4000b8d8: 7f ff e5 f5 call 400050ac 4000b8dc: 90 12 20 68 or %o0, 0x68, %o0 4000b8e0: 30 80 00 03 b,a 4000b8ec <_Watchdog_Report_chain+0x70> } else { printk( "Chain is empty\n" ); 4000b8e4: 7f ff e5 f2 call 400050ac 4000b8e8: 90 12 20 78 or %o0, 0x78, %o0 } _ISR_Enable( level ); 4000b8ec: 7f ff dc 08 call 4000290c 4000b8f0: 81 e8 00 00 restore =============================================================================== 400073c8 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 400073c8: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 400073cc: 21 10 00 65 sethi %hi(0x40019400), %l0 400073d0: 40 00 04 6c call 40008580 400073d4: 90 14 20 74 or %l0, 0x74, %o0 ! 40019474 if (fcntl (fildes, F_GETFD) < 0) { 400073d8: 90 10 00 18 mov %i0, %o0 400073dc: 40 00 1c b3 call 4000e6a8 400073e0: 92 10 20 01 mov 1, %o1 400073e4: 80 a2 20 00 cmp %o0, 0 400073e8: 16 80 00 08 bge 40007408 400073ec: 80 a6 60 00 cmp %i1, 0 pthread_mutex_unlock(&aio_request_queue.mutex); 400073f0: 40 00 04 85 call 40008604 400073f4: 90 14 20 74 or %l0, 0x74, %o0 rtems_set_errno_and_return_minus_one (EBADF); 400073f8: 40 00 2a 05 call 40011c0c <__errno> 400073fc: 01 00 00 00 nop 40007400: 10 80 00 4e b 40007538 40007404: 82 10 20 09 mov 9, %g1 ! 9 } /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { 40007408: 32 80 00 2f bne,a 400074c4 4000740c: 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); 40007410: 11 10 00 65 sethi %hi(0x40019400), %o0 40007414: 92 10 00 18 mov %i0, %o1 40007418: 90 12 20 bc or %o0, 0xbc, %o0 4000741c: 40 00 00 bc call 4000770c 40007420: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40007424: a2 92 20 00 orcc %o0, 0, %l1 40007428: 32 80 00 1a bne,a 40007490 4000742c: 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; } 40007430: a0 14 20 74 or %l0, 0x74, %l0 r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { AIO_printf ("Request chain not on [WQ]\n"); if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40007434: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 40007438: 82 04 20 58 add %l0, 0x58, %g1 4000743c: 80 a0 80 01 cmp %g2, %g1 40007440: 02 80 00 48 be 40007560 <== NEVER TAKEN 40007444: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40007448: 92 10 00 18 mov %i0, %o1 4000744c: 40 00 00 b0 call 4000770c 40007450: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40007454: a2 92 20 00 orcc %o0, 0, %l1 40007458: 22 80 00 43 be,a 40007564 4000745c: 90 10 00 10 mov %l0, %o0 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40007460: 40 00 0a c3 call 40009f6c <_Chain_Extract> 40007464: 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); 40007468: 40 00 01 94 call 40007ab8 4000746c: 90 10 00 11 mov %l1, %o0 pthread_mutex_destroy (&r_chain->mutex); 40007470: 40 00 03 9b call 400082dc 40007474: 90 10 00 19 mov %i1, %o0 pthread_cond_destroy (&r_chain->mutex); 40007478: 40 00 02 bd call 40007f6c 4000747c: 90 10 00 19 mov %i1, %o0 free (r_chain); 40007480: 7f ff f3 1b call 400040ec 40007484: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007488: 10 80 00 0b b 400074b4 4000748c: 90 10 00 10 mov %l0, %o0 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 40007490: 40 00 04 3c call 40008580 40007494: 90 10 00 19 mov %i1, %o0 40007498: 40 00 0a b5 call 40009f6c <_Chain_Extract> 4000749c: 90 10 00 11 mov %l1, %o0 rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 400074a0: 40 00 01 86 call 40007ab8 400074a4: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&r_chain->mutex); 400074a8: 40 00 04 57 call 40008604 400074ac: 90 10 00 19 mov %i1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 400074b0: 90 14 20 74 or %l0, 0x74, %o0 400074b4: 40 00 04 54 call 40008604 400074b8: b0 10 20 00 clr %i0 return AIO_CANCELED; 400074bc: 81 c7 e0 08 ret 400074c0: 81 e8 00 00 restore } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { 400074c4: 80 a4 40 18 cmp %l1, %i0 400074c8: 12 80 00 17 bne 40007524 400074cc: 90 14 20 74 or %l0, 0x74, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EINVAL); } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 400074d0: 11 10 00 65 sethi %hi(0x40019400), %o0 400074d4: 92 10 00 11 mov %l1, %o1 400074d8: 90 12 20 bc or %o0, 0xbc, %o0 400074dc: 40 00 00 8c call 4000770c 400074e0: 94 10 20 00 clr %o2 if (r_chain == NULL) { 400074e4: b0 92 20 00 orcc %o0, 0, %i0 400074e8: 32 80 00 23 bne,a 40007574 400074ec: 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; } 400074f0: a0 14 20 74 or %l0, 0x74, %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)) { 400074f4: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 400074f8: 82 04 20 58 add %l0, 0x58, %g1 400074fc: 80 a0 80 01 cmp %g2, %g1 40007500: 02 80 00 18 be 40007560 <== NEVER TAKEN 40007504: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40007508: 92 10 00 11 mov %l1, %o1 4000750c: 40 00 00 80 call 4000770c 40007510: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40007514: 80 a2 20 00 cmp %o0, 0 40007518: 12 80 00 0b bne 40007544 4000751c: 92 10 00 19 mov %i1, %o1 pthread_mutex_unlock (&aio_request_queue.mutex); 40007520: 90 10 00 10 mov %l0, %o0 40007524: 40 00 04 38 call 40008604 40007528: 01 00 00 00 nop rtems_set_errno_and_return_minus_one (EINVAL); 4000752c: 40 00 29 b8 call 40011c0c <__errno> 40007530: 01 00 00 00 nop 40007534: 82 10 20 16 mov 0x16, %g1 ! 16 40007538: c2 22 00 00 st %g1, [ %o0 ] 4000753c: 81 c7 e0 08 ret 40007540: 91 e8 3f ff restore %g0, -1, %o0 } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 40007544: 40 00 01 71 call 40007b08 40007548: 90 02 20 08 add %o0, 8, %o0 4000754c: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007550: 40 00 04 2d call 40008604 40007554: 90 10 00 10 mov %l0, %o0 return result; 40007558: 81 c7 e0 08 ret 4000755c: 81 e8 00 00 restore } else { pthread_mutex_unlock (&aio_request_queue.mutex); 40007560: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40007564: 40 00 04 28 call 40008604 40007568: b0 10 20 02 mov 2, %i0 return AIO_ALLDONE; 4000756c: 81 c7 e0 08 ret 40007570: 81 e8 00 00 restore } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 40007574: 40 00 04 03 call 40008580 40007578: 90 10 00 11 mov %l1, %o0 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 4000757c: 92 10 00 19 mov %i1, %o1 40007580: 40 00 01 62 call 40007b08 40007584: 90 06 20 08 add %i0, 8, %o0 40007588: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&r_chain->mutex); 4000758c: 40 00 04 1e call 40008604 40007590: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007594: 40 00 04 1c call 40008604 40007598: 90 14 20 74 or %l0, 0x74, %o0 return result; } return AIO_ALLDONE; } 4000759c: 81 c7 e0 08 ret 400075a0: 81 e8 00 00 restore =============================================================================== 400075ac : int aio_fsync( int op, struct aiocb *aiocbp ) { 400075ac: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; if (op != O_SYNC) 400075b0: 03 00 00 08 sethi %hi(0x2000), %g1 400075b4: 80 a6 00 01 cmp %i0, %g1 400075b8: 12 80 00 10 bne 400075f8 400075bc: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 400075c0: d0 06 40 00 ld [ %i1 ], %o0 400075c4: 40 00 1c 39 call 4000e6a8 400075c8: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 400075cc: 90 0a 20 03 and %o0, 3, %o0 400075d0: 90 02 3f ff add %o0, -1, %o0 400075d4: 80 a2 20 01 cmp %o0, 1 400075d8: 18 80 00 08 bgu 400075f8 400075dc: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); 400075e0: 7f ff f4 43 call 400046ec 400075e4: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 400075e8: 80 a2 20 00 cmp %o0, 0 400075ec: 32 80 00 0b bne,a 40007618 <== ALWAYS TAKEN 400075f0: f2 22 20 14 st %i1, [ %o0 + 0x14 ] rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 400075f4: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED 400075f8: 82 10 3f ff mov -1, %g1 400075fc: e0 26 60 34 st %l0, [ %i1 + 0x34 ] 40007600: c2 26 60 38 st %g1, [ %i1 + 0x38 ] 40007604: 40 00 29 82 call 40011c0c <__errno> 40007608: b0 10 3f ff mov -1, %i0 4000760c: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } 40007610: 81 c7 e0 08 ret 40007614: 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; 40007618: 82 10 20 03 mov 3, %g1 4000761c: c2 26 60 30 st %g1, [ %i1 + 0x30 ] return rtems_aio_enqueue (req); 40007620: 40 00 01 56 call 40007b78 40007624: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40007da8 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 40007da8: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007dac: d0 06 00 00 ld [ %i0 ], %o0 40007db0: 40 00 1a 3e call 4000e6a8 40007db4: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40007db8: 90 0a 20 03 and %o0, 3, %o0 40007dbc: 80 a2 20 02 cmp %o0, 2 40007dc0: 02 80 00 05 be 40007dd4 40007dc4: a0 10 00 18 mov %i0, %l0 40007dc8: 80 a2 20 00 cmp %o0, 0 40007dcc: 12 80 00 10 bne 40007e0c <== ALWAYS TAKEN 40007dd0: 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) 40007dd4: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40007dd8: 80 a0 60 00 cmp %g1, 0 40007ddc: 32 80 00 0c bne,a 40007e0c 40007de0: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007de4: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007de8: 80 a0 60 00 cmp %g1, 0 40007dec: 26 80 00 08 bl,a 40007e0c 40007df0: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007df4: 7f ff f2 3e call 400046ec 40007df8: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007dfc: 80 a2 20 00 cmp %o0, 0 40007e00: 32 80 00 0b bne,a 40007e2c <== ALWAYS TAKEN 40007e04: e0 22 20 14 st %l0, [ %o0 + 0x14 ] 40007e08: a2 10 20 0b mov 0xb, %l1 <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007e0c: 82 10 3f ff mov -1, %g1 40007e10: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40007e14: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40007e18: 40 00 27 7d call 40011c0c <__errno> 40007e1c: b0 10 3f ff mov -1, %i0 40007e20: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; return rtems_aio_enqueue (req); } 40007e24: 81 c7 e0 08 ret 40007e28: 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; 40007e2c: 82 10 20 01 mov 1, %g1 40007e30: c2 24 20 30 st %g1, [ %l0 + 0x30 ] return rtems_aio_enqueue (req); 40007e34: 7f ff ff 51 call 40007b78 40007e38: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40007e48 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40007e48: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007e4c: d0 06 00 00 ld [ %i0 ], %o0 40007e50: 40 00 1a 16 call 4000e6a8 40007e54: 92 10 20 03 mov 3, %o1 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40007e58: 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))) 40007e5c: 90 0a 20 03 and %o0, 3, %o0 40007e60: 90 02 3f ff add %o0, -1, %o0 40007e64: 80 a2 20 01 cmp %o0, 1 40007e68: 18 80 00 10 bgu 40007ea8 40007e6c: 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) 40007e70: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 40007e74: 80 a0 60 00 cmp %g1, 0 40007e78: 32 80 00 0c bne,a 40007ea8 40007e7c: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007e80: c2 06 20 08 ld [ %i0 + 8 ], %g1 40007e84: 80 a0 60 00 cmp %g1, 0 40007e88: 26 80 00 08 bl,a 40007ea8 40007e8c: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007e90: 7f ff f2 17 call 400046ec 40007e94: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007e98: 80 a2 20 00 cmp %o0, 0 40007e9c: 32 80 00 0b bne,a 40007ec8 <== ALWAYS TAKEN 40007ea0: f0 22 20 14 st %i0, [ %o0 + 0x14 ] 40007ea4: a2 10 20 0b mov 0xb, %l1 <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007ea8: 82 10 3f ff mov -1, %g1 40007eac: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40007eb0: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40007eb4: 40 00 27 56 call 40011c0c <__errno> 40007eb8: b0 10 3f ff mov -1, %i0 40007ebc: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; return rtems_aio_enqueue (req); } 40007ec0: 81 c7 e0 08 ret 40007ec4: 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; 40007ec8: 82 10 20 02 mov 2, %g1 40007ecc: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 40007ed0: 7f ff ff 2a call 40007b78 40007ed4: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 400069dc : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 400069dc: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 400069e0: 90 96 60 00 orcc %i1, 0, %o0 400069e4: 12 80 00 06 bne 400069fc 400069e8: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); 400069ec: 40 00 26 3f call 400102e8 <__errno> 400069f0: 01 00 00 00 nop 400069f4: 10 80 00 15 b 40006a48 400069f8: 82 10 20 16 mov 0x16, %g1 ! 16 if ( clock_id == CLOCK_REALTIME ) { 400069fc: 12 80 00 05 bne 40006a10 40006a00: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); 40006a04: 40 00 07 d8 call 40008964 <_TOD_Get> 40006a08: b0 10 20 00 clr %i0 40006a0c: 30 80 00 16 b,a 40006a64 return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 40006a10: 02 80 00 05 be 40006a24 <== NEVER TAKEN 40006a14: 01 00 00 00 nop return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 40006a18: 80 a6 20 02 cmp %i0, 2 40006a1c: 12 80 00 06 bne 40006a34 40006a20: 80 a6 20 03 cmp %i0, 3 _TOD_Get_uptime_as_timespec( tp ); 40006a24: 40 00 07 ec call 400089d4 <_TOD_Get_uptime_as_timespec> 40006a28: b0 10 20 00 clr %i0 return 0; 40006a2c: 81 c7 e0 08 ret 40006a30: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 40006a34: 12 80 00 08 bne 40006a54 40006a38: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 40006a3c: 40 00 26 2b call 400102e8 <__errno> 40006a40: 01 00 00 00 nop 40006a44: 82 10 20 58 mov 0x58, %g1 ! 58 40006a48: c2 22 00 00 st %g1, [ %o0 ] 40006a4c: 81 c7 e0 08 ret 40006a50: 91 e8 3f ff restore %g0, -1, %o0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40006a54: 40 00 26 25 call 400102e8 <__errno> 40006a58: b0 10 3f ff mov -1, %i0 40006a5c: 82 10 20 16 mov 0x16, %g1 40006a60: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40006a64: 81 c7 e0 08 ret 40006a68: 81 e8 00 00 restore =============================================================================== 40006a6c : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 40006a6c: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40006a70: 90 96 60 00 orcc %i1, 0, %o0 40006a74: 02 80 00 0b be 40006aa0 <== NEVER TAKEN 40006a78: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40006a7c: 80 a6 20 01 cmp %i0, 1 40006a80: 12 80 00 15 bne 40006ad4 40006a84: 80 a6 20 02 cmp %i0, 2 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 40006a88: c4 02 00 00 ld [ %o0 ], %g2 40006a8c: 03 08 76 b9 sethi %hi(0x21dae400), %g1 40006a90: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 40006a94: 80 a0 80 01 cmp %g2, %g1 40006a98: 38 80 00 06 bgu,a 40006ab0 40006a9c: 03 10 00 81 sethi %hi(0x40020400), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40006aa0: 40 00 26 12 call 400102e8 <__errno> 40006aa4: 01 00 00 00 nop 40006aa8: 10 80 00 13 b 40006af4 40006aac: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006ab0: c4 00 63 a0 ld [ %g1 + 0x3a0 ], %g2 40006ab4: 84 00 a0 01 inc %g2 40006ab8: c4 20 63 a0 st %g2, [ %g1 + 0x3a0 ] _Thread_Disable_dispatch(); _TOD_Set( tp ); 40006abc: 40 00 07 dc call 40008a2c <_TOD_Set> 40006ac0: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40006ac4: 40 00 0d cb call 4000a1f0 <_Thread_Enable_dispatch> 40006ac8: 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; 40006acc: 81 c7 e0 08 ret 40006ad0: 81 e8 00 00 restore _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 40006ad4: 02 80 00 05 be 40006ae8 40006ad8: 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 ) 40006adc: 80 a6 20 03 cmp %i0, 3 40006ae0: 12 80 00 08 bne 40006b00 40006ae4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 40006ae8: 40 00 26 00 call 400102e8 <__errno> 40006aec: 01 00 00 00 nop 40006af0: 82 10 20 58 mov 0x58, %g1 ! 58 40006af4: c2 22 00 00 st %g1, [ %o0 ] 40006af8: 81 c7 e0 08 ret 40006afc: 91 e8 3f ff restore %g0, -1, %o0 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 40006b00: 40 00 25 fa call 400102e8 <__errno> 40006b04: b0 10 3f ff mov -1, %i0 40006b08: 82 10 20 16 mov 0x16, %g1 40006b0c: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40006b10: 81 c7 e0 08 ret 40006b14: 81 e8 00 00 restore =============================================================================== 40024ae4 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 40024ae4: 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() ) 40024ae8: 7f ff ff 37 call 400247c4 40024aec: 01 00 00 00 nop 40024af0: 80 a6 00 08 cmp %i0, %o0 40024af4: 02 80 00 06 be 40024b0c 40024af8: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40024afc: 7f ff bf 63 call 40014888 <__errno> 40024b00: 01 00 00 00 nop 40024b04: 10 80 00 07 b 40024b20 40024b08: 82 10 20 03 mov 3, %g1 ! 3 /* * Validate the signal passed. */ if ( !sig ) 40024b0c: 12 80 00 08 bne 40024b2c 40024b10: a0 06 7f ff add %i1, -1, %l0 rtems_set_errno_and_return_minus_one( EINVAL ); 40024b14: 7f ff bf 5d call 40014888 <__errno> 40024b18: 01 00 00 00 nop 40024b1c: 82 10 20 16 mov 0x16, %g1 ! 16 40024b20: c2 22 00 00 st %g1, [ %o0 ] 40024b24: 10 80 00 a6 b 40024dbc 40024b28: 90 10 3f ff mov -1, %o0 if ( !is_valid_signo(sig) ) 40024b2c: 80 a4 20 1f cmp %l0, 0x1f 40024b30: 18 bf ff f9 bgu 40024b14 40024b34: 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 ) 40024b38: 83 2e 60 02 sll %i1, 2, %g1 40024b3c: 85 2e 60 04 sll %i1, 4, %g2 40024b40: 84 20 80 01 sub %g2, %g1, %g2 40024b44: 03 10 00 a2 sethi %hi(0x40028800), %g1 40024b48: 82 10 62 f0 or %g1, 0x2f0, %g1 ! 40028af0 <_POSIX_signals_Vectors> 40024b4c: 82 00 40 02 add %g1, %g2, %g1 40024b50: c2 00 60 08 ld [ %g1 + 8 ], %g1 40024b54: 80 a0 60 01 cmp %g1, 1 40024b58: 02 80 00 99 be 40024dbc 40024b5c: 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 ) ) 40024b60: 80 a6 60 04 cmp %i1, 4 40024b64: 02 80 00 06 be 40024b7c 40024b68: 80 a6 60 08 cmp %i1, 8 40024b6c: 02 80 00 04 be 40024b7c 40024b70: 80 a6 60 0b cmp %i1, 0xb 40024b74: 12 80 00 08 bne 40024b94 40024b78: 82 10 20 01 mov 1, %g1 return pthread_kill( pthread_self(), sig ); 40024b7c: 40 00 01 26 call 40025014 40024b80: 01 00 00 00 nop 40024b84: 40 00 00 ea call 40024f2c 40024b88: 92 10 00 19 mov %i1, %o1 40024b8c: 81 c7 e0 08 ret 40024b90: 91 e8 00 08 restore %g0, %o0, %o0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 40024b94: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 40024b98: c2 27 bf f8 st %g1, [ %fp + -8 ] if ( !value ) { 40024b9c: 80 a6 a0 00 cmp %i2, 0 40024ba0: 12 80 00 04 bne 40024bb0 40024ba4: a1 28 40 10 sll %g1, %l0, %l0 siginfo->si_value.sival_int = 0; 40024ba8: 10 80 00 04 b 40024bb8 40024bac: c0 27 bf fc clr [ %fp + -4 ] } else { siginfo->si_value = *value; 40024bb0: c2 06 80 00 ld [ %i2 ], %g1 40024bb4: c2 27 bf fc st %g1, [ %fp + -4 ] 40024bb8: 03 10 00 a1 sethi %hi(0x40028400), %g1 40024bbc: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 ! 40028560 <_Thread_Dispatch_disable_level> 40024bc0: 84 00 a0 01 inc %g2 40024bc4: c4 20 61 60 st %g2, [ %g1 + 0x160 ] /* * 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; 40024bc8: 03 10 00 a2 sethi %hi(0x40028800), %g1 40024bcc: d0 00 62 a4 ld [ %g1 + 0x2a4 ], %o0 ! 40028aa4 <_Per_CPU_Information+0xc> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 40024bd0: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 40024bd4: c2 00 60 d0 ld [ %g1 + 0xd0 ], %g1 40024bd8: 80 ac 00 01 andncc %l0, %g1, %g0 40024bdc: 12 80 00 51 bne 40024d20 40024be0: 03 10 00 a3 sethi %hi(0x40028c00), %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 ); 40024be4: 05 10 00 a3 sethi %hi(0x40028c00), %g2 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 40024be8: c2 00 60 7c ld [ %g1 + 0x7c ], %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 ); 40024bec: 10 80 00 0b b 40024c18 40024bf0: 84 10 a0 80 or %g2, 0x80, %g2 !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 40024bf4: 90 10 00 01 mov %g1, %o0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 40024bf8: 80 8c 00 04 btst %l0, %g4 40024bfc: 12 80 00 49 bne 40024d20 40024c00: 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) 40024c04: c6 00 e0 d0 ld [ %g3 + 0xd0 ], %g3 40024c08: 80 ac 00 03 andncc %l0, %g3, %g0 40024c0c: 12 80 00 46 bne 40024d24 40024c10: 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 ) { 40024c14: 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 ); 40024c18: 80 a0 40 02 cmp %g1, %g2 40024c1c: 32 bf ff f6 bne,a 40024bf4 40024c20: c8 00 60 30 ld [ %g1 + 0x30 ], %g4 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 40024c24: 03 10 00 9e sethi %hi(0x40027800), %g1 40024c28: c6 08 60 f4 ldub [ %g1 + 0xf4 ], %g3 ! 400278f4 40024c2c: 05 10 00 a1 sethi %hi(0x40028400), %g2 40024c30: 86 00 e0 01 inc %g3 40024c34: 84 10 a0 d0 or %g2, 0xd0, %g2 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 40024c38: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 40024c3c: 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); 40024c40: 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 ] ) 40024c44: c2 00 80 00 ld [ %g2 ], %g1 40024c48: 80 a0 60 00 cmp %g1, 0 40024c4c: 22 80 00 2f be,a 40024d08 <== NEVER TAKEN 40024c50: 84 00 a0 04 add %g2, 4, %g2 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 40024c54: 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++ ) { 40024c58: 9a 10 20 01 mov 1, %o5 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 40024c5c: f4 10 60 10 lduh [ %g1 + 0x10 ], %i2 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40024c60: 10 80 00 26 b 40024cf8 40024c64: de 00 60 1c ld [ %g1 + 0x1c ], %o7 the_thread = (Thread_Control *) object_table[ index ]; 40024c68: c2 03 c0 01 ld [ %o7 + %g1 ], %g1 if ( !the_thread ) 40024c6c: 80 a0 60 00 cmp %g1, 0 40024c70: 22 80 00 22 be,a 40024cf8 40024c74: 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 ) 40024c78: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 40024c7c: 80 a1 00 03 cmp %g4, %g3 40024c80: 38 80 00 1e bgu,a 40024cf8 40024c84: 9a 03 60 01 inc %o5 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 40024c88: d6 00 61 58 ld [ %g1 + 0x158 ], %o3 40024c8c: d6 02 e0 d0 ld [ %o3 + 0xd0 ], %o3 40024c90: 80 ac 00 0b andncc %l0, %o3, %g0 40024c94: 22 80 00 19 be,a 40024cf8 40024c98: 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 ) { 40024c9c: 80 a1 00 03 cmp %g4, %g3 40024ca0: 2a 80 00 14 bcs,a 40024cf0 40024ca4: 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 ) ) { 40024ca8: 80 a2 20 00 cmp %o0, 0 40024cac: 22 80 00 13 be,a 40024cf8 <== NEVER TAKEN 40024cb0: 9a 03 60 01 inc %o5 <== NOT EXECUTED 40024cb4: d4 02 20 10 ld [ %o0 + 0x10 ], %o2 40024cb8: 80 a2 a0 00 cmp %o2, 0 40024cbc: 22 80 00 0f be,a 40024cf8 <== NEVER TAKEN 40024cc0: 9a 03 60 01 inc %o5 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 40024cc4: d6 00 60 10 ld [ %g1 + 0x10 ], %o3 40024cc8: 80 a2 e0 00 cmp %o3, 0 40024ccc: 22 80 00 09 be,a 40024cf0 40024cd0: 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) ) { 40024cd4: 80 8a 80 0c btst %o2, %o4 40024cd8: 32 80 00 08 bne,a 40024cf8 40024cdc: 9a 03 60 01 inc %o5 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 40024ce0: 80 8a c0 0c btst %o3, %o4 40024ce4: 22 80 00 05 be,a 40024cf8 40024ce8: 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 ) ) { 40024cec: 86 10 00 04 mov %g4, %g3 40024cf0: 90 10 00 01 mov %g1, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40024cf4: 9a 03 60 01 inc %o5 40024cf8: 80 a3 40 1a cmp %o5, %i2 40024cfc: 08 bf ff db bleu 40024c68 40024d00: 83 2b 60 02 sll %o5, 2, %g1 40024d04: 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++) { 40024d08: 80 a0 80 09 cmp %g2, %o1 40024d0c: 32 bf ff cf bne,a 40024c48 40024d10: c2 00 80 00 ld [ %g2 ], %g1 } } } } if ( interested ) { 40024d14: 80 a2 20 00 cmp %o0, 0 40024d18: 02 80 00 08 be 40024d38 40024d1c: 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 ) ) { 40024d20: 92 10 00 19 mov %i1, %o1 40024d24: 40 00 00 33 call 40024df0 <_POSIX_signals_Unblock_thread> 40024d28: 94 07 bf f4 add %fp, -12, %o2 40024d2c: 80 8a 20 ff btst 0xff, %o0 40024d30: 12 80 00 20 bne 40024db0 40024d34: 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 ); 40024d38: 40 00 00 24 call 40024dc8 <_POSIX_signals_Set_process_signals> 40024d3c: 90 10 00 10 mov %l0, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 40024d40: 83 2e 60 02 sll %i1, 2, %g1 40024d44: b3 2e 60 04 sll %i1, 4, %i1 40024d48: b2 26 40 01 sub %i1, %g1, %i1 40024d4c: 03 10 00 a2 sethi %hi(0x40028800), %g1 40024d50: 82 10 62 f0 or %g1, 0x2f0, %g1 ! 40028af0 <_POSIX_signals_Vectors> 40024d54: c2 00 40 19 ld [ %g1 + %i1 ], %g1 40024d58: 80 a0 60 02 cmp %g1, 2 40024d5c: 12 80 00 15 bne 40024db0 40024d60: 11 10 00 a3 sethi %hi(0x40028c00), %o0 psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 40024d64: 7f ff 9f b9 call 4000cc48 <_Chain_Get> 40024d68: 90 12 20 70 or %o0, 0x70, %o0 ! 40028c70 <_POSIX_signals_Inactive_siginfo> if ( !psiginfo ) { 40024d6c: a0 92 20 00 orcc %o0, 0, %l0 40024d70: 12 80 00 08 bne 40024d90 40024d74: 92 07 bf f4 add %fp, -12, %o1 _Thread_Enable_dispatch(); 40024d78: 7f ff a6 dc call 4000e8e8 <_Thread_Enable_dispatch> 40024d7c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 40024d80: 7f ff be c2 call 40014888 <__errno> 40024d84: 01 00 00 00 nop 40024d88: 10 bf ff 66 b 40024b20 40024d8c: 82 10 20 0b mov 0xb, %g1 ! b } psiginfo->Info = *siginfo; 40024d90: 90 04 20 08 add %l0, 8, %o0 40024d94: 7f ff c1 17 call 400151f0 40024d98: 94 10 20 0c mov 0xc, %o2 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 40024d9c: 11 10 00 a3 sethi %hi(0x40028c00), %o0 40024da0: 92 10 00 10 mov %l0, %o1 40024da4: 90 12 20 e8 or %o0, 0xe8, %o0 40024da8: 7f ff 9f 92 call 4000cbf0 <_Chain_Append> 40024dac: 90 02 00 19 add %o0, %i1, %o0 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 40024db0: 7f ff a6 ce call 4000e8e8 <_Thread_Enable_dispatch> 40024db4: 01 00 00 00 nop return 0; 40024db8: 90 10 20 00 clr %o0 ! 0 } 40024dbc: b0 10 00 08 mov %o0, %i0 40024dc0: 81 c7 e0 08 ret 40024dc4: 81 e8 00 00 restore =============================================================================== 4000c1c0 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 4000c1c0: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 4000c1c4: 80 a0 60 00 cmp %g1, 0 4000c1c8: 02 80 00 0f be 4000c204 4000c1cc: 90 10 20 16 mov 0x16, %o0 4000c1d0: c4 00 40 00 ld [ %g1 ], %g2 4000c1d4: 80 a0 a0 00 cmp %g2, 0 4000c1d8: 02 80 00 0b be 4000c204 4000c1dc: 80 a2 60 04 cmp %o1, 4 return EINVAL; switch ( policy ) { 4000c1e0: 18 80 00 09 bgu 4000c204 4000c1e4: 90 10 20 86 mov 0x86, %o0 4000c1e8: 84 10 20 01 mov 1, %g2 4000c1ec: 85 28 80 09 sll %g2, %o1, %g2 4000c1f0: 80 88 a0 17 btst 0x17, %g2 4000c1f4: 02 80 00 04 be 4000c204 <== NEVER TAKEN 4000c1f8: 01 00 00 00 nop case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 4000c1fc: d2 20 60 14 st %o1, [ %g1 + 0x14 ] 4000c200: 90 10 20 00 clr %o0 return 0; default: return ENOTSUP; } } 4000c204: 81 c3 e0 08 retl =============================================================================== 40007030 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 40007030: 9d e3 bf 90 save %sp, -112, %sp 40007034: a0 10 00 18 mov %i0, %l0 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 40007038: 80 a4 20 00 cmp %l0, 0 4000703c: 02 80 00 1f be 400070b8 40007040: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( count == 0 ) 40007044: 80 a6 a0 00 cmp %i2, 0 40007048: 02 80 00 1c be 400070b8 4000704c: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40007050: 32 80 00 06 bne,a 40007068 40007054: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 40007058: b2 07 bf f0 add %fp, -16, %i1 4000705c: 7f ff ff bd call 40006f50 40007060: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40007064: c2 06 40 00 ld [ %i1 ], %g1 40007068: 80 a0 60 00 cmp %g1, 0 4000706c: 02 80 00 13 be 400070b8 40007070: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40007074: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007078: 80 a0 60 00 cmp %g1, 0 4000707c: 12 80 00 0f bne 400070b8 <== NEVER TAKEN 40007080: 03 10 00 5f sethi %hi(0x40017c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007084: c4 00 63 00 ld [ %g1 + 0x300 ], %g2 ! 40017f00 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 40007088: c0 27 bf f8 clr [ %fp + -8 ] the_attributes.maximum_count = count; 4000708c: f4 27 bf fc st %i2, [ %fp + -4 ] 40007090: 84 00 a0 01 inc %g2 40007094: c4 20 63 00 st %g2, [ %g1 + 0x300 ] * 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 ); 40007098: 25 10 00 60 sethi %hi(0x40018000), %l2 4000709c: 40 00 08 64 call 4000922c <_Objects_Allocate> 400070a0: 90 14 a2 c0 or %l2, 0x2c0, %o0 ! 400182c0 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 400070a4: a2 92 20 00 orcc %o0, 0, %l1 400070a8: 12 80 00 06 bne 400070c0 400070ac: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 400070b0: 40 00 0c e9 call 4000a454 <_Thread_Enable_dispatch> 400070b4: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 400070b8: 81 c7 e0 08 ret 400070bc: 81 e8 00 00 restore } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 400070c0: 40 00 05 cd call 400087f4 <_CORE_barrier_Initialize> 400070c4: 92 07 bf f8 add %fp, -8, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400070c8: 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; } 400070cc: a4 14 a2 c0 or %l2, 0x2c0, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400070d0: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400070d4: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400070d8: 85 28 a0 02 sll %g2, 2, %g2 400070dc: 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; 400070e0: c0 24 60 0c clr [ %l1 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 400070e4: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 400070e8: 40 00 0c db call 4000a454 <_Thread_Enable_dispatch> 400070ec: b0 10 20 00 clr %i0 return 0; } 400070f0: 81 c7 e0 08 ret 400070f4: 81 e8 00 00 restore =============================================================================== 400067e8 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 400067e8: 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 ) 400067ec: 80 a6 20 00 cmp %i0, 0 400067f0: 02 80 00 14 be 40006840 400067f4: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400067f8: 03 10 00 60 sethi %hi(0x40018000), %g1 400067fc: c4 00 62 a0 ld [ %g1 + 0x2a0 ], %g2 ! 400182a0 <_Thread_Dispatch_disable_level> 40006800: 84 00 a0 01 inc %g2 40006804: c4 20 62 a0 st %g2, [ %g1 + 0x2a0 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 40006808: 40 00 11 a8 call 4000aea8 <_Workspace_Allocate> 4000680c: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 40006810: 92 92 20 00 orcc %o0, 0, %o1 40006814: 02 80 00 09 be 40006838 <== NEVER TAKEN 40006818: 01 00 00 00 nop thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 4000681c: 03 10 00 61 sethi %hi(0x40018400), %g1 40006820: c2 00 63 e4 ld [ %g1 + 0x3e4 ], %g1 ! 400187e4 <_Per_CPU_Information+0xc> handler_stack = &thread_support->Cancellation_Handlers; 40006824: d0 00 61 58 ld [ %g1 + 0x158 ], %o0 handler->routine = routine; 40006828: f0 22 60 08 st %i0, [ %o1 + 8 ] handler->arg = arg; 4000682c: f2 22 60 0c st %i1, [ %o1 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 40006830: 40 00 06 02 call 40008038 <_Chain_Append> 40006834: 90 02 20 e4 add %o0, 0xe4, %o0 } _Thread_Enable_dispatch(); 40006838: 40 00 0d 0e call 40009c70 <_Thread_Enable_dispatch> 4000683c: 81 e8 00 00 restore 40006840: 81 c7 e0 08 ret 40006844: 81 e8 00 00 restore =============================================================================== 400078f0 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 400078f0: 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; 400078f4: 80 a6 60 00 cmp %i1, 0 400078f8: 12 80 00 04 bne 40007908 400078fc: a0 10 00 18 mov %i0, %l0 else the_attr = &_POSIX_Condition_variables_Default_attributes; 40007900: 33 10 00 5e sethi %hi(0x40017800), %i1 40007904: b2 16 62 94 or %i1, 0x294, %i1 ! 40017a94 <_POSIX_Condition_variables_Default_attributes> /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 40007908: c2 06 60 04 ld [ %i1 + 4 ], %g1 4000790c: 80 a0 60 01 cmp %g1, 1 40007910: 02 80 00 11 be 40007954 <== NEVER TAKEN 40007914: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !the_attr->is_initialized ) 40007918: c2 06 40 00 ld [ %i1 ], %g1 4000791c: 80 a0 60 00 cmp %g1, 0 40007920: 02 80 00 0d be 40007954 40007924: 03 10 00 64 sethi %hi(0x40019000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007928: c4 00 60 d0 ld [ %g1 + 0xd0 ], %g2 ! 400190d0 <_Thread_Dispatch_disable_level> 4000792c: 84 00 a0 01 inc %g2 40007930: c4 20 60 d0 st %g2, [ %g1 + 0xd0 ] RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 40007934: 25 10 00 65 sethi %hi(0x40019400), %l2 40007938: 40 00 09 cf call 4000a074 <_Objects_Allocate> 4000793c: 90 14 a1 28 or %l2, 0x128, %o0 ! 40019528 <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 40007940: a2 92 20 00 orcc %o0, 0, %l1 40007944: 32 80 00 06 bne,a 4000795c 40007948: c2 06 60 04 ld [ %i1 + 4 ], %g1 _Thread_Enable_dispatch(); 4000794c: 40 00 0e 54 call 4000b29c <_Thread_Enable_dispatch> 40007950: b0 10 20 0c mov 0xc, %i0 return ENOMEM; 40007954: 81 c7 e0 08 ret 40007958: 81 e8 00 00 restore the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 4000795c: 90 04 60 18 add %l1, 0x18, %o0 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40007960: c2 24 60 10 st %g1, [ %l1 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40007964: 92 10 20 00 clr %o1 40007968: 15 04 00 02 sethi %hi(0x10000800), %o2 4000796c: 96 10 20 74 mov 0x74, %o3 40007970: 40 00 10 45 call 4000ba84 <_Thread_queue_Initialize> 40007974: c0 24 60 14 clr [ %l1 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007978: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 4000797c: a4 14 a1 28 or %l2, 0x128, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007980: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007984: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007988: 85 28 a0 02 sll %g2, 2, %g2 4000798c: 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; 40007990: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 40007994: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40007998: 40 00 0e 41 call 4000b29c <_Thread_Enable_dispatch> 4000799c: b0 10 20 00 clr %i0 return 0; } 400079a0: 81 c7 e0 08 ret 400079a4: 81 e8 00 00 restore =============================================================================== 40007754 : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 40007754: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 40007758: 80 a0 60 00 cmp %g1, 0 4000775c: 02 80 00 08 be 4000777c 40007760: 90 10 20 16 mov 0x16, %o0 40007764: c4 00 40 00 ld [ %g1 ], %g2 40007768: 80 a0 a0 00 cmp %g2, 0 4000776c: 02 80 00 04 be 4000777c <== NEVER TAKEN 40007770: 01 00 00 00 nop return EINVAL; attr->is_initialized = false; 40007774: c0 20 40 00 clr [ %g1 ] return 0; 40007778: 90 10 20 00 clr %o0 } 4000777c: 81 c3 e0 08 retl =============================================================================== 40006cbc : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 40006cbc: 9d e3 bf 58 save %sp, -168, %sp 40006cc0: a0 10 00 18 mov %i0, %l0 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 40006cc4: 80 a6 a0 00 cmp %i2, 0 40006cc8: 02 80 00 66 be 40006e60 40006ccc: b0 10 20 0e mov 0xe, %i0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 40006cd0: 80 a6 60 00 cmp %i1, 0 40006cd4: 32 80 00 05 bne,a 40006ce8 40006cd8: c2 06 40 00 ld [ %i1 ], %g1 40006cdc: 33 10 00 77 sethi %hi(0x4001dc00), %i1 40006ce0: b2 16 63 5c or %i1, 0x35c, %i1 ! 4001df5c <_POSIX_Threads_Default_attributes> if ( !the_attr->is_initialized ) 40006ce4: c2 06 40 00 ld [ %i1 ], %g1 40006ce8: 80 a0 60 00 cmp %g1, 0 40006cec: 02 80 00 5d be 40006e60 40006cf0: 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) ) 40006cf4: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006cf8: 80 a0 60 00 cmp %g1, 0 40006cfc: 02 80 00 07 be 40006d18 40006d00: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40006d04: c4 06 60 08 ld [ %i1 + 8 ], %g2 40006d08: c2 00 60 d4 ld [ %g1 + 0xd4 ], %g1 40006d0c: 80 a0 80 01 cmp %g2, %g1 40006d10: 0a 80 00 79 bcs 40006ef4 40006d14: 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 ) { 40006d18: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 40006d1c: 80 a0 60 01 cmp %g1, 1 40006d20: 02 80 00 06 be 40006d38 40006d24: 80 a0 60 02 cmp %g1, 2 40006d28: 12 80 00 4e bne 40006e60 40006d2c: b0 10 20 16 mov 0x16, %i0 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 40006d30: 10 80 00 09 b 40006d54 40006d34: 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 ]; 40006d38: 03 10 00 7f sethi %hi(0x4001fc00), %g1 40006d3c: c2 00 60 d4 ld [ %g1 + 0xd4 ], %g1 ! 4001fcd4 <_Per_CPU_Information+0xc> schedpolicy = api->schedpolicy; schedparam = api->schedparam; 40006d40: 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 ]; 40006d44: d2 00 61 58 ld [ %g1 + 0x158 ], %o1 schedpolicy = api->schedpolicy; 40006d48: e4 02 60 84 ld [ %o1 + 0x84 ], %l2 schedparam = api->schedparam; 40006d4c: 10 80 00 04 b 40006d5c 40006d50: 92 02 60 88 add %o1, 0x88, %o1 break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 40006d54: 90 07 bf dc add %fp, -36, %o0 40006d58: 92 06 60 18 add %i1, 0x18, %o1 40006d5c: 40 00 26 b2 call 40010824 40006d60: 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 ) 40006d64: c2 06 60 0c ld [ %i1 + 0xc ], %g1 40006d68: 80 a0 60 00 cmp %g1, 0 40006d6c: 12 80 00 3d bne 40006e60 40006d70: b0 10 20 86 mov 0x86, %i0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 40006d74: d0 07 bf dc ld [ %fp + -36 ], %o0 40006d78: 40 00 1a 51 call 4000d6bc <_POSIX_Priority_Is_valid> 40006d7c: b0 10 20 16 mov 0x16, %i0 40006d80: 80 8a 20 ff btst 0xff, %o0 40006d84: 02 80 00 37 be 40006e60 <== NEVER TAKEN 40006d88: 03 10 00 7b sethi %hi(0x4001ec00), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 40006d8c: 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); 40006d90: e6 08 60 d8 ldub [ %g1 + 0xd8 ], %l3 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 40006d94: 90 10 00 12 mov %l2, %o0 40006d98: 92 07 bf dc add %fp, -36, %o1 40006d9c: 94 07 bf fc add %fp, -4, %o2 40006da0: 40 00 1a 52 call 4000d6e8 <_POSIX_Thread_Translate_sched_param> 40006da4: 96 07 bf f8 add %fp, -8, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 40006da8: b0 92 20 00 orcc %o0, 0, %i0 40006dac: 12 80 00 2d bne 40006e60 40006db0: 2b 10 00 7e sethi %hi(0x4001f800), %l5 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 40006db4: 40 00 06 0b call 400085e0 <_API_Mutex_Lock> 40006db8: d0 05 60 30 ld [ %l5 + 0x30 ], %o0 ! 4001f830 <_RTEMS_Allocator_Mutex> * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 40006dbc: 11 10 00 7e sethi %hi(0x4001f800), %o0 40006dc0: 40 00 08 ae call 40009078 <_Objects_Allocate> 40006dc4: 90 12 21 d0 or %o0, 0x1d0, %o0 ! 4001f9d0 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 40006dc8: a2 92 20 00 orcc %o0, 0, %l1 40006dcc: 32 80 00 04 bne,a 40006ddc 40006dd0: c2 06 60 08 ld [ %i1 + 8 ], %g1 _RTEMS_Unlock_allocator(); 40006dd4: 10 80 00 21 b 40006e58 40006dd8: d0 05 60 30 ld [ %l5 + 0x30 ], %o0 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 40006ddc: 05 10 00 7b sethi %hi(0x4001ec00), %g2 40006de0: d6 00 a0 d4 ld [ %g2 + 0xd4 ], %o3 ! 4001ecd4 40006de4: 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( 40006de8: 80 a2 c0 01 cmp %o3, %g1 40006dec: 1a 80 00 03 bcc 40006df8 40006df0: d4 06 60 04 ld [ %i1 + 4 ], %o2 40006df4: 96 10 00 01 mov %g1, %o3 40006df8: 82 10 20 01 mov 1, %g1 40006dfc: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40006e00: c2 07 bf fc ld [ %fp + -4 ], %g1 40006e04: 9a 0c e0 ff and %l3, 0xff, %o5 40006e08: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 40006e0c: c2 07 bf f8 ld [ %fp + -8 ], %g1 40006e10: c0 27 bf d4 clr [ %fp + -44 ] 40006e14: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40006e18: 82 07 bf d4 add %fp, -44, %g1 40006e1c: c0 23 a0 68 clr [ %sp + 0x68 ] 40006e20: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40006e24: 27 10 00 7e sethi %hi(0x4001f800), %l3 40006e28: 92 10 00 11 mov %l1, %o1 40006e2c: 90 14 e1 d0 or %l3, 0x1d0, %o0 40006e30: 98 10 20 00 clr %o4 40006e34: 40 00 0d 53 call 4000a380 <_Thread_Initialize> 40006e38: 9a 23 40 14 sub %o5, %l4, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 40006e3c: 80 8a 20 ff btst 0xff, %o0 40006e40: 12 80 00 0a bne 40006e68 40006e44: 90 14 e1 d0 or %l3, 0x1d0, %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 40006e48: 40 00 09 63 call 400093d4 <_Objects_Free> 40006e4c: 92 10 00 11 mov %l1, %o1 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 40006e50: 03 10 00 7e sethi %hi(0x4001f800), %g1 40006e54: d0 00 60 30 ld [ %g1 + 0x30 ], %o0 ! 4001f830 <_RTEMS_Allocator_Mutex> 40006e58: 40 00 05 f8 call 40008638 <_API_Mutex_Unlock> 40006e5c: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40006e60: 81 c7 e0 08 ret 40006e64: 81 e8 00 00 restore } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40006e68: e6 04 61 58 ld [ %l1 + 0x158 ], %l3 api->Attributes = *the_attr; 40006e6c: 92 10 00 19 mov %i1, %o1 40006e70: 94 10 20 40 mov 0x40, %o2 40006e74: 40 00 26 6c call 40010824 40006e78: 90 10 00 13 mov %l3, %o0 api->detachstate = the_attr->detachstate; 40006e7c: c2 06 60 3c ld [ %i1 + 0x3c ], %g1 api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006e80: 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; 40006e84: c2 24 e0 40 st %g1, [ %l3 + 0x40 ] api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006e88: 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; 40006e8c: e4 24 e0 84 st %l2, [ %l3 + 0x84 ] api->schedparam = schedparam; 40006e90: 40 00 26 65 call 40010824 40006e94: 90 04 e0 88 add %l3, 0x88, %o0 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40006e98: 90 10 00 11 mov %l1, %o0 40006e9c: 92 10 20 01 mov 1, %o1 40006ea0: 94 10 00 1a mov %i2, %o2 40006ea4: 96 10 00 1b mov %i3, %o3 40006ea8: 40 00 0f 82 call 4000acb0 <_Thread_Start> 40006eac: 98 10 20 00 clr %o4 _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 40006eb0: 80 a4 a0 04 cmp %l2, 4 40006eb4: 32 80 00 0a bne,a 40006edc 40006eb8: c2 04 60 08 ld [ %l1 + 8 ], %g1 _Watchdog_Insert_ticks( 40006ebc: 40 00 0f fc call 4000aeac <_Timespec_To_ticks> 40006ec0: 90 04 e0 90 add %l3, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006ec4: 92 04 e0 a8 add %l3, 0xa8, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006ec8: d0 24 e0 b4 st %o0, [ %l3 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006ecc: 11 10 00 7e sethi %hi(0x4001f800), %o0 40006ed0: 40 00 10 d0 call 4000b210 <_Watchdog_Insert> 40006ed4: 90 12 20 50 or %o0, 0x50, %o0 ! 4001f850 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 40006ed8: c2 04 60 08 ld [ %l1 + 8 ], %g1 40006edc: c2 24 00 00 st %g1, [ %l0 ] _RTEMS_Unlock_allocator(); 40006ee0: 03 10 00 7e sethi %hi(0x4001f800), %g1 40006ee4: 40 00 05 d5 call 40008638 <_API_Mutex_Unlock> 40006ee8: d0 00 60 30 ld [ %g1 + 0x30 ], %o0 ! 4001f830 <_RTEMS_Allocator_Mutex> return 0; 40006eec: 81 c7 e0 08 ret 40006ef0: 81 e8 00 00 restore } 40006ef4: 81 c7 e0 08 ret 40006ef8: 81 e8 00 00 restore =============================================================================== 40024f2c : int pthread_kill( pthread_t thread, int sig ) { 40024f2c: 9d e3 bf 98 save %sp, -104, %sp POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) 40024f30: 80 a6 60 00 cmp %i1, 0 40024f34: 02 80 00 06 be 40024f4c 40024f38: 90 10 00 18 mov %i0, %o0 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 40024f3c: a4 06 7f ff add %i1, -1, %l2 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 40024f40: 80 a4 a0 1f cmp %l2, 0x1f 40024f44: 08 80 00 08 bleu 40024f64 40024f48: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); 40024f4c: 7f ff be 4f call 40014888 <__errno> 40024f50: b0 10 3f ff mov -1, %i0 ! ffffffff 40024f54: 82 10 20 16 mov 0x16, %g1 40024f58: c2 22 00 00 st %g1, [ %o0 ] 40024f5c: 81 c7 e0 08 ret 40024f60: 81 e8 00 00 restore the_thread = _Thread_Get( thread, &location ); 40024f64: 7f ff a6 6e call 4000e91c <_Thread_Get> 40024f68: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40024f6c: c2 07 bf fc ld [ %fp + -4 ], %g1 40024f70: 80 a0 60 00 cmp %g1, 0 40024f74: 12 80 00 22 bne 40024ffc <== NEVER TAKEN 40024f78: 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 ) { 40024f7c: 85 2e 60 02 sll %i1, 2, %g2 40024f80: 87 2e 60 04 sll %i1, 4, %g3 40024f84: 86 20 c0 02 sub %g3, %g2, %g3 40024f88: 05 10 00 a2 sethi %hi(0x40028800), %g2 40024f8c: 84 10 a2 f0 or %g2, 0x2f0, %g2 ! 40028af0 <_POSIX_signals_Vectors> 40024f90: 84 00 80 03 add %g2, %g3, %g2 40024f94: c4 00 a0 08 ld [ %g2 + 8 ], %g2 40024f98: 80 a0 a0 01 cmp %g2, 1 40024f9c: 02 80 00 14 be 40024fec 40024fa0: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); 40024fa4: c4 00 60 d4 ld [ %g1 + 0xd4 ], %g2 static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); 40024fa8: a0 10 20 01 mov 1, %l0 (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); 40024fac: 92 10 00 19 mov %i1, %o1 40024fb0: a5 2c 00 12 sll %l0, %l2, %l2 40024fb4: 94 10 20 00 clr %o2 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); 40024fb8: a4 10 80 12 or %g2, %l2, %l2 (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); 40024fbc: 7f ff ff 8d call 40024df0 <_POSIX_signals_Unblock_thread> 40024fc0: e4 20 60 d4 st %l2, [ %g1 + 0xd4 ] if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40024fc4: 03 10 00 a2 sethi %hi(0x40028800), %g1 40024fc8: 82 10 62 98 or %g1, 0x298, %g1 ! 40028a98 <_Per_CPU_Information> 40024fcc: c4 00 60 08 ld [ %g1 + 8 ], %g2 40024fd0: 80 a0 a0 00 cmp %g2, 0 40024fd4: 02 80 00 06 be 40024fec 40024fd8: 01 00 00 00 nop 40024fdc: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40024fe0: 80 a4 40 02 cmp %l1, %g2 40024fe4: 22 80 00 02 be,a 40024fec 40024fe8: e0 28 60 18 stb %l0, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } _Thread_Enable_dispatch(); 40024fec: 7f ff a6 3f call 4000e8e8 <_Thread_Enable_dispatch> 40024ff0: b0 10 20 00 clr %i0 return 0; 40024ff4: 81 c7 e0 08 ret 40024ff8: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); 40024ffc: 7f ff be 23 call 40014888 <__errno> <== NOT EXECUTED 40025000: b0 10 3f ff mov -1, %i0 <== NOT EXECUTED 40025004: 82 10 20 03 mov 3, %g1 <== NOT EXECUTED 40025008: c2 22 00 00 st %g1, [ %o0 ] <== NOT EXECUTED } 4002500c: 81 c7 e0 08 ret <== NOT EXECUTED 40025010: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40008efc : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 40008efc: 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 ); 40008f00: 92 07 bf fc add %fp, -4, %o1 40008f04: 40 00 00 37 call 40008fe0 <_POSIX_Absolute_timeout_to_ticks> 40008f08: 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 ); 40008f0c: 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, 40008f10: 82 1a 20 03 xor %o0, 3, %g1 40008f14: 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 ); 40008f18: 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 ); 40008f1c: a2 60 3f ff subx %g0, -1, %l1 40008f20: 90 10 00 18 mov %i0, %o0 40008f24: 7f ff ff bd call 40008e18 <_POSIX_Mutex_Lock_support> 40008f28: 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) ) { 40008f2c: 80 a4 60 00 cmp %l1, 0 40008f30: 12 80 00 0c bne 40008f60 40008f34: 80 a2 20 10 cmp %o0, 0x10 40008f38: 12 80 00 0a bne 40008f60 <== NEVER TAKEN 40008f3c: 80 a4 20 00 cmp %l0, 0 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40008f40: 02 80 00 07 be 40008f5c <== NEVER TAKEN 40008f44: a0 04 3f ff add %l0, -1, %l0 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40008f48: 80 a4 20 01 cmp %l0, 1 40008f4c: 18 80 00 05 bgu 40008f60 <== NEVER TAKEN 40008f50: 01 00 00 00 nop status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 40008f54: 10 80 00 03 b 40008f60 40008f58: 90 10 20 74 mov 0x74, %o0 ! 74 40008f5c: 90 10 20 16 mov 0x16, %o0 <== NOT EXECUTED } return lock_status; } 40008f60: 81 c7 e0 08 ret 40008f64: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 400066d4 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 400066d4: 82 10 00 08 mov %o0, %g1 if ( !attr ) 400066d8: 80 a0 60 00 cmp %g1, 0 400066dc: 02 80 00 0b be 40006708 400066e0: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 400066e4: c4 00 40 00 ld [ %g1 ], %g2 400066e8: 80 a0 a0 00 cmp %g2, 0 400066ec: 02 80 00 07 be 40006708 400066f0: 80 a2 60 00 cmp %o1, 0 return EINVAL; if ( !type ) 400066f4: 02 80 00 05 be 40006708 <== NEVER TAKEN 400066f8: 01 00 00 00 nop return EINVAL; *type = attr->type; 400066fc: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 40006700: 90 10 20 00 clr %o0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 40006704: c2 22 40 00 st %g1, [ %o1 ] return 0; } 40006708: 81 c3 e0 08 retl =============================================================================== 40008ad8 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 40008ad8: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40008adc: 80 a0 60 00 cmp %g1, 0 40008ae0: 02 80 00 0a be 40008b08 40008ae4: 90 10 20 16 mov 0x16, %o0 40008ae8: c4 00 40 00 ld [ %g1 ], %g2 40008aec: 80 a0 a0 00 cmp %g2, 0 40008af0: 02 80 00 06 be 40008b08 40008af4: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40008af8: 18 80 00 04 bgu 40008b08 <== NEVER TAKEN 40008afc: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40008b00: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 40008b04: 90 10 20 00 clr %o0 default: return EINVAL; } } 40008b08: 81 c3 e0 08 retl =============================================================================== 40006740 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 40006740: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40006744: 80 a0 60 00 cmp %g1, 0 40006748: 02 80 00 0a be 40006770 4000674c: 90 10 20 16 mov 0x16, %o0 40006750: c4 00 40 00 ld [ %g1 ], %g2 40006754: 80 a0 a0 00 cmp %g2, 0 40006758: 02 80 00 06 be 40006770 <== NEVER TAKEN 4000675c: 80 a2 60 03 cmp %o1, 3 return EINVAL; switch ( type ) { 40006760: 18 80 00 04 bgu 40006770 40006764: 01 00 00 00 nop case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 40006768: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; 4000676c: 90 10 20 00 clr %o0 default: return EINVAL; } } 40006770: 81 c3 e0 08 retl =============================================================================== 400072e4 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 400072e4: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 400072e8: 80 a6 60 00 cmp %i1, 0 400072ec: 02 80 00 1c be 4000735c 400072f0: a0 10 00 18 mov %i0, %l0 400072f4: 80 a6 20 00 cmp %i0, 0 400072f8: 22 80 00 17 be,a 40007354 400072fc: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !once_control->init_executed ) { 40007300: c2 06 20 04 ld [ %i0 + 4 ], %g1 40007304: 80 a0 60 00 cmp %g1, 0 40007308: 12 80 00 13 bne 40007354 4000730c: b0 10 20 00 clr %i0 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 40007310: 90 10 21 00 mov 0x100, %o0 40007314: 92 10 21 00 mov 0x100, %o1 40007318: 40 00 03 09 call 40007f3c 4000731c: 94 07 bf fc add %fp, -4, %o2 if ( !once_control->init_executed ) { 40007320: c2 04 20 04 ld [ %l0 + 4 ], %g1 40007324: 80 a0 60 00 cmp %g1, 0 40007328: 12 80 00 07 bne 40007344 <== NEVER TAKEN 4000732c: d0 07 bf fc ld [ %fp + -4 ], %o0 once_control->is_initialized = true; 40007330: 82 10 20 01 mov 1, %g1 40007334: c2 24 00 00 st %g1, [ %l0 ] once_control->init_executed = true; (*init_routine)(); 40007338: 9f c6 40 00 call %i1 4000733c: c2 24 20 04 st %g1, [ %l0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 40007340: d0 07 bf fc ld [ %fp + -4 ], %o0 40007344: 92 10 21 00 mov 0x100, %o1 40007348: 94 07 bf fc add %fp, -4, %o2 4000734c: 40 00 02 fc call 40007f3c 40007350: b0 10 20 00 clr %i0 40007354: 81 c7 e0 08 ret 40007358: 81 e8 00 00 restore pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) return EINVAL; 4000735c: b0 10 20 16 mov 0x16, %i0 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 40007360: 81 c7 e0 08 ret 40007364: 81 e8 00 00 restore =============================================================================== 40007db4 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 40007db4: 9d e3 bf 90 save %sp, -112, %sp 40007db8: a0 10 00 18 mov %i0, %l0 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 40007dbc: 80 a4 20 00 cmp %l0, 0 40007dc0: 02 80 00 1c be 40007e30 40007dc4: b0 10 20 16 mov 0x16, %i0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40007dc8: 80 a6 60 00 cmp %i1, 0 40007dcc: 32 80 00 06 bne,a 40007de4 40007dd0: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 40007dd4: b2 07 bf f4 add %fp, -12, %i1 40007dd8: 40 00 02 6d call 4000878c 40007ddc: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40007de0: c2 06 40 00 ld [ %i1 ], %g1 40007de4: 80 a0 60 00 cmp %g1, 0 40007de8: 02 80 00 12 be 40007e30 <== NEVER TAKEN 40007dec: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40007df0: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007df4: 80 a0 60 00 cmp %g1, 0 40007df8: 12 80 00 0e bne 40007e30 <== NEVER TAKEN 40007dfc: 03 10 00 69 sethi %hi(0x4001a400), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007e00: c4 00 62 60 ld [ %g1 + 0x260 ], %g2 ! 4001a660 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 40007e04: c0 27 bf fc clr [ %fp + -4 ] 40007e08: 84 00 a0 01 inc %g2 40007e0c: c4 20 62 60 st %g2, [ %g1 + 0x260 ] * 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 ); 40007e10: 25 10 00 6a sethi %hi(0x4001a800), %l2 40007e14: 40 00 09 ed call 4000a5c8 <_Objects_Allocate> 40007e18: 90 14 a0 60 or %l2, 0x60, %o0 ! 4001a860 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 40007e1c: a2 92 20 00 orcc %o0, 0, %l1 40007e20: 12 80 00 06 bne 40007e38 40007e24: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 40007e28: 40 00 0e 72 call 4000b7f0 <_Thread_Enable_dispatch> 40007e2c: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40007e30: 81 c7 e0 08 ret 40007e34: 81 e8 00 00 restore } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 40007e38: 40 00 07 94 call 40009c88 <_CORE_RWLock_Initialize> 40007e3c: 92 07 bf fc add %fp, -4, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007e40: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 40007e44: a4 14 a0 60 or %l2, 0x60, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007e48: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007e4c: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007e50: 85 28 a0 02 sll %g2, 2, %g2 40007e54: 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; 40007e58: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 40007e5c: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40007e60: 40 00 0e 64 call 4000b7f0 <_Thread_Enable_dispatch> 40007e64: b0 10 20 00 clr %i0 return 0; } 40007e68: 81 c7 e0 08 ret 40007e6c: 81 e8 00 00 restore =============================================================================== 40007ee0 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007ee0: 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; 40007ee4: 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 ) 40007ee8: 80 a6 20 00 cmp %i0, 0 40007eec: 02 80 00 2b be 40007f98 40007ef0: 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 ); 40007ef4: 40 00 1a d6 call 4000ea4c <_POSIX_Absolute_timeout_to_ticks> 40007ef8: 92 07 bf f8 add %fp, -8, %o1 40007efc: d2 06 00 00 ld [ %i0 ], %o1 40007f00: a2 10 00 08 mov %o0, %l1 40007f04: 94 07 bf fc add %fp, -4, %o2 40007f08: 11 10 00 6a sethi %hi(0x4001a800), %o0 40007f0c: 40 00 0a eb call 4000aab8 <_Objects_Get> 40007f10: 90 12 20 60 or %o0, 0x60, %o0 ! 4001a860 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007f14: c2 07 bf fc ld [ %fp + -4 ], %g1 40007f18: 80 a0 60 00 cmp %g1, 0 40007f1c: 12 80 00 1f bne 40007f98 40007f20: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 40007f24: 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, 40007f28: 82 1c 60 03 xor %l1, 3, %g1 40007f2c: 90 02 20 10 add %o0, 0x10, %o0 40007f30: 80 a0 00 01 cmp %g0, %g1 40007f34: 98 10 20 00 clr %o4 40007f38: a4 60 3f ff subx %g0, -1, %l2 40007f3c: 40 00 07 5e call 40009cb4 <_CORE_RWLock_Obtain_for_reading> 40007f40: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40007f44: 40 00 0e 2b call 4000b7f0 <_Thread_Enable_dispatch> 40007f48: 01 00 00 00 nop if ( !do_wait ) { 40007f4c: 80 a4 a0 00 cmp %l2, 0 40007f50: 12 80 00 0d bne 40007f84 40007f54: 03 10 00 6a sethi %hi(0x4001a800), %g1 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 40007f58: c2 00 63 a4 ld [ %g1 + 0x3a4 ], %g1 ! 4001aba4 <_Per_CPU_Information+0xc> 40007f5c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007f60: 80 a0 60 02 cmp %g1, 2 40007f64: 32 80 00 09 bne,a 40007f88 40007f68: 03 10 00 6a sethi %hi(0x4001a800), %g1 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40007f6c: 80 a4 60 00 cmp %l1, 0 40007f70: 02 80 00 0a be 40007f98 <== NEVER TAKEN 40007f74: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40007f78: 80 a4 60 01 cmp %l1, 1 40007f7c: 08 80 00 07 bleu 40007f98 <== ALWAYS TAKEN 40007f80: 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 40007f84: 03 10 00 6a sethi %hi(0x4001a800), %g1 40007f88: c2 00 63 a4 ld [ %g1 + 0x3a4 ], %g1 ! 4001aba4 <_Per_CPU_Information+0xc> status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 40007f8c: 40 00 00 35 call 40008060 <_POSIX_RWLock_Translate_core_RWLock_return_code> 40007f90: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 40007f94: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40007f98: 81 c7 e0 08 ret 40007f9c: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40007fa0 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007fa0: 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; 40007fa4: 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 ) 40007fa8: 80 a6 20 00 cmp %i0, 0 40007fac: 02 80 00 2b be 40008058 40007fb0: 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 ); 40007fb4: 40 00 1a a6 call 4000ea4c <_POSIX_Absolute_timeout_to_ticks> 40007fb8: 92 07 bf f8 add %fp, -8, %o1 40007fbc: d2 06 00 00 ld [ %i0 ], %o1 40007fc0: a2 10 00 08 mov %o0, %l1 40007fc4: 94 07 bf fc add %fp, -4, %o2 40007fc8: 11 10 00 6a sethi %hi(0x4001a800), %o0 40007fcc: 40 00 0a bb call 4000aab8 <_Objects_Get> 40007fd0: 90 12 20 60 or %o0, 0x60, %o0 ! 4001a860 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007fd4: c2 07 bf fc ld [ %fp + -4 ], %g1 40007fd8: 80 a0 60 00 cmp %g1, 0 40007fdc: 12 80 00 1f bne 40008058 40007fe0: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 40007fe4: 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, 40007fe8: 82 1c 60 03 xor %l1, 3, %g1 40007fec: 90 02 20 10 add %o0, 0x10, %o0 40007ff0: 80 a0 00 01 cmp %g0, %g1 40007ff4: 98 10 20 00 clr %o4 40007ff8: a4 60 3f ff subx %g0, -1, %l2 40007ffc: 40 00 07 62 call 40009d84 <_CORE_RWLock_Obtain_for_writing> 40008000: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40008004: 40 00 0d fb call 4000b7f0 <_Thread_Enable_dispatch> 40008008: 01 00 00 00 nop if ( !do_wait && 4000800c: 80 a4 a0 00 cmp %l2, 0 40008010: 12 80 00 0d bne 40008044 40008014: 03 10 00 6a sethi %hi(0x4001a800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 40008018: c2 00 63 a4 ld [ %g1 + 0x3a4 ], %g1 ! 4001aba4 <_Per_CPU_Information+0xc> ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 4000801c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40008020: 80 a0 60 02 cmp %g1, 2 40008024: 32 80 00 09 bne,a 40008048 40008028: 03 10 00 6a sethi %hi(0x4001a800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 4000802c: 80 a4 60 00 cmp %l1, 0 40008030: 02 80 00 0a be 40008058 <== NEVER TAKEN 40008034: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40008038: 80 a4 60 01 cmp %l1, 1 4000803c: 08 80 00 07 bleu 40008058 <== ALWAYS TAKEN 40008040: 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 40008044: 03 10 00 6a sethi %hi(0x4001a800), %g1 40008048: c2 00 63 a4 ld [ %g1 + 0x3a4 ], %g1 ! 4001aba4 <_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( 4000804c: 40 00 00 05 call 40008060 <_POSIX_RWLock_Translate_core_RWLock_return_code> 40008050: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 40008054: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40008058: 81 c7 e0 08 ret 4000805c: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 400087b4 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 400087b4: 82 10 00 08 mov %o0, %g1 if ( !attr ) 400087b8: 80 a0 60 00 cmp %g1, 0 400087bc: 02 80 00 0a be 400087e4 400087c0: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 400087c4: c4 00 40 00 ld [ %g1 ], %g2 400087c8: 80 a0 a0 00 cmp %g2, 0 400087cc: 02 80 00 06 be 400087e4 400087d0: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 400087d4: 18 80 00 04 bgu 400087e4 <== NEVER TAKEN 400087d8: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 400087dc: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 400087e0: 90 10 20 00 clr %o0 default: return EINVAL; } } 400087e4: 81 c3 e0 08 retl =============================================================================== 40009730 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 40009730: 9d e3 bf 90 save %sp, -112, %sp 40009734: a0 10 00 18 mov %i0, %l0 int rc; /* * Check all the parameters */ if ( !param ) 40009738: 80 a6 a0 00 cmp %i2, 0 4000973c: 02 80 00 3d be 40009830 40009740: b0 10 20 16 mov 0x16, %i0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 40009744: 90 10 00 19 mov %i1, %o0 40009748: 92 10 00 1a mov %i2, %o1 4000974c: 94 07 bf fc add %fp, -4, %o2 40009750: 40 00 18 cf call 4000fa8c <_POSIX_Thread_Translate_sched_param> 40009754: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 40009758: b0 92 20 00 orcc %o0, 0, %i0 4000975c: 12 80 00 35 bne 40009830 40009760: 90 10 00 10 mov %l0, %o0 return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); 40009764: 40 00 0b 9b call 4000c5d0 <_Thread_Get> 40009768: 92 07 bf f4 add %fp, -12, %o1 switch ( location ) { 4000976c: c2 07 bf f4 ld [ %fp + -12 ], %g1 40009770: 80 a0 60 00 cmp %g1, 0 40009774: 12 80 00 31 bne 40009838 40009778: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000977c: e0 02 21 58 ld [ %o0 + 0x158 ], %l0 if ( api->schedpolicy == SCHED_SPORADIC ) 40009780: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 40009784: 80 a0 60 04 cmp %g1, 4 40009788: 32 80 00 05 bne,a 4000979c 4000978c: f2 24 20 84 st %i1, [ %l0 + 0x84 ] (void) _Watchdog_Remove( &api->Sporadic_timer ); 40009790: 40 00 0f f0 call 4000d750 <_Watchdog_Remove> 40009794: 90 04 20 a8 add %l0, 0xa8, %o0 api->schedpolicy = policy; 40009798: f2 24 20 84 st %i1, [ %l0 + 0x84 ] api->schedparam = *param; 4000979c: 90 04 20 88 add %l0, 0x88, %o0 400097a0: 92 10 00 1a mov %i2, %o1 400097a4: 40 00 25 67 call 40012d40 400097a8: 94 10 20 1c mov 0x1c, %o2 the_thread->budget_algorithm = budget_algorithm; 400097ac: c2 07 bf fc ld [ %fp + -4 ], %g1 the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 400097b0: 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; 400097b4: c2 24 60 7c st %g1, [ %l1 + 0x7c ] the_thread->budget_callout = budget_callout; 400097b8: c2 07 bf f8 ld [ %fp + -8 ], %g1 switch ( api->schedpolicy ) { 400097bc: 06 80 00 1b bl 40009828 <== NEVER TAKEN 400097c0: c2 24 60 80 st %g1, [ %l1 + 0x80 ] 400097c4: 80 a6 60 02 cmp %i1, 2 400097c8: 04 80 00 07 ble 400097e4 400097cc: 03 10 00 6f sethi %hi(0x4001bc00), %g1 400097d0: 80 a6 60 04 cmp %i1, 4 400097d4: 12 80 00 15 bne 40009828 <== NEVER TAKEN 400097d8: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 400097dc: 10 80 00 0d b 40009810 400097e0: 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; 400097e4: c2 00 60 a4 ld [ %g1 + 0xa4 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 400097e8: 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; 400097ec: c2 24 60 78 st %g1, [ %l1 + 0x78 ] 400097f0: 03 10 00 6c sethi %hi(0x4001b000), %g1 400097f4: d2 08 62 18 ldub [ %g1 + 0x218 ], %o1 ! 4001b218 400097f8: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 400097fc: 94 10 20 01 mov 1, %o2 40009800: 92 22 40 01 sub %o1, %g1, %o1 40009804: 40 00 0a 5a call 4000c16c <_Thread_Change_priority> 40009808: d2 24 60 18 st %o1, [ %l1 + 0x18 ] the_thread, the_thread->real_priority, true ); break; 4000980c: 30 80 00 07 b,a 40009828 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; _Watchdog_Remove( &api->Sporadic_timer ); 40009810: 90 04 20 a8 add %l0, 0xa8, %o0 40009814: 40 00 0f cf call 4000d750 <_Watchdog_Remove> 40009818: c2 24 20 a4 st %g1, [ %l0 + 0xa4 ] _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 4000981c: 90 10 20 00 clr %o0 40009820: 7f ff ff 7e call 40009618 <_POSIX_Threads_Sporadic_budget_TSR> 40009824: 92 10 00 11 mov %l1, %o1 break; } _Thread_Enable_dispatch(); 40009828: 40 00 0b 5d call 4000c59c <_Thread_Enable_dispatch> 4000982c: 01 00 00 00 nop return 0; 40009830: 81 c7 e0 08 ret 40009834: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return ESRCH; 40009838: b0 10 20 03 mov 3, %i0 } 4000983c: 81 c7 e0 08 ret 40009840: 81 e8 00 00 restore =============================================================================== 40006f60 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 40006f60: 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() ) 40006f64: 03 10 00 61 sethi %hi(0x40018400), %g1 40006f68: 82 10 63 d8 or %g1, 0x3d8, %g1 ! 400187d8 <_Per_CPU_Information> 40006f6c: c4 00 60 08 ld [ %g1 + 8 ], %g2 40006f70: 80 a0 a0 00 cmp %g2, 0 40006f74: 12 80 00 18 bne 40006fd4 <== NEVER TAKEN 40006f78: 01 00 00 00 nop 40006f7c: 05 10 00 60 sethi %hi(0x40018000), %g2 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40006f80: c2 00 60 0c ld [ %g1 + 0xc ], %g1 40006f84: c6 00 a2 a0 ld [ %g2 + 0x2a0 ], %g3 40006f88: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 40006f8c: 86 00 e0 01 inc %g3 40006f90: c6 20 a2 a0 st %g3, [ %g2 + 0x2a0 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 40006f94: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 40006f98: 80 a0 a0 00 cmp %g2, 0 40006f9c: 12 80 00 05 bne 40006fb0 <== NEVER TAKEN 40006fa0: 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)); 40006fa4: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 40006fa8: 80 a0 00 01 cmp %g0, %g1 40006fac: a0 40 20 00 addx %g0, 0, %l0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 40006fb0: 40 00 0b 30 call 40009c70 <_Thread_Enable_dispatch> 40006fb4: 01 00 00 00 nop if ( cancel ) 40006fb8: 80 8c 20 ff btst 0xff, %l0 40006fbc: 02 80 00 06 be 40006fd4 40006fc0: 01 00 00 00 nop _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 40006fc4: 03 10 00 61 sethi %hi(0x40018400), %g1 40006fc8: f0 00 63 e4 ld [ %g1 + 0x3e4 ], %i0 ! 400187e4 <_Per_CPU_Information+0xc> 40006fcc: 40 00 18 ac call 4000d27c <_POSIX_Thread_Exit> 40006fd0: 93 e8 3f ff restore %g0, -1, %o1 40006fd4: 81 c7 e0 08 ret 40006fd8: 81 e8 00 00 restore =============================================================================== 40007b78 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 40007b78: 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); 40007b7c: 21 10 00 65 sethi %hi(0x40019400), %l0 40007b80: 40 00 02 80 call 40008580 40007b84: 90 14 20 74 or %l0, 0x74, %o0 ! 40019474 if (result != 0) { 40007b88: a2 92 20 00 orcc %o0, 0, %l1 40007b8c: 02 80 00 06 be 40007ba4 <== ALWAYS TAKEN 40007b90: 01 00 00 00 nop free (req); 40007b94: 7f ff f1 56 call 400040ec <== NOT EXECUTED 40007b98: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED return result; 40007b9c: 81 c7 e0 08 ret <== NOT EXECUTED 40007ba0: 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); 40007ba4: 40 00 04 82 call 40008dac 40007ba8: a0 14 20 74 or %l0, 0x74, %l0 40007bac: 92 07 bf f8 add %fp, -8, %o1 40007bb0: 40 00 03 87 call 400089cc 40007bb4: 94 07 bf dc add %fp, -36, %o2 req->caller_thread = pthread_self (); 40007bb8: 40 00 04 7d call 40008dac 40007bbc: 01 00 00 00 nop req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40007bc0: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40007bc4: c6 07 bf dc ld [ %fp + -36 ], %g3 40007bc8: 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 (); 40007bcc: d0 26 20 10 st %o0, [ %i0 + 0x10 ] req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40007bd0: 84 20 c0 02 sub %g3, %g2, %g2 40007bd4: c4 26 20 0c st %g2, [ %i0 + 0xc ] req->policy = policy; 40007bd8: c4 07 bf f8 ld [ %fp + -8 ], %g2 40007bdc: c4 26 20 08 st %g2, [ %i0 + 8 ] req->aiocbp->error_code = EINPROGRESS; 40007be0: 84 10 20 77 mov 0x77, %g2 40007be4: c4 20 60 34 st %g2, [ %g1 + 0x34 ] req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 40007be8: c4 04 20 68 ld [ %l0 + 0x68 ], %g2 40007bec: 80 a0 a0 00 cmp %g2, 0 40007bf0: 12 80 00 34 bne 40007cc0 <== NEVER TAKEN 40007bf4: c0 20 60 38 clr [ %g1 + 0x38 ] 40007bf8: c4 04 20 64 ld [ %l0 + 0x64 ], %g2 40007bfc: 80 a0 a0 04 cmp %g2, 4 40007c00: 14 80 00 31 bg 40007cc4 40007c04: 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); 40007c08: 90 04 20 48 add %l0, 0x48, %o0 40007c0c: 7f ff fe c0 call 4000770c 40007c10: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40007c14: 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); 40007c18: a4 10 00 08 mov %o0, %l2 if (r_chain->new_fd == 1) { 40007c1c: 80 a0 60 01 cmp %g1, 1 40007c20: aa 02 20 08 add %o0, 8, %l5 40007c24: a6 02 20 1c add %o0, 0x1c, %l3 40007c28: 12 80 00 1d bne 40007c9c 40007c2c: 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); 40007c30: 90 10 00 15 mov %l5, %o0 40007c34: 40 00 08 e7 call 40009fd0 <_Chain_Insert> 40007c38: 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); 40007c3c: 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; 40007c40: c0 24 a0 18 clr [ %l2 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40007c44: 40 00 01 f7 call 40008420 40007c48: 90 10 00 13 mov %l3, %o0 pthread_cond_init (&r_chain->cond, NULL); 40007c4c: 92 10 20 00 clr %o1 40007c50: 40 00 00 fc call 40008040 40007c54: 90 10 00 14 mov %l4, %o0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 40007c58: 96 10 00 12 mov %l2, %o3 40007c5c: 90 07 bf fc add %fp, -4, %o0 40007c60: 92 04 20 08 add %l0, 8, %o1 40007c64: 15 10 00 1e sethi %hi(0x40007800), %o2 40007c68: 40 00 02 c9 call 4000878c 40007c6c: 94 12 a0 00 mov %o2, %o2 ! 40007800 rtems_aio_handle, (void *) r_chain); if (result != 0) { 40007c70: a4 92 20 00 orcc %o0, 0, %l2 40007c74: 22 80 00 07 be,a 40007c90 <== ALWAYS TAKEN 40007c78: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 40007c7c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40007c80: 40 00 02 61 call 40008604 <== NOT EXECUTED 40007c84: a2 10 00 12 mov %l2, %l1 <== NOT EXECUTED return result; 40007c88: 81 c7 e0 08 ret <== NOT EXECUTED 40007c8c: 91 e8 00 11 restore %g0, %l1, %o0 <== NOT EXECUTED } ++aio_request_queue.active_threads; 40007c90: 82 00 60 01 inc %g1 40007c94: 10 80 00 3f b 40007d90 40007c98: c2 24 20 64 st %g1, [ %l0 + 0x64 ] } else { /* put request in the fd chain it belongs to */ pthread_mutex_lock (&r_chain->mutex); 40007c9c: 40 00 02 39 call 40008580 40007ca0: 90 10 00 13 mov %l3, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40007ca4: 90 10 00 15 mov %l5, %o0 40007ca8: 7f ff ff 6d call 40007a5c 40007cac: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 40007cb0: 40 00 01 12 call 400080f8 40007cb4: 90 10 00 14 mov %l4, %o0 pthread_mutex_unlock (&r_chain->mutex); 40007cb8: 10 80 00 12 b 40007d00 40007cbc: 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, 40007cc0: d2 00 40 00 ld [ %g1 ], %o1 <== NOT EXECUTED 40007cc4: 11 10 00 65 sethi %hi(0x40019400), %o0 40007cc8: 94 10 20 00 clr %o2 40007ccc: 7f ff fe 90 call 4000770c 40007cd0: 90 12 20 bc or %o0, 0xbc, %o0 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 40007cd4: a0 92 20 00 orcc %o0, 0, %l0 40007cd8: 02 80 00 0e be 40007d10 40007cdc: a4 04 20 1c add %l0, 0x1c, %l2 { pthread_mutex_lock (&r_chain->mutex); 40007ce0: 40 00 02 28 call 40008580 40007ce4: 90 10 00 12 mov %l2, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40007ce8: 90 04 20 08 add %l0, 8, %o0 40007cec: 7f ff ff 5c call 40007a5c 40007cf0: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 40007cf4: 40 00 01 01 call 400080f8 40007cf8: 90 04 20 20 add %l0, 0x20, %o0 pthread_mutex_unlock (&r_chain->mutex); 40007cfc: 90 10 00 12 mov %l2, %o0 40007d00: 40 00 02 41 call 40008604 40007d04: 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); 40007d08: 10 80 00 23 b 40007d94 40007d0c: 11 10 00 65 sethi %hi(0x40019400), %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); 40007d10: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40007d14: 11 10 00 65 sethi %hi(0x40019400), %o0 40007d18: d2 00 40 00 ld [ %g1 ], %o1 40007d1c: 90 12 20 c8 or %o0, 0xc8, %o0 40007d20: 7f ff fe 7b call 4000770c 40007d24: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40007d28: 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); 40007d2c: a0 10 00 08 mov %o0, %l0 if (r_chain->new_fd == 1) { 40007d30: 80 a0 60 01 cmp %g1, 1 40007d34: 12 80 00 0d bne 40007d68 40007d38: 90 02 20 08 add %o0, 8, %o0 40007d3c: 40 00 08 a5 call 40009fd0 <_Chain_Insert> 40007d40: 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); 40007d44: 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; 40007d48: c0 24 20 18 clr [ %l0 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40007d4c: 40 00 01 b5 call 40008420 40007d50: 92 10 20 00 clr %o1 pthread_cond_init (&r_chain->cond, NULL); 40007d54: 90 04 20 20 add %l0, 0x20, %o0 40007d58: 40 00 00 ba call 40008040 40007d5c: 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) 40007d60: 10 80 00 05 b 40007d74 40007d64: 11 10 00 65 sethi %hi(0x40019400), %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); 40007d68: 7f ff ff 3d call 40007a5c 40007d6c: 92 10 00 18 mov %i0, %o1 if (aio_request_queue.idle_threads > 0) 40007d70: 11 10 00 65 sethi %hi(0x40019400), %o0 40007d74: 90 12 20 74 or %o0, 0x74, %o0 ! 40019474 40007d78: c2 02 20 68 ld [ %o0 + 0x68 ], %g1 40007d7c: 80 a0 60 00 cmp %g1, 0 40007d80: 24 80 00 05 ble,a 40007d94 <== ALWAYS TAKEN 40007d84: 11 10 00 65 sethi %hi(0x40019400), %o0 pthread_cond_signal (&aio_request_queue.new_req); 40007d88: 40 00 00 dc call 400080f8 <== NOT EXECUTED 40007d8c: 90 02 20 04 add %o0, 4, %o0 ! 40019404 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); 40007d90: 11 10 00 65 sethi %hi(0x40019400), %o0 40007d94: 40 00 02 1c call 40008604 40007d98: 90 12 20 74 or %o0, 0x74, %o0 ! 40019474 return 0; } 40007d9c: b0 10 00 11 mov %l1, %i0 40007da0: 81 c7 e0 08 ret 40007da4: 81 e8 00 00 restore =============================================================================== 40007800 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 40007800: 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); 40007804: 21 10 00 65 sethi %hi(0x40019400), %l0 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 40007808: 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); 4000780c: a0 14 20 74 or %l0, 0x74, %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); 40007810: 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)) { 40007814: 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, 40007818: 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); 4000781c: a6 07 bf d8 add %fp, -40, %l3 default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 40007820: 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); 40007824: ba 06 20 1c add %i0, 0x1c, %i5 40007828: 40 00 03 56 call 40008580 4000782c: 90 10 00 1d mov %i5, %o0 if (result != 0) 40007830: 80 a2 20 00 cmp %o0, 0 40007834: 12 80 00 87 bne 40007a50 <== NEVER TAKEN 40007838: 82 06 20 0c add %i0, 0xc, %g1 } } AIO_printf ("Thread finished\n"); return NULL; } 4000783c: 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)) { 40007840: 80 a4 40 01 cmp %l1, %g1 40007844: 02 80 00 3a be 4000792c 40007848: 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); 4000784c: 40 00 05 58 call 40008dac 40007850: 01 00 00 00 nop 40007854: 92 10 00 15 mov %l5, %o1 40007858: 40 00 04 5d call 400089cc 4000785c: 94 10 00 13 mov %l3, %o2 param.sched_priority = req->priority; 40007860: c2 04 60 0c ld [ %l1 + 0xc ], %g1 pthread_setschedparam (pthread_self(), req->policy, ¶m); 40007864: 40 00 05 52 call 40008dac 40007868: c2 27 bf d8 st %g1, [ %fp + -40 ] 4000786c: d2 04 60 08 ld [ %l1 + 8 ], %o1 40007870: 40 00 05 53 call 40008dbc 40007874: 94 10 00 13 mov %l3, %o2 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40007878: 40 00 09 bd call 40009f6c <_Chain_Extract> 4000787c: 90 10 00 11 mov %l1, %o0 rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 40007880: 40 00 03 61 call 40008604 40007884: 90 10 00 1d mov %i5, %o0 switch (req->aiocbp->aio_lio_opcode) { 40007888: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 4000788c: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 40007890: 80 a0 a0 02 cmp %g2, 2 40007894: 22 80 00 10 be,a 400078d4 40007898: c4 18 60 08 ldd [ %g1 + 8 ], %g2 4000789c: 80 a0 a0 03 cmp %g2, 3 400078a0: 02 80 00 15 be 400078f4 <== NEVER TAKEN 400078a4: 80 a0 a0 01 cmp %g2, 1 400078a8: 32 80 00 19 bne,a 4000790c <== NEVER TAKEN 400078ac: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED case LIO_READ: AIO_printf ("read\n"); result = pread (req->aiocbp->aio_fildes, 400078b0: c4 18 60 08 ldd [ %g1 + 8 ], %g2 400078b4: d0 00 40 00 ld [ %g1 ], %o0 400078b8: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 400078bc: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 400078c0: 96 10 00 02 mov %g2, %o3 400078c4: 40 00 2c 06 call 400128dc 400078c8: 98 10 00 03 mov %g3, %o4 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 400078cc: 10 80 00 0d b 40007900 400078d0: 80 a2 3f ff cmp %o0, -1 case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, 400078d4: d0 00 40 00 ld [ %g1 ], %o0 400078d8: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 400078dc: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 400078e0: 96 10 00 02 mov %g2, %o3 400078e4: 40 00 2c 3a call 400129cc 400078e8: 98 10 00 03 mov %g3, %o4 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 400078ec: 10 80 00 05 b 40007900 400078f0: 80 a2 3f ff cmp %o0, -1 case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); 400078f4: 40 00 1b dd call 4000e868 <== NOT EXECUTED 400078f8: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { 400078fc: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED 40007900: 32 80 00 08 bne,a 40007920 <== ALWAYS TAKEN 40007904: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 req->aiocbp->return_value = -1; 40007908: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED req->aiocbp->error_code = errno; 4000790c: 40 00 28 c0 call 40011c0c <__errno> <== NOT EXECUTED 40007910: e8 24 60 38 st %l4, [ %l1 + 0x38 ] <== NOT EXECUTED 40007914: c2 02 00 00 ld [ %o0 ], %g1 <== NOT EXECUTED 40007918: 10 bf ff c3 b 40007824 <== NOT EXECUTED 4000791c: c2 24 60 34 st %g1, [ %l1 + 0x34 ] <== NOT EXECUTED } else { req->aiocbp->return_value = result; 40007920: d0 20 60 38 st %o0, [ %g1 + 0x38 ] req->aiocbp->error_code = 0; 40007924: 10 bf ff c0 b 40007824 40007928: 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); 4000792c: 40 00 03 36 call 40008604 40007930: 90 10 00 1d mov %i5, %o0 pthread_mutex_lock (&aio_request_queue.mutex); 40007934: 40 00 03 13 call 40008580 40007938: 90 10 00 10 mov %l0, %o0 if (rtems_chain_is_empty (chain)) 4000793c: c2 06 20 08 ld [ %i0 + 8 ], %g1 40007940: 80 a0 40 11 cmp %g1, %l1 40007944: 12 80 00 3f bne 40007a40 <== NEVER TAKEN 40007948: 92 10 00 12 mov %l2, %o1 { clock_gettime (CLOCK_REALTIME, &timeout); 4000794c: 40 00 01 64 call 40007edc 40007950: 90 10 20 01 mov 1, %o0 timeout.tv_sec += 3; 40007954: c2 07 bf f4 ld [ %fp + -12 ], %g1 timeout.tv_nsec = 0; 40007958: 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; 4000795c: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40007960: 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; 40007964: c2 27 bf f4 st %g1, [ %fp + -12 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40007968: 90 10 00 11 mov %l1, %o0 4000796c: 92 10 00 10 mov %l0, %o1 40007970: 40 00 02 01 call 40008174 40007974: 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) { 40007978: 80 a2 20 74 cmp %o0, 0x74 4000797c: 12 80 00 31 bne 40007a40 <== NEVER TAKEN 40007980: 01 00 00 00 nop 40007984: 40 00 09 7a call 40009f6c <_Chain_Extract> 40007988: 90 10 00 18 mov %i0, %o0 rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 4000798c: 40 00 02 54 call 400082dc 40007990: 90 10 00 1d mov %i5, %o0 pthread_cond_destroy (&r_chain->cond); 40007994: 40 00 01 76 call 40007f6c 40007998: 90 10 00 11 mov %l1, %o0 free (r_chain); 4000799c: 7f ff f1 d4 call 400040ec 400079a0: 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)) { 400079a4: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 400079a8: 80 a0 40 17 cmp %g1, %l7 400079ac: 12 80 00 1b bne 40007a18 400079b0: 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); 400079b4: 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; 400079b8: 82 00 60 01 inc %g1 400079bc: c2 24 20 68 st %g1, [ %l0 + 0x68 ] --aio_request_queue.active_threads; 400079c0: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 clock_gettime (CLOCK_REALTIME, &timeout); 400079c4: 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; 400079c8: 82 00 7f ff add %g1, -1, %g1 clock_gettime (CLOCK_REALTIME, &timeout); 400079cc: 40 00 01 44 call 40007edc 400079d0: c2 24 20 64 st %g1, [ %l0 + 0x64 ] timeout.tv_sec += 3; 400079d4: c2 07 bf f4 ld [ %fp + -12 ], %g1 timeout.tv_nsec = 0; 400079d8: 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; 400079dc: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 400079e0: 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; 400079e4: c2 27 bf f4 st %g1, [ %fp + -12 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 400079e8: 92 10 00 10 mov %l0, %o1 400079ec: 40 00 01 e2 call 40008174 400079f0: 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) { 400079f4: 80 a2 20 74 cmp %o0, 0x74 400079f8: 12 80 00 08 bne 40007a18 <== NEVER TAKEN 400079fc: c2 04 20 68 ld [ %l0 + 0x68 ], %g1 AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; pthread_mutex_unlock (&aio_request_queue.mutex); 40007a00: 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; 40007a04: 82 00 7f ff add %g1, -1, %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 40007a08: 40 00 02 ff call 40008604 40007a0c: c2 24 20 68 st %g1, [ %l0 + 0x68 ] return NULL; 40007a10: 81 c7 e0 08 ret 40007a14: 91 e8 20 00 restore %g0, 0, %o0 } } AIO_printf ("Thread finished\n"); return NULL; } 40007a18: 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; 40007a1c: 82 00 7f ff add %g1, -1, %g1 40007a20: c2 24 20 68 st %g1, [ %l0 + 0x68 ] ++aio_request_queue.active_threads; 40007a24: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 40007a28: 90 10 00 18 mov %i0, %o0 40007a2c: 82 00 60 01 inc %g1 40007a30: 40 00 09 4f call 40009f6c <_Chain_Extract> 40007a34: 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); 40007a38: 7f ff ff 61 call 400077bc 40007a3c: 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); 40007a40: 40 00 02 f1 call 40008604 40007a44: 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); 40007a48: 10 bf ff 78 b 40007828 40007a4c: ba 06 20 1c add %i0, 0x1c, %i5 } } AIO_printf ("Thread finished\n"); return NULL; } 40007a50: b0 10 20 00 clr %i0 <== NOT EXECUTED 40007a54: 81 c7 e0 08 ret <== NOT EXECUTED 40007a58: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 4000762c : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 4000762c: 9d e3 bf a0 save %sp, -96, %sp int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 40007630: 21 10 00 65 sethi %hi(0x40019400), %l0 40007634: 40 00 04 3c call 40008724 40007638: 90 14 20 7c or %l0, 0x7c, %o0 ! 4001947c if (result != 0) 4000763c: b0 92 20 00 orcc %o0, 0, %i0 40007640: 12 80 00 31 bne 40007704 <== NEVER TAKEN 40007644: 90 14 20 7c or %l0, 0x7c, %o0 return result; result = 40007648: 40 00 04 43 call 40008754 4000764c: 92 10 20 00 clr %o1 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 40007650: 80 a2 20 00 cmp %o0, 0 40007654: 22 80 00 05 be,a 40007668 <== ALWAYS TAKEN 40007658: 11 10 00 65 sethi %hi(0x40019400), %o0 pthread_attr_destroy (&aio_request_queue.attr); 4000765c: 40 00 04 26 call 400086f4 <== NOT EXECUTED 40007660: 90 14 20 7c or %l0, 0x7c, %o0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 40007664: 11 10 00 65 sethi %hi(0x40019400), %o0 <== NOT EXECUTED 40007668: 92 10 20 00 clr %o1 4000766c: 40 00 03 6d call 40008420 40007670: 90 12 20 74 or %o0, 0x74, %o0 if (result != 0) 40007674: 80 a2 20 00 cmp %o0, 0 40007678: 22 80 00 06 be,a 40007690 <== ALWAYS TAKEN 4000767c: 11 10 00 65 sethi %hi(0x40019400), %o0 pthread_attr_destroy (&aio_request_queue.attr); 40007680: 11 10 00 65 sethi %hi(0x40019400), %o0 <== NOT EXECUTED 40007684: 40 00 04 1c call 400086f4 <== NOT EXECUTED 40007688: 90 12 20 7c or %o0, 0x7c, %o0 ! 4001947c <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 4000768c: 11 10 00 65 sethi %hi(0x40019400), %o0 <== NOT EXECUTED 40007690: 92 10 20 00 clr %o1 40007694: 40 00 02 6b call 40008040 40007698: 90 12 20 78 or %o0, 0x78, %o0 if (result != 0) { 4000769c: b0 92 20 00 orcc %o0, 0, %i0 400076a0: 02 80 00 09 be 400076c4 <== ALWAYS TAKEN 400076a4: 03 10 00 65 sethi %hi(0x40019400), %g1 pthread_mutex_destroy (&aio_request_queue.mutex); 400076a8: 11 10 00 65 sethi %hi(0x40019400), %o0 <== NOT EXECUTED 400076ac: 40 00 03 0c call 400082dc <== NOT EXECUTED 400076b0: 90 12 20 74 or %o0, 0x74, %o0 ! 40019474 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 400076b4: 11 10 00 65 sethi %hi(0x40019400), %o0 <== NOT EXECUTED 400076b8: 40 00 04 0f call 400086f4 <== NOT EXECUTED 400076bc: 90 12 20 7c or %o0, 0x7c, %o0 ! 4001947c <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400076c0: 03 10 00 65 sethi %hi(0x40019400), %g1 <== NOT EXECUTED 400076c4: 82 10 60 74 or %g1, 0x74, %g1 ! 40019474 400076c8: 84 00 60 4c add %g1, 0x4c, %g2 400076cc: c4 20 60 48 st %g2, [ %g1 + 0x48 ] head->previous = NULL; tail->previous = head; 400076d0: 84 00 60 48 add %g1, 0x48, %g2 400076d4: 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; 400076d8: 84 00 60 58 add %g1, 0x58, %g2 400076dc: c4 20 60 54 st %g2, [ %g1 + 0x54 ] head->previous = NULL; tail->previous = head; 400076e0: 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; 400076e4: c0 20 60 4c clr [ %g1 + 0x4c ] tail->previous = head; 400076e8: 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; 400076ec: 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; 400076f0: 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; 400076f4: c0 20 60 64 clr [ %g1 + 0x64 ] aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 400076f8: 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; 400076fc: c0 20 60 68 clr [ %g1 + 0x68 ] aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 40007700: c4 20 60 60 st %g2, [ %g1 + 0x60 ] return result; } 40007704: 81 c7 e0 08 ret 40007708: 81 e8 00 00 restore =============================================================================== 40007a5c : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 40007a5c: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 40007a60: c2 06 00 00 ld [ %i0 ], %g1 40007a64: 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)) { 40007a68: 80 a0 40 03 cmp %g1, %g3 40007a6c: 02 80 00 10 be 40007aac <== NEVER TAKEN 40007a70: 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; 40007a74: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 while (req->aiocbp->aio_reqprio > prio && 40007a78: 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; 40007a7c: c8 01 20 18 ld [ %g4 + 0x18 ], %g4 while (req->aiocbp->aio_reqprio > prio && 40007a80: 10 80 00 04 b 40007a90 40007a84: 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; 40007a88: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 <== NOT EXECUTED 40007a8c: 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 && 40007a90: 80 a3 40 04 cmp %o5, %g4 40007a94: 04 80 00 04 ble 40007aa4 <== ALWAYS TAKEN 40007a98: 80 a0 40 03 cmp %g1, %g3 40007a9c: 32 bf ff fb bne,a 40007a88 <== NOT EXECUTED 40007aa0: 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 ); 40007aa4: f0 00 60 04 ld [ %g1 + 4 ], %i0 40007aa8: b2 10 00 02 mov %g2, %i1 40007aac: 40 00 09 49 call 40009fd0 <_Chain_Insert> 40007ab0: 81 e8 00 00 restore =============================================================================== 400077bc : } } AIO_printf ("Thread finished\n"); return NULL; } 400077bc: 05 10 00 65 sethi %hi(0x40019400), %g2 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { 400077c0: 92 10 00 08 mov %o0, %o1 } } AIO_printf ("Thread finished\n"); return NULL; } 400077c4: 84 10 a0 74 or %g2, 0x74, %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 && 400077c8: c6 02 20 14 ld [ %o0 + 0x14 ], %g3 } } AIO_printf ("Thread finished\n"); return NULL; } 400077cc: c2 00 a0 48 ld [ %g2 + 0x48 ], %g1 400077d0: 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 && 400077d4: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 400077d8: 80 a1 00 03 cmp %g4, %g3 400077dc: 16 80 00 04 bge 400077ec 400077e0: 80 a0 40 02 cmp %g1, %g2 400077e4: 32 bf ff fc bne,a 400077d4 <== ALWAYS TAKEN 400077e8: c2 00 40 00 ld [ %g1 ], %g1 400077ec: d0 00 60 04 ld [ %g1 + 4 ], %o0 400077f0: 82 13 c0 00 mov %o7, %g1 400077f4: 40 00 09 f7 call 40009fd0 <_Chain_Insert> 400077f8: 9e 10 40 00 mov %g1, %o7 =============================================================================== 40007b08 : * 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) { 40007b08: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 40007b0c: e0 06 00 00 ld [ %i0 ], %l0 40007b10: 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)) 40007b14: 80 a4 00 01 cmp %l0, %g1 40007b18: 12 80 00 07 bne 40007b34 40007b1c: b0 10 20 02 mov 2, %i0 40007b20: 30 80 00 14 b,a 40007b70 } } AIO_printf ("Thread finished\n"); return NULL; } 40007b24: 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) { 40007b28: 80 a4 00 01 cmp %l0, %g1 <== NOT EXECUTED 40007b2c: 02 80 00 0f be 40007b68 <== NOT EXECUTED 40007b30: b0 10 20 01 mov 1, %i0 <== NOT EXECUTED 40007b34: c4 04 20 14 ld [ %l0 + 0x14 ], %g2 40007b38: 80 a0 80 19 cmp %g2, %i1 40007b3c: 12 bf ff fa bne 40007b24 <== NEVER TAKEN 40007b40: 90 10 00 10 mov %l0, %o0 40007b44: 40 00 09 0a call 40009f6c <_Chain_Extract> 40007b48: 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; 40007b4c: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40007b50: 84 10 20 8c mov 0x8c, %g2 40007b54: c4 20 60 34 st %g2, [ %g1 + 0x34 ] current->aiocbp->return_value = -1; 40007b58: 84 10 3f ff mov -1, %g2 free (current); 40007b5c: 90 10 00 10 mov %l0, %o0 40007b60: 7f ff f1 63 call 400040ec 40007b64: c4 20 60 38 st %g2, [ %g1 + 0x38 ] } return AIO_CANCELED; 40007b68: 81 c7 e0 08 ret 40007b6c: 81 e8 00 00 restore } 40007b70: 81 c7 e0 08 ret 40007b74: 81 e8 00 00 restore =============================================================================== 40007920 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 40007920: 9d e3 bf 98 save %sp, -104, %sp 40007924: 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( 40007928: 10 80 00 09 b 4000794c 4000792c: a4 07 bf fc add %fp, -4, %l2 40007930: 92 10 20 00 clr %o1 40007934: 94 10 00 1a mov %i2, %o2 40007938: 7f ff fc fc call 40006d28 4000793c: 96 10 00 12 mov %l2, %o3 ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 40007940: 80 a2 20 00 cmp %o0, 0 40007944: 32 80 00 09 bne,a 40007968 <== ALWAYS TAKEN 40007948: 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 ); 4000794c: 40 00 01 81 call 40007f50 <_Chain_Get> 40007950: 90 10 00 10 mov %l0, %o0 sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 40007954: a2 92 20 00 orcc %o0, 0, %l1 40007958: 02 bf ff f6 be 40007930 4000795c: 90 10 00 19 mov %i1, %o0 40007960: 90 10 20 00 clr %o0 timeout, &out ); } *node_ptr = node; 40007964: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 40007968: 81 c7 e0 08 ret 4000796c: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40009b38 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 40009b38: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 40009b3c: 80 a6 20 00 cmp %i0, 0 40009b40: 02 80 00 1a be 40009ba8 <== NEVER TAKEN 40009b44: 21 10 00 85 sethi %hi(0x40021400), %l0 40009b48: a0 14 22 dc or %l0, 0x2dc, %l0 ! 400216dc <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 40009b4c: 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 ]; 40009b50: c2 04 00 00 ld [ %l0 ], %g1 40009b54: e4 00 60 04 ld [ %g1 + 4 ], %l2 if ( !information ) 40009b58: 80 a4 a0 00 cmp %l2, 0 40009b5c: 12 80 00 0b bne 40009b88 40009b60: a2 10 20 01 mov 1, %l1 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40009b64: 10 80 00 0e b 40009b9c 40009b68: a0 04 20 04 add %l0, 4, %l0 the_thread = (Thread_Control *)information->local_table[ i ]; 40009b6c: 83 2c 60 02 sll %l1, 2, %g1 40009b70: d0 00 80 01 ld [ %g2 + %g1 ], %o0 if ( !the_thread ) 40009b74: 80 a2 20 00 cmp %o0, 0 40009b78: 02 80 00 04 be 40009b88 <== NEVER TAKEN 40009b7c: a2 04 60 01 inc %l1 continue; (*routine)(the_thread); 40009b80: 9f c6 00 00 call %i0 40009b84: 01 00 00 00 nop information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40009b88: c2 14 a0 10 lduh [ %l2 + 0x10 ], %g1 40009b8c: 80 a4 40 01 cmp %l1, %g1 40009b90: 28 bf ff f7 bleu,a 40009b6c 40009b94: c4 04 a0 1c ld [ %l2 + 0x1c ], %g2 40009b98: 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++ ) { 40009b9c: 80 a4 00 13 cmp %l0, %l3 40009ba0: 32 bf ff ed bne,a 40009b54 40009ba4: c2 04 00 00 ld [ %l0 ], %g1 40009ba8: 81 c7 e0 08 ret 40009bac: 81 e8 00 00 restore =============================================================================== 40014d44 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 40014d44: 9d e3 bf a0 save %sp, -96, %sp 40014d48: a0 10 00 18 mov %i0, %l0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 40014d4c: 80 a4 20 00 cmp %l0, 0 40014d50: 02 80 00 1f be 40014dcc 40014d54: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !starting_address ) 40014d58: 80 a6 60 00 cmp %i1, 0 40014d5c: 02 80 00 1c be 40014dcc 40014d60: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !id ) 40014d64: 80 a7 60 00 cmp %i5, 0 40014d68: 02 80 00 19 be 40014dcc <== NEVER TAKEN 40014d6c: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 40014d70: 02 80 00 32 be 40014e38 40014d74: 80 a6 a0 00 cmp %i2, 0 40014d78: 02 80 00 30 be 40014e38 40014d7c: 80 a6 80 1b cmp %i2, %i3 40014d80: 0a 80 00 13 bcs 40014dcc 40014d84: b0 10 20 08 mov 8, %i0 40014d88: 80 8e e0 07 btst 7, %i3 40014d8c: 12 80 00 10 bne 40014dcc 40014d90: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 40014d94: 12 80 00 0e bne 40014dcc 40014d98: b0 10 20 09 mov 9, %i0 40014d9c: 03 10 00 fe sethi %hi(0x4003f800), %g1 40014da0: c4 00 63 50 ld [ %g1 + 0x350 ], %g2 ! 4003fb50 <_Thread_Dispatch_disable_level> 40014da4: 84 00 a0 01 inc %g2 40014da8: c4 20 63 50 st %g2, [ %g1 + 0x350 ] * 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 ); 40014dac: 25 10 00 fe sethi %hi(0x4003f800), %l2 40014db0: 40 00 12 8f call 400197ec <_Objects_Allocate> 40014db4: 90 14 a1 64 or %l2, 0x164, %o0 ! 4003f964 <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 40014db8: a2 92 20 00 orcc %o0, 0, %l1 40014dbc: 12 80 00 06 bne 40014dd4 40014dc0: 92 10 00 1b mov %i3, %o1 _Thread_Enable_dispatch(); 40014dc4: 40 00 17 52 call 4001ab0c <_Thread_Enable_dispatch> 40014dc8: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 40014dcc: 81 c7 e0 08 ret 40014dd0: 81 e8 00 00 restore _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 40014dd4: f2 24 60 10 st %i1, [ %l1 + 0x10 ] the_partition->length = length; 40014dd8: f4 24 60 14 st %i2, [ %l1 + 0x14 ] the_partition->buffer_size = buffer_size; 40014ddc: f6 24 60 18 st %i3, [ %l1 + 0x18 ] the_partition->attribute_set = attribute_set; 40014de0: f8 24 60 1c st %i4, [ %l1 + 0x1c ] the_partition->number_of_used_blocks = 0; 40014de4: c0 24 60 20 clr [ %l1 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 40014de8: 40 00 65 53 call 4002e334 <.udiv> 40014dec: 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, 40014df0: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 40014df4: 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, 40014df8: 96 10 00 1b mov %i3, %o3 40014dfc: a6 04 60 24 add %l1, 0x24, %l3 40014e00: 40 00 0c 78 call 40017fe0 <_Chain_Initialize> 40014e04: 90 10 00 13 mov %l3, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40014e08: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40014e0c: a4 14 a1 64 or %l2, 0x164, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40014e10: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40014e14: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40014e18: 85 28 a0 02 sll %g2, 2, %g2 40014e1c: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40014e20: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 40014e24: c2 27 40 00 st %g1, [ %i5 ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 40014e28: 40 00 17 39 call 4001ab0c <_Thread_Enable_dispatch> 40014e2c: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40014e30: 81 c7 e0 08 ret 40014e34: 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; 40014e38: b0 10 20 08 mov 8, %i0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40014e3c: 81 c7 e0 08 ret 40014e40: 81 e8 00 00 restore =============================================================================== 40007d4c : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 40007d4c: 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 ); 40007d50: 11 10 00 82 sethi %hi(0x40020800), %o0 40007d54: 92 10 00 18 mov %i0, %o1 40007d58: 90 12 21 cc or %o0, 0x1cc, %o0 40007d5c: 40 00 09 0a call 4000a184 <_Objects_Get> 40007d60: 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 ) { 40007d64: c2 07 bf fc ld [ %fp + -4 ], %g1 40007d68: 80 a0 60 00 cmp %g1, 0 40007d6c: 12 80 00 66 bne 40007f04 40007d70: a0 10 00 08 mov %o0, %l0 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40007d74: 25 10 00 84 sethi %hi(0x40021000), %l2 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 40007d78: c4 02 20 40 ld [ %o0 + 0x40 ], %g2 40007d7c: a4 14 a0 68 or %l2, 0x68, %l2 40007d80: c2 04 a0 0c ld [ %l2 + 0xc ], %g1 40007d84: 80 a0 80 01 cmp %g2, %g1 40007d88: 02 80 00 06 be 40007da0 40007d8c: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 40007d90: 40 00 0c 77 call 4000af6c <_Thread_Enable_dispatch> 40007d94: b0 10 20 17 mov 0x17, %i0 return RTEMS_NOT_OWNER_OF_RESOURCE; 40007d98: 81 c7 e0 08 ret 40007d9c: 81 e8 00 00 restore } if ( length == RTEMS_PERIOD_STATUS ) { 40007da0: 12 80 00 0e bne 40007dd8 40007da4: 01 00 00 00 nop switch ( the_period->state ) { 40007da8: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40007dac: 80 a0 60 04 cmp %g1, 4 40007db0: 18 80 00 06 bgu 40007dc8 <== NEVER TAKEN 40007db4: b0 10 20 00 clr %i0 40007db8: 83 28 60 02 sll %g1, 2, %g1 40007dbc: 05 10 00 7a sethi %hi(0x4001e800), %g2 40007dc0: 84 10 a1 b4 or %g2, 0x1b4, %g2 ! 4001e9b4 40007dc4: 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(); 40007dc8: 40 00 0c 69 call 4000af6c <_Thread_Enable_dispatch> 40007dcc: 01 00 00 00 nop return( return_value ); 40007dd0: 81 c7 e0 08 ret 40007dd4: 81 e8 00 00 restore } _ISR_Disable( level ); 40007dd8: 7f ff eb ac call 40002c88 40007ddc: 01 00 00 00 nop 40007de0: a6 10 00 08 mov %o0, %l3 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 40007de4: e2 04 20 38 ld [ %l0 + 0x38 ], %l1 40007de8: 80 a4 60 00 cmp %l1, 0 40007dec: 12 80 00 15 bne 40007e40 40007df0: 80 a4 60 02 cmp %l1, 2 _ISR_Enable( level ); 40007df4: 7f ff eb a9 call 40002c98 40007df8: 01 00 00 00 nop /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 40007dfc: 7f ff ff 7a call 40007be4 <_Rate_monotonic_Initiate_statistics> 40007e00: 90 10 00 10 mov %l0, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40007e04: 82 10 20 02 mov 2, %g1 40007e08: c2 24 20 38 st %g1, [ %l0 + 0x38 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40007e0c: 03 10 00 20 sethi %hi(0x40008000), %g1 40007e10: 82 10 61 d4 or %g1, 0x1d4, %g1 ! 400081d4 <_Rate_monotonic_Timeout> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40007e14: c0 24 20 18 clr [ %l0 + 0x18 ] the_watchdog->routine = routine; 40007e18: c2 24 20 2c st %g1, [ %l0 + 0x2c ] the_watchdog->id = id; 40007e1c: f0 24 20 30 st %i0, [ %l0 + 0x30 ] the_watchdog->user_data = user_data; 40007e20: c0 24 20 34 clr [ %l0 + 0x34 ] _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 40007e24: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007e28: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007e2c: 11 10 00 82 sethi %hi(0x40020800), %o0 40007e30: 92 04 20 10 add %l0, 0x10, %o1 40007e34: 40 00 10 60 call 4000bfb4 <_Watchdog_Insert> 40007e38: 90 12 23 f0 or %o0, 0x3f0, %o0 40007e3c: 30 80 00 1b b,a 40007ea8 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 40007e40: 12 80 00 1e bne 40007eb8 40007e44: 80 a4 60 04 cmp %l1, 4 /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 40007e48: 7f ff ff 83 call 40007c54 <_Rate_monotonic_Update_statistics> 40007e4c: 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; 40007e50: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 40007e54: 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; 40007e58: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 40007e5c: 7f ff eb 8f call 40002c98 40007e60: 90 10 00 13 mov %l3, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 40007e64: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40007e68: c2 04 20 08 ld [ %l0 + 8 ], %g1 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40007e6c: 13 00 00 10 sethi %hi(0x4000), %o1 40007e70: 40 00 0e 69 call 4000b814 <_Thread_Set_state> 40007e74: c2 22 20 20 st %g1, [ %o0 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 40007e78: 7f ff eb 84 call 40002c88 40007e7c: 01 00 00 00 nop local_state = the_period->state; 40007e80: e6 04 20 38 ld [ %l0 + 0x38 ], %l3 the_period->state = RATE_MONOTONIC_ACTIVE; 40007e84: e2 24 20 38 st %l1, [ %l0 + 0x38 ] _ISR_Enable( level ); 40007e88: 7f ff eb 84 call 40002c98 40007e8c: 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 ) 40007e90: 80 a4 e0 03 cmp %l3, 3 40007e94: 12 80 00 05 bne 40007ea8 40007e98: 01 00 00 00 nop _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40007e9c: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40007ea0: 40 00 0b 6c call 4000ac50 <_Thread_Clear_state> 40007ea4: 13 00 00 10 sethi %hi(0x4000), %o1 _Thread_Enable_dispatch(); 40007ea8: 40 00 0c 31 call 4000af6c <_Thread_Enable_dispatch> 40007eac: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40007eb0: 81 c7 e0 08 ret 40007eb4: 81 e8 00 00 restore } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 40007eb8: 12 bf ff b8 bne 40007d98 <== NEVER TAKEN 40007ebc: b0 10 20 04 mov 4, %i0 /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 40007ec0: 7f ff ff 65 call 40007c54 <_Rate_monotonic_Update_statistics> 40007ec4: 90 10 00 10 mov %l0, %o0 _ISR_Enable( level ); 40007ec8: 7f ff eb 74 call 40002c98 40007ecc: 90 10 00 13 mov %l3, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40007ed0: 82 10 20 02 mov 2, %g1 40007ed4: 92 04 20 10 add %l0, 0x10, %o1 40007ed8: 11 10 00 82 sethi %hi(0x40020800), %o0 40007edc: 90 12 23 f0 or %o0, 0x3f0, %o0 ! 40020bf0 <_Watchdog_Ticks_chain> 40007ee0: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; 40007ee4: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007ee8: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007eec: 40 00 10 32 call 4000bfb4 <_Watchdog_Insert> 40007ef0: b0 10 20 06 mov 6, %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 40007ef4: 40 00 0c 1e call 4000af6c <_Thread_Enable_dispatch> 40007ef8: 01 00 00 00 nop return RTEMS_TIMEOUT; 40007efc: 81 c7 e0 08 ret 40007f00: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 40007f04: b0 10 20 04 mov 4, %i0 } 40007f08: 81 c7 e0 08 ret 40007f0c: 81 e8 00 00 restore =============================================================================== 40007f10 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 40007f10: 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 ) 40007f14: 80 a6 60 00 cmp %i1, 0 40007f18: 02 80 00 79 be 400080fc <== NEVER TAKEN 40007f1c: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 40007f20: 13 10 00 7a sethi %hi(0x4001e800), %o1 40007f24: 9f c6 40 00 call %i1 40007f28: 92 12 61 c8 or %o1, 0x1c8, %o1 ! 4001e9c8 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 40007f2c: 90 10 00 18 mov %i0, %o0 40007f30: 13 10 00 7a sethi %hi(0x4001e800), %o1 40007f34: 9f c6 40 00 call %i1 40007f38: 92 12 61 e8 or %o1, 0x1e8, %o1 ! 4001e9e8 (*print)( context, "--- Wall times are in seconds ---\n" ); 40007f3c: 90 10 00 18 mov %i0, %o0 40007f40: 13 10 00 7a sethi %hi(0x4001e800), %o1 40007f44: 9f c6 40 00 call %i1 40007f48: 92 12 62 10 or %o1, 0x210, %o1 ! 4001ea10 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 40007f4c: 90 10 00 18 mov %i0, %o0 40007f50: 13 10 00 7a sethi %hi(0x4001e800), %o1 40007f54: 9f c6 40 00 call %i1 40007f58: 92 12 62 38 or %o1, 0x238, %o1 ! 4001ea38 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 40007f5c: 90 10 00 18 mov %i0, %o0 40007f60: 13 10 00 7a sethi %hi(0x4001e800), %o1 40007f64: 9f c6 40 00 call %i1 40007f68: 92 12 62 88 or %o1, 0x288, %o1 ! 4001ea88 /* * 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 ; 40007f6c: 3b 10 00 82 sethi %hi(0x40020800), %i5 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007f70: 2b 10 00 7a sethi %hi(0x4001e800), %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 ; 40007f74: 82 17 61 cc or %i5, 0x1cc, %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, 40007f78: 27 10 00 7a sethi %hi(0x4001e800), %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, 40007f7c: 35 10 00 7a sethi %hi(0x4001e800), %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 ; 40007f80: e0 00 60 08 ld [ %g1 + 8 ], %l0 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 40007f84: 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 ); 40007f88: ac 07 bf d8 add %fp, -40, %l6 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007f8c: a4 07 bf f8 add %fp, -8, %l2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007f90: aa 15 62 d8 or %l5, 0x2d8, %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; 40007f94: a8 07 bf b8 add %fp, -72, %l4 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 40007f98: a2 07 bf f0 add %fp, -16, %l1 (*print)( context, 40007f9c: a6 14 e2 f0 or %l3, 0x2f0, %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; 40007fa0: 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 ; 40007fa4: 10 80 00 52 b 400080ec 40007fa8: b4 16 a3 10 or %i2, 0x310, %i2 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 40007fac: 40 00 1a 30 call 4000e86c 40007fb0: 92 10 00 17 mov %l7, %o1 if ( status != RTEMS_SUCCESSFUL ) 40007fb4: 80 a2 20 00 cmp %o0, 0 40007fb8: 32 80 00 4c bne,a 400080e8 40007fbc: 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 ); 40007fc0: 92 10 00 16 mov %l6, %o1 40007fc4: 40 00 1a 57 call 4000e920 40007fc8: 90 10 00 10 mov %l0, %o0 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007fcc: d0 07 bf d8 ld [ %fp + -40 ], %o0 40007fd0: 92 10 20 05 mov 5, %o1 40007fd4: 40 00 00 ae call 4000828c 40007fd8: 94 10 00 12 mov %l2, %o2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007fdc: d8 1f bf a0 ldd [ %fp + -96 ], %o4 40007fe0: 92 10 00 15 mov %l5, %o1 40007fe4: 90 10 00 18 mov %i0, %o0 40007fe8: 94 10 00 10 mov %l0, %o2 40007fec: 9f c6 40 00 call %i1 40007ff0: 96 10 00 12 mov %l2, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 40007ff4: d2 07 bf a0 ld [ %fp + -96 ], %o1 40007ff8: 80 a2 60 00 cmp %o1, 0 40007ffc: 12 80 00 08 bne 4000801c 40008000: 94 10 00 11 mov %l1, %o2 (*print)( context, "\n" ); 40008004: 90 10 00 18 mov %i0, %o0 40008008: 13 10 00 77 sethi %hi(0x4001dc00), %o1 4000800c: 9f c6 40 00 call %i1 40008010: 92 12 60 a8 or %o1, 0xa8, %o1 ! 4001dca8 <_rodata_start+0x158> continue; 40008014: 10 80 00 35 b 400080e8 40008018: 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 ); 4000801c: 40 00 0e c3 call 4000bb28 <_Timespec_Divide_by_integer> 40008020: 90 10 00 14 mov %l4, %o0 (*print)( context, 40008024: d0 07 bf ac ld [ %fp + -84 ], %o0 40008028: 40 00 48 e5 call 4001a3bc <.div> 4000802c: 92 10 23 e8 mov 0x3e8, %o1 40008030: 96 10 00 08 mov %o0, %o3 40008034: d0 07 bf b4 ld [ %fp + -76 ], %o0 40008038: d6 27 bf 9c st %o3, [ %fp + -100 ] 4000803c: 40 00 48 e0 call 4001a3bc <.div> 40008040: 92 10 23 e8 mov 0x3e8, %o1 40008044: c2 07 bf f0 ld [ %fp + -16 ], %g1 40008048: b6 10 00 08 mov %o0, %i3 4000804c: d0 07 bf f4 ld [ %fp + -12 ], %o0 40008050: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40008054: 40 00 48 da call 4001a3bc <.div> 40008058: 92 10 23 e8 mov 0x3e8, %o1 4000805c: d8 07 bf b0 ld [ %fp + -80 ], %o4 40008060: d6 07 bf 9c ld [ %fp + -100 ], %o3 40008064: d4 07 bf a8 ld [ %fp + -88 ], %o2 40008068: 9a 10 00 1b mov %i3, %o5 4000806c: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40008070: 92 10 00 13 mov %l3, %o1 40008074: 9f c6 40 00 call %i1 40008078: 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); 4000807c: d2 07 bf a0 ld [ %fp + -96 ], %o1 40008080: 94 10 00 11 mov %l1, %o2 40008084: 40 00 0e a9 call 4000bb28 <_Timespec_Divide_by_integer> 40008088: 90 10 00 1c mov %i4, %o0 (*print)( context, 4000808c: d0 07 bf c4 ld [ %fp + -60 ], %o0 40008090: 40 00 48 cb call 4001a3bc <.div> 40008094: 92 10 23 e8 mov 0x3e8, %o1 40008098: 96 10 00 08 mov %o0, %o3 4000809c: d0 07 bf cc ld [ %fp + -52 ], %o0 400080a0: d6 27 bf 9c st %o3, [ %fp + -100 ] 400080a4: 40 00 48 c6 call 4001a3bc <.div> 400080a8: 92 10 23 e8 mov 0x3e8, %o1 400080ac: c2 07 bf f0 ld [ %fp + -16 ], %g1 400080b0: b6 10 00 08 mov %o0, %i3 400080b4: d0 07 bf f4 ld [ %fp + -12 ], %o0 400080b8: 92 10 23 e8 mov 0x3e8, %o1 400080bc: 40 00 48 c0 call 4001a3bc <.div> 400080c0: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 400080c4: d4 07 bf c0 ld [ %fp + -64 ], %o2 400080c8: d6 07 bf 9c ld [ %fp + -100 ], %o3 400080cc: d8 07 bf c8 ld [ %fp + -56 ], %o4 400080d0: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 400080d4: 92 10 00 1a mov %i2, %o1 400080d8: 90 10 00 18 mov %i0, %o0 400080dc: 9f c6 40 00 call %i1 400080e0: 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++ ) { 400080e4: 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 ; 400080e8: 82 17 61 cc or %i5, 0x1cc, %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 ; 400080ec: c2 00 60 0c ld [ %g1 + 0xc ], %g1 400080f0: 80 a4 00 01 cmp %l0, %g1 400080f4: 08 bf ff ae bleu 40007fac 400080f8: 90 10 00 10 mov %l0, %o0 400080fc: 81 c7 e0 08 ret 40008100: 81 e8 00 00 restore =============================================================================== 400162e8 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 400162e8: 9d e3 bf 98 save %sp, -104, %sp 400162ec: 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 ) 400162f0: 80 a6 60 00 cmp %i1, 0 400162f4: 02 80 00 2e be 400163ac 400162f8: b0 10 20 0a mov 0xa, %i0 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 400162fc: 40 00 12 11 call 4001ab40 <_Thread_Get> 40016300: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40016304: c2 07 bf fc ld [ %fp + -4 ], %g1 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 40016308: a2 10 00 08 mov %o0, %l1 switch ( location ) { 4001630c: 80 a0 60 00 cmp %g1, 0 40016310: 12 80 00 27 bne 400163ac 40016314: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 40016318: e0 02 21 54 ld [ %o0 + 0x154 ], %l0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 4001631c: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40016320: 80 a0 60 00 cmp %g1, 0 40016324: 02 80 00 24 be 400163b4 40016328: 01 00 00 00 nop if ( asr->is_enabled ) { 4001632c: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 40016330: 80 a0 60 00 cmp %g1, 0 40016334: 02 80 00 15 be 40016388 40016338: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 4001633c: 7f ff e4 79 call 4000f520 40016340: 01 00 00 00 nop *signal_set |= signals; 40016344: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40016348: b2 10 40 19 or %g1, %i1, %i1 4001634c: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _ISR_Enable( _level ); 40016350: 7f ff e4 78 call 4000f530 40016354: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40016358: 03 10 01 00 sethi %hi(0x40040000), %g1 4001635c: 82 10 60 90 or %g1, 0x90, %g1 ! 40040090 <_Per_CPU_Information> 40016360: c4 00 60 08 ld [ %g1 + 8 ], %g2 40016364: 80 a0 a0 00 cmp %g2, 0 40016368: 02 80 00 0f be 400163a4 4001636c: 01 00 00 00 nop 40016370: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40016374: 80 a4 40 02 cmp %l1, %g2 40016378: 12 80 00 0b bne 400163a4 <== NEVER TAKEN 4001637c: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 40016380: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 40016384: 30 80 00 08 b,a 400163a4 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 40016388: 7f ff e4 66 call 4000f520 4001638c: 01 00 00 00 nop *signal_set |= signals; 40016390: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40016394: b2 10 40 19 or %g1, %i1, %i1 40016398: f2 24 20 18 st %i1, [ %l0 + 0x18 ] _ISR_Enable( _level ); 4001639c: 7f ff e4 65 call 4000f530 400163a0: 01 00 00 00 nop } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 400163a4: 40 00 11 da call 4001ab0c <_Thread_Enable_dispatch> 400163a8: b0 10 20 00 clr %i0 ! 0 return RTEMS_SUCCESSFUL; 400163ac: 81 c7 e0 08 ret 400163b0: 81 e8 00 00 restore } _Thread_Enable_dispatch(); 400163b4: 40 00 11 d6 call 4001ab0c <_Thread_Enable_dispatch> 400163b8: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; 400163bc: 81 c7 e0 08 ret 400163c0: 81 e8 00 00 restore =============================================================================== 4000eb18 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4000eb18: 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 ) 4000eb1c: 80 a6 a0 00 cmp %i2, 0 4000eb20: 02 80 00 5a be 4000ec88 4000eb24: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4000eb28: 03 10 00 5a sethi %hi(0x40016800), %g1 4000eb2c: e2 00 62 64 ld [ %g1 + 0x264 ], %l1 ! 40016a64 <_Per_CPU_Information+0xc> api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000eb30: 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 ]; 4000eb34: e0 04 61 54 ld [ %l1 + 0x154 ], %l0 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000eb38: 80 a0 00 01 cmp %g0, %g1 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000eb3c: 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; 4000eb40: a4 60 3f ff subx %g0, -1, %l2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000eb44: 80 a0 60 00 cmp %g1, 0 4000eb48: 02 80 00 03 be 4000eb54 4000eb4c: a5 2c a0 08 sll %l2, 8, %l2 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4000eb50: a4 14 a2 00 or %l2, 0x200, %l2 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000eb54: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 4000eb58: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000eb5c: 7f ff ef 1f call 4000a7d8 <_CPU_ISR_Get_level> 4000eb60: 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; 4000eb64: a7 2c e0 0a sll %l3, 0xa, %l3 4000eb68: a6 14 c0 08 or %l3, %o0, %l3 old_mode |= _ISR_Get_level(); 4000eb6c: a4 14 c0 12 or %l3, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000eb70: 80 8e 61 00 btst 0x100, %i1 4000eb74: 02 80 00 06 be 4000eb8c 4000eb78: 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; 4000eb7c: 82 0e 21 00 and %i0, 0x100, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4000eb80: 80 a0 00 01 cmp %g0, %g1 4000eb84: 82 60 3f ff subx %g0, -1, %g1 4000eb88: c2 2c 60 74 stb %g1, [ %l1 + 0x74 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 4000eb8c: 80 8e 62 00 btst 0x200, %i1 4000eb90: 02 80 00 0b be 4000ebbc 4000eb94: 80 8e 60 0f btst 0xf, %i1 if ( _Modes_Is_timeslice(mode_set) ) { 4000eb98: 80 8e 22 00 btst 0x200, %i0 4000eb9c: 22 80 00 07 be,a 4000ebb8 4000eba0: c0 24 60 7c clr [ %l1 + 0x7c ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000eba4: 82 10 20 01 mov 1, %g1 4000eba8: c2 24 60 7c st %g1, [ %l1 + 0x7c ] executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000ebac: 03 10 00 59 sethi %hi(0x40016400), %g1 4000ebb0: c2 00 60 84 ld [ %g1 + 0x84 ], %g1 ! 40016484 <_Thread_Ticks_per_timeslice> 4000ebb4: c2 24 60 78 st %g1, [ %l1 + 0x78 ] } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4000ebb8: 80 8e 60 0f btst 0xf, %i1 4000ebbc: 02 80 00 06 be 4000ebd4 4000ebc0: 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 ); 4000ebc4: 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 ) ); 4000ebc8: 7f ff cc 6f call 40001d84 4000ebcc: 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 ) { 4000ebd0: 80 8e 64 00 btst 0x400, %i1 4000ebd4: 02 80 00 14 be 4000ec24 4000ebd8: 88 10 20 00 clr %g4 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4000ebdc: 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; 4000ebe0: 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( 4000ebe4: 80 a0 00 18 cmp %g0, %i0 4000ebe8: 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 ) { 4000ebec: 80 a0 40 02 cmp %g1, %g2 4000ebf0: 22 80 00 0e be,a 4000ec28 4000ebf4: 03 10 00 59 sethi %hi(0x40016400), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4000ebf8: 7f ff cc 5f call 40001d74 4000ebfc: c2 2c 20 08 stb %g1, [ %l0 + 8 ] _signals = information->signals_pending; 4000ec00: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 information->signals_pending = information->signals_posted; 4000ec04: c4 04 20 14 ld [ %l0 + 0x14 ], %g2 information->signals_posted = _signals; 4000ec08: 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; 4000ec0c: c4 24 20 18 st %g2, [ %l0 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 4000ec10: 7f ff cc 5d call 40001d84 4000ec14: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 4000ec18: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4000ec1c: 80 a0 00 01 cmp %g0, %g1 4000ec20: 88 40 20 00 addx %g0, 0, %g4 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4000ec24: 03 10 00 59 sethi %hi(0x40016400), %g1 4000ec28: c4 00 62 78 ld [ %g1 + 0x278 ], %g2 ! 40016678 <_System_state_Current> 4000ec2c: 80 a0 a0 03 cmp %g2, 3 4000ec30: 12 80 00 16 bne 4000ec88 4000ec34: 82 10 20 00 clr %g1 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000ec38: 07 10 00 5a sethi %hi(0x40016800), %g3 if ( are_signals_pending || 4000ec3c: 80 89 20 ff btst 0xff, %g4 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000ec40: 86 10 e2 58 or %g3, 0x258, %g3 if ( are_signals_pending || 4000ec44: 12 80 00 0a bne 4000ec6c 4000ec48: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 4000ec4c: c6 00 e0 10 ld [ %g3 + 0x10 ], %g3 4000ec50: 80 a0 80 03 cmp %g2, %g3 4000ec54: 02 80 00 0d be 4000ec88 4000ec58: 01 00 00 00 nop (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 4000ec5c: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 4000ec60: 80 a0 a0 00 cmp %g2, 0 4000ec64: 02 80 00 09 be 4000ec88 <== NEVER TAKEN 4000ec68: 01 00 00 00 nop _Thread_Dispatch_necessary = true; 4000ec6c: 84 10 20 01 mov 1, %g2 ! 1 4000ec70: 03 10 00 5a sethi %hi(0x40016800), %g1 4000ec74: 82 10 62 58 or %g1, 0x258, %g1 ! 40016a58 <_Per_CPU_Information> 4000ec78: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 4000ec7c: 7f ff e9 0f call 400090b8 <_Thread_Dispatch> 4000ec80: 01 00 00 00 nop } return RTEMS_SUCCESSFUL; 4000ec84: 82 10 20 00 clr %g1 ! 0 } 4000ec88: 81 c7 e0 08 ret 4000ec8c: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 4000b55c : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4000b55c: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4000b560: 80 a6 60 00 cmp %i1, 0 4000b564: 02 80 00 07 be 4000b580 4000b568: 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 ) ); 4000b56c: 03 10 00 68 sethi %hi(0x4001a000), %g1 4000b570: c2 08 61 d4 ldub [ %g1 + 0x1d4 ], %g1 ! 4001a1d4 4000b574: 80 a6 40 01 cmp %i1, %g1 4000b578: 18 80 00 1c bgu 4000b5e8 4000b57c: b0 10 20 13 mov 0x13, %i0 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4000b580: 80 a6 a0 00 cmp %i2, 0 4000b584: 02 80 00 19 be 4000b5e8 4000b588: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4000b58c: 40 00 09 43 call 4000da98 <_Thread_Get> 4000b590: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000b594: c2 07 bf fc ld [ %fp + -4 ], %g1 4000b598: 80 a0 60 00 cmp %g1, 0 4000b59c: 12 80 00 13 bne 4000b5e8 4000b5a0: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4000b5a4: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4000b5a8: 80 a6 60 00 cmp %i1, 0 4000b5ac: 02 80 00 0d be 4000b5e0 4000b5b0: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 4000b5b4: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4000b5b8: 80 a0 60 00 cmp %g1, 0 4000b5bc: 02 80 00 06 be 4000b5d4 4000b5c0: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 4000b5c4: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000b5c8: 80 a0 40 19 cmp %g1, %i1 4000b5cc: 08 80 00 05 bleu 4000b5e0 <== ALWAYS TAKEN 4000b5d0: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4000b5d4: 92 10 00 19 mov %i1, %o1 4000b5d8: 40 00 08 17 call 4000d634 <_Thread_Change_priority> 4000b5dc: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 4000b5e0: 40 00 09 21 call 4000da64 <_Thread_Enable_dispatch> 4000b5e4: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 4000b5e8: 81 c7 e0 08 ret 4000b5ec: 81 e8 00 00 restore =============================================================================== 40016cf4 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 40016cf4: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 40016cf8: 11 10 01 01 sethi %hi(0x40040400), %o0 40016cfc: 92 10 00 18 mov %i0, %o1 40016d00: 90 12 20 c4 or %o0, 0xc4, %o0 40016d04: 40 00 0c 08 call 40019d24 <_Objects_Get> 40016d08: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40016d0c: c2 07 bf fc ld [ %fp + -4 ], %g1 40016d10: 80 a0 60 00 cmp %g1, 0 40016d14: 12 80 00 0c bne 40016d44 40016d18: 01 00 00 00 nop case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 40016d1c: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40016d20: 80 a0 60 04 cmp %g1, 4 40016d24: 02 80 00 04 be 40016d34 <== NEVER TAKEN 40016d28: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 40016d2c: 40 00 14 40 call 4001be2c <_Watchdog_Remove> 40016d30: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 40016d34: 40 00 0f 76 call 4001ab0c <_Thread_Enable_dispatch> 40016d38: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40016d3c: 81 c7 e0 08 ret 40016d40: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40016d44: 81 c7 e0 08 ret 40016d48: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 400171dc : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 400171dc: 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; 400171e0: 03 10 01 01 sethi %hi(0x40040400), %g1 400171e4: e2 00 61 04 ld [ %g1 + 0x104 ], %l1 ! 40040504 <_Timer_server> rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 400171e8: 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 ) 400171ec: 80 a4 60 00 cmp %l1, 0 400171f0: 02 80 00 33 be 400172bc 400171f4: b0 10 20 0e mov 0xe, %i0 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 400171f8: 03 10 00 fe sethi %hi(0x4003f800), %g1 400171fc: c2 08 63 60 ldub [ %g1 + 0x360 ], %g1 ! 4003fb60 <_TOD_Is_set> 40017200: 80 a0 60 00 cmp %g1, 0 40017204: 02 80 00 2e be 400172bc <== NEVER TAKEN 40017208: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; if ( !routine ) 4001720c: 80 a6 a0 00 cmp %i2, 0 40017210: 02 80 00 2b be 400172bc 40017214: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 40017218: 90 10 00 19 mov %i1, %o0 4001721c: 7f ff f4 07 call 40014238 <_TOD_Validate> 40017220: b0 10 20 14 mov 0x14, %i0 40017224: 80 8a 20 ff btst 0xff, %o0 40017228: 02 80 00 27 be 400172c4 4001722c: 01 00 00 00 nop return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 40017230: 7f ff f3 ce call 40014168 <_TOD_To_seconds> 40017234: 90 10 00 19 mov %i1, %o0 if ( seconds <= _TOD_Seconds_since_epoch() ) 40017238: 27 10 00 fe sethi %hi(0x4003f800), %l3 4001723c: c2 04 e3 d8 ld [ %l3 + 0x3d8 ], %g1 ! 4003fbd8 <_TOD_Now> 40017240: 80 a2 00 01 cmp %o0, %g1 40017244: 08 80 00 1e bleu 400172bc 40017248: a4 10 00 08 mov %o0, %l2 4001724c: 11 10 01 01 sethi %hi(0x40040400), %o0 40017250: 92 10 00 10 mov %l0, %o1 40017254: 90 12 20 c4 or %o0, 0xc4, %o0 40017258: 40 00 0a b3 call 40019d24 <_Objects_Get> 4001725c: 94 07 bf fc add %fp, -4, %o2 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40017260: c2 07 bf fc ld [ %fp + -4 ], %g1 40017264: b2 10 00 08 mov %o0, %i1 40017268: 80 a0 60 00 cmp %g1, 0 4001726c: 12 80 00 14 bne 400172bc 40017270: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 40017274: 40 00 12 ee call 4001be2c <_Watchdog_Remove> 40017278: 90 02 20 10 add %o0, 0x10, %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 4001727c: 82 10 20 03 mov 3, %g1 40017280: 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(); 40017284: c2 04 e3 d8 ld [ %l3 + 0x3d8 ], %g1 (*timer_server->schedule_operation)( timer_server, the_timer ); 40017288: 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(); 4001728c: a4 24 80 01 sub %l2, %g1, %l2 (*timer_server->schedule_operation)( timer_server, the_timer ); 40017290: c2 04 60 04 ld [ %l1 + 4 ], %g1 40017294: 92 10 00 19 mov %i1, %o1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40017298: c0 26 60 18 clr [ %i1 + 0x18 ] the_watchdog->routine = routine; 4001729c: f4 26 60 2c st %i2, [ %i1 + 0x2c ] the_watchdog->id = id; 400172a0: e0 26 60 30 st %l0, [ %i1 + 0x30 ] the_watchdog->user_data = user_data; 400172a4: 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(); 400172a8: e4 26 60 1c st %l2, [ %i1 + 0x1c ] (*timer_server->schedule_operation)( timer_server, the_timer ); 400172ac: 9f c0 40 00 call %g1 400172b0: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 400172b4: 40 00 0e 16 call 4001ab0c <_Thread_Enable_dispatch> 400172b8: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 400172bc: 81 c7 e0 08 ret 400172c0: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400172c4: 81 c7 e0 08 ret 400172c8: 81 e8 00 00 restore =============================================================================== 40007378 : #include int sched_get_priority_max( int policy ) { 40007378: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 4000737c: 80 a6 20 04 cmp %i0, 4 40007380: 18 80 00 06 bgu 40007398 40007384: 82 10 20 01 mov 1, %g1 40007388: b1 28 40 18 sll %g1, %i0, %i0 4000738c: 80 8e 20 17 btst 0x17, %i0 40007390: 12 80 00 08 bne 400073b0 <== ALWAYS TAKEN 40007394: 03 10 00 7b sethi %hi(0x4001ec00), %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40007398: 40 00 22 c9 call 4000febc <__errno> 4000739c: b0 10 3f ff mov -1, %i0 400073a0: 82 10 20 16 mov 0x16, %g1 400073a4: c2 22 00 00 st %g1, [ %o0 ] 400073a8: 81 c7 e0 08 ret 400073ac: 81 e8 00 00 restore } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 400073b0: f0 08 60 d8 ldub [ %g1 + 0xd8 ], %i0 } 400073b4: 81 c7 e0 08 ret 400073b8: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 400073bc : #include int sched_get_priority_min( int policy ) { 400073bc: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 400073c0: 80 a6 20 04 cmp %i0, 4 400073c4: 18 80 00 06 bgu 400073dc 400073c8: 82 10 20 01 mov 1, %g1 400073cc: 83 28 40 18 sll %g1, %i0, %g1 400073d0: 80 88 60 17 btst 0x17, %g1 400073d4: 12 80 00 06 bne 400073ec <== ALWAYS TAKEN 400073d8: b0 10 20 01 mov 1, %i0 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 400073dc: 40 00 22 b8 call 4000febc <__errno> 400073e0: b0 10 3f ff mov -1, %i0 400073e4: 82 10 20 16 mov 0x16, %g1 400073e8: c2 22 00 00 st %g1, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 400073ec: 81 c7 e0 08 ret 400073f0: 81 e8 00 00 restore =============================================================================== 400073f4 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 400073f4: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 400073f8: 80 a6 20 00 cmp %i0, 0 400073fc: 02 80 00 0b be 40007428 <== NEVER TAKEN 40007400: 80 a6 60 00 cmp %i1, 0 40007404: 7f ff f2 4e call 40003d3c 40007408: 01 00 00 00 nop 4000740c: 80 a6 00 08 cmp %i0, %o0 40007410: 02 80 00 06 be 40007428 40007414: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40007418: 40 00 22 a9 call 4000febc <__errno> 4000741c: 01 00 00 00 nop 40007420: 10 80 00 07 b 4000743c 40007424: 82 10 20 03 mov 3, %g1 ! 3 if ( !interval ) 40007428: 12 80 00 08 bne 40007448 4000742c: 03 10 00 7d sethi %hi(0x4001f400), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40007430: 40 00 22 a3 call 4000febc <__errno> 40007434: 01 00 00 00 nop 40007438: 82 10 20 16 mov 0x16, %g1 ! 16 4000743c: c2 22 00 00 st %g1, [ %o0 ] 40007440: 81 c7 e0 08 ret 40007444: 91 e8 3f ff restore %g0, -1, %o0 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 40007448: d0 00 62 f4 ld [ %g1 + 0x2f4 ], %o0 4000744c: 92 10 00 19 mov %i1, %o1 40007450: 40 00 0e 70 call 4000ae10 <_Timespec_From_ticks> 40007454: b0 10 20 00 clr %i0 return 0; } 40007458: 81 c7 e0 08 ret 4000745c: 81 e8 00 00 restore =============================================================================== 40009da0 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 40009da0: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40009da4: 03 10 00 91 sethi %hi(0x40024400), %g1 40009da8: c4 00 63 90 ld [ %g1 + 0x390 ], %g2 ! 40024790 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40009dac: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 40009db0: 84 00 a0 01 inc %g2 40009db4: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 40009db8: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40009dbc: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 40009dc0: c4 20 63 90 st %g2, [ %g1 + 0x390 ] POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 40009dc4: a2 8e 62 00 andcc %i1, 0x200, %l1 40009dc8: 02 80 00 05 be 40009ddc 40009dcc: a0 10 20 00 clr %l0 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 40009dd0: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 40009dd4: 82 07 a0 54 add %fp, 0x54, %g1 40009dd8: c2 27 bf fc st %g1, [ %fp + -4 ] va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 40009ddc: 90 10 00 18 mov %i0, %o0 40009de0: 40 00 1a 63 call 4001076c <_POSIX_Semaphore_Name_to_id> 40009de4: 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 ) { 40009de8: a4 92 20 00 orcc %o0, 0, %l2 40009dec: 22 80 00 0e be,a 40009e24 40009df0: 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) ) ) { 40009df4: 80 a4 a0 02 cmp %l2, 2 40009df8: 12 80 00 04 bne 40009e08 <== NEVER TAKEN 40009dfc: 80 a4 60 00 cmp %l1, 0 40009e00: 12 80 00 21 bne 40009e84 40009e04: 94 10 00 10 mov %l0, %o2 _Thread_Enable_dispatch(); 40009e08: 40 00 0b e4 call 4000cd98 <_Thread_Enable_dispatch> 40009e0c: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 40009e10: 40 00 25 e2 call 40013598 <__errno> 40009e14: 01 00 00 00 nop 40009e18: e4 22 00 00 st %l2, [ %o0 ] 40009e1c: 81 c7 e0 08 ret 40009e20: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 40009e24: 80 a6 6a 00 cmp %i1, 0xa00 40009e28: 12 80 00 0a bne 40009e50 40009e2c: d2 07 bf f8 ld [ %fp + -8 ], %o1 _Thread_Enable_dispatch(); 40009e30: 40 00 0b da call 4000cd98 <_Thread_Enable_dispatch> 40009e34: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 40009e38: 40 00 25 d8 call 40013598 <__errno> 40009e3c: 01 00 00 00 nop 40009e40: 82 10 20 11 mov 0x11, %g1 ! 11 40009e44: c2 22 00 00 st %g1, [ %o0 ] 40009e48: 81 c7 e0 08 ret 40009e4c: 81 e8 00 00 restore 40009e50: 94 07 bf f0 add %fp, -16, %o2 40009e54: 11 10 00 92 sethi %hi(0x40024800), %o0 40009e58: 40 00 08 64 call 4000bfe8 <_Objects_Get> 40009e5c: 90 12 22 50 or %o0, 0x250, %o0 ! 40024a50 <_POSIX_Semaphore_Information> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 40009e60: 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 ); 40009e64: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 40009e68: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 40009e6c: 40 00 0b cb call 4000cd98 <_Thread_Enable_dispatch> 40009e70: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 40009e74: 40 00 0b c9 call 4000cd98 <_Thread_Enable_dispatch> 40009e78: 01 00 00 00 nop goto return_id; 40009e7c: 10 80 00 0c b 40009eac 40009e80: 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( 40009e84: 90 10 00 18 mov %i0, %o0 40009e88: 92 10 20 00 clr %o1 40009e8c: 40 00 19 e1 call 40010610 <_POSIX_Semaphore_Create_support> 40009e90: 96 07 bf f4 add %fp, -12, %o3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 40009e94: 40 00 0b c1 call 4000cd98 <_Thread_Enable_dispatch> 40009e98: a0 10 00 08 mov %o0, %l0 if ( status == -1 ) 40009e9c: 80 a4 3f ff cmp %l0, -1 40009ea0: 02 bf ff ea be 40009e48 40009ea4: 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; 40009ea8: f0 07 bf f4 ld [ %fp + -12 ], %i0 40009eac: b0 06 20 08 add %i0, 8, %i0 #endif return id; } 40009eb0: 81 c7 e0 08 ret 40009eb4: 81 e8 00 00 restore =============================================================================== 400072e8 : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 400072e8: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 400072ec: 90 96 a0 00 orcc %i2, 0, %o0 400072f0: 02 80 00 0a be 40007318 400072f4: a0 10 00 18 mov %i0, %l0 *oact = _POSIX_signals_Vectors[ sig ]; 400072f8: 83 2e 20 02 sll %i0, 2, %g1 400072fc: 85 2e 20 04 sll %i0, 4, %g2 40007300: 82 20 80 01 sub %g2, %g1, %g1 40007304: 13 10 00 83 sethi %hi(0x40020c00), %o1 40007308: 94 10 20 0c mov 0xc, %o2 4000730c: 92 12 61 30 or %o1, 0x130, %o1 40007310: 40 00 26 55 call 40010c64 40007314: 92 02 40 01 add %o1, %g1, %o1 if ( !sig ) 40007318: 80 a4 20 00 cmp %l0, 0 4000731c: 02 80 00 09 be 40007340 40007320: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 40007324: 82 04 3f ff add %l0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 40007328: 80 a0 60 1f cmp %g1, 0x1f 4000732c: 18 80 00 05 bgu 40007340 40007330: 01 00 00 00 nop * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 40007334: 80 a4 20 09 cmp %l0, 9 40007338: 12 80 00 08 bne 40007358 4000733c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 40007340: 40 00 23 ea call 400102e8 <__errno> 40007344: b0 10 3f ff mov -1, %i0 40007348: 82 10 20 16 mov 0x16, %g1 4000734c: c2 22 00 00 st %g1, [ %o0 ] 40007350: 81 c7 e0 08 ret 40007354: 81 e8 00 00 restore /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 40007358: 02 bf ff fe be 40007350 <== NEVER TAKEN 4000735c: 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 ); 40007360: 7f ff ec 17 call 400023bc 40007364: 01 00 00 00 nop 40007368: a2 10 00 08 mov %o0, %l1 if ( act->sa_handler == SIG_DFL ) { 4000736c: c2 06 60 08 ld [ %i1 + 8 ], %g1 40007370: 25 10 00 83 sethi %hi(0x40020c00), %l2 40007374: 80 a0 60 00 cmp %g1, 0 40007378: a4 14 a1 30 or %l2, 0x130, %l2 4000737c: a7 2c 20 02 sll %l0, 2, %l3 40007380: 12 80 00 08 bne 400073a0 40007384: a9 2c 20 04 sll %l0, 4, %l4 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 40007388: a6 25 00 13 sub %l4, %l3, %l3 4000738c: 13 10 00 7c sethi %hi(0x4001f000), %o1 40007390: 90 04 80 13 add %l2, %l3, %o0 40007394: 92 12 61 d0 or %o1, 0x1d0, %o1 40007398: 10 80 00 07 b 400073b4 4000739c: 92 02 40 13 add %o1, %l3, %o1 } else { _POSIX_signals_Clear_process_signals( sig ); 400073a0: 40 00 18 0b call 4000d3cc <_POSIX_signals_Clear_process_signals> 400073a4: 90 10 00 10 mov %l0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 400073a8: a6 25 00 13 sub %l4, %l3, %l3 400073ac: 92 10 00 19 mov %i1, %o1 400073b0: 90 04 80 13 add %l2, %l3, %o0 400073b4: 40 00 26 2c call 40010c64 400073b8: 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; 400073bc: 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 ); 400073c0: 7f ff ec 03 call 400023cc 400073c4: 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; } 400073c8: 81 c7 e0 08 ret 400073cc: 81 e8 00 00 restore =============================================================================== 4000779c : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 4000779c: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 400077a0: a0 96 20 00 orcc %i0, 0, %l0 400077a4: 02 80 00 0f be 400077e0 400077a8: 01 00 00 00 nop /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 400077ac: 80 a6 a0 00 cmp %i2, 0 400077b0: 02 80 00 12 be 400077f8 400077b4: a8 10 20 00 clr %l4 if ( !_Timespec_Is_valid( timeout ) ) 400077b8: 40 00 0e a0 call 4000b238 <_Timespec_Is_valid> 400077bc: 90 10 00 1a mov %i2, %o0 400077c0: 80 8a 20 ff btst 0xff, %o0 400077c4: 02 80 00 07 be 400077e0 400077c8: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 400077cc: 40 00 0e be call 4000b2c4 <_Timespec_To_ticks> 400077d0: 90 10 00 1a mov %i2, %o0 if ( !interval ) 400077d4: a8 92 20 00 orcc %o0, 0, %l4 400077d8: 12 80 00 09 bne 400077fc <== ALWAYS TAKEN 400077dc: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 400077e0: 40 00 24 87 call 400109fc <__errno> 400077e4: b0 10 3f ff mov -1, %i0 400077e8: 82 10 20 16 mov 0x16, %g1 400077ec: c2 22 00 00 st %g1, [ %o0 ] 400077f0: 81 c7 e0 08 ret 400077f4: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 400077f8: 80 a6 60 00 cmp %i1, 0 400077fc: 22 80 00 02 be,a 40007804 40007800: b2 07 bf f4 add %fp, -12, %i1 the_thread = _Thread_Executing; 40007804: 31 10 00 85 sethi %hi(0x40021400), %i0 40007808: b0 16 20 c8 or %i0, 0xc8, %i0 ! 400214c8 <_Per_CPU_Information> 4000780c: e6 06 20 0c ld [ %i0 + 0xc ], %l3 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40007810: 7f ff eb c6 call 40002728 40007814: e4 04 e1 58 ld [ %l3 + 0x158 ], %l2 40007818: a2 10 00 08 mov %o0, %l1 if ( *set & api->signals_pending ) { 4000781c: c4 04 00 00 ld [ %l0 ], %g2 40007820: c2 04 a0 d4 ld [ %l2 + 0xd4 ], %g1 40007824: 80 88 80 01 btst %g2, %g1 40007828: 22 80 00 13 be,a 40007874 4000782c: 03 10 00 85 sethi %hi(0x40021400), %g1 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 40007830: 7f ff ff c3 call 4000773c <_POSIX_signals_Get_lowest> 40007834: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( 40007838: 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 ); 4000783c: 92 10 00 08 mov %o0, %o1 40007840: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 40007844: 96 10 20 00 clr %o3 40007848: 90 10 00 12 mov %l2, %o0 4000784c: 40 00 18 d7 call 4000dba8 <_POSIX_signals_Clear_signals> 40007850: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 40007854: 7f ff eb b9 call 40002738 40007858: 90 10 00 11 mov %l1, %o0 the_info->si_code = SI_USER; 4000785c: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 40007860: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 40007864: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 40007868: f0 06 40 00 ld [ %i1 ], %i0 4000786c: 81 c7 e0 08 ret 40007870: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 40007874: c2 00 63 14 ld [ %g1 + 0x314 ], %g1 40007878: 80 88 80 01 btst %g2, %g1 4000787c: 22 80 00 13 be,a 400078c8 40007880: 82 10 3f ff mov -1, %g1 signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40007884: 7f ff ff ae call 4000773c <_POSIX_signals_Get_lowest> 40007888: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 4000788c: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40007890: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40007894: 96 10 20 01 mov 1, %o3 40007898: 90 10 00 12 mov %l2, %o0 4000789c: 92 10 00 18 mov %i0, %o1 400078a0: 40 00 18 c2 call 4000dba8 <_POSIX_signals_Clear_signals> 400078a4: 98 10 20 00 clr %o4 _ISR_Enable( level ); 400078a8: 7f ff eb a4 call 40002738 400078ac: 90 10 00 11 mov %l1, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 400078b0: 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; 400078b4: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 400078b8: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 400078bc: c0 26 60 08 clr [ %i1 + 8 ] return signo; 400078c0: 81 c7 e0 08 ret 400078c4: 81 e8 00 00 restore } the_info->si_signo = -1; 400078c8: c2 26 40 00 st %g1, [ %i1 ] 400078cc: 03 10 00 83 sethi %hi(0x40020c00), %g1 400078d0: c4 00 63 90 ld [ %g1 + 0x390 ], %g2 ! 40020f90 <_Thread_Dispatch_disable_level> 400078d4: 84 00 a0 01 inc %g2 400078d8: c4 20 63 90 st %g2, [ %g1 + 0x390 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 400078dc: 82 10 20 04 mov 4, %g1 400078e0: c2 24 e0 34 st %g1, [ %l3 + 0x34 ] the_thread->Wait.option = *set; 400078e4: c2 04 00 00 ld [ %l0 ], %g1 the_thread->Wait.return_argument = the_info; 400078e8: 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; 400078ec: 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; 400078f0: a2 10 20 01 mov 1, %l1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 400078f4: 2b 10 00 85 sethi %hi(0x40021400), %l5 400078f8: aa 15 62 ac or %l5, 0x2ac, %l5 ! 400216ac <_POSIX_signals_Wait_queue> 400078fc: ea 24 e0 44 st %l5, [ %l3 + 0x44 ] 40007900: 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 ); 40007904: 7f ff eb 8d call 40002738 40007908: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 4000790c: 90 10 00 15 mov %l5, %o0 40007910: 92 10 00 14 mov %l4, %o1 40007914: 15 10 00 2b sethi %hi(0x4000ac00), %o2 40007918: 40 00 0c 9c call 4000ab88 <_Thread_queue_Enqueue_with_handler> 4000791c: 94 12 a3 10 or %o2, 0x310, %o2 ! 4000af10 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 40007920: 40 00 0b 6a call 4000a6c8 <_Thread_Enable_dispatch> 40007924: 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 ); 40007928: d2 06 40 00 ld [ %i1 ], %o1 4000792c: 90 10 00 12 mov %l2, %o0 40007930: 94 10 00 19 mov %i1, %o2 40007934: 96 10 20 00 clr %o3 40007938: 40 00 18 9c call 4000dba8 <_POSIX_signals_Clear_signals> 4000793c: 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) 40007940: c2 06 20 0c ld [ %i0 + 0xc ], %g1 40007944: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007948: 80 a0 60 04 cmp %g1, 4 4000794c: 12 80 00 09 bne 40007970 40007950: 01 00 00 00 nop || !(*set & signo_to_mask( the_info->si_signo )) ) { 40007954: f0 06 40 00 ld [ %i1 ], %i0 40007958: 82 06 3f ff add %i0, -1, %g1 4000795c: a3 2c 40 01 sll %l1, %g1, %l1 40007960: c2 04 00 00 ld [ %l0 ], %g1 40007964: 80 8c 40 01 btst %l1, %g1 40007968: 12 80 00 08 bne 40007988 4000796c: 01 00 00 00 nop errno = _Thread_Executing->Wait.return_code; 40007970: 40 00 24 23 call 400109fc <__errno> 40007974: b0 10 3f ff mov -1, %i0 ! ffffffff 40007978: 03 10 00 85 sethi %hi(0x40021400), %g1 4000797c: c2 00 60 d4 ld [ %g1 + 0xd4 ], %g1 ! 400214d4 <_Per_CPU_Information+0xc> 40007980: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007984: c2 22 00 00 st %g1, [ %o0 ] return -1; } return the_info->si_signo; } 40007988: 81 c7 e0 08 ret 4000798c: 81 e8 00 00 restore =============================================================================== 400098f0 : int sigwait( const sigset_t *set, int *sig ) { 400098f0: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 400098f4: 92 10 20 00 clr %o1 400098f8: 90 10 00 18 mov %i0, %o0 400098fc: 7f ff ff 7b call 400096e8 40009900: 94 10 20 00 clr %o2 if ( status != -1 ) { 40009904: 80 a2 3f ff cmp %o0, -1 40009908: 02 80 00 07 be 40009924 4000990c: 80 a6 60 00 cmp %i1, 0 if ( sig ) 40009910: 02 80 00 03 be 4000991c <== NEVER TAKEN 40009914: b0 10 20 00 clr %i0 *sig = status; 40009918: d0 26 40 00 st %o0, [ %i1 ] 4000991c: 81 c7 e0 08 ret 40009920: 81 e8 00 00 restore return 0; } return errno; 40009924: 40 00 23 1e call 4001259c <__errno> 40009928: 01 00 00 00 nop 4000992c: f0 02 00 00 ld [ %o0 ], %i0 } 40009930: 81 c7 e0 08 ret 40009934: 81 e8 00 00 restore =============================================================================== 40006638 : */ long sysconf( int name ) { 40006638: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 4000663c: 80 a6 20 02 cmp %i0, 2 40006640: 12 80 00 09 bne 40006664 40006644: 80 a6 20 04 cmp %i0, 4 return (TOD_MICROSECONDS_PER_SECOND / 40006648: 03 10 00 5b sethi %hi(0x40016c00), %g1 4000664c: d2 00 61 98 ld [ %g1 + 0x198 ], %o1 ! 40016d98 40006650: 11 00 03 d0 sethi %hi(0xf4000), %o0 40006654: 40 00 33 8c call 40013484 <.udiv> 40006658: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 4000665c: 81 c7 e0 08 ret 40006660: 91 e8 00 08 restore %g0, %o0, %o0 rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 40006664: 12 80 00 05 bne 40006678 40006668: 80 a6 20 33 cmp %i0, 0x33 return rtems_libio_number_iops; 4000666c: 03 10 00 5b sethi %hi(0x40016c00), %g1 40006670: 10 80 00 0f b 400066ac 40006674: d0 00 60 84 ld [ %g1 + 0x84 ], %o0 ! 40016c84 if ( name == _SC_GETPW_R_SIZE_MAX ) 40006678: 02 80 00 0d be 400066ac 4000667c: 90 10 24 00 mov 0x400, %o0 return 1024; if ( name == _SC_PAGESIZE ) 40006680: 80 a6 20 08 cmp %i0, 8 40006684: 02 80 00 0a be 400066ac 40006688: 90 02 2c 00 add %o0, 0xc00, %o0 return PAGE_SIZE; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 4000668c: 80 a6 22 03 cmp %i0, 0x203 40006690: 02 80 00 07 be 400066ac <== NEVER TAKEN 40006694: 90 10 20 00 clr %o0 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40006698: 40 00 23 df call 4000f614 <__errno> 4000669c: 01 00 00 00 nop 400066a0: 82 10 20 16 mov 0x16, %g1 ! 16 400066a4: c2 22 00 00 st %g1, [ %o0 ] 400066a8: 90 10 3f ff mov -1, %o0 } 400066ac: b0 10 00 08 mov %o0, %i0 400066b0: 81 c7 e0 08 ret 400066b4: 81 e8 00 00 restore =============================================================================== 400069c4 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 400069c4: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 400069c8: 80 a6 20 01 cmp %i0, 1 400069cc: 12 80 00 15 bne 40006a20 400069d0: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 400069d4: 80 a6 a0 00 cmp %i2, 0 400069d8: 02 80 00 12 be 40006a20 400069dc: 01 00 00 00 nop /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 400069e0: 80 a6 60 00 cmp %i1, 0 400069e4: 02 80 00 13 be 40006a30 400069e8: 03 10 00 7d sethi %hi(0x4001f400), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 400069ec: c2 06 40 00 ld [ %i1 ], %g1 400069f0: 82 00 7f ff add %g1, -1, %g1 400069f4: 80 a0 60 01 cmp %g1, 1 400069f8: 18 80 00 0a bgu 40006a20 <== NEVER TAKEN 400069fc: 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 ) 40006a00: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006a04: 80 a0 60 00 cmp %g1, 0 40006a08: 02 80 00 06 be 40006a20 <== NEVER TAKEN 40006a0c: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 40006a10: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 40006a14: 80 a0 60 1f cmp %g1, 0x1f 40006a18: 28 80 00 06 bleu,a 40006a30 <== ALWAYS TAKEN 40006a1c: 03 10 00 7d sethi %hi(0x4001f400), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40006a20: 40 00 25 18 call 4000fe80 <__errno> 40006a24: 01 00 00 00 nop 40006a28: 10 80 00 10 b 40006a68 40006a2c: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006a30: c4 00 62 10 ld [ %g1 + 0x210 ], %g2 40006a34: 84 00 a0 01 inc %g2 40006a38: c4 20 62 10 st %g2, [ %g1 + 0x210 ] * 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 ); 40006a3c: 11 10 00 7e sethi %hi(0x4001f800), %o0 40006a40: 40 00 07 e8 call 400089e0 <_Objects_Allocate> 40006a44: 90 12 21 10 or %o0, 0x110, %o0 ! 4001f910 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 40006a48: 80 a2 20 00 cmp %o0, 0 40006a4c: 12 80 00 0a bne 40006a74 40006a50: 82 10 20 02 mov 2, %g1 _Thread_Enable_dispatch(); 40006a54: 40 00 0c 6d call 40009c08 <_Thread_Enable_dispatch> 40006a58: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 40006a5c: 40 00 25 09 call 4000fe80 <__errno> 40006a60: 01 00 00 00 nop 40006a64: 82 10 20 0b mov 0xb, %g1 ! b 40006a68: c2 22 00 00 st %g1, [ %o0 ] 40006a6c: 81 c7 e0 08 ret 40006a70: 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; 40006a74: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 40006a78: 03 10 00 7e sethi %hi(0x4001f800), %g1 40006a7c: c2 00 63 54 ld [ %g1 + 0x354 ], %g1 ! 4001fb54 <_Per_CPU_Information+0xc> if ( evp != NULL ) { 40006a80: 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; 40006a84: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 40006a88: 02 80 00 08 be 40006aa8 40006a8c: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 40006a90: c2 06 40 00 ld [ %i1 ], %g1 40006a94: c2 22 20 40 st %g1, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 40006a98: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006a9c: c2 22 20 44 st %g1, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 40006aa0: c2 06 60 08 ld [ %i1 + 8 ], %g1 40006aa4: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006aa8: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006aac: 07 10 00 7e sethi %hi(0x4001f800), %g3 40006ab0: c6 00 e1 2c ld [ %g3 + 0x12c ], %g3 ! 4001f92c <_POSIX_Timer_Information+0x1c> } ptimer->overrun = 0; 40006ab4: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 40006ab8: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 40006abc: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 40006ac0: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 40006ac4: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40006ac8: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 40006acc: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 40006ad0: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 40006ad4: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006ad8: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006adc: 85 28 a0 02 sll %g2, 2, %g2 40006ae0: 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; 40006ae4: 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; 40006ae8: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 40006aec: 40 00 0c 47 call 40009c08 <_Thread_Enable_dispatch> 40006af0: b0 10 20 00 clr %i0 return 0; } 40006af4: 81 c7 e0 08 ret 40006af8: 81 e8 00 00 restore =============================================================================== 40006afc : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 40006afc: 9d e3 bf 80 save %sp, -128, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 40006b00: 80 a6 a0 00 cmp %i2, 0 40006b04: 02 80 00 22 be 40006b8c <== NEVER TAKEN 40006b08: 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) ) ) { 40006b0c: 40 00 0f 2c call 4000a7bc <_Timespec_Is_valid> 40006b10: 90 06 a0 08 add %i2, 8, %o0 40006b14: 80 8a 20 ff btst 0xff, %o0 40006b18: 02 80 00 1d be 40006b8c 40006b1c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 40006b20: 40 00 0f 27 call 4000a7bc <_Timespec_Is_valid> 40006b24: 90 10 00 1a mov %i2, %o0 40006b28: 80 8a 20 ff btst 0xff, %o0 40006b2c: 02 80 00 18 be 40006b8c <== NEVER TAKEN 40006b30: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40006b34: 80 a6 60 00 cmp %i1, 0 40006b38: 02 80 00 05 be 40006b4c 40006b3c: 90 07 bf e4 add %fp, -28, %o0 40006b40: 80 a6 60 04 cmp %i1, 4 40006b44: 12 80 00 12 bne 40006b8c 40006b48: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 40006b4c: 92 10 00 1a mov %i2, %o1 40006b50: 40 00 27 40 call 40010850 40006b54: 94 10 20 10 mov 0x10, %o2 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 40006b58: 80 a6 60 04 cmp %i1, 4 40006b5c: 12 80 00 16 bne 40006bb4 40006b60: 92 10 00 18 mov %i0, %o1 struct timespec now; _TOD_Get( &now ); 40006b64: b2 07 bf f4 add %fp, -12, %i1 40006b68: 40 00 06 2e call 40008420 <_TOD_Get> 40006b6c: 90 10 00 19 mov %i1, %o0 /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 40006b70: a0 07 bf ec add %fp, -20, %l0 40006b74: 90 10 00 19 mov %i1, %o0 40006b78: 40 00 0f 00 call 4000a778 <_Timespec_Greater_than> 40006b7c: 92 10 00 10 mov %l0, %o1 40006b80: 80 8a 20 ff btst 0xff, %o0 40006b84: 02 80 00 08 be 40006ba4 40006b88: 90 10 00 19 mov %i1, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); 40006b8c: 40 00 24 bd call 4000fe80 <__errno> 40006b90: b0 10 3f ff mov -1, %i0 40006b94: 82 10 20 16 mov 0x16, %g1 40006b98: c2 22 00 00 st %g1, [ %o0 ] 40006b9c: 81 c7 e0 08 ret 40006ba0: 81 e8 00 00 restore _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 40006ba4: 92 10 00 10 mov %l0, %o1 40006ba8: 40 00 0f 16 call 4000a800 <_Timespec_Subtract> 40006bac: 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 ); 40006bb0: 92 10 00 18 mov %i0, %o1 40006bb4: 11 10 00 7e sethi %hi(0x4001f800), %o0 40006bb8: 94 07 bf fc add %fp, -4, %o2 40006bbc: 40 00 08 c5 call 40008ed0 <_Objects_Get> 40006bc0: 90 12 21 10 or %o0, 0x110, %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 ) { 40006bc4: c2 07 bf fc ld [ %fp + -4 ], %g1 40006bc8: 80 a0 60 00 cmp %g1, 0 40006bcc: 12 80 00 39 bne 40006cb0 40006bd0: 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 ) { 40006bd4: c2 07 bf ec ld [ %fp + -20 ], %g1 40006bd8: 80 a0 60 00 cmp %g1, 0 40006bdc: 12 80 00 14 bne 40006c2c 40006be0: c2 07 bf f0 ld [ %fp + -16 ], %g1 40006be4: 80 a0 60 00 cmp %g1, 0 40006be8: 12 80 00 11 bne 40006c2c 40006bec: 01 00 00 00 nop /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 40006bf0: 40 00 10 3b call 4000acdc <_Watchdog_Remove> 40006bf4: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 40006bf8: 80 a6 e0 00 cmp %i3, 0 40006bfc: 02 80 00 05 be 40006c10 40006c00: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40006c04: 92 06 20 54 add %i0, 0x54, %o1 40006c08: 40 00 27 12 call 40010850 40006c0c: 94 10 20 10 mov 0x10, %o2 /* The new data are set */ ptimer->timer_data = normalize; 40006c10: 90 06 20 54 add %i0, 0x54, %o0 40006c14: 92 07 bf e4 add %fp, -28, %o1 40006c18: 40 00 27 0e call 40010850 40006c1c: 94 10 20 10 mov 0x10, %o2 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 40006c20: 82 10 20 04 mov 4, %g1 40006c24: 10 80 00 1f b 40006ca0 40006c28: 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 ); 40006c2c: 40 00 0f 07 call 4000a848 <_Timespec_To_ticks> 40006c30: 90 10 00 1a mov %i2, %o0 40006c34: d0 26 20 64 st %o0, [ %i0 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 40006c38: 40 00 0f 04 call 4000a848 <_Timespec_To_ticks> 40006c3c: 90 07 bf ec add %fp, -20, %o0 activated = _POSIX_Timer_Insert_helper( 40006c40: 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 ); 40006c44: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 40006c48: 17 10 00 1b sethi %hi(0x40006c00), %o3 40006c4c: 90 06 20 10 add %i0, 0x10, %o0 40006c50: 96 12 e0 c8 or %o3, 0xc8, %o3 40006c54: 40 00 19 e6 call 4000d3ec <_POSIX_Timer_Insert_helper> 40006c58: 98 10 00 18 mov %i0, %o4 initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 40006c5c: 80 8a 20 ff btst 0xff, %o0 40006c60: 02 80 00 10 be 40006ca0 40006c64: 01 00 00 00 nop /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 40006c68: 80 a6 e0 00 cmp %i3, 0 40006c6c: 02 80 00 05 be 40006c80 40006c70: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40006c74: 92 06 20 54 add %i0, 0x54, %o1 40006c78: 40 00 26 f6 call 40010850 40006c7c: 94 10 20 10 mov 0x10, %o2 ptimer->timer_data = normalize; 40006c80: 90 06 20 54 add %i0, 0x54, %o0 40006c84: 92 07 bf e4 add %fp, -28, %o1 40006c88: 40 00 26 f2 call 40010850 40006c8c: 94 10 20 10 mov 0x10, %o2 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40006c90: 82 10 20 03 mov 3, %g1 _TOD_Get( &ptimer->time ); 40006c94: 90 06 20 6c add %i0, 0x6c, %o0 40006c98: 40 00 05 e2 call 40008420 <_TOD_Get> 40006c9c: c2 2e 20 3c stb %g1, [ %i0 + 0x3c ] _Thread_Enable_dispatch(); 40006ca0: 40 00 0b da call 40009c08 <_Thread_Enable_dispatch> 40006ca4: b0 10 20 00 clr %i0 return 0; 40006ca8: 81 c7 e0 08 ret 40006cac: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 40006cb0: 40 00 24 74 call 4000fe80 <__errno> 40006cb4: b0 10 3f ff mov -1, %i0 40006cb8: 82 10 20 16 mov 0x16, %g1 40006cbc: c2 22 00 00 st %g1, [ %o0 ] } 40006cc0: 81 c7 e0 08 ret 40006cc4: 81 e8 00 00 restore =============================================================================== 400068dc : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 400068dc: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 400068e0: 23 10 00 63 sethi %hi(0x40018c00), %l1 400068e4: a2 14 63 d8 or %l1, 0x3d8, %l1 ! 40018fd8 <_POSIX_signals_Ualarm_timer> 400068e8: c2 04 60 1c ld [ %l1 + 0x1c ], %g1 400068ec: 80 a0 60 00 cmp %g1, 0 400068f0: 12 80 00 0a bne 40006918 400068f4: a0 10 00 18 mov %i0, %l0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 400068f8: 03 10 00 1a sethi %hi(0x40006800), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 400068fc: c0 24 60 08 clr [ %l1 + 8 ] the_watchdog->routine = routine; 40006900: 82 10 60 ac or %g1, 0xac, %g1 the_watchdog->id = id; 40006904: c0 24 60 20 clr [ %l1 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40006908: c2 24 60 1c st %g1, [ %l1 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 4000690c: c0 24 60 24 clr [ %l1 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 40006910: 10 80 00 1b b 4000697c 40006914: 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 ); 40006918: 40 00 0f cb call 4000a844 <_Watchdog_Remove> 4000691c: 90 10 00 11 mov %l1, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 40006920: 90 02 3f fe add %o0, -2, %o0 40006924: 80 a2 20 01 cmp %o0, 1 40006928: 18 80 00 15 bgu 4000697c <== NEVER TAKEN 4000692c: 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); 40006930: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40006934: d0 04 60 14 ld [ %l1 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40006938: 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); 4000693c: 90 02 00 01 add %o0, %g1, %o0 40006940: c2 04 60 18 ld [ %l1 + 0x18 ], %g1 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40006944: 40 00 0e 4c call 4000a274 <_Timespec_From_ticks> 40006948: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 4000694c: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 40006950: 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; 40006954: b1 28 60 08 sll %g1, 8, %i0 40006958: 85 28 60 03 sll %g1, 3, %g2 4000695c: 84 26 00 02 sub %i0, %g2, %g2 remaining += tp.tv_nsec / 1000; 40006960: 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; 40006964: b1 28 a0 06 sll %g2, 6, %i0 40006968: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 4000696c: 40 00 37 b1 call 40014830 <.div> 40006970: 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; 40006974: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 40006978: 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 ) { 4000697c: 80 a4 20 00 cmp %l0, 0 40006980: 02 80 00 1a be 400069e8 40006984: 23 00 03 d0 sethi %hi(0xf4000), %l1 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40006988: 90 10 00 10 mov %l0, %o0 4000698c: 40 00 37 a7 call 40014828 <.udiv> 40006990: 92 14 62 40 or %l1, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006994: 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; 40006998: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 4000699c: 40 00 38 4f call 40014ad8 <.urem> 400069a0: 90 10 00 10 mov %l0, %o0 400069a4: 85 2a 20 07 sll %o0, 7, %g2 400069a8: 83 2a 20 02 sll %o0, 2, %g1 400069ac: 82 20 80 01 sub %g2, %g1, %g1 400069b0: 90 00 40 08 add %g1, %o0, %o0 400069b4: 91 2a 20 03 sll %o0, 3, %o0 ticks = _Timespec_To_ticks( &tp ); 400069b8: 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; 400069bc: d0 27 bf fc st %o0, [ %fp + -4 ] ticks = _Timespec_To_ticks( &tp ); 400069c0: 40 00 0e 54 call 4000a310 <_Timespec_To_ticks> 400069c4: 90 10 00 10 mov %l0, %o0 if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 400069c8: 40 00 0e 52 call 4000a310 <_Timespec_To_ticks> 400069cc: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400069d0: 13 10 00 63 sethi %hi(0x40018c00), %o1 400069d4: 92 12 63 d8 or %o1, 0x3d8, %o1 ! 40018fd8 <_POSIX_signals_Ualarm_timer> 400069d8: d0 22 60 0c st %o0, [ %o1 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400069dc: 11 10 00 61 sethi %hi(0x40018400), %o0 400069e0: 40 00 0f 3d call 4000a6d4 <_Watchdog_Insert> 400069e4: 90 12 23 90 or %o0, 0x390, %o0 ! 40018790 <_Watchdog_Ticks_chain> } return remaining; } 400069e8: 81 c7 e0 08 ret 400069ec: 81 e8 00 00 restore