=============================================================================== 40009d90 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 40009d90: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 40009d94: 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 ); 40009d98: 7f ff e6 2a call 40003640 40009d9c: e0 00 62 b4 ld [ %g1 + 0x2b4 ], %l0 ! 4001aab4 <_Per_CPU_Information+0xc> 40009da0: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 40009da4: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 40009da8: 80 a0 60 00 cmp %g1, 0 40009dac: 12 80 00 08 bne 40009dcc <_CORE_RWLock_Release+0x3c> 40009db0: 80 a0 60 01 cmp %g1, 1 _ISR_Enable( level ); 40009db4: 7f ff e6 27 call 40003650 40009db8: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 40009dbc: 82 10 20 02 mov 2, %g1 40009dc0: c2 24 20 34 st %g1, [ %l0 + 0x34 ] 40009dc4: 81 c7 e0 08 ret 40009dc8: 81 e8 00 00 restore return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 40009dcc: 32 80 00 0b bne,a 40009df8 <_CORE_RWLock_Release+0x68> 40009dd0: c0 24 20 34 clr [ %l0 + 0x34 ] the_rwlock->number_of_readers -= 1; 40009dd4: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40009dd8: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 40009ddc: 80 a0 60 00 cmp %g1, 0 40009de0: 02 80 00 05 be 40009df4 <_CORE_RWLock_Release+0x64> 40009de4: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 40009de8: 7f ff e6 1a call 40003650 40009dec: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 40009df0: 30 80 00 24 b,a 40009e80 <_CORE_RWLock_Release+0xf0> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 40009df4: 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; 40009df8: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 40009dfc: 7f ff e6 15 call 40003650 40009e00: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 40009e04: 40 00 06 d5 call 4000b958 <_Thread_queue_Dequeue> 40009e08: 90 10 00 18 mov %i0, %o0 if ( next ) { 40009e0c: 80 a2 20 00 cmp %o0, 0 40009e10: 22 80 00 1c be,a 40009e80 <_CORE_RWLock_Release+0xf0> 40009e14: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 40009e18: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 40009e1c: 80 a0 60 01 cmp %g1, 1 40009e20: 32 80 00 05 bne,a 40009e34 <_CORE_RWLock_Release+0xa4> 40009e24: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 40009e28: 82 10 20 02 mov 2, %g1 return CORE_RWLOCK_SUCCESSFUL; 40009e2c: 10 80 00 14 b 40009e7c <_CORE_RWLock_Release+0xec> 40009e30: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 40009e34: 82 00 60 01 inc %g1 40009e38: c2 26 20 48 st %g1, [ %i0 + 0x48 ] the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 40009e3c: 82 10 20 01 mov 1, %g1 40009e40: 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 ); 40009e44: 40 00 08 0d call 4000be78 <_Thread_queue_First> 40009e48: 90 10 00 18 mov %i0, %o0 if ( !next || 40009e4c: 92 92 20 00 orcc %o0, 0, %o1 40009e50: 22 80 00 0c be,a 40009e80 <_CORE_RWLock_Release+0xf0> 40009e54: b0 10 20 00 clr %i0 40009e58: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 40009e5c: 80 a0 60 01 cmp %g1, 1 40009e60: 02 80 00 07 be 40009e7c <_CORE_RWLock_Release+0xec> <== NEVER TAKEN 40009e64: 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; 40009e68: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 40009e6c: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 40009e70: 40 00 07 b2 call 4000bd38 <_Thread_queue_Extract> 40009e74: c2 26 20 48 st %g1, [ %i0 + 0x48 ] } 40009e78: 30 bf ff f3 b,a 40009e44 <_CORE_RWLock_Release+0xb4> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 40009e7c: b0 10 20 00 clr %i0 40009e80: 81 c7 e0 08 ret 40009e84: 81 e8 00 00 restore =============================================================================== 40009e88 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 40009e88: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009e8c: 90 10 00 18 mov %i0, %o0 40009e90: 40 00 05 e4 call 4000b620 <_Thread_Get> 40009e94: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009e98: c2 07 bf fc ld [ %fp + -4 ], %g1 40009e9c: 80 a0 60 00 cmp %g1, 0 40009ea0: 12 80 00 08 bne 40009ec0 <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 40009ea4: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40009ea8: 40 00 08 37 call 4000bf84 <_Thread_queue_Process_timeout> 40009eac: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 40009eb0: 03 10 00 69 sethi %hi(0x4001a400), %g1 40009eb4: c4 00 61 50 ld [ %g1 + 0x150 ], %g2 ! 4001a550 <_Thread_Dispatch_disable_level> 40009eb8: 84 00 bf ff add %g2, -1, %g2 40009ebc: c4 20 61 50 st %g2, [ %g1 + 0x150 ] 40009ec0: 81 c7 e0 08 ret 40009ec4: 81 e8 00 00 restore =============================================================================== 40017ec0 <_CORE_message_queue_Broadcast>: Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 40017ec0: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 40017ec4: c2 06 20 4c ld [ %i0 + 0x4c ], %g1 Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 40017ec8: a0 10 00 18 mov %i0, %l0 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 40017ecc: 80 a6 80 01 cmp %i2, %g1 40017ed0: 18 80 00 16 bgu 40017f28 <_CORE_message_queue_Broadcast+0x68><== NEVER TAKEN 40017ed4: b0 10 20 01 mov 1, %i0 * NOTE: This check is critical because threads can block on * send and receive and this ensures that we are broadcasting * the message to threads waiting to receive -- not to send. */ if ( the_message_queue->number_of_pending_messages != 0 ) { 40017ed8: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40017edc: 80 a0 60 00 cmp %g1, 0 40017ee0: 02 80 00 0b be 40017f0c <_CORE_message_queue_Broadcast+0x4c> 40017ee4: a2 10 20 00 clr %l1 *count = 0; 40017ee8: c0 27 40 00 clr [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 40017eec: 81 c7 e0 08 ret 40017ef0: 91 e8 20 00 restore %g0, 0, %o0 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 40017ef4: 92 10 00 19 mov %i1, %o1 40017ef8: 40 00 24 a9 call 4002119c 40017efc: 94 10 00 1a mov %i2, %o2 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 40017f00: c2 04 a0 28 ld [ %l2 + 0x28 ], %g1 */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 40017f04: a2 04 60 01 inc %l1 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 40017f08: f4 20 40 00 st %i2, [ %g1 ] /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 40017f0c: 40 00 0b 23 call 4001ab98 <_Thread_queue_Dequeue> 40017f10: 90 10 00 10 mov %l0, %o0 40017f14: a4 92 20 00 orcc %o0, 0, %l2 40017f18: 32 bf ff f7 bne,a 40017ef4 <_CORE_message_queue_Broadcast+0x34> 40017f1c: d0 04 a0 2c ld [ %l2 + 0x2c ], %o0 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 40017f20: e2 27 40 00 st %l1, [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 40017f24: b0 10 20 00 clr %i0 } 40017f28: 81 c7 e0 08 ret 40017f2c: 81 e8 00 00 restore =============================================================================== 400107a8 <_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 ) { 400107a8: 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; 400107ac: f4 26 20 44 st %i2, [ %i0 + 0x44 ] the_message_queue->number_of_pending_messages = 0; 400107b0: c0 26 20 48 clr [ %i0 + 0x48 ] the_message_queue->maximum_message_size = maximum_message_size; 400107b4: 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; 400107b8: c0 26 20 60 clr [ %i0 + 0x60 ] the_message_queue->notify_argument = the_argument; 400107bc: 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 ) { 400107c0: 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)) { 400107c4: 80 8e e0 03 btst 3, %i3 400107c8: 02 80 00 07 be 400107e4 <_CORE_message_queue_Initialize+0x3c> 400107cc: a4 10 00 1b mov %i3, %l2 allocated_message_size += sizeof(uint32_t); 400107d0: a4 06 e0 04 add %i3, 4, %l2 allocated_message_size &= ~(sizeof(uint32_t) - 1); 400107d4: a4 0c bf fc and %l2, -4, %l2 } if (allocated_message_size < maximum_message_size) 400107d8: 80 a4 80 1b cmp %l2, %i3 400107dc: 0a 80 00 22 bcs 40010864 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 400107e0: 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)); 400107e4: 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 * 400107e8: 92 10 00 1a mov %i2, %o1 400107ec: 90 10 00 11 mov %l1, %o0 400107f0: 40 00 41 5c call 40020d60 <.umul> 400107f4: b0 10 20 00 clr %i0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 400107f8: 80 a2 00 12 cmp %o0, %l2 400107fc: 0a 80 00 1a bcs 40010864 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 40010800: 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 ); 40010804: 40 00 0b ff call 40013800 <_Workspace_Allocate> 40010808: 01 00 00 00 nop return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 4001080c: d0 24 20 5c st %o0, [ %l0 + 0x5c ] _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 40010810: 80 a2 20 00 cmp %o0, 0 40010814: 02 80 00 14 be 40010864 <_CORE_message_queue_Initialize+0xbc> 40010818: 92 10 00 08 mov %o0, %o1 /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 4001081c: 90 04 20 68 add %l0, 0x68, %o0 40010820: 94 10 00 1a mov %i2, %o2 40010824: 40 00 16 38 call 40016104 <_Chain_Initialize> 40010828: 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 ); 4001082c: 82 04 20 54 add %l0, 0x54, %g1 head->next = tail; 40010830: 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 ); 40010834: 82 04 20 50 add %l0, 0x50, %g1 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 40010838: c0 24 20 54 clr [ %l0 + 0x54 ] tail->previous = head; 4001083c: 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( 40010840: c2 06 40 00 ld [ %i1 ], %g1 40010844: 90 10 00 10 mov %l0, %o0 40010848: 82 18 60 01 xor %g1, 1, %g1 4001084c: 80 a0 00 01 cmp %g0, %g1 40010850: 94 10 20 80 mov 0x80, %o2 40010854: 92 60 3f ff subx %g0, -1, %o1 40010858: 96 10 20 06 mov 6, %o3 4001085c: 40 00 09 48 call 40012d7c <_Thread_queue_Initialize> 40010860: b0 10 20 01 mov 1, %i0 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 40010864: 81 c7 e0 08 ret 40010868: 81 e8 00 00 restore =============================================================================== 4001086c <_CORE_message_queue_Seize>: void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4001086c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 40010870: 27 10 00 9c sethi %hi(0x40027000), %l3 40010874: a6 14 e0 98 or %l3, 0x98, %l3 ! 40027098 <_Per_CPU_Information> 40010878: e4 04 e0 0c ld [ %l3 + 0xc ], %l2 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 4001087c: 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; 40010880: c0 24 a0 34 clr [ %l2 + 0x34 ] _ISR_Disable( level ); 40010884: 7f ff da b2 call 4000734c 40010888: a2 10 00 19 mov %i1, %l1 4001088c: 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 ); } 40010890: 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 ); 40010894: 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)) 40010898: 80 a6 40 02 cmp %i1, %g2 4001089c: 02 80 00 24 be 4001092c <_CORE_message_queue_Seize+0xc0> 400108a0: 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; 400108a4: c4 06 40 00 ld [ %i1 ], %g2 head->next = new_first; 400108a8: 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 ) { 400108ac: 80 a6 60 00 cmp %i1, 0 400108b0: 02 80 00 1f be 4001092c <_CORE_message_queue_Seize+0xc0> <== NEVER TAKEN 400108b4: c6 20 a0 04 st %g3, [ %g2 + 4 ] the_message_queue->number_of_pending_messages -= 1; 400108b8: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 400108bc: 82 00 7f ff add %g1, -1, %g1 400108c0: c2 26 20 48 st %g1, [ %i0 + 0x48 ] _ISR_Enable( level ); 400108c4: 7f ff da a6 call 4000735c 400108c8: a2 06 60 10 add %i1, 0x10, %l1 *size_p = the_message->Contents.size; 400108cc: d4 06 60 0c ld [ %i1 + 0xc ], %o2 _Thread_Executing->Wait.count = 400108d0: 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; 400108d4: d4 26 c0 00 st %o2, [ %i3 ] _Thread_Executing->Wait.count = 400108d8: c4 06 60 08 ld [ %i1 + 8 ], %g2 400108dc: c4 20 60 24 st %g2, [ %g1 + 0x24 ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 400108e0: 92 10 00 11 mov %l1, %o1 400108e4: 40 00 22 06 call 400190fc 400108e8: 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 ); 400108ec: 40 00 08 17 call 40012948 <_Thread_queue_Dequeue> 400108f0: 90 10 00 18 mov %i0, %o0 if ( !the_thread ) { 400108f4: 82 92 20 00 orcc %o0, 0, %g1 400108f8: 32 80 00 04 bne,a 40010908 <_CORE_message_queue_Seize+0x9c> 400108fc: 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 ); 40010900: 7f ff ff 7a call 400106e8 <_Chain_Append> 40010904: 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; 40010908: d4 00 60 30 ld [ %g1 + 0x30 ], %o2 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 4001090c: 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; 40010910: c4 26 60 08 st %g2, [ %i1 + 8 ] 40010914: d4 26 60 0c st %o2, [ %i1 + 0xc ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 40010918: 40 00 21 f9 call 400190fc 4001091c: 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( 40010920: f4 06 60 08 ld [ %i1 + 8 ], %i2 40010924: 40 00 16 06 call 4001613c <_CORE_message_queue_Insert_message> 40010928: 81 e8 00 00 restore return; } #endif } if ( !wait ) { 4001092c: 80 8f 20 ff btst 0xff, %i4 40010930: 32 80 00 08 bne,a 40010950 <_CORE_message_queue_Seize+0xe4> 40010934: 84 10 20 01 mov 1, %g2 _ISR_Enable( level ); 40010938: 7f ff da 89 call 4000735c 4001093c: 90 10 00 01 mov %g1, %o0 executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 40010940: 82 10 20 04 mov 4, %g1 40010944: 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 ); } 40010948: 81 c7 e0 08 ret 4001094c: 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; 40010950: 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; 40010954: e0 24 a0 44 st %l0, [ %l2 + 0x44 ] executing->Wait.id = id; 40010958: e2 24 a0 20 st %l1, [ %l2 + 0x20 ] executing->Wait.return_argument_second.mutable_object = buffer; 4001095c: f4 24 a0 2c st %i2, [ %l2 + 0x2c ] executing->Wait.return_argument = size_p; 40010960: f6 24 a0 28 st %i3, [ %l2 + 0x28 ] /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 40010964: 90 10 00 01 mov %g1, %o0 40010968: 7f ff da 7d call 4000735c 4001096c: 35 10 00 4b sethi %hi(0x40012c00), %i2 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 40010970: b0 10 00 10 mov %l0, %i0 40010974: b2 10 00 1d mov %i5, %i1 40010978: 40 00 08 57 call 40012ad4 <_Thread_queue_Enqueue_with_handler> 4001097c: 95 ee a2 5c restore %i2, 0x25c, %o2 =============================================================================== 40007620 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 40007620: 9d e3 bf a0 save %sp, -96, %sp _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 40007624: 03 10 00 59 sethi %hi(0x40016400), %g1 40007628: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 ! 40016410 <_Thread_Dispatch_disable_level> 4000762c: 80 a0 60 00 cmp %g1, 0 40007630: 02 80 00 0d be 40007664 <_CORE_mutex_Seize+0x44> 40007634: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40007638: 80 8e a0 ff btst 0xff, %i2 4000763c: 02 80 00 0b be 40007668 <_CORE_mutex_Seize+0x48> <== NEVER TAKEN 40007640: 90 10 00 18 mov %i0, %o0 40007644: 03 10 00 59 sethi %hi(0x40016400), %g1 40007648: c2 00 61 88 ld [ %g1 + 0x188 ], %g1 ! 40016588 <_System_state_Current> 4000764c: 80 a0 60 01 cmp %g1, 1 40007650: 08 80 00 05 bleu 40007664 <_CORE_mutex_Seize+0x44> 40007654: 90 10 20 00 clr %o0 40007658: 92 10 20 00 clr %o1 4000765c: 40 00 01 dd call 40007dd0 <_Internal_error_Occurred> 40007660: 94 10 20 12 mov 0x12, %o2 40007664: 90 10 00 18 mov %i0, %o0 40007668: 40 00 15 29 call 4000cb0c <_CORE_mutex_Seize_interrupt_trylock> 4000766c: 92 07 a0 54 add %fp, 0x54, %o1 40007670: 80 a2 20 00 cmp %o0, 0 40007674: 02 80 00 0a be 4000769c <_CORE_mutex_Seize+0x7c> 40007678: 80 8e a0 ff btst 0xff, %i2 4000767c: 35 10 00 5a sethi %hi(0x40016800), %i2 40007680: 12 80 00 09 bne 400076a4 <_CORE_mutex_Seize+0x84> 40007684: b4 16 a1 68 or %i2, 0x168, %i2 ! 40016968 <_Per_CPU_Information> 40007688: 7f ff e9 af call 40001d44 4000768c: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40007690: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 40007694: 84 10 20 01 mov 1, %g2 40007698: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 4000769c: 81 c7 e0 08 ret 400076a0: 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; 400076a4: 82 10 20 01 mov 1, %g1 400076a8: c2 26 20 30 st %g1, [ %i0 + 0x30 ] 400076ac: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 400076b0: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 400076b4: f2 20 60 20 st %i1, [ %g1 + 0x20 ] 400076b8: 03 10 00 59 sethi %hi(0x40016400), %g1 400076bc: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 ! 40016410 <_Thread_Dispatch_disable_level> 400076c0: 84 00 a0 01 inc %g2 400076c4: c4 20 60 10 st %g2, [ %g1 + 0x10 ] 400076c8: 7f ff e9 9f call 40001d44 400076cc: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 400076d0: 90 10 00 18 mov %i0, %o0 400076d4: 7f ff ff ba call 400075bc <_CORE_mutex_Seize_interrupt_blocking> 400076d8: 92 10 00 1b mov %i3, %o1 400076dc: 81 c7 e0 08 ret 400076e0: 81 e8 00 00 restore =============================================================================== 40007860 <_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 ) { 40007860: 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)) ) { 40007864: 90 10 00 18 mov %i0, %o0 40007868: 40 00 06 b2 call 40009330 <_Thread_queue_Dequeue> 4000786c: a0 10 00 18 mov %i0, %l0 40007870: 80 a2 20 00 cmp %o0, 0 40007874: 12 80 00 0e bne 400078ac <_CORE_semaphore_Surrender+0x4c> 40007878: 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 ); 4000787c: 7f ff e9 2e call 40001d34 40007880: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 40007884: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40007888: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 4000788c: 80 a0 40 02 cmp %g1, %g2 40007890: 1a 80 00 05 bcc 400078a4 <_CORE_semaphore_Surrender+0x44> <== NEVER TAKEN 40007894: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 40007898: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 4000789c: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 400078a0: c2 24 20 48 st %g1, [ %l0 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 400078a4: 7f ff e9 28 call 40001d44 400078a8: 01 00 00 00 nop } return status; } 400078ac: 81 c7 e0 08 ret 400078b0: 81 e8 00 00 restore =============================================================================== 400065a0 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 400065a0: 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 ]; 400065a4: e2 06 21 54 ld [ %i0 + 0x154 ], %l1 option_set = (rtems_option) the_thread->Wait.option; 400065a8: e4 06 20 30 ld [ %i0 + 0x30 ], %l2 _ISR_Disable( level ); 400065ac: 7f ff ed e2 call 40001d34 400065b0: a0 10 00 18 mov %i0, %l0 400065b4: b0 10 00 08 mov %o0, %i0 pending_events = api->pending_events; 400065b8: c4 04 40 00 ld [ %l1 ], %g2 event_condition = (rtems_event_set) the_thread->Wait.count; 400065bc: 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 ) ) { 400065c0: 82 88 c0 02 andcc %g3, %g2, %g1 400065c4: 12 80 00 03 bne 400065d0 <_Event_Surrender+0x30> 400065c8: 09 10 00 5a sethi %hi(0x40016800), %g4 _ISR_Enable( level ); 400065cc: 30 80 00 42 b,a 400066d4 <_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() && 400065d0: 88 11 21 68 or %g4, 0x168, %g4 ! 40016968 <_Per_CPU_Information> 400065d4: da 01 20 08 ld [ %g4 + 8 ], %o5 400065d8: 80 a3 60 00 cmp %o5, 0 400065dc: 22 80 00 1d be,a 40006650 <_Event_Surrender+0xb0> 400065e0: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 400065e4: c8 01 20 0c ld [ %g4 + 0xc ], %g4 400065e8: 80 a4 00 04 cmp %l0, %g4 400065ec: 32 80 00 19 bne,a 40006650 <_Event_Surrender+0xb0> 400065f0: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 400065f4: 09 10 00 5b sethi %hi(0x40016c00), %g4 400065f8: da 01 21 60 ld [ %g4 + 0x160 ], %o5 ! 40016d60 <_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 ) && 400065fc: 80 a3 60 02 cmp %o5, 2 40006600: 02 80 00 07 be 4000661c <_Event_Surrender+0x7c> <== NEVER TAKEN 40006604: 80 a0 40 03 cmp %g1, %g3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 40006608: c8 01 21 60 ld [ %g4 + 0x160 ], %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) || 4000660c: 80 a1 20 01 cmp %g4, 1 40006610: 32 80 00 10 bne,a 40006650 <_Event_Surrender+0xb0> 40006614: 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) ) { 40006618: 80 a0 40 03 cmp %g1, %g3 4000661c: 02 80 00 04 be 4000662c <_Event_Surrender+0x8c> 40006620: 80 8c a0 02 btst 2, %l2 40006624: 02 80 00 0a be 4000664c <_Event_Surrender+0xac> <== NEVER TAKEN 40006628: 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) ); 4000662c: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 40006630: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006634: 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; 40006638: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 4000663c: c2 20 80 00 st %g1, [ %g2 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 40006640: 84 10 20 03 mov 3, %g2 40006644: 03 10 00 5b sethi %hi(0x40016c00), %g1 40006648: c4 20 61 60 st %g2, [ %g1 + 0x160 ] ! 40016d60 <_Event_Sync_state> } _ISR_Enable( level ); 4000664c: 30 80 00 22 b,a 400066d4 <_Event_Surrender+0x134> } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 40006650: 80 89 21 00 btst 0x100, %g4 40006654: 02 80 00 20 be 400066d4 <_Event_Surrender+0x134> 40006658: 80 a0 40 03 cmp %g1, %g3 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 4000665c: 02 80 00 04 be 4000666c <_Event_Surrender+0xcc> 40006660: 80 8c a0 02 btst 2, %l2 40006664: 02 80 00 1c be 400066d4 <_Event_Surrender+0x134> <== NEVER TAKEN 40006668: 01 00 00 00 nop 4000666c: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 40006670: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006674: 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; 40006678: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 4000667c: c2 20 80 00 st %g1, [ %g2 ] _ISR_Flash( level ); 40006680: 7f ff ed b1 call 40001d44 40006684: 90 10 00 18 mov %i0, %o0 40006688: 7f ff ed ab call 40001d34 4000668c: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 40006690: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 40006694: 80 a0 60 02 cmp %g1, 2 40006698: 02 80 00 06 be 400066b0 <_Event_Surrender+0x110> 4000669c: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 400066a0: 7f ff ed a9 call 40001d44 400066a4: 90 10 00 18 mov %i0, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 400066a8: 10 80 00 08 b 400066c8 <_Event_Surrender+0x128> 400066ac: 33 04 00 ff sethi %hi(0x1003fc00), %i1 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 400066b0: c2 24 20 50 st %g1, [ %l0 + 0x50 ] _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 400066b4: 7f ff ed a4 call 40001d44 400066b8: 90 10 00 18 mov %i0, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 400066bc: 40 00 0e 60 call 4000a03c <_Watchdog_Remove> 400066c0: 90 04 20 48 add %l0, 0x48, %o0 400066c4: 33 04 00 ff sethi %hi(0x1003fc00), %i1 400066c8: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 400066cc: 40 00 09 72 call 40008c94 <_Thread_Clear_state> 400066d0: 91 e8 00 10 restore %g0, %l0, %o0 _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 400066d4: 7f ff ed 9c call 40001d44 400066d8: 81 e8 00 00 restore =============================================================================== 400066e0 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 400066e0: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 400066e4: 90 10 00 18 mov %i0, %o0 400066e8: 40 00 0a 44 call 40008ff8 <_Thread_Get> 400066ec: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 400066f0: c2 07 bf fc ld [ %fp + -4 ], %g1 400066f4: 80 a0 60 00 cmp %g1, 0 400066f8: 12 80 00 1c bne 40006768 <_Event_Timeout+0x88> <== NEVER TAKEN 400066fc: 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 ); 40006700: 7f ff ed 8d call 40001d34 40006704: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40006708: 03 10 00 5a sethi %hi(0x40016800), %g1 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 4000670c: c2 00 61 74 ld [ %g1 + 0x174 ], %g1 ! 40016974 <_Per_CPU_Information+0xc> 40006710: 80 a4 00 01 cmp %l0, %g1 40006714: 12 80 00 09 bne 40006738 <_Event_Timeout+0x58> 40006718: c0 24 20 24 clr [ %l0 + 0x24 ] if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 4000671c: 03 10 00 5b sethi %hi(0x40016c00), %g1 40006720: c4 00 61 60 ld [ %g1 + 0x160 ], %g2 ! 40016d60 <_Event_Sync_state> 40006724: 80 a0 a0 01 cmp %g2, 1 40006728: 32 80 00 05 bne,a 4000673c <_Event_Timeout+0x5c> 4000672c: 82 10 20 06 mov 6, %g1 _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 40006730: 84 10 20 02 mov 2, %g2 40006734: c4 20 61 60 st %g2, [ %g1 + 0x160 ] } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40006738: 82 10 20 06 mov 6, %g1 4000673c: c2 24 20 34 st %g1, [ %l0 + 0x34 ] _ISR_Enable( level ); 40006740: 7f ff ed 81 call 40001d44 40006744: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40006748: 90 10 00 10 mov %l0, %o0 4000674c: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40006750: 40 00 09 51 call 40008c94 <_Thread_Clear_state> 40006754: 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; 40006758: 03 10 00 59 sethi %hi(0x40016400), %g1 4000675c: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 ! 40016410 <_Thread_Dispatch_disable_level> 40006760: 84 00 bf ff add %g2, -1, %g2 40006764: c4 20 60 10 st %g2, [ %g1 + 0x10 ] 40006768: 81 c7 e0 08 ret 4000676c: 81 e8 00 00 restore =============================================================================== 4000d188 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000d188: 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; 4000d18c: c0 27 bf fc clr [ %fp + -4 ] Heap_Block *extend_last_block = NULL; 4000d190: 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 ) { 4000d194: a0 10 00 18 mov %i0, %l0 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4000d198: 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; 4000d19c: e6 06 20 10 ld [ %i0 + 0x10 ], %l3 uintptr_t const min_block_size = heap->min_block_size; 4000d1a0: 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; 4000d1a4: a2 06 40 1a add %i1, %i2, %l1 uintptr_t const free_size = stats->free_size; 4000d1a8: 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 ) { 4000d1ac: 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 ) { 4000d1b0: 80 a4 40 19 cmp %l1, %i1 4000d1b4: 0a 80 00 9f bcs 4000d430 <_Heap_Extend+0x2a8> 4000d1b8: b0 10 20 00 clr %i0 return false; } extend_area_ok = _Heap_Get_first_and_last_block( 4000d1bc: 90 10 00 19 mov %i1, %o0 4000d1c0: 94 10 00 13 mov %l3, %o2 4000d1c4: 98 07 bf fc add %fp, -4, %o4 4000d1c8: 7f ff eb 1e call 40007e40 <_Heap_Get_first_and_last_block> 4000d1cc: 9a 07 bf f8 add %fp, -8, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4000d1d0: 80 8a 20 ff btst 0xff, %o0 4000d1d4: 02 80 00 97 be 4000d430 <_Heap_Extend+0x2a8> 4000d1d8: aa 10 00 12 mov %l2, %l5 4000d1dc: ba 10 20 00 clr %i5 4000d1e0: b8 10 20 00 clr %i4 4000d1e4: b0 10 20 00 clr %i0 4000d1e8: ae 10 20 00 clr %l7 4000d1ec: 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 ( 4000d1f0: 80 a0 40 11 cmp %g1, %l1 4000d1f4: 1a 80 00 05 bcc 4000d208 <_Heap_Extend+0x80> 4000d1f8: ec 05 40 00 ld [ %l5 ], %l6 4000d1fc: 80 a6 40 16 cmp %i1, %l6 4000d200: 2a 80 00 8c bcs,a 4000d430 <_Heap_Extend+0x2a8> 4000d204: 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 ) { 4000d208: 80 a4 40 01 cmp %l1, %g1 4000d20c: 02 80 00 06 be 4000d224 <_Heap_Extend+0x9c> 4000d210: 80 a4 40 16 cmp %l1, %l6 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4000d214: 2a 80 00 05 bcs,a 4000d228 <_Heap_Extend+0xa0> 4000d218: b8 10 00 15 mov %l5, %i4 4000d21c: 10 80 00 04 b 4000d22c <_Heap_Extend+0xa4> 4000d220: 90 10 00 16 mov %l6, %o0 4000d224: ae 10 00 15 mov %l5, %l7 4000d228: 90 10 00 16 mov %l6, %o0 4000d22c: 40 00 17 88 call 4001304c <.urem> 4000d230: 92 10 00 13 mov %l3, %o1 4000d234: b4 05 bf f8 add %l6, -8, %i2 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000d238: 80 a5 80 19 cmp %l6, %i1 4000d23c: 12 80 00 05 bne 4000d250 <_Heap_Extend+0xc8> 4000d240: 90 26 80 08 sub %i2, %o0, %o0 start_block->prev_size = extend_area_end; 4000d244: 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 ) 4000d248: 10 80 00 04 b 4000d258 <_Heap_Extend+0xd0> 4000d24c: b0 10 00 08 mov %o0, %i0 merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4000d250: 2a 80 00 02 bcs,a 4000d258 <_Heap_Extend+0xd0> 4000d254: 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; 4000d258: ea 02 20 04 ld [ %o0 + 4 ], %l5 4000d25c: 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); 4000d260: 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 ); 4000d264: 80 a5 40 12 cmp %l5, %l2 4000d268: 12 bf ff e2 bne 4000d1f0 <_Heap_Extend+0x68> 4000d26c: 82 10 00 15 mov %l5, %g1 if ( extend_area_begin < heap->area_begin ) { 4000d270: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000d274: 80 a6 40 01 cmp %i1, %g1 4000d278: 3a 80 00 04 bcc,a 4000d288 <_Heap_Extend+0x100> 4000d27c: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 4000d280: 10 80 00 05 b 4000d294 <_Heap_Extend+0x10c> 4000d284: f2 24 20 18 st %i1, [ %l0 + 0x18 ] } else if ( heap->area_end < extend_area_end ) { 4000d288: 80 a0 40 11 cmp %g1, %l1 4000d28c: 2a 80 00 02 bcs,a 4000d294 <_Heap_Extend+0x10c> 4000d290: 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; 4000d294: c4 07 bf fc ld [ %fp + -4 ], %g2 4000d298: c2 07 bf f8 ld [ %fp + -8 ], %g1 extend_first_block->prev_size = extend_area_end; 4000d29c: 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 = 4000d2a0: 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; 4000d2a4: 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; 4000d2a8: 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 = 4000d2ac: 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 ) { 4000d2b0: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 4000d2b4: 80 a0 c0 02 cmp %g3, %g2 4000d2b8: 08 80 00 04 bleu 4000d2c8 <_Heap_Extend+0x140> 4000d2bc: c0 20 60 04 clr [ %g1 + 4 ] heap->first_block = extend_first_block; 4000d2c0: 10 80 00 06 b 4000d2d8 <_Heap_Extend+0x150> 4000d2c4: c4 24 20 20 st %g2, [ %l0 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 4000d2c8: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 4000d2cc: 80 a0 80 01 cmp %g2, %g1 4000d2d0: 2a 80 00 02 bcs,a 4000d2d8 <_Heap_Extend+0x150> 4000d2d4: c2 24 20 24 st %g1, [ %l0 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000d2d8: 80 a5 e0 00 cmp %l7, 0 4000d2dc: 02 80 00 14 be 4000d32c <_Heap_Extend+0x1a4> 4000d2e0: 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; 4000d2e4: 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; 4000d2e8: 92 10 00 12 mov %l2, %o1 4000d2ec: 40 00 17 58 call 4001304c <.urem> 4000d2f0: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 4000d2f4: 80 a2 20 00 cmp %o0, 0 4000d2f8: 02 80 00 04 be 4000d308 <_Heap_Extend+0x180> <== ALWAYS TAKEN 4000d2fc: c2 05 c0 00 ld [ %l7 ], %g1 return value - remainder + alignment; 4000d300: b2 06 40 12 add %i1, %l2, %i1 <== NOT EXECUTED 4000d304: b2 26 40 08 sub %i1, %o0, %i1 <== NOT EXECUTED uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = 4000d308: 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; 4000d30c: 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 = 4000d310: 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; 4000d314: 82 10 60 01 or %g1, 1, %g1 _Heap_Free_block( heap, new_first_block ); 4000d318: 90 10 00 10 mov %l0, %o0 4000d31c: 7f ff ff 90 call 4000d15c <_Heap_Free_block> 4000d320: c2 22 60 04 st %g1, [ %o1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000d324: 10 80 00 09 b 4000d348 <_Heap_Extend+0x1c0> 4000d328: 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 ) { 4000d32c: 80 a7 20 00 cmp %i4, 0 4000d330: 02 80 00 05 be 4000d344 <_Heap_Extend+0x1bc> 4000d334: 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; 4000d338: b8 27 00 01 sub %i4, %g1, %i4 4000d33c: 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 = 4000d340: f8 20 60 04 st %i4, [ %g1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000d344: 80 a6 20 00 cmp %i0, 0 4000d348: 02 80 00 15 be 4000d39c <_Heap_Extend+0x214> 4000d34c: 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); 4000d350: 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( 4000d354: a2 24 40 18 sub %l1, %i0, %l1 4000d358: 40 00 17 3d call 4001304c <.urem> 4000d35c: 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) 4000d360: c4 06 20 04 ld [ %i0 + 4 ], %g2 4000d364: 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 = 4000d368: 82 04 40 18 add %l1, %i0, %g1 (last_block->size_and_flag - last_block_new_size) 4000d36c: 84 20 80 11 sub %g2, %l1, %g2 | HEAP_PREV_BLOCK_USED; 4000d370: 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 = 4000d374: 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; 4000d378: 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 ); 4000d37c: 90 10 00 10 mov %l0, %o0 4000d380: 82 08 60 01 and %g1, 1, %g1 4000d384: 92 10 00 18 mov %i0, %o1 block->size_and_flag = size | flag; 4000d388: a2 14 40 01 or %l1, %g1, %l1 4000d38c: 7f ff ff 74 call 4000d15c <_Heap_Free_block> 4000d390: e2 26 20 04 st %l1, [ %i0 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d394: 10 80 00 0f b 4000d3d0 <_Heap_Extend+0x248> 4000d398: 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 ) { 4000d39c: 80 a7 60 00 cmp %i5, 0 4000d3a0: 02 80 00 0b be 4000d3cc <_Heap_Extend+0x244> 4000d3a4: 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; 4000d3a8: c4 07 60 04 ld [ %i5 + 4 ], %g2 _Heap_Link_above( 4000d3ac: 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 ); 4000d3b0: 86 20 c0 1d sub %g3, %i5, %g3 4000d3b4: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000d3b8: 84 10 c0 02 or %g3, %g2, %g2 4000d3bc: c4 27 60 04 st %g2, [ %i5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4000d3c0: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000d3c4: 84 10 a0 01 or %g2, 1, %g2 4000d3c8: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d3cc: 80 a6 20 00 cmp %i0, 0 4000d3d0: 32 80 00 09 bne,a 4000d3f4 <_Heap_Extend+0x26c> 4000d3d4: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000d3d8: 80 a5 e0 00 cmp %l7, 0 4000d3dc: 32 80 00 06 bne,a 4000d3f4 <_Heap_Extend+0x26c> 4000d3e0: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 4000d3e4: d2 07 bf fc ld [ %fp + -4 ], %o1 4000d3e8: 7f ff ff 5d call 4000d15c <_Heap_Free_block> 4000d3ec: 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 4000d3f0: 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( 4000d3f4: 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; 4000d3f8: 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( 4000d3fc: 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; 4000d400: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 4000d404: 84 10 c0 02 or %g3, %g2, %g2 4000d408: c4 20 60 04 st %g2, [ %g1 + 4 ] } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000d40c: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 4000d410: 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; 4000d414: a8 20 40 14 sub %g1, %l4, %l4 /* Statistics */ stats->size += extended_size; 4000d418: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 if ( extended_size_ptr != NULL ) 4000d41c: 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; 4000d420: 82 00 40 14 add %g1, %l4, %g1 if ( extended_size_ptr != NULL ) 4000d424: 02 80 00 03 be 4000d430 <_Heap_Extend+0x2a8> <== NEVER TAKEN 4000d428: c2 24 20 2c st %g1, [ %l0 + 0x2c ] *extended_size_ptr = extended_size; 4000d42c: e8 26 c0 00 st %l4, [ %i3 ] 4000d430: 81 c7 e0 08 ret 4000d434: 81 e8 00 00 restore =============================================================================== 4000ce88 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4000ce88: 9d e3 bf a0 save %sp, -96, %sp 4000ce8c: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 4000ce90: 40 00 17 31 call 40012b54 <.urem> 4000ce94: 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 4000ce98: d8 06 20 20 ld [ %i0 + 0x20 ], %o4 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000ce9c: a2 06 7f f8 add %i1, -8, %l1 4000cea0: 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); 4000cea4: 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; 4000cea8: 80 a2 00 0c cmp %o0, %o4 4000ceac: 0a 80 00 05 bcs 4000cec0 <_Heap_Free+0x38> 4000ceb0: 82 10 20 00 clr %g1 4000ceb4: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 4000ceb8: 80 a0 40 08 cmp %g1, %o0 4000cebc: 82 60 3f ff subx %g0, -1, %g1 uintptr_t next_block_size = 0; bool next_is_free = false; _Heap_Protection_block_check( heap, block ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { 4000cec0: 80 a0 60 00 cmp %g1, 0 4000cec4: 02 80 00 6a be 4000d06c <_Heap_Free+0x1e4> 4000cec8: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000cecc: 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; 4000ced0: 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); 4000ced4: 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; 4000ced8: 80 a0 40 0c cmp %g1, %o4 4000cedc: 0a 80 00 05 bcs 4000cef0 <_Heap_Free+0x68> <== NEVER TAKEN 4000cee0: 86 10 20 00 clr %g3 4000cee4: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 4000cee8: 80 a0 c0 01 cmp %g3, %g1 4000ceec: 86 60 3f ff subx %g0, -1, %g3 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 4000cef0: 80 a0 e0 00 cmp %g3, 0 4000cef4: 02 80 00 5e be 4000d06c <_Heap_Free+0x1e4> <== NEVER TAKEN 4000cef8: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000cefc: c8 00 60 04 ld [ %g1 + 4 ], %g4 if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 4000cf00: 80 89 20 01 btst 1, %g4 4000cf04: 02 80 00 5a be 4000d06c <_Heap_Free+0x1e4> <== NEVER TAKEN 4000cf08: 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 4000cf0c: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4000cf10: 80 a0 40 09 cmp %g1, %o1 4000cf14: 02 80 00 07 be 4000cf30 <_Heap_Free+0xa8> 4000cf18: 96 10 20 00 clr %o3 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000cf1c: 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; 4000cf20: c6 00 e0 04 ld [ %g3 + 4 ], %g3 4000cf24: 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 )); 4000cf28: 80 a0 00 03 cmp %g0, %g3 4000cf2c: 96 60 3f ff subx %g0, -1, %o3 if ( !_Heap_Is_prev_used( block ) ) { 4000cf30: 80 8b 60 01 btst 1, %o5 4000cf34: 12 80 00 26 bne 4000cfcc <_Heap_Free+0x144> 4000cf38: 80 8a e0 ff btst 0xff, %o3 uintptr_t const prev_size = block->prev_size; 4000cf3c: 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); 4000cf40: 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; 4000cf44: 80 a0 c0 0c cmp %g3, %o4 4000cf48: 0a 80 00 04 bcs 4000cf58 <_Heap_Free+0xd0> <== NEVER TAKEN 4000cf4c: 94 10 20 00 clr %o2 4000cf50: 80 a2 40 03 cmp %o1, %g3 4000cf54: 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 ) ) { 4000cf58: 80 a2 a0 00 cmp %o2, 0 4000cf5c: 02 80 00 44 be 4000d06c <_Heap_Free+0x1e4> <== NEVER TAKEN 4000cf60: 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; 4000cf64: 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) ) { 4000cf68: 80 8b 20 01 btst 1, %o4 4000cf6c: 02 80 00 40 be 4000d06c <_Heap_Free+0x1e4> <== NEVER TAKEN 4000cf70: 80 8a e0 ff btst 0xff, %o3 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4000cf74: 22 80 00 0f be,a 4000cfb0 <_Heap_Free+0x128> 4000cf78: 9a 00 80 0d add %g2, %o5, %o5 uintptr_t const size = block_size + prev_size + next_block_size; 4000cf7c: 88 00 80 04 add %g2, %g4, %g4 4000cf80: 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; 4000cf84: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = block->prev; 4000cf88: c2 00 60 0c ld [ %g1 + 0xc ], %g1 prev->next = next; 4000cf8c: c8 20 60 08 st %g4, [ %g1 + 8 ] next->prev = prev; 4000cf90: c2 21 20 0c st %g1, [ %g4 + 0xc ] _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4000cf94: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 4000cf98: 82 00 7f ff add %g1, -1, %g1 4000cf9c: 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; 4000cfa0: 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; 4000cfa4: 82 13 60 01 or %o5, 1, %g1 4000cfa8: 10 80 00 27 b 4000d044 <_Heap_Free+0x1bc> 4000cfac: 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; 4000cfb0: 88 13 60 01 or %o5, 1, %g4 4000cfb4: c8 20 e0 04 st %g4, [ %g3 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000cfb8: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = size; 4000cfbc: 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; 4000cfc0: 86 08 ff fe and %g3, -2, %g3 4000cfc4: 10 80 00 20 b 4000d044 <_Heap_Free+0x1bc> 4000cfc8: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4000cfcc: 22 80 00 0d be,a 4000d000 <_Heap_Free+0x178> 4000cfd0: c6 04 20 08 ld [ %l0 + 8 ], %g3 uintptr_t const size = block_size + next_block_size; 4000cfd4: 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; 4000cfd8: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = old_block->prev; 4000cfdc: c2 00 60 0c ld [ %g1 + 0xc ], %g1 new_block->next = next; 4000cfe0: c8 22 20 08 st %g4, [ %o0 + 8 ] new_block->prev = prev; 4000cfe4: c2 22 20 0c st %g1, [ %o0 + 0xc ] next->prev = new_block; prev->next = new_block; 4000cfe8: 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; 4000cfec: d0 21 20 0c st %o0, [ %g4 + 0xc ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000cff0: 82 10 e0 01 or %g3, 1, %g1 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4000cff4: 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; 4000cff8: 10 80 00 13 b 4000d044 <_Heap_Free+0x1bc> 4000cffc: c2 22 20 04 st %g1, [ %o0 + 4 ] ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 4000d000: e0 22 20 0c st %l0, [ %o0 + 0xc ] Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4000d004: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4000d008: 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; 4000d00c: 86 10 a0 01 or %g2, 1, %g3 4000d010: c6 22 20 04 st %g3, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000d014: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = block_size; 4000d018: 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; 4000d01c: 86 08 ff fe and %g3, -2, %g3 4000d020: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000d024: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 if ( stats->max_free_blocks < stats->free_blocks ) { 4000d028: 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; 4000d02c: 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; 4000d030: d0 24 20 08 st %o0, [ %l0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 4000d034: 80 a0 c0 01 cmp %g3, %g1 4000d038: 1a 80 00 03 bcc 4000d044 <_Heap_Free+0x1bc> 4000d03c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 4000d040: c2 24 20 3c st %g1, [ %l0 + 0x3c ] } } /* Statistics */ --stats->used_blocks; 4000d044: c2 04 20 40 ld [ %l0 + 0x40 ], %g1 ++stats->frees; stats->free_size += block_size; return( true ); 4000d048: b0 10 20 01 mov 1, %i0 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000d04c: 82 00 7f ff add %g1, -1, %g1 4000d050: c2 24 20 40 st %g1, [ %l0 + 0x40 ] ++stats->frees; 4000d054: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 4000d058: 82 00 60 01 inc %g1 4000d05c: c2 24 20 50 st %g1, [ %l0 + 0x50 ] stats->free_size += block_size; 4000d060: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 4000d064: 84 00 40 02 add %g1, %g2, %g2 4000d068: c4 24 20 30 st %g2, [ %l0 + 0x30 ] return( true ); } 4000d06c: 81 c7 e0 08 ret 4000d070: 81 e8 00 00 restore =============================================================================== 40014498 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 40014498: 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); 4001449c: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 400144a0: 7f ff f9 ad call 40012b54 <.urem> 400144a4: 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 400144a8: 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); 400144ac: a2 06 7f f8 add %i1, -8, %l1 400144b0: 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); 400144b4: 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; 400144b8: 80 a2 00 02 cmp %o0, %g2 400144bc: 0a 80 00 05 bcs 400144d0 <_Heap_Size_of_alloc_area+0x38> 400144c0: 82 10 20 00 clr %g1 400144c4: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 400144c8: 80 a0 40 08 cmp %g1, %o0 400144cc: 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 ) ) { 400144d0: 80 a0 60 00 cmp %g1, 0 400144d4: 02 80 00 15 be 40014528 <_Heap_Size_of_alloc_area+0x90> 400144d8: 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; 400144dc: e2 02 20 04 ld [ %o0 + 4 ], %l1 400144e0: 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); 400144e4: 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; 400144e8: 80 a4 40 02 cmp %l1, %g2 400144ec: 0a 80 00 05 bcs 40014500 <_Heap_Size_of_alloc_area+0x68> <== NEVER TAKEN 400144f0: 82 10 20 00 clr %g1 400144f4: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 400144f8: 80 a0 40 11 cmp %g1, %l1 400144fc: 82 60 3f ff subx %g0, -1, %g1 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 40014500: 80 a0 60 00 cmp %g1, 0 40014504: 02 80 00 09 be 40014528 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 40014508: 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; 4001450c: c2 04 60 04 ld [ %l1 + 4 ], %g1 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 40014510: 80 88 60 01 btst 1, %g1 40014514: 02 80 00 05 be 40014528 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 40014518: a2 24 40 19 sub %l1, %i1, %l1 return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; 4001451c: 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; 40014520: a2 04 60 04 add %l1, 4, %l1 40014524: e2 26 80 00 st %l1, [ %i2 ] return true; } 40014528: 81 c7 e0 08 ret 4001452c: 81 e8 00 00 restore =============================================================================== 40008c48 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40008c48: 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; 40008c4c: 23 10 00 22 sethi %hi(0x40008800), %l1 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40008c50: a0 10 00 18 mov %i0, %l0 uintptr_t const page_size = heap->page_size; 40008c54: e4 06 20 10 ld [ %i0 + 0x10 ], %l2 uintptr_t const min_block_size = heap->min_block_size; 40008c58: e8 06 20 14 ld [ %i0 + 0x14 ], %l4 Heap_Block *const first_block = heap->first_block; 40008c5c: e6 06 20 20 ld [ %i0 + 0x20 ], %l3 Heap_Block *const last_block = heap->last_block; 40008c60: 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; 40008c64: 80 8e a0 ff btst 0xff, %i2 40008c68: 02 80 00 04 be 40008c78 <_Heap_Walk+0x30> 40008c6c: a2 14 63 f4 or %l1, 0x3f4, %l1 40008c70: 23 10 00 22 sethi %hi(0x40008800), %l1 40008c74: a2 14 63 fc or %l1, 0x3fc, %l1 ! 40008bfc <_Heap_Walk_print> if ( !_System_state_Is_up( _System_state_Get() ) ) { 40008c78: 03 10 00 63 sethi %hi(0x40018c00), %g1 40008c7c: c2 00 60 28 ld [ %g1 + 0x28 ], %g1 ! 40018c28 <_System_state_Current> 40008c80: 80 a0 60 03 cmp %g1, 3 40008c84: 12 80 01 2d bne 40009138 <_Heap_Walk+0x4f0> 40008c88: 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)( 40008c8c: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40008c90: da 04 20 18 ld [ %l0 + 0x18 ], %o5 40008c94: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40008c98: c2 04 20 08 ld [ %l0 + 8 ], %g1 40008c9c: e6 23 a0 60 st %l3, [ %sp + 0x60 ] 40008ca0: c2 23 a0 68 st %g1, [ %sp + 0x68 ] 40008ca4: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40008ca8: ea 23 a0 64 st %l5, [ %sp + 0x64 ] 40008cac: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40008cb0: 90 10 00 19 mov %i1, %o0 40008cb4: 92 10 20 00 clr %o1 40008cb8: 15 10 00 58 sethi %hi(0x40016000), %o2 40008cbc: 96 10 00 12 mov %l2, %o3 40008cc0: 94 12 a1 98 or %o2, 0x198, %o2 40008cc4: 9f c4 40 00 call %l1 40008cc8: 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 ) { 40008ccc: 80 a4 a0 00 cmp %l2, 0 40008cd0: 12 80 00 07 bne 40008cec <_Heap_Walk+0xa4> 40008cd4: 80 8c a0 07 btst 7, %l2 (*printer)( source, true, "page size is zero\n" ); 40008cd8: 15 10 00 58 sethi %hi(0x40016000), %o2 40008cdc: 90 10 00 19 mov %i1, %o0 40008ce0: 92 10 20 01 mov 1, %o1 40008ce4: 10 80 00 38 b 40008dc4 <_Heap_Walk+0x17c> 40008ce8: 94 12 a2 30 or %o2, 0x230, %o2 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 40008cec: 22 80 00 08 be,a 40008d0c <_Heap_Walk+0xc4> 40008cf0: 90 10 00 14 mov %l4, %o0 (*printer)( 40008cf4: 15 10 00 58 sethi %hi(0x40016000), %o2 40008cf8: 90 10 00 19 mov %i1, %o0 40008cfc: 92 10 20 01 mov 1, %o1 40008d00: 94 12 a2 48 or %o2, 0x248, %o2 40008d04: 10 80 01 0b b 40009130 <_Heap_Walk+0x4e8> 40008d08: 96 10 00 12 mov %l2, %o3 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008d0c: 7f ff e3 6e call 40001ac4 <.urem> 40008d10: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 40008d14: 80 a2 20 00 cmp %o0, 0 40008d18: 22 80 00 08 be,a 40008d38 <_Heap_Walk+0xf0> 40008d1c: 90 04 e0 08 add %l3, 8, %o0 (*printer)( 40008d20: 15 10 00 58 sethi %hi(0x40016000), %o2 40008d24: 90 10 00 19 mov %i1, %o0 40008d28: 92 10 20 01 mov 1, %o1 40008d2c: 94 12 a2 68 or %o2, 0x268, %o2 40008d30: 10 80 01 00 b 40009130 <_Heap_Walk+0x4e8> 40008d34: 96 10 00 14 mov %l4, %o3 40008d38: 7f ff e3 63 call 40001ac4 <.urem> 40008d3c: 92 10 00 12 mov %l2, %o1 ); return false; } if ( 40008d40: 80 a2 20 00 cmp %o0, 0 40008d44: 22 80 00 08 be,a 40008d64 <_Heap_Walk+0x11c> 40008d48: c2 04 e0 04 ld [ %l3 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 40008d4c: 15 10 00 58 sethi %hi(0x40016000), %o2 40008d50: 90 10 00 19 mov %i1, %o0 40008d54: 92 10 20 01 mov 1, %o1 40008d58: 94 12 a2 90 or %o2, 0x290, %o2 40008d5c: 10 80 00 f5 b 40009130 <_Heap_Walk+0x4e8> 40008d60: 96 10 00 13 mov %l3, %o3 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 40008d64: 80 88 60 01 btst 1, %g1 40008d68: 32 80 00 07 bne,a 40008d84 <_Heap_Walk+0x13c> 40008d6c: ec 05 60 04 ld [ %l5 + 4 ], %l6 (*printer)( 40008d70: 15 10 00 58 sethi %hi(0x40016000), %o2 40008d74: 90 10 00 19 mov %i1, %o0 40008d78: 92 10 20 01 mov 1, %o1 40008d7c: 10 80 00 12 b 40008dc4 <_Heap_Walk+0x17c> 40008d80: 94 12 a2 c8 or %o2, 0x2c8, %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; 40008d84: 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); 40008d88: 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; 40008d8c: c2 05 a0 04 ld [ %l6 + 4 ], %g1 ); return false; } if ( _Heap_Is_free( last_block ) ) { 40008d90: 80 88 60 01 btst 1, %g1 40008d94: 12 80 00 07 bne 40008db0 <_Heap_Walk+0x168> 40008d98: 80 a5 80 13 cmp %l6, %l3 (*printer)( 40008d9c: 15 10 00 58 sethi %hi(0x40016000), %o2 40008da0: 90 10 00 19 mov %i1, %o0 40008da4: 92 10 20 01 mov 1, %o1 40008da8: 10 80 00 07 b 40008dc4 <_Heap_Walk+0x17c> 40008dac: 94 12 a2 f8 or %o2, 0x2f8, %o2 ); return false; } if ( 40008db0: 02 80 00 08 be 40008dd0 <_Heap_Walk+0x188> <== ALWAYS TAKEN 40008db4: 15 10 00 58 sethi %hi(0x40016000), %o2 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40008db8: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 40008dbc: 92 10 20 01 mov 1, %o1 <== NOT EXECUTED 40008dc0: 94 12 a3 10 or %o2, 0x310, %o2 <== NOT EXECUTED 40008dc4: 9f c4 40 00 call %l1 40008dc8: b0 10 20 00 clr %i0 40008dcc: 30 80 00 db b,a 40009138 <_Heap_Walk+0x4f0> block = next_block; } while ( block != first_block ); return true; } 40008dd0: 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; 40008dd4: fa 04 20 10 ld [ %l0 + 0x10 ], %i5 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); 40008dd8: ae 10 00 10 mov %l0, %l7 40008ddc: 10 80 00 32 b 40008ea4 <_Heap_Walk+0x25c> 40008de0: 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; 40008de4: 80 a0 80 1c cmp %g2, %i4 40008de8: 18 80 00 05 bgu 40008dfc <_Heap_Walk+0x1b4> 40008dec: 82 10 20 00 clr %g1 40008df0: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 40008df4: 80 a0 40 1c cmp %g1, %i4 40008df8: 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 ) ) { 40008dfc: 80 a0 60 00 cmp %g1, 0 40008e00: 32 80 00 08 bne,a 40008e20 <_Heap_Walk+0x1d8> 40008e04: 90 07 20 08 add %i4, 8, %o0 (*printer)( 40008e08: 15 10 00 58 sethi %hi(0x40016000), %o2 40008e0c: 96 10 00 1c mov %i4, %o3 40008e10: 90 10 00 19 mov %i1, %o0 40008e14: 92 10 20 01 mov 1, %o1 40008e18: 10 80 00 c6 b 40009130 <_Heap_Walk+0x4e8> 40008e1c: 94 12 a3 40 or %o2, 0x340, %o2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008e20: 7f ff e3 29 call 40001ac4 <.urem> 40008e24: 92 10 00 1d mov %i5, %o1 ); return false; } if ( 40008e28: 80 a2 20 00 cmp %o0, 0 40008e2c: 22 80 00 08 be,a 40008e4c <_Heap_Walk+0x204> 40008e30: c2 07 20 04 ld [ %i4 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 40008e34: 15 10 00 58 sethi %hi(0x40016000), %o2 40008e38: 96 10 00 1c mov %i4, %o3 40008e3c: 90 10 00 19 mov %i1, %o0 40008e40: 92 10 20 01 mov 1, %o1 40008e44: 10 80 00 bb b 40009130 <_Heap_Walk+0x4e8> 40008e48: 94 12 a3 60 or %o2, 0x360, %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; 40008e4c: 82 08 7f fe and %g1, -2, %g1 block = next_block; } while ( block != first_block ); return true; } 40008e50: 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; 40008e54: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 40008e58: 80 88 60 01 btst 1, %g1 40008e5c: 22 80 00 08 be,a 40008e7c <_Heap_Walk+0x234> 40008e60: d8 07 20 0c ld [ %i4 + 0xc ], %o4 (*printer)( 40008e64: 15 10 00 58 sethi %hi(0x40016000), %o2 40008e68: 96 10 00 1c mov %i4, %o3 40008e6c: 90 10 00 19 mov %i1, %o0 40008e70: 92 10 20 01 mov 1, %o1 40008e74: 10 80 00 af b 40009130 <_Heap_Walk+0x4e8> 40008e78: 94 12 a3 90 or %o2, 0x390, %o2 ); return false; } if ( free_block->prev != prev_block ) { 40008e7c: 80 a3 00 17 cmp %o4, %l7 40008e80: 22 80 00 08 be,a 40008ea0 <_Heap_Walk+0x258> 40008e84: ae 10 00 1c mov %i4, %l7 (*printer)( 40008e88: 15 10 00 58 sethi %hi(0x40016000), %o2 40008e8c: 96 10 00 1c mov %i4, %o3 40008e90: 90 10 00 19 mov %i1, %o0 40008e94: 92 10 20 01 mov 1, %o1 40008e98: 10 80 00 49 b 40008fbc <_Heap_Walk+0x374> 40008e9c: 94 12 a3 b0 or %o2, 0x3b0, %o2 return false; } prev_block = free_block; free_block = free_block->next; 40008ea0: 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 ) { 40008ea4: 80 a7 00 10 cmp %i4, %l0 40008ea8: 32 bf ff cf bne,a 40008de4 <_Heap_Walk+0x19c> 40008eac: c4 04 20 20 ld [ %l0 + 0x20 ], %g2 40008eb0: 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)( 40008eb4: 31 10 00 59 sethi %hi(0x40016400), %i0 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40008eb8: b4 16 a1 70 or %i2, 0x170, %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)( 40008ebc: b0 16 21 58 or %i0, 0x158, %i0 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40008ec0: 37 10 00 59 sethi %hi(0x40016400), %i3 block = next_block; } while ( block != first_block ); return true; } 40008ec4: 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; 40008ec8: 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; 40008ecc: 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); 40008ed0: 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; 40008ed4: 80 a0 c0 1d cmp %g3, %i5 40008ed8: 18 80 00 05 bgu 40008eec <_Heap_Walk+0x2a4> <== NEVER TAKEN 40008edc: 84 10 20 00 clr %g2 40008ee0: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 40008ee4: 80 a0 80 1d cmp %g2, %i5 40008ee8: 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 ) ) { 40008eec: 80 a0 a0 00 cmp %g2, 0 40008ef0: 12 80 00 07 bne 40008f0c <_Heap_Walk+0x2c4> 40008ef4: 84 1d 80 15 xor %l6, %l5, %g2 (*printer)( 40008ef8: 15 10 00 58 sethi %hi(0x40016000), %o2 40008efc: 90 10 00 19 mov %i1, %o0 40008f00: 92 10 20 01 mov 1, %o1 40008f04: 10 80 00 2c b 40008fb4 <_Heap_Walk+0x36c> 40008f08: 94 12 a3 e8 or %o2, 0x3e8, %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; 40008f0c: 80 a0 00 02 cmp %g0, %g2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40008f10: c2 27 bf fc st %g1, [ %fp + -4 ] 40008f14: b8 40 20 00 addx %g0, 0, %i4 40008f18: 90 10 00 17 mov %l7, %o0 40008f1c: 7f ff e2 ea call 40001ac4 <.urem> 40008f20: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 40008f24: 80 a2 20 00 cmp %o0, 0 40008f28: 02 80 00 0c be 40008f58 <_Heap_Walk+0x310> 40008f2c: c2 07 bf fc ld [ %fp + -4 ], %g1 40008f30: 80 8f 20 ff btst 0xff, %i4 40008f34: 02 80 00 0a be 40008f5c <_Heap_Walk+0x314> 40008f38: 80 a5 c0 14 cmp %l7, %l4 (*printer)( 40008f3c: 15 10 00 59 sethi %hi(0x40016400), %o2 40008f40: 90 10 00 19 mov %i1, %o0 40008f44: 92 10 20 01 mov 1, %o1 40008f48: 94 12 a0 18 or %o2, 0x18, %o2 40008f4c: 96 10 00 16 mov %l6, %o3 40008f50: 10 80 00 1b b 40008fbc <_Heap_Walk+0x374> 40008f54: 98 10 00 17 mov %l7, %o4 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 40008f58: 80 a5 c0 14 cmp %l7, %l4 40008f5c: 1a 80 00 0d bcc 40008f90 <_Heap_Walk+0x348> 40008f60: 80 a7 40 16 cmp %i5, %l6 40008f64: 80 8f 20 ff btst 0xff, %i4 40008f68: 02 80 00 0a be 40008f90 <_Heap_Walk+0x348> <== NEVER TAKEN 40008f6c: 80 a7 40 16 cmp %i5, %l6 (*printer)( 40008f70: 15 10 00 59 sethi %hi(0x40016400), %o2 40008f74: 90 10 00 19 mov %i1, %o0 40008f78: 92 10 20 01 mov 1, %o1 40008f7c: 94 12 a0 48 or %o2, 0x48, %o2 40008f80: 96 10 00 16 mov %l6, %o3 40008f84: 98 10 00 17 mov %l7, %o4 40008f88: 10 80 00 3f b 40009084 <_Heap_Walk+0x43c> 40008f8c: 9a 10 00 14 mov %l4, %o5 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 40008f90: 38 80 00 0e bgu,a 40008fc8 <_Heap_Walk+0x380> 40008f94: b8 08 60 01 and %g1, 1, %i4 40008f98: 80 8f 20 ff btst 0xff, %i4 40008f9c: 02 80 00 0b be 40008fc8 <_Heap_Walk+0x380> 40008fa0: b8 08 60 01 and %g1, 1, %i4 (*printer)( 40008fa4: 15 10 00 59 sethi %hi(0x40016400), %o2 40008fa8: 90 10 00 19 mov %i1, %o0 40008fac: 92 10 20 01 mov 1, %o1 40008fb0: 94 12 a0 78 or %o2, 0x78, %o2 40008fb4: 96 10 00 16 mov %l6, %o3 40008fb8: 98 10 00 1d mov %i5, %o4 40008fbc: 9f c4 40 00 call %l1 40008fc0: b0 10 20 00 clr %i0 40008fc4: 30 80 00 5d b,a 40009138 <_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; 40008fc8: c2 07 60 04 ld [ %i5 + 4 ], %g1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 40008fcc: 80 88 60 01 btst 1, %g1 40008fd0: 12 80 00 3f bne 400090cc <_Heap_Walk+0x484> 40008fd4: 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 ? 40008fd8: 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)( 40008fdc: c2 04 20 08 ld [ %l0 + 8 ], %g1 40008fe0: 05 10 00 58 sethi %hi(0x40016000), %g2 block = next_block; } while ( block != first_block ); return true; } 40008fe4: 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)( 40008fe8: 80 a3 40 01 cmp %o5, %g1 40008fec: 02 80 00 07 be 40009008 <_Heap_Walk+0x3c0> 40008ff0: 86 10 a1 58 or %g2, 0x158, %g3 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 40008ff4: 80 a3 40 10 cmp %o5, %l0 40008ff8: 12 80 00 04 bne 40009008 <_Heap_Walk+0x3c0> 40008ffc: 86 16 e1 20 or %i3, 0x120, %g3 40009000: 19 10 00 58 sethi %hi(0x40016000), %o4 40009004: 86 13 21 68 or %o4, 0x168, %g3 ! 40016168 block->next, block->next == last_free_block ? 40009008: 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)( 4000900c: 19 10 00 58 sethi %hi(0x40016000), %o4 40009010: 80 a0 80 04 cmp %g2, %g4 40009014: 02 80 00 07 be 40009030 <_Heap_Walk+0x3e8> 40009018: 82 13 21 78 or %o4, 0x178, %g1 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 4000901c: 80 a0 80 10 cmp %g2, %l0 40009020: 12 80 00 04 bne 40009030 <_Heap_Walk+0x3e8> 40009024: 82 16 e1 20 or %i3, 0x120, %g1 40009028: 09 10 00 58 sethi %hi(0x40016000), %g4 4000902c: 82 11 21 88 or %g4, 0x188, %g1 ! 40016188 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)( 40009030: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 40009034: c4 23 a0 60 st %g2, [ %sp + 0x60 ] 40009038: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 4000903c: 90 10 00 19 mov %i1, %o0 40009040: 92 10 20 00 clr %o1 40009044: 15 10 00 59 sethi %hi(0x40016400), %o2 40009048: 96 10 00 16 mov %l6, %o3 4000904c: 94 12 a0 b0 or %o2, 0xb0, %o2 40009050: 9f c4 40 00 call %l1 40009054: 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 ) { 40009058: da 07 40 00 ld [ %i5 ], %o5 4000905c: 80 a5 c0 0d cmp %l7, %o5 40009060: 02 80 00 0c be 40009090 <_Heap_Walk+0x448> 40009064: 80 a7 20 00 cmp %i4, 0 (*printer)( 40009068: 15 10 00 59 sethi %hi(0x40016400), %o2 4000906c: fa 23 a0 5c st %i5, [ %sp + 0x5c ] 40009070: 90 10 00 19 mov %i1, %o0 40009074: 92 10 20 01 mov 1, %o1 40009078: 94 12 a0 e8 or %o2, 0xe8, %o2 4000907c: 96 10 00 16 mov %l6, %o3 40009080: 98 10 00 17 mov %l7, %o4 40009084: 9f c4 40 00 call %l1 40009088: b0 10 20 00 clr %i0 4000908c: 30 80 00 2b b,a 40009138 <_Heap_Walk+0x4f0> ); return false; } if ( !prev_used ) { 40009090: 32 80 00 0a bne,a 400090b8 <_Heap_Walk+0x470> 40009094: c2 04 20 08 ld [ %l0 + 8 ], %g1 (*printer)( 40009098: 15 10 00 59 sethi %hi(0x40016400), %o2 4000909c: 90 10 00 19 mov %i1, %o0 400090a0: 92 10 20 01 mov 1, %o1 400090a4: 10 80 00 22 b 4000912c <_Heap_Walk+0x4e4> 400090a8: 94 12 a1 28 or %o2, 0x128, %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 ) { 400090ac: 02 80 00 19 be 40009110 <_Heap_Walk+0x4c8> 400090b0: 80 a7 40 13 cmp %i5, %l3 return true; } free_block = free_block->next; 400090b4: 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 ) { 400090b8: 80 a0 40 10 cmp %g1, %l0 400090bc: 12 bf ff fc bne 400090ac <_Heap_Walk+0x464> 400090c0: 80 a0 40 16 cmp %g1, %l6 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 400090c4: 10 80 00 17 b 40009120 <_Heap_Walk+0x4d8> 400090c8: 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) { 400090cc: 22 80 00 0a be,a 400090f4 <_Heap_Walk+0x4ac> 400090d0: da 05 80 00 ld [ %l6 ], %o5 (*printer)( 400090d4: 90 10 00 19 mov %i1, %o0 400090d8: 92 10 20 00 clr %o1 400090dc: 94 10 00 18 mov %i0, %o2 400090e0: 96 10 00 16 mov %l6, %o3 400090e4: 9f c4 40 00 call %l1 400090e8: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 400090ec: 10 80 00 09 b 40009110 <_Heap_Walk+0x4c8> 400090f0: 80 a7 40 13 cmp %i5, %l3 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 400090f4: 90 10 00 19 mov %i1, %o0 400090f8: 92 10 20 00 clr %o1 400090fc: 94 10 00 1a mov %i2, %o2 40009100: 96 10 00 16 mov %l6, %o3 40009104: 9f c4 40 00 call %l1 40009108: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 4000910c: 80 a7 40 13 cmp %i5, %l3 40009110: 32 bf ff 6d bne,a 40008ec4 <_Heap_Walk+0x27c> 40009114: ac 10 00 1d mov %i5, %l6 return true; } 40009118: 81 c7 e0 08 ret 4000911c: 91 e8 20 01 restore %g0, 1, %o0 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 40009120: 90 10 00 19 mov %i1, %o0 40009124: 92 10 20 01 mov 1, %o1 40009128: 94 12 a1 98 or %o2, 0x198, %o2 4000912c: 96 10 00 16 mov %l6, %o3 40009130: 9f c4 40 00 call %l1 40009134: b0 10 20 00 clr %i0 40009138: 81 c7 e0 08 ret 4000913c: 81 e8 00 00 restore =============================================================================== 40007dd0 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40007dd0: 9d e3 bf a0 save %sp, -96, %sp _Internal_errors_What_happened.the_source = the_source; 40007dd4: 05 10 00 59 sethi %hi(0x40016400), %g2 40007dd8: 82 10 a0 c4 or %g2, 0xc4, %g1 ! 400164c4 <_Internal_errors_What_happened> void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40007ddc: 90 10 00 18 mov %i0, %o0 40007de0: 94 10 00 1a mov %i2, %o2 _Internal_errors_What_happened.the_source = the_source; 40007de4: f0 20 a0 c4 st %i0, [ %g2 + 0xc4 ] _Internal_errors_What_happened.is_internal = is_internal; 40007de8: f2 28 60 04 stb %i1, [ %g1 + 4 ] _Internal_errors_What_happened.the_error = the_error; 40007dec: f4 20 60 08 st %i2, [ %g1 + 8 ] _User_extensions_Fatal( the_source, is_internal, the_error ); 40007df0: 40 00 07 db call 40009d5c <_User_extensions_Fatal> 40007df4: 92 0e 60 ff and %i1, 0xff, %o1 RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 40007df8: 84 10 20 05 mov 5, %g2 <== NOT EXECUTED 40007dfc: 03 10 00 59 sethi %hi(0x40016400), %g1 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 40007e00: 7f ff e7 cd call 40001d34 <== NOT EXECUTED 40007e04: c4 20 61 88 st %g2, [ %g1 + 0x188 ] ! 40016588 <_System_state_Current><== NOT EXECUTED 40007e08: 82 10 00 08 mov %o0, %g1 <== NOT EXECUTED 40007e0c: 30 80 00 00 b,a 40007e0c <_Internal_error_Occurred+0x3c> <== NOT EXECUTED =============================================================================== 40007e80 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007e80: 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 ) 40007e84: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40007e88: 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 ) 40007e8c: 80 a0 60 00 cmp %g1, 0 40007e90: 02 80 00 20 be 40007f10 <_Objects_Allocate+0x90> <== NEVER TAKEN 40007e94: 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 ); 40007e98: a2 04 20 20 add %l0, 0x20, %l1 40007e9c: 7f ff fd 88 call 400074bc <_Chain_Get> 40007ea0: 90 10 00 11 mov %l1, %o0 if ( information->auto_extend ) { 40007ea4: c2 0c 20 12 ldub [ %l0 + 0x12 ], %g1 40007ea8: 80 a0 60 00 cmp %g1, 0 40007eac: 02 80 00 19 be 40007f10 <_Objects_Allocate+0x90> 40007eb0: 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 ) { 40007eb4: 80 a2 20 00 cmp %o0, 0 40007eb8: 32 80 00 0a bne,a 40007ee0 <_Objects_Allocate+0x60> 40007ebc: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 _Objects_Extend_information( information ); 40007ec0: 40 00 00 1e call 40007f38 <_Objects_Extend_information> 40007ec4: 90 10 00 10 mov %l0, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 40007ec8: 7f ff fd 7d call 400074bc <_Chain_Get> 40007ecc: 90 10 00 11 mov %l1, %o0 } if ( the_object ) { 40007ed0: b0 92 20 00 orcc %o0, 0, %i0 40007ed4: 02 80 00 0f be 40007f10 <_Objects_Allocate+0x90> 40007ed8: 01 00 00 00 nop uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 40007edc: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 40007ee0: d0 16 20 0a lduh [ %i0 + 0xa ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 40007ee4: d2 14 20 14 lduh [ %l0 + 0x14 ], %o1 40007ee8: 40 00 2a 6f call 400128a4 <.udiv> 40007eec: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 40007ef0: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 40007ef4: 91 2a 20 02 sll %o0, 2, %o0 40007ef8: c4 00 40 08 ld [ %g1 + %o0 ], %g2 40007efc: 84 00 bf ff add %g2, -1, %g2 40007f00: c4 20 40 08 st %g2, [ %g1 + %o0 ] information->inactive--; 40007f04: c2 14 20 2c lduh [ %l0 + 0x2c ], %g1 40007f08: 82 00 7f ff add %g1, -1, %g1 40007f0c: c2 34 20 2c sth %g1, [ %l0 + 0x2c ] ); } #endif return the_object; } 40007f10: 81 c7 e0 08 ret 40007f14: 81 e8 00 00 restore =============================================================================== 40008294 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 40008294: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 40008298: b3 2e 60 10 sll %i1, 0x10, %i1 4000829c: b3 36 60 10 srl %i1, 0x10, %i1 400082a0: 80 a6 60 00 cmp %i1, 0 400082a4: 02 80 00 17 be 40008300 <_Objects_Get_information+0x6c> 400082a8: 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 ); 400082ac: 40 00 13 72 call 4000d074 <_Objects_API_maximum_class> 400082b0: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 400082b4: 80 a2 20 00 cmp %o0, 0 400082b8: 02 80 00 12 be 40008300 <_Objects_Get_information+0x6c> 400082bc: 80 a6 40 08 cmp %i1, %o0 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 400082c0: 18 80 00 10 bgu 40008300 <_Objects_Get_information+0x6c> 400082c4: 03 10 00 58 sethi %hi(0x40016000), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 400082c8: b1 2e 20 02 sll %i0, 2, %i0 400082cc: 82 10 63 78 or %g1, 0x378, %g1 400082d0: c2 00 40 18 ld [ %g1 + %i0 ], %g1 400082d4: 80 a0 60 00 cmp %g1, 0 400082d8: 02 80 00 0a be 40008300 <_Objects_Get_information+0x6c> <== NEVER TAKEN 400082dc: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 400082e0: e0 00 40 19 ld [ %g1 + %i1 ], %l0 if ( !info ) 400082e4: 80 a4 20 00 cmp %l0, 0 400082e8: 02 80 00 06 be 40008300 <_Objects_Get_information+0x6c> <== NEVER TAKEN 400082ec: 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 ) 400082f0: c2 14 20 10 lduh [ %l0 + 0x10 ], %g1 return NULL; 400082f4: 80 a0 00 01 cmp %g0, %g1 400082f8: 82 60 20 00 subx %g0, 0, %g1 400082fc: a0 0c 00 01 and %l0, %g1, %l0 #endif return info; } 40008300: 81 c7 e0 08 ret 40008304: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40019b9c <_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; 40019b9c: c2 02 20 08 ld [ %o0 + 8 ], %g1 if ( information->maximum >= index ) { 40019ba0: 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; 40019ba4: 82 22 40 01 sub %o1, %g1, %g1 40019ba8: 82 00 60 01 inc %g1 if ( information->maximum >= index ) { 40019bac: 80 a0 80 01 cmp %g2, %g1 40019bb0: 0a 80 00 09 bcs 40019bd4 <_Objects_Get_no_protection+0x38> 40019bb4: 83 28 60 02 sll %g1, 2, %g1 if ( (the_object = information->local_table[ index ]) != NULL ) { 40019bb8: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 40019bbc: d0 00 80 01 ld [ %g2 + %g1 ], %o0 40019bc0: 80 a2 20 00 cmp %o0, 0 40019bc4: 02 80 00 05 be 40019bd8 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 40019bc8: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 40019bcc: 81 c3 e0 08 retl 40019bd0: 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; 40019bd4: 82 10 20 01 mov 1, %g1 return NULL; 40019bd8: 90 10 20 00 clr %o0 } 40019bdc: 81 c3 e0 08 retl 40019be0: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 40009b70 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 40009b70: 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; 40009b74: 92 96 20 00 orcc %i0, 0, %o1 40009b78: 12 80 00 06 bne 40009b90 <_Objects_Id_to_name+0x20> 40009b7c: 83 32 60 18 srl %o1, 0x18, %g1 40009b80: 03 10 00 81 sethi %hi(0x40020400), %g1 40009b84: c2 00 60 d4 ld [ %g1 + 0xd4 ], %g1 ! 400204d4 <_Per_CPU_Information+0xc> 40009b88: d2 00 60 08 ld [ %g1 + 8 ], %o1 40009b8c: 83 32 60 18 srl %o1, 0x18, %g1 40009b90: 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 ) 40009b94: 84 00 7f ff add %g1, -1, %g2 40009b98: 80 a0 a0 02 cmp %g2, 2 40009b9c: 18 80 00 16 bgu 40009bf4 <_Objects_Id_to_name+0x84> 40009ba0: 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 ] ) 40009ba4: 10 80 00 16 b 40009bfc <_Objects_Id_to_name+0x8c> 40009ba8: 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 ]; 40009bac: 85 28 a0 02 sll %g2, 2, %g2 40009bb0: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 40009bb4: 80 a2 20 00 cmp %o0, 0 40009bb8: 02 80 00 0f be 40009bf4 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40009bbc: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 40009bc0: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 40009bc4: 80 a0 60 00 cmp %g1, 0 40009bc8: 12 80 00 0b bne 40009bf4 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 40009bcc: 01 00 00 00 nop return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 40009bd0: 7f ff ff cb call 40009afc <_Objects_Get> 40009bd4: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 40009bd8: 80 a2 20 00 cmp %o0, 0 40009bdc: 02 80 00 06 be 40009bf4 <_Objects_Id_to_name+0x84> 40009be0: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 40009be4: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 40009be8: 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(); 40009bec: 40 00 03 00 call 4000a7ec <_Thread_Enable_dispatch> 40009bf0: c2 26 40 00 st %g1, [ %i1 ] return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 40009bf4: 81 c7 e0 08 ret 40009bf8: 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 ] ) 40009bfc: 05 10 00 7f sethi %hi(0x4001fc00), %g2 40009c00: 84 10 a2 d8 or %g2, 0x2d8, %g2 ! 4001fed8 <_Objects_Information_table> 40009c04: c2 00 80 01 ld [ %g2 + %g1 ], %g1 40009c08: 80 a0 60 00 cmp %g1, 0 40009c0c: 12 bf ff e8 bne 40009bac <_Objects_Id_to_name+0x3c> 40009c10: 85 32 60 1b srl %o1, 0x1b, %g2 40009c14: 30 bf ff f8 b,a 40009bf4 <_Objects_Id_to_name+0x84> =============================================================================== 4000bb28 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4000bb28: 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( 4000bb2c: 11 10 00 a1 sethi %hi(0x40028400), %o0 4000bb30: 92 10 00 18 mov %i0, %o1 4000bb34: 90 12 22 cc or %o0, 0x2cc, %o0 4000bb38: 40 00 0c 9c call 4000eda8 <_Objects_Get> 4000bb3c: 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 ) { 4000bb40: c2 07 bf fc ld [ %fp + -4 ], %g1 4000bb44: 80 a0 60 00 cmp %g1, 0 4000bb48: 12 80 00 3f bne 4000bc44 <_POSIX_Message_queue_Receive_support+0x11c> 4000bb4c: 01 00 00 00 nop case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 4000bb50: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000bb54: 84 08 60 03 and %g1, 3, %g2 4000bb58: 80 a0 a0 01 cmp %g2, 1 4000bb5c: 32 80 00 08 bne,a 4000bb7c <_POSIX_Message_queue_Receive_support+0x54> 4000bb60: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 _Thread_Enable_dispatch(); 4000bb64: 40 00 0f 95 call 4000f9b8 <_Thread_Enable_dispatch> 4000bb68: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EBADF ); 4000bb6c: 40 00 2a 26 call 40016404 <__errno> 4000bb70: 01 00 00 00 nop 4000bb74: 10 80 00 0b b 4000bba0 <_POSIX_Message_queue_Receive_support+0x78> 4000bb78: 82 10 20 09 mov 9, %g1 ! 9 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 4000bb7c: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 4000bb80: 80 a6 80 02 cmp %i2, %g2 4000bb84: 1a 80 00 09 bcc 4000bba8 <_POSIX_Message_queue_Receive_support+0x80> 4000bb88: 84 10 3f ff mov -1, %g2 _Thread_Enable_dispatch(); 4000bb8c: 40 00 0f 8b call 4000f9b8 <_Thread_Enable_dispatch> 4000bb90: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EMSGSIZE ); 4000bb94: 40 00 2a 1c call 40016404 <__errno> 4000bb98: 01 00 00 00 nop 4000bb9c: 82 10 20 7a mov 0x7a, %g1 ! 7a 4000bba0: 10 80 00 27 b 4000bc3c <_POSIX_Message_queue_Receive_support+0x114> 4000bba4: 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; 4000bba8: c4 27 bf f8 st %g2, [ %fp + -8 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000bbac: 80 8f 20 ff btst 0xff, %i4 4000bbb0: 02 80 00 06 be 4000bbc8 <_POSIX_Message_queue_Receive_support+0xa0><== NEVER TAKEN 4000bbb4: 98 10 20 00 clr %o4 do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000bbb8: 05 00 00 10 sethi %hi(0x4000), %g2 4000bbbc: 82 08 40 02 and %g1, %g2, %g1 4000bbc0: 80 a0 00 01 cmp %g0, %g1 4000bbc4: 98 60 3f ff subx %g0, -1, %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4000bbc8: 9a 10 00 1d mov %i5, %o5 4000bbcc: 90 02 20 1c add %o0, 0x1c, %o0 4000bbd0: 92 10 00 18 mov %i0, %o1 4000bbd4: 94 10 00 19 mov %i1, %o2 4000bbd8: 96 07 bf f8 add %fp, -8, %o3 4000bbdc: 40 00 08 3e call 4000dcd4 <_CORE_message_queue_Seize> 4000bbe0: 98 0b 20 01 and %o4, 1, %o4 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 4000bbe4: 40 00 0f 75 call 4000f9b8 <_Thread_Enable_dispatch> 4000bbe8: 3b 10 00 a1 sethi %hi(0x40028400), %i5 *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4000bbec: ba 17 63 38 or %i5, 0x338, %i5 ! 40028738 <_Per_CPU_Information> 4000bbf0: 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); 4000bbf4: c6 00 60 24 ld [ %g1 + 0x24 ], %g3 if ( !_Thread_Executing->Wait.return_code ) 4000bbf8: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 4000bbfc: 85 38 e0 1f sra %g3, 0x1f, %g2 4000bc00: 86 18 80 03 xor %g2, %g3, %g3 4000bc04: 84 20 c0 02 sub %g3, %g2, %g2 4000bc08: 80 a0 60 00 cmp %g1, 0 4000bc0c: 12 80 00 05 bne 4000bc20 <_POSIX_Message_queue_Receive_support+0xf8> 4000bc10: c4 26 c0 00 st %g2, [ %i3 ] return length_out; 4000bc14: f0 07 bf f8 ld [ %fp + -8 ], %i0 4000bc18: 81 c7 e0 08 ret 4000bc1c: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one( 4000bc20: 40 00 29 f9 call 40016404 <__errno> 4000bc24: 01 00 00 00 nop 4000bc28: c2 07 60 0c ld [ %i5 + 0xc ], %g1 4000bc2c: b8 10 00 08 mov %o0, %i4 4000bc30: 40 00 00 9c call 4000bea0 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000bc34: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000bc38: d0 27 00 00 st %o0, [ %i4 ] 4000bc3c: 81 c7 e0 08 ret 4000bc40: 91 e8 3f ff restore %g0, -1, %o0 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000bc44: 40 00 29 f0 call 40016404 <__errno> 4000bc48: b0 10 3f ff mov -1, %i0 4000bc4c: 82 10 20 09 mov 9, %g1 4000bc50: c2 22 00 00 st %g1, [ %o0 ] } 4000bc54: 81 c7 e0 08 ret 4000bc58: 81 e8 00 00 restore =============================================================================== 4000c0f0 <_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 ]; 4000c0f0: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000c0f4: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 4000c0f8: 80 a0 a0 00 cmp %g2, 0 4000c0fc: 12 80 00 12 bne 4000c144 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54><== NEVER TAKEN 4000c100: 01 00 00 00 nop 4000c104: c4 00 60 dc ld [ %g1 + 0xdc ], %g2 4000c108: 80 a0 a0 01 cmp %g2, 1 4000c10c: 12 80 00 0e bne 4000c144 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000c110: 01 00 00 00 nop thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 4000c114: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 4000c118: 80 a0 60 00 cmp %g1, 0 4000c11c: 02 80 00 0a be 4000c144 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 4000c120: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000c124: 03 10 00 5e sethi %hi(0x40017800), %g1 4000c128: c4 00 60 70 ld [ %g1 + 0x70 ], %g2 ! 40017870 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 4000c12c: 92 10 3f ff mov -1, %o1 4000c130: 84 00 bf ff add %g2, -1, %g2 4000c134: c4 20 60 70 st %g2, [ %g1 + 0x70 ] 4000c138: 82 13 c0 00 mov %o7, %g1 4000c13c: 40 00 01 f8 call 4000c91c <_POSIX_Thread_Exit> 4000c140: 9e 10 40 00 mov %g1, %o7 } else _Thread_Enable_dispatch(); 4000c144: 82 13 c0 00 mov %o7, %g1 4000c148: 7f ff f4 76 call 40009320 <_Thread_Enable_dispatch> 4000c14c: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000d584 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4000d584: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4000d588: d0 06 40 00 ld [ %i1 ], %o0 4000d58c: 7f ff ff f3 call 4000d558 <_POSIX_Priority_Is_valid> 4000d590: a0 10 00 18 mov %i0, %l0 4000d594: 80 8a 20 ff btst 0xff, %o0 4000d598: 02 80 00 11 be 4000d5dc <_POSIX_Thread_Translate_sched_param+0x58><== NEVER TAKEN 4000d59c: b0 10 20 16 mov 0x16, %i0 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4000d5a0: c0 26 80 00 clr [ %i2 ] *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 4000d5a4: 80 a4 20 00 cmp %l0, 0 4000d5a8: 12 80 00 06 bne 4000d5c0 <_POSIX_Thread_Translate_sched_param+0x3c> 4000d5ac: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000d5b0: 82 10 20 01 mov 1, %g1 4000d5b4: c2 26 80 00 st %g1, [ %i2 ] return 0; 4000d5b8: 81 c7 e0 08 ret 4000d5bc: 91 e8 20 00 restore %g0, 0, %o0 } if ( policy == SCHED_FIFO ) { 4000d5c0: 80 a4 20 01 cmp %l0, 1 4000d5c4: 02 80 00 06 be 4000d5dc <_POSIX_Thread_Translate_sched_param+0x58> 4000d5c8: b0 10 20 00 clr %i0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 4000d5cc: 80 a4 20 02 cmp %l0, 2 4000d5d0: 32 80 00 05 bne,a 4000d5e4 <_POSIX_Thread_Translate_sched_param+0x60> 4000d5d4: 80 a4 20 04 cmp %l0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 4000d5d8: e0 26 80 00 st %l0, [ %i2 ] return 0; 4000d5dc: 81 c7 e0 08 ret 4000d5e0: 81 e8 00 00 restore } if ( policy == SCHED_SPORADIC ) { 4000d5e4: 12 bf ff fe bne 4000d5dc <_POSIX_Thread_Translate_sched_param+0x58> 4000d5e8: b0 10 20 16 mov 0x16, %i0 if ( (param->sched_ss_repl_period.tv_sec == 0) && 4000d5ec: c2 06 60 08 ld [ %i1 + 8 ], %g1 4000d5f0: 80 a0 60 00 cmp %g1, 0 4000d5f4: 32 80 00 07 bne,a 4000d610 <_POSIX_Thread_Translate_sched_param+0x8c> 4000d5f8: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d5fc: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000d600: 80 a0 60 00 cmp %g1, 0 4000d604: 02 80 00 1d be 4000d678 <_POSIX_Thread_Translate_sched_param+0xf4> 4000d608: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4000d60c: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d610: 80 a0 60 00 cmp %g1, 0 4000d614: 12 80 00 06 bne 4000d62c <_POSIX_Thread_Translate_sched_param+0xa8> 4000d618: 01 00 00 00 nop 4000d61c: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000d620: 80 a0 60 00 cmp %g1, 0 4000d624: 02 bf ff ee be 4000d5dc <_POSIX_Thread_Translate_sched_param+0x58> 4000d628: 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 ) < 4000d62c: 7f ff f5 c9 call 4000ad50 <_Timespec_To_ticks> 4000d630: 90 06 60 08 add %i1, 8, %o0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; 4000d634: 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 ) < 4000d638: a0 10 00 08 mov %o0, %l0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 4000d63c: 7f ff f5 c5 call 4000ad50 <_Timespec_To_ticks> 4000d640: 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 ) < 4000d644: 80 a4 00 08 cmp %l0, %o0 4000d648: 0a 80 00 0c bcs 4000d678 <_POSIX_Thread_Translate_sched_param+0xf4> 4000d64c: 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 ) ) 4000d650: 7f ff ff c2 call 4000d558 <_POSIX_Priority_Is_valid> 4000d654: d0 06 60 04 ld [ %i1 + 4 ], %o0 4000d658: 80 8a 20 ff btst 0xff, %o0 4000d65c: 02 bf ff e0 be 4000d5dc <_POSIX_Thread_Translate_sched_param+0x58> 4000d660: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4000d664: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; 4000d668: 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; 4000d66c: 03 10 00 1c sethi %hi(0x40007000), %g1 4000d670: 82 10 61 c4 or %g1, 0x1c4, %g1 ! 400071c4 <_POSIX_Threads_Sporadic_budget_callout> 4000d674: c2 26 c0 00 st %g1, [ %i3 ] return 0; } return EINVAL; } 4000d678: 81 c7 e0 08 ret 4000d67c: 81 e8 00 00 restore =============================================================================== 40006f04 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 40006f04: 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; 40006f08: 03 10 00 79 sethi %hi(0x4001e400), %g1 40006f0c: 82 10 61 ec or %g1, 0x1ec, %g1 ! 4001e5ec maximum = Configuration_POSIX_API.number_of_initialization_threads; 40006f10: e6 00 60 30 ld [ %g1 + 0x30 ], %l3 if ( !user_threads || maximum == 0 ) 40006f14: 80 a4 e0 00 cmp %l3, 0 40006f18: 02 80 00 1d be 40006f8c <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 40006f1c: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 40006f20: 80 a4 60 00 cmp %l1, 0 40006f24: 02 80 00 1a be 40006f8c <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 40006f28: 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 ); 40006f2c: 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( 40006f30: 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 ); 40006f34: 40 00 19 d3 call 4000d680 40006f38: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 40006f3c: 92 10 20 02 mov 2, %o1 40006f40: 40 00 19 dc call 4000d6b0 40006f44: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 40006f48: d2 04 60 04 ld [ %l1 + 4 ], %o1 40006f4c: 40 00 19 e8 call 4000d6ec 40006f50: 90 10 00 10 mov %l0, %o0 status = pthread_create( 40006f54: d4 04 40 00 ld [ %l1 ], %o2 40006f58: 90 10 00 14 mov %l4, %o0 40006f5c: 92 10 00 10 mov %l0, %o1 40006f60: 7f ff ff 36 call 40006c38 40006f64: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 40006f68: 94 92 20 00 orcc %o0, 0, %o2 40006f6c: 22 80 00 05 be,a 40006f80 <_POSIX_Threads_Initialize_user_threads_body+0x7c> 40006f70: a4 04 a0 01 inc %l2 _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 40006f74: 90 10 20 02 mov 2, %o0 40006f78: 40 00 07 f9 call 40008f5c <_Internal_error_Occurred> 40006f7c: 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++ ) { 40006f80: 80 a4 80 13 cmp %l2, %l3 40006f84: 0a bf ff ec bcs 40006f34 <_POSIX_Threads_Initialize_user_threads_body+0x30><== NEVER TAKEN 40006f88: a2 04 60 08 add %l1, 8, %l1 40006f8c: 81 c7 e0 08 ret 40006f90: 81 e8 00 00 restore =============================================================================== 4000c428 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 4000c428: 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 ]; 4000c42c: 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 ); 4000c430: 40 00 04 2c call 4000d4e0 <_Timespec_To_ticks> 4000c434: 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); 4000c438: 03 10 00 56 sethi %hi(0x40015800), %g1 4000c43c: d2 08 61 54 ldub [ %g1 + 0x154 ], %o1 ! 40015954 4000c440: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->cpu_time_budget = ticks; 4000c444: d0 26 60 78 st %o0, [ %i1 + 0x78 ] 4000c448: 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 ) { 4000c44c: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 4000c450: 80 a0 60 00 cmp %g1, 0 4000c454: 12 80 00 08 bne 4000c474 <_POSIX_Threads_Sporadic_budget_TSR+0x4c><== NEVER TAKEN 4000c458: 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 ) { 4000c45c: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000c460: 80 a0 40 09 cmp %g1, %o1 4000c464: 08 80 00 04 bleu 4000c474 <_POSIX_Threads_Sporadic_budget_TSR+0x4c> 4000c468: 90 10 00 19 mov %i1, %o0 _Thread_Change_priority( the_thread, new_priority, true ); 4000c46c: 7f ff f1 a9 call 40008b10 <_Thread_Change_priority> 4000c470: 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 ); 4000c474: 40 00 04 1b call 4000d4e0 <_Timespec_To_ticks> 4000c478: 90 04 20 90 add %l0, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000c47c: 31 10 00 59 sethi %hi(0x40016400), %i0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000c480: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000c484: b0 16 20 f0 or %i0, 0xf0, %i0 4000c488: 7f ff f6 93 call 40009ed4 <_Watchdog_Insert> 4000c48c: 93 ec 20 a8 restore %l0, 0xa8, %o1 =============================================================================== 4000c494 <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000c494: 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 */ 4000c498: 86 10 3f ff mov -1, %g3 4000c49c: c4 00 a0 8c ld [ %g2 + 0x8c ], %g2 4000c4a0: c6 22 20 78 st %g3, [ %o0 + 0x78 ] 4000c4a4: 07 10 00 56 sethi %hi(0x40015800), %g3 4000c4a8: d2 08 e1 54 ldub [ %g3 + 0x154 ], %o1 ! 40015954 4000c4ac: 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 ) { 4000c4b0: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 4000c4b4: 80 a0 a0 00 cmp %g2, 0 4000c4b8: 12 80 00 09 bne 4000c4dc <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000c4bc: 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 ) { 4000c4c0: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000c4c4: 80 a0 40 09 cmp %g1, %o1 4000c4c8: 1a 80 00 05 bcc 4000c4dc <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 4000c4cc: 94 10 20 01 mov 1, %o2 _Thread_Change_priority( the_thread, new_priority, true ); 4000c4d0: 82 13 c0 00 mov %o7, %g1 4000c4d4: 7f ff f1 8f call 40008b10 <_Thread_Change_priority> 4000c4d8: 9e 10 40 00 mov %g1, %o7 4000c4dc: 81 c3 e0 08 retl <== NOT EXECUTED =============================================================================== 40006c44 <_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) { 40006c44: 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; 40006c48: c2 06 60 68 ld [ %i1 + 0x68 ], %g1 40006c4c: 82 00 60 01 inc %g1 40006c50: c2 26 60 68 st %g1, [ %i1 + 0x68 ] /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 40006c54: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 40006c58: 80 a0 60 00 cmp %g1, 0 40006c5c: 32 80 00 07 bne,a 40006c78 <_POSIX_Timer_TSR+0x34> 40006c60: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40006c64: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 40006c68: 80 a0 60 00 cmp %g1, 0 40006c6c: 02 80 00 0f be 40006ca8 <_POSIX_Timer_TSR+0x64> <== NEVER TAKEN 40006c70: 82 10 20 04 mov 4, %g1 ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 40006c74: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 40006c78: d4 06 60 08 ld [ %i1 + 8 ], %o2 40006c7c: 90 06 60 10 add %i1, 0x10, %o0 40006c80: 17 10 00 1b sethi %hi(0x40006c00), %o3 40006c84: 98 10 00 19 mov %i1, %o4 40006c88: 40 00 19 80 call 4000d288 <_POSIX_Timer_Insert_helper> 40006c8c: 96 12 e0 44 or %o3, 0x44, %o3 ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 40006c90: 80 8a 20 ff btst 0xff, %o0 40006c94: 02 80 00 0a be 40006cbc <_POSIX_Timer_TSR+0x78> <== NEVER TAKEN 40006c98: 01 00 00 00 nop return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 40006c9c: 40 00 05 c2 call 400083a4 <_TOD_Get> 40006ca0: 90 06 60 6c add %i1, 0x6c, %o0 40006ca4: 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 ) ) { 40006ca8: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 40006cac: d2 06 60 44 ld [ %i1 + 0x44 ], %o1 40006cb0: 40 00 18 60 call 4000ce30 40006cb4: 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; 40006cb8: c0 26 60 68 clr [ %i1 + 0x68 ] 40006cbc: 81 c7 e0 08 ret 40006cc0: 81 e8 00 00 restore =============================================================================== 4000e8a4 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000e8a4: 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, 4000e8a8: 98 10 20 01 mov 1, %o4 4000e8ac: 90 10 00 18 mov %i0, %o0 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000e8b0: 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, 4000e8b4: a2 07 bf f4 add %fp, -12, %l1 4000e8b8: 92 10 00 19 mov %i1, %o1 4000e8bc: 94 10 00 11 mov %l1, %o2 4000e8c0: 96 0e a0 ff and %i2, 0xff, %o3 4000e8c4: 40 00 00 2c call 4000e974 <_POSIX_signals_Clear_signals> 4000e8c8: b0 10 20 00 clr %i0 4000e8cc: 80 8a 20 ff btst 0xff, %o0 4000e8d0: 02 80 00 27 be 4000e96c <_POSIX_signals_Check_signal+0xc8> 4000e8d4: 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 ) 4000e8d8: 2b 10 00 5a sethi %hi(0x40016800), %l5 4000e8dc: a9 2e 60 04 sll %i1, 4, %l4 4000e8e0: aa 15 61 c0 or %l5, 0x1c0, %l5 4000e8e4: a8 25 00 01 sub %l4, %g1, %l4 4000e8e8: 82 05 40 14 add %l5, %l4, %g1 4000e8ec: e4 00 60 08 ld [ %g1 + 8 ], %l2 4000e8f0: 80 a4 a0 01 cmp %l2, 1 4000e8f4: 02 80 00 1e be 4000e96c <_POSIX_signals_Check_signal+0xc8><== NEVER TAKEN 4000e8f8: 90 07 bf cc add %fp, -52, %o0 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 4000e8fc: e6 04 20 d0 ld [ %l0 + 0xd0 ], %l3 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000e900: c2 00 60 04 ld [ %g1 + 4 ], %g1 4000e904: 82 10 40 13 or %g1, %l3, %g1 4000e908: 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, 4000e90c: 03 10 00 5a sethi %hi(0x40016800), %g1 4000e910: d2 00 61 74 ld [ %g1 + 0x174 ], %o1 ! 40016974 <_Per_CPU_Information+0xc> 4000e914: 94 10 20 28 mov 0x28, %o2 4000e918: 40 00 04 2e call 4000f9d0 4000e91c: 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 ) { 4000e920: c2 05 40 14 ld [ %l5 + %l4 ], %g1 4000e924: 80 a0 60 02 cmp %g1, 2 4000e928: 12 80 00 07 bne 4000e944 <_POSIX_signals_Check_signal+0xa0> 4000e92c: 90 10 00 19 mov %i1, %o0 case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 4000e930: 92 10 00 11 mov %l1, %o1 4000e934: 9f c4 80 00 call %l2 4000e938: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 4000e93c: 10 80 00 05 b 4000e950 <_POSIX_signals_Check_signal+0xac> 4000e940: 03 10 00 5a sethi %hi(0x40016800), %g1 default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 4000e944: 9f c4 80 00 call %l2 4000e948: 90 10 00 19 mov %i1, %o0 } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 4000e94c: 03 10 00 5a sethi %hi(0x40016800), %g1 4000e950: d0 00 61 74 ld [ %g1 + 0x174 ], %o0 ! 40016974 <_Per_CPU_Information+0xc> 4000e954: 92 07 bf cc add %fp, -52, %o1 4000e958: 90 02 20 20 add %o0, 0x20, %o0 4000e95c: 94 10 20 28 mov 0x28, %o2 4000e960: 40 00 04 1c call 4000f9d0 4000e964: b0 10 20 01 mov 1, %i0 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 4000e968: e6 24 20 d0 st %l3, [ %l0 + 0xd0 ] return true; } 4000e96c: 81 c7 e0 08 ret 4000e970: 81 e8 00 00 restore =============================================================================== 4000efd4 <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 4000efd4: 9d e3 bf a0 save %sp, -96, %sp clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4000efd8: 7f ff cb 57 call 40001d34 4000efdc: 01 00 00 00 nop if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4000efe0: 85 2e 20 04 sll %i0, 4, %g2 4000efe4: 83 2e 20 02 sll %i0, 2, %g1 4000efe8: 82 20 80 01 sub %g2, %g1, %g1 4000efec: 05 10 00 5a sethi %hi(0x40016800), %g2 4000eff0: 84 10 a1 c0 or %g2, 0x1c0, %g2 ! 400169c0 <_POSIX_signals_Vectors> 4000eff4: c4 00 80 01 ld [ %g2 + %g1 ], %g2 4000eff8: 80 a0 a0 02 cmp %g2, 2 4000effc: 12 80 00 0a bne 4000f024 <_POSIX_signals_Clear_process_signals+0x50> 4000f000: 84 10 20 01 mov 1, %g2 } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } 4000f004: 05 10 00 5a sethi %hi(0x40016800), %g2 4000f008: 84 10 a3 b8 or %g2, 0x3b8, %g2 ! 40016bb8 <_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 ); 4000f00c: 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 ] ) ) 4000f010: c2 00 80 01 ld [ %g2 + %g1 ], %g1 4000f014: 86 00 e0 04 add %g3, 4, %g3 4000f018: 80 a0 40 03 cmp %g1, %g3 4000f01c: 12 80 00 08 bne 4000f03c <_POSIX_signals_Clear_process_signals+0x68><== NEVER TAKEN 4000f020: 84 10 20 01 mov 1, %g2 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 4000f024: 03 10 00 5a sethi %hi(0x40016800), %g1 4000f028: b0 06 3f ff add %i0, -1, %i0 4000f02c: b1 28 80 18 sll %g2, %i0, %i0 4000f030: c4 00 63 b4 ld [ %g1 + 0x3b4 ], %g2 4000f034: b0 28 80 18 andn %g2, %i0, %i0 4000f038: f0 20 63 b4 st %i0, [ %g1 + 0x3b4 ] } _ISR_Enable( level ); 4000f03c: 7f ff cb 42 call 40001d44 4000f040: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 400076bc <_POSIX_signals_Get_lowest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 400076bc: 82 10 20 1b mov 0x1b, %g1 ! 1b 400076c0: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 400076c4: 86 00 7f ff add %g1, -1, %g3 400076c8: 87 28 80 03 sll %g2, %g3, %g3 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 400076cc: 80 88 c0 08 btst %g3, %o0 400076d0: 12 80 00 11 bne 40007714 <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 400076d4: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 400076d8: 82 00 60 01 inc %g1 400076dc: 80 a0 60 20 cmp %g1, 0x20 400076e0: 12 bf ff fa bne 400076c8 <_POSIX_signals_Get_lowest+0xc> 400076e4: 86 00 7f ff add %g1, -1, %g3 400076e8: 82 10 20 01 mov 1, %g1 400076ec: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_lowest( 400076f0: 86 00 7f ff add %g1, -1, %g3 400076f4: 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 ) ) { 400076f8: 80 88 c0 08 btst %g3, %o0 400076fc: 12 80 00 06 bne 40007714 <_POSIX_signals_Get_lowest+0x58> 40007700: 01 00 00 00 nop */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 40007704: 82 00 60 01 inc %g1 40007708: 80 a0 60 1b cmp %g1, 0x1b 4000770c: 12 bf ff fa bne 400076f4 <_POSIX_signals_Get_lowest+0x38> <== ALWAYS TAKEN 40007710: 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; } 40007714: 81 c3 e0 08 retl 40007718: 90 10 00 01 mov %g1, %o0 =============================================================================== 400242b8 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 400242b8: 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 ) ) { 400242bc: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 400242c0: 1b 04 00 20 sethi %hi(0x10008000), %o5 400242c4: 84 06 7f ff add %i1, -1, %g2 400242c8: 86 10 20 01 mov 1, %g3 400242cc: 98 08 40 0d and %g1, %o5, %o4 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 400242d0: a0 10 00 18 mov %i0, %l0 400242d4: 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 ]; 400242d8: 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 ) ) { 400242dc: 80 a3 00 0d cmp %o4, %o5 400242e0: 12 80 00 1b bne 4002434c <_POSIX_signals_Unblock_thread+0x94> 400242e4: 85 28 c0 02 sll %g3, %g2, %g2 if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 400242e8: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 400242ec: 80 88 80 01 btst %g2, %g1 400242f0: 12 80 00 07 bne 4002430c <_POSIX_signals_Unblock_thread+0x54> 400242f4: 82 10 20 04 mov 4, %g1 400242f8: c2 01 20 d0 ld [ %g4 + 0xd0 ], %g1 400242fc: 80 a8 80 01 andncc %g2, %g1, %g0 40024300: 02 80 00 11 be 40024344 <_POSIX_signals_Unblock_thread+0x8c> 40024304: b0 10 20 00 clr %i0 the_thread->Wait.return_code = EINTR; 40024308: 82 10 20 04 mov 4, %g1 4002430c: c2 24 20 34 st %g1, [ %l0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 40024310: 80 a2 60 00 cmp %o1, 0 40024314: 12 80 00 07 bne 40024330 <_POSIX_signals_Unblock_thread+0x78> 40024318: d0 04 20 28 ld [ %l0 + 0x28 ], %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 4002431c: 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; 40024320: f2 22 00 00 st %i1, [ %o0 ] the_info->si_code = SI_USER; 40024324: c2 22 20 04 st %g1, [ %o0 + 4 ] the_info->si_value.sival_int = 0; 40024328: 10 80 00 04 b 40024338 <_POSIX_signals_Unblock_thread+0x80> 4002432c: c0 22 20 08 clr [ %o0 + 8 ] } else { *the_info = *info; 40024330: 7f ff c3 ad call 400151e4 40024334: 94 10 20 0c mov 0xc, %o2 } _Thread_queue_Extract_with_proxy( the_thread ); 40024338: 90 10 00 10 mov %l0, %o0 4002433c: 7f ff aa bc call 4000ee2c <_Thread_queue_Extract_with_proxy> 40024340: b0 10 20 01 mov 1, %i0 return true; 40024344: 81 c7 e0 08 ret 40024348: 81 e8 00 00 restore } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 4002434c: c8 01 20 d0 ld [ %g4 + 0xd0 ], %g4 40024350: 80 a8 80 04 andncc %g2, %g4, %g0 40024354: 02 bf ff fc be 40024344 <_POSIX_signals_Unblock_thread+0x8c> 40024358: 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 ) ) { 4002435c: 05 04 00 00 sethi %hi(0x10000000), %g2 40024360: 80 88 40 02 btst %g1, %g2 40024364: 02 80 00 17 be 400243c0 <_POSIX_signals_Unblock_thread+0x108> 40024368: 80 a0 60 00 cmp %g1, 0 the_thread->Wait.return_code = EINTR; 4002436c: 84 10 20 04 mov 4, %g2 40024370: 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) ) 40024374: 05 00 00 ef sethi %hi(0x3bc00), %g2 40024378: 84 10 a2 e0 or %g2, 0x2e0, %g2 ! 3bee0 4002437c: 80 88 40 02 btst %g1, %g2 40024380: 02 80 00 06 be 40024398 <_POSIX_signals_Unblock_thread+0xe0> 40024384: 80 88 60 08 btst 8, %g1 _Thread_queue_Extract_with_proxy( the_thread ); 40024388: 7f ff aa a9 call 4000ee2c <_Thread_queue_Extract_with_proxy> 4002438c: 90 10 00 10 mov %l0, %o0 40024390: 81 c7 e0 08 ret 40024394: 81 e8 00 00 restore else if ( _States_Is_delaying(the_thread->current_state) ) { 40024398: 02 80 00 15 be 400243ec <_POSIX_signals_Unblock_thread+0x134><== NEVER TAKEN 4002439c: 01 00 00 00 nop (void) _Watchdog_Remove( &the_thread->Timer ); 400243a0: 7f ff ac ee call 4000f758 <_Watchdog_Remove> 400243a4: 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 ); 400243a8: 90 10 00 10 mov %l0, %o0 400243ac: 13 04 00 ff sethi %hi(0x1003fc00), %o1 400243b0: 7f ff a8 00 call 4000e3b0 <_Thread_Clear_state> 400243b4: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 400243b8: 81 c7 e0 08 ret 400243bc: 81 e8 00 00 restore _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 400243c0: 12 bf ff e1 bne 40024344 <_POSIX_signals_Unblock_thread+0x8c><== NEVER TAKEN 400243c4: 03 10 00 9f sethi %hi(0x40027c00), %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 400243c8: 82 10 63 68 or %g1, 0x368, %g1 ! 40027f68 <_Per_CPU_Information> 400243cc: c4 00 60 08 ld [ %g1 + 8 ], %g2 400243d0: 80 a0 a0 00 cmp %g2, 0 400243d4: 02 80 00 06 be 400243ec <_POSIX_signals_Unblock_thread+0x134> 400243d8: 01 00 00 00 nop 400243dc: c4 00 60 0c ld [ %g1 + 0xc ], %g2 400243e0: 80 a4 00 02 cmp %l0, %g2 400243e4: 22 bf ff d8 be,a 40024344 <_POSIX_signals_Unblock_thread+0x8c><== ALWAYS TAKEN 400243e8: c6 28 60 18 stb %g3, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } } return false; } 400243ec: 81 c7 e0 08 ret 400243f0: 81 e8 00 00 restore =============================================================================== 40008150 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 40008150: 9d e3 bf 98 save %sp, -104, %sp 40008154: 11 10 00 81 sethi %hi(0x40020400), %o0 40008158: 92 10 00 18 mov %i0, %o1 4000815c: 90 12 20 7c or %o0, 0x7c, %o0 40008160: 40 00 07 f3 call 4000a12c <_Objects_Get> 40008164: 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 ) { 40008168: c2 07 bf fc ld [ %fp + -4 ], %g1 4000816c: 80 a0 60 00 cmp %g1, 0 40008170: 12 80 00 24 bne 40008200 <_Rate_monotonic_Timeout+0xb0> <== NEVER TAKEN 40008174: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: the_thread = the_period->owner; 40008178: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 4000817c: 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); 40008180: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 40008184: 80 88 80 01 btst %g2, %g1 40008188: 22 80 00 0b be,a 400081b4 <_Rate_monotonic_Timeout+0x64> 4000818c: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 40008190: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 40008194: c2 04 20 08 ld [ %l0 + 8 ], %g1 40008198: 80 a0 80 01 cmp %g2, %g1 4000819c: 32 80 00 06 bne,a 400081b4 <_Rate_monotonic_Timeout+0x64> 400081a0: 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 ); 400081a4: 13 04 00 ff sethi %hi(0x1003fc00), %o1 400081a8: 40 00 0a 27 call 4000aa44 <_Thread_Clear_state> 400081ac: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 400081b0: 30 80 00 06 b,a 400081c8 <_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 ) { 400081b4: 80 a0 60 01 cmp %g1, 1 400081b8: 12 80 00 0d bne 400081ec <_Rate_monotonic_Timeout+0x9c> 400081bc: 82 10 20 04 mov 4, %g1 the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 400081c0: 82 10 20 03 mov 3, %g1 400081c4: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 400081c8: 7f ff fe 66 call 40007b60 <_Rate_monotonic_Initiate_statistics> 400081cc: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400081d0: c2 04 20 3c ld [ %l0 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400081d4: 11 10 00 81 sethi %hi(0x40020400), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400081d8: c2 24 20 1c st %g1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400081dc: 90 12 22 c0 or %o0, 0x2c0, %o0 400081e0: 40 00 0f 21 call 4000be64 <_Watchdog_Insert> 400081e4: 92 04 20 10 add %l0, 0x10, %o1 400081e8: 30 80 00 02 b,a 400081f0 <_Rate_monotonic_Timeout+0xa0> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 400081ec: 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; 400081f0: 03 10 00 81 sethi %hi(0x40020400), %g1 400081f4: c4 00 61 e0 ld [ %g1 + 0x1e0 ], %g2 ! 400205e0 <_Thread_Dispatch_disable_level> 400081f8: 84 00 bf ff add %g2, -1, %g2 400081fc: c4 20 61 e0 st %g2, [ %g1 + 0x1e0 ] 40008200: 81 c7 e0 08 ret 40008204: 81 e8 00 00 restore =============================================================================== 4000d09c <_Scheduler_priority_Block>: void _Scheduler_priority_Block( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { 4000d09c: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_extract( Thread_Control *the_thread ) { Chain_Control *ready = the_thread->scheduler.priority->ready_chain; 4000d0a0: c2 06 60 8c ld [ %i1 + 0x8c ], %g1 4000d0a4: c2 00 40 00 ld [ %g1 ], %g1 if ( _Chain_Has_only_one_node( ready ) ) { 4000d0a8: c6 00 40 00 ld [ %g1 ], %g3 4000d0ac: c4 00 60 08 ld [ %g1 + 8 ], %g2 4000d0b0: 80 a0 c0 02 cmp %g3, %g2 4000d0b4: 32 80 00 17 bne,a 4000d110 <_Scheduler_priority_Block+0x74> 4000d0b8: c4 06 40 00 ld [ %i1 ], %g2 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 4000d0bc: c0 20 60 04 clr [ %g1 + 4 ] RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4000d0c0: 84 00 60 04 add %g1, 4, %g2 head->next = tail; head->previous = NULL; tail->previous = head; 4000d0c4: 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; 4000d0c8: c4 20 40 00 st %g2, [ %g1 ] _Chain_Initialize_empty( ready ); _Priority_bit_map_Remove( &the_thread->scheduler.priority->Priority_map ); 4000d0cc: c2 06 60 8c ld [ %i1 + 0x8c ], %g1 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; 4000d0d0: c6 00 60 04 ld [ %g1 + 4 ], %g3 4000d0d4: c4 10 60 0e lduh [ %g1 + 0xe ], %g2 4000d0d8: c8 10 c0 00 lduh [ %g3 ], %g4 4000d0dc: 84 09 00 02 and %g4, %g2, %g2 4000d0e0: c4 30 c0 00 sth %g2, [ %g3 ] if ( *the_priority_map->minor == 0 ) 4000d0e4: 85 28 a0 10 sll %g2, 0x10, %g2 4000d0e8: 80 a0 a0 00 cmp %g2, 0 4000d0ec: 32 80 00 0d bne,a 4000d120 <_Scheduler_priority_Block+0x84> 4000d0f0: 03 10 00 5a sethi %hi(0x40016800), %g1 _Priority_Major_bit_map &= the_priority_map->block_major; 4000d0f4: 05 10 00 5a sethi %hi(0x40016800), %g2 4000d0f8: c2 10 60 0c lduh [ %g1 + 0xc ], %g1 4000d0fc: c6 10 a1 90 lduh [ %g2 + 0x190 ], %g3 4000d100: 82 08 40 03 and %g1, %g3, %g1 4000d104: c2 30 a1 90 sth %g1, [ %g2 + 0x190 ] RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); 4000d108: 10 80 00 06 b 4000d120 <_Scheduler_priority_Block+0x84> 4000d10c: 03 10 00 5a sethi %hi(0x40016800), %g1 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4000d110: c2 06 60 04 ld [ %i1 + 4 ], %g1 next->previous = previous; 4000d114: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000d118: c4 20 40 00 st %g2, [ %g1 ] 4000d11c: 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 ) ) 4000d120: c2 00 61 78 ld [ %g1 + 0x178 ], %g1 ! 40016978 <_Per_CPU_Information+0x10> 4000d124: 80 a6 40 01 cmp %i1, %g1 4000d128: 32 80 00 32 bne,a 4000d1f0 <_Scheduler_priority_Block+0x154> 4000d12c: 03 10 00 5a sethi %hi(0x40016800), %g1 RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4000d130: 03 10 00 5a sethi %hi(0x40016800), %g1 4000d134: c4 10 61 90 lduh [ %g1 + 0x190 ], %g2 ! 40016990 <_Priority_Major_bit_map> _Scheduler_priority_Block_body(the_scheduler, the_thread); } 4000d138: c6 06 00 00 ld [ %i0 ], %g3 4000d13c: 85 28 a0 10 sll %g2, 0x10, %g2 4000d140: 03 10 00 53 sethi %hi(0x40014c00), %g1 4000d144: 89 30 a0 10 srl %g2, 0x10, %g4 4000d148: 80 a1 20 ff cmp %g4, 0xff 4000d14c: 18 80 00 05 bgu 4000d160 <_Scheduler_priority_Block+0xc4> 4000d150: 82 10 62 40 or %g1, 0x240, %g1 4000d154: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 4000d158: 10 80 00 04 b 4000d168 <_Scheduler_priority_Block+0xcc> 4000d15c: 84 00 a0 08 add %g2, 8, %g2 4000d160: 85 30 a0 18 srl %g2, 0x18, %g2 4000d164: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4000d168: 83 28 a0 10 sll %g2, 0x10, %g1 4000d16c: 09 10 00 5a sethi %hi(0x40016800), %g4 4000d170: 83 30 60 0f srl %g1, 0xf, %g1 4000d174: 88 11 21 a0 or %g4, 0x1a0, %g4 4000d178: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 4000d17c: 03 10 00 53 sethi %hi(0x40014c00), %g1 4000d180: 89 29 20 10 sll %g4, 0x10, %g4 4000d184: 9b 31 20 10 srl %g4, 0x10, %o5 4000d188: 80 a3 60 ff cmp %o5, 0xff 4000d18c: 18 80 00 05 bgu 4000d1a0 <_Scheduler_priority_Block+0x104> 4000d190: 82 10 62 40 or %g1, 0x240, %g1 4000d194: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 4000d198: 10 80 00 04 b 4000d1a8 <_Scheduler_priority_Block+0x10c> 4000d19c: 82 00 60 08 add %g1, 8, %g1 4000d1a0: 89 31 20 18 srl %g4, 0x18, %g4 4000d1a4: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 4000d1a8: 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) + 4000d1ac: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 4000d1b0: 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) + 4000d1b4: 85 30 a0 0c srl %g2, 0xc, %g2 4000d1b8: 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 ] ) ) 4000d1bc: 89 28 a0 02 sll %g2, 2, %g4 4000d1c0: 83 28 a0 04 sll %g2, 4, %g1 4000d1c4: 82 20 40 04 sub %g1, %g4, %g1 4000d1c8: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 4000d1cc: 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 ); 4000d1d0: 86 01 20 04 add %g4, 4, %g3 4000d1d4: 80 a0 80 03 cmp %g2, %g3 4000d1d8: 02 80 00 03 be 4000d1e4 <_Scheduler_priority_Block+0x148> <== NEVER TAKEN 4000d1dc: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 4000d1e0: 82 10 00 02 mov %g2, %g1 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 4000d1e4: 05 10 00 5a sethi %hi(0x40016800), %g2 4000d1e8: c2 20 a1 78 st %g1, [ %g2 + 0x178 ] ! 40016978 <_Per_CPU_Information+0x10> RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 4000d1ec: 03 10 00 5a sethi %hi(0x40016800), %g1 4000d1f0: 82 10 61 68 or %g1, 0x168, %g1 ! 40016968 <_Per_CPU_Information> /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(the_scheduler); if ( _Thread_Is_executing( the_thread ) ) 4000d1f4: c4 00 60 0c ld [ %g1 + 0xc ], %g2 4000d1f8: 80 a6 40 02 cmp %i1, %g2 4000d1fc: 12 80 00 03 bne 4000d208 <_Scheduler_priority_Block+0x16c> 4000d200: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 4000d204: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 4000d208: 81 c7 e0 08 ret 4000d20c: 81 e8 00 00 restore =============================================================================== 40008808 <_Scheduler_priority_Schedule>: */ void _Scheduler_priority_Schedule( Scheduler_Control *the_scheduler ) { 40008808: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4000880c: 03 10 00 5a sethi %hi(0x40016800), %g1 40008810: c4 10 61 90 lduh [ %g1 + 0x190 ], %g2 ! 40016990 <_Priority_Major_bit_map> _Scheduler_priority_Schedule_body( the_scheduler ); } 40008814: c6 06 00 00 ld [ %i0 ], %g3 40008818: 85 28 a0 10 sll %g2, 0x10, %g2 4000881c: 03 10 00 53 sethi %hi(0x40014c00), %g1 40008820: 89 30 a0 10 srl %g2, 0x10, %g4 40008824: 80 a1 20 ff cmp %g4, 0xff 40008828: 18 80 00 05 bgu 4000883c <_Scheduler_priority_Schedule+0x34> 4000882c: 82 10 62 40 or %g1, 0x240, %g1 40008830: c4 08 40 04 ldub [ %g1 + %g4 ], %g2 40008834: 10 80 00 04 b 40008844 <_Scheduler_priority_Schedule+0x3c> 40008838: 84 00 a0 08 add %g2, 8, %g2 4000883c: 85 30 a0 18 srl %g2, 0x18, %g2 40008840: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40008844: 83 28 a0 10 sll %g2, 0x10, %g1 40008848: 09 10 00 5a sethi %hi(0x40016800), %g4 4000884c: 83 30 60 0f srl %g1, 0xf, %g1 40008850: 88 11 21 a0 or %g4, 0x1a0, %g4 40008854: c8 11 00 01 lduh [ %g4 + %g1 ], %g4 40008858: 03 10 00 53 sethi %hi(0x40014c00), %g1 4000885c: 89 29 20 10 sll %g4, 0x10, %g4 40008860: 9b 31 20 10 srl %g4, 0x10, %o5 40008864: 80 a3 60 ff cmp %o5, 0xff 40008868: 18 80 00 05 bgu 4000887c <_Scheduler_priority_Schedule+0x74> 4000886c: 82 10 62 40 or %g1, 0x240, %g1 40008870: c2 08 40 0d ldub [ %g1 + %o5 ], %g1 40008874: 10 80 00 04 b 40008884 <_Scheduler_priority_Schedule+0x7c> 40008878: 82 00 60 08 add %g1, 8, %g1 4000887c: 89 31 20 18 srl %g4, 0x18, %g4 40008880: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 40008884: 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) + 40008888: 85 28 a0 10 sll %g2, 0x10, %g2 _Priority_Bits_index( minor ); 4000888c: 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) + 40008890: 85 30 a0 0c srl %g2, 0xc, %g2 40008894: 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 ] ) ) 40008898: 89 28 a0 02 sll %g2, 2, %g4 4000889c: 83 28 a0 04 sll %g2, 4, %g1 400088a0: 82 20 40 04 sub %g1, %g4, %g1 400088a4: c4 00 c0 01 ld [ %g3 + %g1 ], %g2 400088a8: 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 ); 400088ac: 86 01 20 04 add %g4, 4, %g3 400088b0: 80 a0 80 03 cmp %g2, %g3 400088b4: 02 80 00 03 be 400088c0 <_Scheduler_priority_Schedule+0xb8><== NEVER TAKEN 400088b8: 82 10 20 00 clr %g1 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 400088bc: 82 10 00 02 mov %g2, %g1 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 400088c0: 05 10 00 5a sethi %hi(0x40016800), %g2 400088c4: c2 20 a1 78 st %g1, [ %g2 + 0x178 ] ! 40016978 <_Per_CPU_Information+0x10> 400088c8: 81 c7 e0 08 ret 400088cc: 81 e8 00 00 restore =============================================================================== 40007b58 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40007b58: 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(); 40007b5c: 03 10 00 80 sethi %hi(0x40020000), %g1 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40007b60: 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(); 40007b64: d2 00 63 34 ld [ %g1 + 0x334 ], %o1 if ((!the_tod) || 40007b68: 80 a4 20 00 cmp %l0, 0 40007b6c: 02 80 00 2b be 40007c18 <_TOD_Validate+0xc0> <== NEVER TAKEN 40007b70: b0 10 20 00 clr %i0 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 40007b74: 11 00 03 d0 sethi %hi(0xf4000), %o0 40007b78: 40 00 4a 62 call 4001a500 <.udiv> 40007b7c: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 40007b80: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40007b84: 80 a0 40 08 cmp %g1, %o0 40007b88: 1a 80 00 24 bcc 40007c18 <_TOD_Validate+0xc0> 40007b8c: 01 00 00 00 nop (the_tod->ticks >= ticks_per_second) || 40007b90: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40007b94: 80 a0 60 3b cmp %g1, 0x3b 40007b98: 18 80 00 20 bgu 40007c18 <_TOD_Validate+0xc0> 40007b9c: 01 00 00 00 nop (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 40007ba0: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40007ba4: 80 a0 60 3b cmp %g1, 0x3b 40007ba8: 18 80 00 1c bgu 40007c18 <_TOD_Validate+0xc0> 40007bac: 01 00 00 00 nop (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 40007bb0: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40007bb4: 80 a0 60 17 cmp %g1, 0x17 40007bb8: 18 80 00 18 bgu 40007c18 <_TOD_Validate+0xc0> 40007bbc: 01 00 00 00 nop (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 40007bc0: 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) || 40007bc4: 80 a0 60 00 cmp %g1, 0 40007bc8: 02 80 00 14 be 40007c18 <_TOD_Validate+0xc0> <== NEVER TAKEN 40007bcc: 80 a0 60 0c cmp %g1, 0xc (the_tod->month == 0) || 40007bd0: 18 80 00 12 bgu 40007c18 <_TOD_Validate+0xc0> 40007bd4: 01 00 00 00 nop (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 40007bd8: 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) || 40007bdc: 80 a0 e7 c3 cmp %g3, 0x7c3 40007be0: 08 80 00 0e bleu 40007c18 <_TOD_Validate+0xc0> 40007be4: 01 00 00 00 nop (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 40007be8: 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) || 40007bec: 80 a0 a0 00 cmp %g2, 0 40007bf0: 02 80 00 0a be 40007c18 <_TOD_Validate+0xc0> <== NEVER TAKEN 40007bf4: 80 88 e0 03 btst 3, %g3 40007bf8: 07 10 00 7b sethi %hi(0x4001ec00), %g3 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 40007bfc: 12 80 00 03 bne 40007c08 <_TOD_Validate+0xb0> 40007c00: 86 10 e2 30 or %g3, 0x230, %g3 ! 4001ee30 <_TOD_Days_per_month> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 40007c04: 82 00 60 0d add %g1, 0xd, %g1 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 40007c08: 83 28 60 02 sll %g1, 2, %g1 40007c0c: 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( 40007c10: 80 a0 40 02 cmp %g1, %g2 40007c14: b0 60 3f ff subx %g0, -1, %i0 if ( the_tod->day > days_in_month ) return false; return true; } 40007c18: 81 c7 e0 08 ret 40007c1c: 81 e8 00 00 restore =============================================================================== 40008b10 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 40008b10: 9d e3 bf a0 save %sp, -96, %sp */ /* * Save original state */ original_state = the_thread->current_state; 40008b14: 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 ); 40008b18: 40 00 03 77 call 400098f4 <_Thread_Set_transient> 40008b1c: 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 ) 40008b20: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40008b24: 80 a0 40 19 cmp %g1, %i1 40008b28: 02 80 00 05 be 40008b3c <_Thread_Change_priority+0x2c> 40008b2c: a0 10 00 18 mov %i0, %l0 _Thread_Set_priority( the_thread, new_priority ); 40008b30: 90 10 00 18 mov %i0, %o0 40008b34: 40 00 03 54 call 40009884 <_Thread_Set_priority> 40008b38: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 40008b3c: 7f ff e4 7e call 40001d34 40008b40: 01 00 00 00 nop 40008b44: 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; 40008b48: f2 04 20 10 ld [ %l0 + 0x10 ], %i1 if ( state != STATES_TRANSIENT ) { 40008b4c: 80 a6 60 04 cmp %i1, 4 40008b50: 02 80 00 10 be 40008b90 <_Thread_Change_priority+0x80> 40008b54: 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 ) ) 40008b58: 80 a4 60 00 cmp %l1, 0 40008b5c: 12 80 00 03 bne 40008b68 <_Thread_Change_priority+0x58> <== NEVER TAKEN 40008b60: 82 0e 7f fb and %i1, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 40008b64: c2 24 20 10 st %g1, [ %l0 + 0x10 ] _ISR_Enable( level ); 40008b68: 7f ff e4 77 call 40001d44 40008b6c: 90 10 00 18 mov %i0, %o0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 40008b70: 03 00 00 ef sethi %hi(0x3bc00), %g1 40008b74: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 40008b78: 80 8e 40 01 btst %i1, %g1 40008b7c: 02 80 00 44 be 40008c8c <_Thread_Change_priority+0x17c> 40008b80: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 40008b84: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 40008b88: 40 00 03 12 call 400097d0 <_Thread_queue_Requeue> 40008b8c: 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 ) ) { 40008b90: 80 a4 60 00 cmp %l1, 0 40008b94: 12 80 00 26 bne 40008c2c <_Thread_Change_priority+0x11c> <== NEVER TAKEN 40008b98: 80 8e a0 ff btst 0xff, %i2 * Ready Queue with interrupts off. * * FIXME: hard-coded for priority scheduling. Might be ok since this * function is specific to priority scheduling? */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 40008b9c: c0 24 20 10 clr [ %l0 + 0x10 ] 40008ba0: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 if ( prepend_it ) 40008ba4: 02 80 00 12 be 40008bec <_Thread_Change_priority+0xdc> 40008ba8: 05 10 00 5a sethi %hi(0x40016800), %g2 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 40008bac: c6 00 60 04 ld [ %g1 + 4 ], %g3 40008bb0: c8 10 60 0a lduh [ %g1 + 0xa ], %g4 40008bb4: da 10 c0 00 lduh [ %g3 ], %o5 40008bb8: 88 13 40 04 or %o5, %g4, %g4 40008bbc: c8 30 c0 00 sth %g4, [ %g3 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 40008bc0: c6 10 a1 90 lduh [ %g2 + 0x190 ], %g3 40008bc4: c8 10 60 08 lduh [ %g1 + 8 ], %g4 Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); _Chain_Prepend_unprotected( the_thread->scheduler.priority->ready_chain, 40008bc8: c2 00 40 00 ld [ %g1 ], %g1 40008bcc: 86 11 00 03 or %g4, %g3, %g3 40008bd0: c6 30 a1 90 sth %g3, [ %g2 + 0x190 ] ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 40008bd4: c4 00 40 00 ld [ %g1 ], %g2 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 40008bd8: c2 24 20 04 st %g1, [ %l0 + 4 ] before_node = after_node->next; after_node->next = the_node; 40008bdc: e0 20 40 00 st %l0, [ %g1 ] the_node->next = before_node; 40008be0: c4 24 00 00 st %g2, [ %l0 ] before_node->previous = the_node; 40008be4: 10 80 00 12 b 40008c2c <_Thread_Change_priority+0x11c> 40008be8: e0 20 a0 04 st %l0, [ %g2 + 4 ] RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 40008bec: c6 00 60 04 ld [ %g1 + 4 ], %g3 40008bf0: c8 10 60 0a lduh [ %g1 + 0xa ], %g4 40008bf4: da 10 c0 00 lduh [ %g3 ], %o5 40008bf8: 88 13 40 04 or %o5, %g4, %g4 40008bfc: c8 30 c0 00 sth %g4, [ %g3 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 40008c00: c8 10 60 08 lduh [ %g1 + 8 ], %g4 40008c04: c6 10 a1 90 lduh [ %g2 + 0x190 ], %g3 Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); _Chain_Append_unprotected( the_thread->scheduler.priority->ready_chain, 40008c08: c2 00 40 00 ld [ %g1 ], %g1 40008c0c: 86 11 00 03 or %g4, %g3, %g3 40008c10: c6 30 a1 90 sth %g3, [ %g2 + 0x190 ] Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 40008c14: c4 00 60 08 ld [ %g1 + 8 ], %g2 RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 40008c18: 86 00 60 04 add %g1, 4, %g3 Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; 40008c1c: e0 20 60 08 st %l0, [ %g1 + 8 ] ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; 40008c20: c6 24 00 00 st %g3, [ %l0 ] tail->previous = the_node; old_last->next = the_node; 40008c24: e0 20 80 00 st %l0, [ %g2 ] the_node->previous = old_last; 40008c28: c4 24 20 04 st %g2, [ %l0 + 4 ] _Scheduler_priority_Ready_queue_enqueue_first( the_thread ); else _Scheduler_priority_Ready_queue_enqueue( the_thread ); } _ISR_Flash( level ); 40008c2c: 7f ff e4 46 call 40001d44 40008c30: 90 10 00 18 mov %i0, %o0 40008c34: 7f ff e4 40 call 40001d34 40008c38: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( Scheduler_Control *the_scheduler ) { the_scheduler->Operations.schedule( the_scheduler ); 40008c3c: 11 10 00 59 sethi %hi(0x40016400), %o0 40008c40: 90 12 20 94 or %o0, 0x94, %o0 ! 40016494 <_Scheduler> 40008c44: c2 02 20 04 ld [ %o0 + 4 ], %g1 40008c48: 9f c0 40 00 call %g1 40008c4c: 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 ); 40008c50: 03 10 00 5a sethi %hi(0x40016800), %g1 40008c54: 82 10 61 68 or %g1, 0x168, %g1 ! 40016968 <_Per_CPU_Information> 40008c58: c4 00 60 0c ld [ %g1 + 0xc ], %g2 * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Scheduler_Schedule(&_Scheduler); if ( !_Thread_Is_executing_also_the_heir() && 40008c5c: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40008c60: 80 a0 80 03 cmp %g2, %g3 40008c64: 02 80 00 08 be 40008c84 <_Thread_Change_priority+0x174> 40008c68: 01 00 00 00 nop 40008c6c: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 40008c70: 80 a0 a0 00 cmp %g2, 0 40008c74: 02 80 00 04 be 40008c84 <_Thread_Change_priority+0x174> 40008c78: 01 00 00 00 nop _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 40008c7c: 84 10 20 01 mov 1, %g2 ! 1 40008c80: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] _ISR_Enable( level ); 40008c84: 7f ff e4 30 call 40001d44 40008c88: 81 e8 00 00 restore 40008c8c: 81 c7 e0 08 ret 40008c90: 81 e8 00 00 restore =============================================================================== 40008e74 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 40008e74: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40008e78: 90 10 00 18 mov %i0, %o0 40008e7c: 40 00 00 5f call 40008ff8 <_Thread_Get> 40008e80: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40008e84: c2 07 bf fc ld [ %fp + -4 ], %g1 40008e88: 80 a0 60 00 cmp %g1, 0 40008e8c: 12 80 00 08 bne 40008eac <_Thread_Delay_ended+0x38> <== NEVER TAKEN 40008e90: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 40008e94: 7f ff ff 80 call 40008c94 <_Thread_Clear_state> 40008e98: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 40008e9c: 03 10 00 59 sethi %hi(0x40016400), %g1 40008ea0: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 ! 40016410 <_Thread_Dispatch_disable_level> 40008ea4: 84 00 bf ff add %g2, -1, %g2 40008ea8: c4 20 60 10 st %g2, [ %g1 + 0x10 ] 40008eac: 81 c7 e0 08 ret 40008eb0: 81 e8 00 00 restore =============================================================================== 40008eb4 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 40008eb4: 9d e3 bf 90 save %sp, -112, %sp Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 40008eb8: 2b 10 00 5a sethi %hi(0x40016800), %l5 40008ebc: 82 15 61 68 or %l5, 0x168, %g1 ! 40016968 <_Per_CPU_Information> _ISR_Disable( level ); 40008ec0: 7f ff e3 9d call 40001d34 40008ec4: e2 00 60 0c ld [ %g1 + 0xc ], %l1 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 40008ec8: 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; 40008ecc: 39 10 00 59 sethi %hi(0x40016400), %i4 40008ed0: 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; 40008ed4: 2f 10 00 58 sethi %hi(0x40016000), %l7 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 40008ed8: a8 07 bf f8 add %fp, -8, %l4 _Timestamp_Subtract( 40008edc: a6 07 bf f0 add %fp, -16, %l3 40008ee0: a4 14 a0 dc or %l2, 0xdc, %l2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 40008ee4: 10 80 00 2b b 40008f90 <_Thread_Dispatch+0xdc> 40008ee8: 2d 10 00 59 sethi %hi(0x40016400), %l6 heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 40008eec: fa 27 20 10 st %i5, [ %i4 + 0x10 ] _Thread_Dispatch_necessary = false; 40008ef0: 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 ) 40008ef4: 80 a4 00 11 cmp %l0, %l1 40008ef8: 02 80 00 2b be 40008fa4 <_Thread_Dispatch+0xf0> 40008efc: 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 ) 40008f00: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40008f04: 80 a0 60 01 cmp %g1, 1 40008f08: 12 80 00 03 bne 40008f14 <_Thread_Dispatch+0x60> 40008f0c: c2 05 e3 74 ld [ %l7 + 0x374 ], %g1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 40008f10: c2 24 20 78 st %g1, [ %l0 + 0x78 ] _ISR_Enable( level ); 40008f14: 7f ff e3 8c call 40001d44 40008f18: 01 00 00 00 nop #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 40008f1c: 40 00 0f 49 call 4000cc40 <_TOD_Get_uptime> 40008f20: 90 10 00 14 mov %l4, %o0 _Timestamp_Subtract( 40008f24: 90 10 00 12 mov %l2, %o0 40008f28: 92 10 00 14 mov %l4, %o1 40008f2c: 40 00 03 2b call 40009bd8 <_Timespec_Subtract> 40008f30: 94 10 00 13 mov %l3, %o2 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 40008f34: 90 04 60 84 add %l1, 0x84, %o0 40008f38: 40 00 03 0f call 40009b74 <_Timespec_Add_to> 40008f3c: 92 10 00 13 mov %l3, %o1 _Thread_Time_of_last_context_switch = uptime; 40008f40: c2 07 bf f8 ld [ %fp + -8 ], %g1 40008f44: c2 24 80 00 st %g1, [ %l2 ] 40008f48: c2 07 bf fc ld [ %fp + -4 ], %g1 40008f4c: c2 24 a0 04 st %g1, [ %l2 + 4 ] #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 40008f50: c2 05 a0 b4 ld [ %l6 + 0xb4 ], %g1 40008f54: 80 a0 60 00 cmp %g1, 0 40008f58: 02 80 00 06 be 40008f70 <_Thread_Dispatch+0xbc> <== NEVER TAKEN 40008f5c: 90 10 00 11 mov %l1, %o0 executing->libc_reent = *_Thread_libc_reent; 40008f60: c4 00 40 00 ld [ %g1 ], %g2 40008f64: c4 24 61 50 st %g2, [ %l1 + 0x150 ] *_Thread_libc_reent = heir->libc_reent; 40008f68: c4 04 21 50 ld [ %l0 + 0x150 ], %g2 40008f6c: c4 20 40 00 st %g2, [ %g1 ] } _User_extensions_Thread_switch( executing, heir ); 40008f70: 40 00 03 ca call 40009e98 <_User_extensions_Thread_switch> 40008f74: 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 ); 40008f78: 90 04 60 c8 add %l1, 0xc8, %o0 40008f7c: 40 00 04 b9 call 4000a260 <_CPU_Context_switch> 40008f80: 92 04 20 c8 add %l0, 0xc8, %o1 if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; 40008f84: 82 15 61 68 or %l5, 0x168, %g1 _ISR_Disable( level ); 40008f88: 7f ff e3 6b call 40001d34 40008f8c: 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 ) { 40008f90: 82 15 61 68 or %l5, 0x168, %g1 40008f94: c4 08 60 18 ldub [ %g1 + 0x18 ], %g2 40008f98: 80 a0 a0 00 cmp %g2, 0 40008f9c: 32 bf ff d4 bne,a 40008eec <_Thread_Dispatch+0x38> 40008fa0: e0 00 60 10 ld [ %g1 + 0x10 ], %l0 _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 40008fa4: 03 10 00 59 sethi %hi(0x40016400), %g1 40008fa8: c0 20 60 10 clr [ %g1 + 0x10 ] ! 40016410 <_Thread_Dispatch_disable_level> _ISR_Enable( level ); 40008fac: 7f ff e3 66 call 40001d44 40008fb0: 01 00 00 00 nop _API_extensions_Run_postswitch(); 40008fb4: 7f ff f8 e1 call 40007338 <_API_extensions_Run_postswitch> 40008fb8: 01 00 00 00 nop } 40008fbc: 81 c7 e0 08 ret 40008fc0: 81 e8 00 00 restore =============================================================================== 4000ee60 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 4000ee60: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 4000ee64: 03 10 00 5a sethi %hi(0x40016800), %g1 4000ee68: e0 00 61 74 ld [ %g1 + 0x174 ], %l0 ! 40016974 <_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(); 4000ee6c: 3f 10 00 3b sethi %hi(0x4000ec00), %i7 4000ee70: be 17 e2 60 or %i7, 0x260, %i7 ! 4000ee60 <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4000ee74: d0 04 20 ac ld [ %l0 + 0xac ], %o0 _ISR_Set_level(level); 4000ee78: 7f ff cb b3 call 40001d44 4000ee7c: 91 2a 20 08 sll %o0, 8, %o0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000ee80: 03 10 00 58 sethi %hi(0x40016000), %g1 doneConstructors = 1; 4000ee84: 84 10 20 01 mov 1, %g2 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000ee88: e2 08 60 98 ldub [ %g1 + 0x98 ], %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 ); 4000ee8c: 90 10 00 10 mov %l0, %o0 4000ee90: 7f ff eb 92 call 40009cd8 <_User_extensions_Thread_begin> 4000ee94: c4 28 60 98 stb %g2, [ %g1 + 0x98 ] /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4000ee98: 7f ff e8 4b call 40008fc4 <_Thread_Enable_dispatch> 4000ee9c: 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) */ { 4000eea0: 80 a4 60 00 cmp %l1, 0 4000eea4: 32 80 00 05 bne,a 4000eeb8 <_Thread_Handler+0x58> 4000eea8: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 INIT_NAME (); 4000eeac: 40 00 1a 6d call 40015860 <_init> 4000eeb0: 01 00 00 00 nop } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000eeb4: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000eeb8: 80 a0 60 00 cmp %g1, 0 4000eebc: 12 80 00 05 bne 4000eed0 <_Thread_Handler+0x70> 4000eec0: 80 a0 60 01 cmp %g1, 1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4000eec4: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000eec8: 10 80 00 06 b 4000eee0 <_Thread_Handler+0x80> 4000eecc: 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 ) { 4000eed0: 12 80 00 07 bne 4000eeec <_Thread_Handler+0x8c> <== NEVER TAKEN 4000eed4: 01 00 00 00 nop executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 4000eed8: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000eedc: d0 04 20 98 ld [ %l0 + 0x98 ], %o0 4000eee0: 9f c0 40 00 call %g1 4000eee4: 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 = 4000eee8: 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 ); 4000eeec: 7f ff eb 8c call 40009d1c <_User_extensions_Thread_exitted> 4000eef0: 90 10 00 10 mov %l0, %o0 _Internal_error_Occurred( 4000eef4: 90 10 20 00 clr %o0 4000eef8: 92 10 20 01 mov 1, %o1 4000eefc: 7f ff e3 b5 call 40007dd0 <_Internal_error_Occurred> 4000ef00: 94 10 20 05 mov 5, %o2 =============================================================================== 40009094 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 40009094: 9d e3 bf a0 save %sp, -96, %sp 40009098: 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; 4000909c: c0 26 61 54 clr [ %i1 + 0x154 ] 400090a0: c0 26 61 58 clr [ %i1 + 0x158 ] extensions_area = NULL; the_thread->libc_reent = NULL; 400090a4: 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 ) { 400090a8: e0 07 a0 60 ld [ %fp + 0x60 ], %l0 400090ac: 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 ) { 400090b0: 80 a6 a0 00 cmp %i2, 0 400090b4: 12 80 00 0d bne 400090e8 <_Thread_Initialize+0x54> 400090b8: e4 0f a0 5f ldub [ %fp + 0x5f ], %l2 actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 400090bc: 90 10 00 19 mov %i1, %o0 400090c0: 40 00 02 35 call 40009994 <_Thread_Stack_Allocate> 400090c4: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 400090c8: 80 a2 00 1b cmp %o0, %i3 400090cc: 0a 80 00 71 bcs 40009290 <_Thread_Initialize+0x1fc> 400090d0: 80 a2 20 00 cmp %o0, 0 400090d4: 02 80 00 6f be 40009290 <_Thread_Initialize+0x1fc> <== NEVER TAKEN 400090d8: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 400090dc: f4 06 60 c0 ld [ %i1 + 0xc0 ], %i2 the_thread->Start.core_allocated_stack = true; 400090e0: 10 80 00 04 b 400090f0 <_Thread_Initialize+0x5c> 400090e4: c2 2e 60 b4 stb %g1, [ %i1 + 0xb4 ] } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 400090e8: c0 2e 60 b4 clrb [ %i1 + 0xb4 ] 400090ec: 90 10 00 1b mov %i3, %o0 void *starting_address, size_t size ) { the_stack->area = starting_address; the_stack->size = size; 400090f0: d0 26 60 b8 st %o0, [ %i1 + 0xb8 ] #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 400090f4: 03 10 00 59 sethi %hi(0x40016400), %g1 400090f8: d0 00 60 c0 ld [ %g1 + 0xc0 ], %o0 ! 400164c0 <_Thread_Maximum_extensions> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 400090fc: f4 26 60 bc st %i2, [ %i1 + 0xbc ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40009100: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 40009104: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 40009108: c0 26 60 68 clr [ %i1 + 0x68 ] the_watchdog->user_data = user_data; 4000910c: c0 26 60 6c clr [ %i1 + 0x6c ] 40009110: 80 a2 20 00 cmp %o0, 0 40009114: 02 80 00 08 be 40009134 <_Thread_Initialize+0xa0> 40009118: b6 10 20 00 clr %i3 extensions_area = _Workspace_Allocate( 4000911c: 90 02 20 01 inc %o0 40009120: 40 00 04 32 call 4000a1e8 <_Workspace_Allocate> 40009124: 91 2a 20 02 sll %o0, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 40009128: b6 92 20 00 orcc %o0, 0, %i3 4000912c: 22 80 00 38 be,a 4000920c <_Thread_Initialize+0x178> 40009130: 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 ) { 40009134: 80 a6 e0 00 cmp %i3, 0 40009138: 02 80 00 0b be 40009164 <_Thread_Initialize+0xd0> 4000913c: f6 26 61 5c st %i3, [ %i1 + 0x15c ] for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 40009140: 03 10 00 59 sethi %hi(0x40016400), %g1 40009144: c4 00 60 c0 ld [ %g1 + 0xc0 ], %g2 ! 400164c0 <_Thread_Maximum_extensions> 40009148: 10 80 00 04 b 40009158 <_Thread_Initialize+0xc4> 4000914c: 82 10 20 00 clr %g1 40009150: 82 00 60 01 inc %g1 the_thread->extensions[i] = NULL; 40009154: 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++ ) 40009158: 80 a0 40 02 cmp %g1, %g2 4000915c: 08 bf ff fd bleu 40009150 <_Thread_Initialize+0xbc> 40009160: 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; 40009164: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 40009168: e4 2e 60 a0 stb %l2, [ %i1 + 0xa0 ] the_thread->Start.budget_algorithm = budget_algorithm; 4000916c: e0 26 60 a4 st %l0, [ %i1 + 0xa4 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 40009170: 80 a4 20 02 cmp %l0, 2 40009174: 12 80 00 05 bne 40009188 <_Thread_Initialize+0xf4> 40009178: 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; 4000917c: 03 10 00 58 sethi %hi(0x40016000), %g1 40009180: c2 00 63 74 ld [ %g1 + 0x374 ], %g1 ! 40016374 <_Thread_Ticks_per_timeslice> 40009184: c2 26 60 78 st %g1, [ %i1 + 0x78 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 40009188: c2 07 a0 68 ld [ %fp + 0x68 ], %g1 Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_allocate( the_scheduler, the_thread ); 4000918c: 11 10 00 59 sethi %hi(0x40016400), %o0 40009190: c2 26 60 ac st %g1, [ %i1 + 0xac ] the_thread->current_state = STATES_DORMANT; 40009194: 82 10 20 01 mov 1, %g1 40009198: 90 12 20 94 or %o0, 0x94, %o0 4000919c: c2 26 60 10 st %g1, [ %i1 + 0x10 ] RTEMS_INLINE_ROUTINE void* _Scheduler_Thread_scheduler_allocate( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return 400091a0: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 the_thread->Wait.queue = NULL; 400091a4: c0 26 60 44 clr [ %i1 + 0x44 ] the_thread->resource_count = 0; 400091a8: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 400091ac: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; 400091b0: fa 26 60 b0 st %i5, [ %i1 + 0xb0 ] 400091b4: 9f c0 40 00 call %g1 400091b8: 92 10 00 19 mov %i1, %o1 sched =_Scheduler_Thread_scheduler_allocate( &_Scheduler, the_thread ); if ( !sched ) 400091bc: a0 92 20 00 orcc %o0, 0, %l0 400091c0: 02 80 00 13 be 4000920c <_Thread_Initialize+0x178> 400091c4: 90 10 00 19 mov %i1, %o0 goto failed; _Thread_Set_priority( the_thread, priority ); 400091c8: 40 00 01 af call 40009884 <_Thread_Set_priority> 400091cc: 92 10 00 1d mov %i5, %o1 _Thread_Stack_Free( the_thread ); return false; } 400091d0: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 400091d4: 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 ); 400091d8: c0 26 60 84 clr [ %i1 + 0x84 ] 400091dc: c0 26 60 88 clr [ %i1 + 0x88 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400091e0: 83 28 60 02 sll %g1, 2, %g1 400091e4: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 400091e8: 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 ); 400091ec: 90 10 00 19 mov %i1, %o0 400091f0: 40 00 02 ed call 40009da4 <_User_extensions_Thread_create> 400091f4: b0 10 20 01 mov 1, %i0 if ( extension_status ) 400091f8: 80 8a 20 ff btst 0xff, %o0 400091fc: 22 80 00 05 be,a 40009210 <_Thread_Initialize+0x17c> 40009200: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 40009204: 81 c7 e0 08 ret 40009208: 81 e8 00 00 restore return true; failed: if ( the_thread->libc_reent ) 4000920c: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 40009210: 80 a2 20 00 cmp %o0, 0 40009214: 22 80 00 05 be,a 40009228 <_Thread_Initialize+0x194> 40009218: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 _Workspace_Free( the_thread->libc_reent ); 4000921c: 40 00 03 fc call 4000a20c <_Workspace_Free> 40009220: 01 00 00 00 nop for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 40009224: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 40009228: 80 a2 20 00 cmp %o0, 0 4000922c: 22 80 00 05 be,a 40009240 <_Thread_Initialize+0x1ac> 40009230: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 _Workspace_Free( the_thread->API_Extensions[i] ); 40009234: 40 00 03 f6 call 4000a20c <_Workspace_Free> 40009238: 01 00 00 00 nop failed: if ( the_thread->libc_reent ) _Workspace_Free( the_thread->libc_reent ); for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 4000923c: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 40009240: 80 a2 20 00 cmp %o0, 0 40009244: 02 80 00 05 be 40009258 <_Thread_Initialize+0x1c4> 40009248: 80 a6 e0 00 cmp %i3, 0 _Workspace_Free( the_thread->API_Extensions[i] ); 4000924c: 40 00 03 f0 call 4000a20c <_Workspace_Free> 40009250: 01 00 00 00 nop if ( extensions_area ) 40009254: 80 a6 e0 00 cmp %i3, 0 40009258: 02 80 00 05 be 4000926c <_Thread_Initialize+0x1d8> 4000925c: 80 a4 20 00 cmp %l0, 0 (void) _Workspace_Free( extensions_area ); 40009260: 40 00 03 eb call 4000a20c <_Workspace_Free> 40009264: 90 10 00 1b mov %i3, %o0 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( fp_area ) (void) _Workspace_Free( fp_area ); #endif if ( sched ) 40009268: 80 a4 20 00 cmp %l0, 0 4000926c: 02 80 00 05 be 40009280 <_Thread_Initialize+0x1ec> 40009270: 90 10 00 19 mov %i1, %o0 (void) _Workspace_Free( sched ); 40009274: 40 00 03 e6 call 4000a20c <_Workspace_Free> 40009278: 90 10 00 10 mov %l0, %o0 _Thread_Stack_Free( the_thread ); 4000927c: 90 10 00 19 mov %i1, %o0 40009280: 40 00 01 dc call 400099f0 <_Thread_Stack_Free> 40009284: b0 10 20 00 clr %i0 return false; 40009288: 81 c7 e0 08 ret 4000928c: 81 e8 00 00 restore } 40009290: 81 c7 e0 08 ret 40009294: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000d0e8 <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { 4000d0e8: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 4000d0ec: 7f ff d3 66 call 40001e84 4000d0f0: 01 00 00 00 nop 4000d0f4: a0 10 00 08 mov %o0, %l0 current_state = the_thread->current_state; 4000d0f8: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 if ( current_state & STATES_SUSPENDED ) { 4000d0fc: 80 88 60 02 btst 2, %g1 4000d100: 02 80 00 0a be 4000d128 <_Thread_Resume+0x40> <== NEVER TAKEN 4000d104: 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 ) ) { 4000d108: 80 a0 60 00 cmp %g1, 0 4000d10c: 12 80 00 07 bne 4000d128 <_Thread_Resume+0x40> 4000d110: c2 26 20 10 st %g1, [ %i0 + 0x10 ] RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { the_scheduler->Operations.unblock( the_scheduler, the_thread ); 4000d114: 11 10 00 69 sethi %hi(0x4001a400), %o0 4000d118: 90 12 20 24 or %o0, 0x24, %o0 ! 4001a424 <_Scheduler> 4000d11c: c2 02 20 10 ld [ %o0 + 0x10 ], %g1 4000d120: 9f c0 40 00 call %g1 4000d124: 92 10 00 18 mov %i0, %o1 _Scheduler_Unblock( &_Scheduler, the_thread ); } } _ISR_Enable( level ); 4000d128: 7f ff d3 5b call 40001e94 4000d12c: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40009ac0 <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 40009ac0: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing; executing = _Thread_Executing; 40009ac4: 03 10 00 5a sethi %hi(0x40016800), %g1 40009ac8: e0 00 61 74 ld [ %g1 + 0x174 ], %l0 ! 40016974 <_Per_CPU_Information+0xc> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 40009acc: c2 0c 20 74 ldub [ %l0 + 0x74 ], %g1 40009ad0: 80 a0 60 00 cmp %g1, 0 40009ad4: 02 80 00 26 be 40009b6c <_Thread_Tickle_timeslice+0xac> 40009ad8: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 40009adc: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40009ae0: 80 a0 60 00 cmp %g1, 0 40009ae4: 12 80 00 22 bne 40009b6c <_Thread_Tickle_timeslice+0xac> 40009ae8: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 40009aec: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 40009af0: 80 a0 60 01 cmp %g1, 1 40009af4: 0a 80 00 15 bcs 40009b48 <_Thread_Tickle_timeslice+0x88> 40009af8: 80 a0 60 02 cmp %g1, 2 40009afc: 28 80 00 07 bleu,a 40009b18 <_Thread_Tickle_timeslice+0x58> 40009b00: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 40009b04: 80 a0 60 03 cmp %g1, 3 40009b08: 12 80 00 19 bne 40009b6c <_Thread_Tickle_timeslice+0xac> <== NEVER TAKEN 40009b0c: 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 ) 40009b10: 10 80 00 10 b 40009b50 <_Thread_Tickle_timeslice+0x90> 40009b14: 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 ) { 40009b18: 82 00 7f ff add %g1, -1, %g1 40009b1c: 80 a0 60 00 cmp %g1, 0 40009b20: 14 80 00 0a bg 40009b48 <_Thread_Tickle_timeslice+0x88> 40009b24: c2 24 20 78 st %g1, [ %l0 + 0x78 ] * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield( &_Scheduler ); 40009b28: 11 10 00 59 sethi %hi(0x40016400), %o0 40009b2c: 90 12 20 94 or %o0, 0x94, %o0 ! 40016494 <_Scheduler> 40009b30: c2 02 20 08 ld [ %o0 + 8 ], %g1 40009b34: 9f c0 40 00 call %g1 40009b38: 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; 40009b3c: 03 10 00 58 sethi %hi(0x40016000), %g1 40009b40: c2 00 63 74 ld [ %g1 + 0x374 ], %g1 ! 40016374 <_Thread_Ticks_per_timeslice> 40009b44: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 40009b48: 81 c7 e0 08 ret 40009b4c: 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 ) 40009b50: 82 00 7f ff add %g1, -1, %g1 40009b54: 80 a0 60 00 cmp %g1, 0 40009b58: 12 bf ff fc bne 40009b48 <_Thread_Tickle_timeslice+0x88> 40009b5c: c2 24 20 78 st %g1, [ %l0 + 0x78 ] (*executing->budget_callout)( executing ); 40009b60: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 40009b64: 9f c0 40 00 call %g1 40009b68: 90 10 00 10 mov %l0, %o0 40009b6c: 81 c7 e0 08 ret 40009b70: 81 e8 00 00 restore =============================================================================== 400097d0 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 400097d0: 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 ) 400097d4: 80 a6 20 00 cmp %i0, 0 400097d8: 02 80 00 19 be 4000983c <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 400097dc: 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 ) { 400097e0: e2 06 20 34 ld [ %i0 + 0x34 ], %l1 400097e4: 80 a4 60 01 cmp %l1, 1 400097e8: 12 80 00 15 bne 4000983c <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 400097ec: 01 00 00 00 nop Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 400097f0: 7f ff e1 51 call 40001d34 400097f4: 01 00 00 00 nop 400097f8: a0 10 00 08 mov %o0, %l0 400097fc: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 40009800: 03 00 00 ef sethi %hi(0x3bc00), %g1 40009804: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 40009808: 80 88 80 01 btst %g2, %g1 4000980c: 02 80 00 0a be 40009834 <_Thread_queue_Requeue+0x64> <== NEVER TAKEN 40009810: 90 10 00 18 mov %i0, %o0 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 40009814: 92 10 00 19 mov %i1, %o1 40009818: 94 10 20 01 mov 1, %o2 4000981c: 40 00 0e d3 call 4000d368 <_Thread_queue_Extract_priority_helper> 40009820: e2 26 20 30 st %l1, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 40009824: 90 10 00 18 mov %i0, %o0 40009828: 92 10 00 19 mov %i1, %o1 4000982c: 7f ff ff 49 call 40009550 <_Thread_queue_Enqueue_priority> 40009830: 94 07 bf fc add %fp, -4, %o2 } _ISR_Enable( level ); 40009834: 7f ff e1 44 call 40001d44 40009838: 90 10 00 10 mov %l0, %o0 4000983c: 81 c7 e0 08 ret 40009840: 81 e8 00 00 restore =============================================================================== 40009844 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 40009844: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009848: 90 10 00 18 mov %i0, %o0 4000984c: 7f ff fd eb call 40008ff8 <_Thread_Get> 40009850: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009854: c2 07 bf fc ld [ %fp + -4 ], %g1 40009858: 80 a0 60 00 cmp %g1, 0 4000985c: 12 80 00 08 bne 4000987c <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 40009860: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 40009864: 40 00 0e f9 call 4000d448 <_Thread_queue_Process_timeout> 40009868: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000986c: 03 10 00 59 sethi %hi(0x40016400), %g1 40009870: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 ! 40016410 <_Thread_Dispatch_disable_level> 40009874: 84 00 bf ff add %g2, -1, %g2 40009878: c4 20 60 10 st %g2, [ %g1 + 0x10 ] 4000987c: 81 c7 e0 08 ret 40009880: 81 e8 00 00 restore =============================================================================== 40017230 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 40017230: 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; 40017234: 39 10 00 fb sethi %hi(0x4003ec00), %i4 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40017238: b6 07 bf f4 add %fp, -12, %i3 4001723c: ae 07 bf f8 add %fp, -8, %l7 40017240: a4 07 bf e8 add %fp, -24, %l2 40017244: a6 07 bf ec add %fp, -20, %l3 40017248: ee 27 bf f4 st %l7, [ %fp + -12 ] head->previous = NULL; 4001724c: c0 27 bf f8 clr [ %fp + -8 ] tail->previous = head; 40017250: 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; 40017254: e6 27 bf e8 st %l3, [ %fp + -24 ] head->previous = NULL; 40017258: c0 27 bf ec clr [ %fp + -20 ] tail->previous = head; 4001725c: 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 ); 40017260: 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(); 40017264: 3b 10 00 fb sethi %hi(0x4003ec00), %i5 /* * The current TOD is before the last TOD which indicates that * TOD has been set backwards. */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); 40017268: 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 ); 4001726c: 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 ); 40017270: 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; 40017274: 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; 40017278: c2 07 23 f0 ld [ %i4 + 0x3f0 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 4001727c: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40017280: 94 10 00 12 mov %l2, %o2 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 40017284: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40017288: 90 10 00 14 mov %l4, %o0 4001728c: 40 00 11 cb call 4001b9b8 <_Watchdog_Adjust_to_chain> 40017290: 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; 40017294: 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(); 40017298: e0 07 63 68 ld [ %i5 + 0x368 ], %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 ) { 4001729c: 80 a4 00 0a cmp %l0, %o2 400172a0: 08 80 00 06 bleu 400172b8 <_Timer_server_Body+0x88> 400172a4: 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 ); 400172a8: 90 10 00 11 mov %l1, %o0 400172ac: 40 00 11 c3 call 4001b9b8 <_Watchdog_Adjust_to_chain> 400172b0: 94 10 00 12 mov %l2, %o2 400172b4: 30 80 00 06 b,a 400172cc <_Timer_server_Body+0x9c> } else if ( snapshot < last_snapshot ) { 400172b8: 1a 80 00 05 bcc 400172cc <_Timer_server_Body+0x9c> 400172bc: 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 ); 400172c0: 92 10 20 01 mov 1, %o1 400172c4: 40 00 11 95 call 4001b918 <_Watchdog_Adjust> 400172c8: 94 22 80 10 sub %o2, %l0, %o2 } watchdogs->last_snapshot = snapshot; 400172cc: 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 ); 400172d0: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 400172d4: 40 00 02 de call 40017e4c <_Chain_Get> 400172d8: 01 00 00 00 nop if ( timer == NULL ) { 400172dc: 92 92 20 00 orcc %o0, 0, %o1 400172e0: 02 80 00 0c be 40017310 <_Timer_server_Body+0xe0> 400172e4: 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 ) { 400172e8: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 400172ec: 80 a0 60 01 cmp %g1, 1 400172f0: 02 80 00 05 be 40017304 <_Timer_server_Body+0xd4> 400172f4: 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 ) { 400172f8: 80 a0 60 03 cmp %g1, 3 400172fc: 12 bf ff f5 bne 400172d0 <_Timer_server_Body+0xa0> <== NEVER TAKEN 40017300: 90 10 00 11 mov %l1, %o0 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 40017304: 40 00 11 e1 call 4001ba88 <_Watchdog_Insert> 40017308: 92 02 60 10 add %o1, 0x10, %o1 4001730c: 30 bf ff f1 b,a 400172d0 <_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 ); 40017310: 7f ff e0 3d call 4000f404 40017314: 01 00 00 00 nop tmp = ts->insert_chain; 40017318: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 if ( _Chain_Is_empty( insert_chain ) ) { 4001731c: c2 07 bf f4 ld [ %fp + -12 ], %g1 40017320: 80 a0 40 17 cmp %g1, %l7 40017324: 12 80 00 04 bne 40017334 <_Timer_server_Body+0x104> <== NEVER TAKEN 40017328: a0 10 20 01 mov 1, %l0 ts->insert_chain = NULL; 4001732c: c0 26 20 78 clr [ %i0 + 0x78 ] do_loop = false; 40017330: a0 10 20 00 clr %l0 } _ISR_Enable( level ); 40017334: 7f ff e0 38 call 4000f414 40017338: 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 ) { 4001733c: 80 8c 20 ff btst 0xff, %l0 40017340: 12 bf ff ce bne 40017278 <_Timer_server_Body+0x48> <== NEVER TAKEN 40017344: 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 ) ) { 40017348: 80 a0 40 13 cmp %g1, %l3 4001734c: 02 80 00 18 be 400173ac <_Timer_server_Body+0x17c> 40017350: 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 ); 40017354: 7f ff e0 2c call 4000f404 40017358: 01 00 00 00 nop 4001735c: 84 10 00 08 mov %o0, %g2 initialized = false; } #endif return status; } 40017360: 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)) 40017364: 80 a4 00 13 cmp %l0, %l3 40017368: 02 80 00 0e be 400173a0 <_Timer_server_Body+0x170> 4001736c: 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; 40017370: c2 04 00 00 ld [ %l0 ], %g1 head->next = new_first; 40017374: 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 ) { 40017378: 02 80 00 0a be 400173a0 <_Timer_server_Body+0x170> <== NEVER TAKEN 4001737c: e4 20 60 04 st %l2, [ %g1 + 4 ] watchdog->state = WATCHDOG_INACTIVE; 40017380: c0 24 20 08 clr [ %l0 + 8 ] _ISR_Enable( level ); 40017384: 7f ff e0 24 call 4000f414 40017388: 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 ); 4001738c: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40017390: d0 04 20 20 ld [ %l0 + 0x20 ], %o0 40017394: 9f c0 40 00 call %g1 40017398: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 } 4001739c: 30 bf ff ee b,a 40017354 <_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 ); 400173a0: 7f ff e0 1d call 4000f414 400173a4: 90 10 00 02 mov %g2, %o0 400173a8: 30 bf ff b3 b,a 40017274 <_Timer_server_Body+0x44> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 400173ac: c0 2e 20 7c clrb [ %i0 + 0x7c ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); 400173b0: 7f ff ff 70 call 40017170 <_Thread_Disable_dispatch> 400173b4: 01 00 00 00 nop _Thread_Set_state( ts->thread, STATES_DELAYING ); 400173b8: d0 06 00 00 ld [ %i0 ], %o0 400173bc: 40 00 0f 83 call 4001b1c8 <_Thread_Set_state> 400173c0: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 400173c4: 7f ff ff 71 call 40017188 <_Timer_server_Reset_interval_system_watchdog> 400173c8: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 400173cc: 7f ff ff 84 call 400171dc <_Timer_server_Reset_tod_system_watchdog> 400173d0: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 400173d4: 40 00 0d 16 call 4001a82c <_Thread_Enable_dispatch> 400173d8: 01 00 00 00 nop ts->active = true; 400173dc: 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 ); 400173e0: 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; 400173e4: 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 ); 400173e8: 40 00 12 02 call 4001bbf0 <_Watchdog_Remove> 400173ec: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 400173f0: 40 00 12 00 call 4001bbf0 <_Watchdog_Remove> 400173f4: 90 10 00 15 mov %l5, %o0 400173f8: 30 bf ff 9f b,a 40017274 <_Timer_server_Body+0x44> =============================================================================== 400173fc <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 400173fc: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 40017400: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 40017404: 80 a0 60 00 cmp %g1, 0 40017408: 12 80 00 49 bne 4001752c <_Timer_server_Schedule_operation_method+0x130> 4001740c: 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(); 40017410: 7f ff ff 58 call 40017170 <_Thread_Disable_dispatch> 40017414: 01 00 00 00 nop if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 40017418: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 4001741c: 80 a0 60 01 cmp %g1, 1 40017420: 12 80 00 1f bne 4001749c <_Timer_server_Schedule_operation_method+0xa0> 40017424: 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 ); 40017428: 7f ff df f7 call 4000f404 4001742c: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 40017430: 03 10 00 fb sethi %hi(0x4003ec00), %g1 40017434: c4 00 63 f0 ld [ %g1 + 0x3f0 ], %g2 ! 4003eff0 <_Watchdog_Ticks_since_boot> initialized = false; } #endif return status; } 40017438: 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; 4001743c: 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 ); 40017440: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 40017444: 80 a0 40 03 cmp %g1, %g3 40017448: 02 80 00 08 be 40017468 <_Timer_server_Schedule_operation_method+0x6c> 4001744c: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 40017450: da 00 60 10 ld [ %g1 + 0x10 ], %o5 if (delta_interval > delta) { 40017454: 80 a3 40 04 cmp %o5, %g4 40017458: 08 80 00 03 bleu 40017464 <_Timer_server_Schedule_operation_method+0x68> 4001745c: 86 10 20 00 clr %g3 delta_interval -= delta; 40017460: 86 23 40 04 sub %o5, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 40017464: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 40017468: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 4001746c: 7f ff df ea call 4000f414 40017470: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 40017474: 90 06 20 30 add %i0, 0x30, %o0 40017478: 40 00 11 84 call 4001ba88 <_Watchdog_Insert> 4001747c: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 40017480: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 40017484: 80 a0 60 00 cmp %g1, 0 40017488: 12 80 00 27 bne 40017524 <_Timer_server_Schedule_operation_method+0x128> 4001748c: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 40017490: 7f ff ff 3e call 40017188 <_Timer_server_Reset_interval_system_watchdog> 40017494: 90 10 00 18 mov %i0, %o0 40017498: 30 80 00 23 b,a 40017524 <_Timer_server_Schedule_operation_method+0x128> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 4001749c: 12 80 00 22 bne 40017524 <_Timer_server_Schedule_operation_method+0x128> 400174a0: 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 ); 400174a4: 7f ff df d8 call 4000f404 400174a8: 01 00 00 00 nop initialized = false; } #endif return status; } 400174ac: 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; 400174b0: 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(); 400174b4: 03 10 00 fb sethi %hi(0x4003ec00), %g1 400174b8: 86 06 20 6c add %i0, 0x6c, %g3 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 400174bc: 80 a0 80 03 cmp %g2, %g3 400174c0: 02 80 00 0d be 400174f4 <_Timer_server_Schedule_operation_method+0xf8> 400174c4: c2 00 63 68 ld [ %g1 + 0x368 ], %g1 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 400174c8: c8 00 a0 10 ld [ %g2 + 0x10 ], %g4 if ( snapshot > last_snapshot ) { 400174cc: 80 a0 40 0d cmp %g1, %o5 } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 400174d0: 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 ) { 400174d4: 08 80 00 07 bleu 400174f0 <_Timer_server_Schedule_operation_method+0xf4> 400174d8: 86 20 c0 01 sub %g3, %g1, %g3 /* * We advanced in time. */ delta = snapshot - last_snapshot; 400174dc: 9a 20 40 0d sub %g1, %o5, %o5 if (delta_interval > delta) { 400174e0: 80 a1 00 0d cmp %g4, %o5 400174e4: 08 80 00 03 bleu 400174f0 <_Timer_server_Schedule_operation_method+0xf4><== NEVER TAKEN 400174e8: 86 10 20 00 clr %g3 delta_interval -= delta; 400174ec: 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; 400174f0: c6 20 a0 10 st %g3, [ %g2 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 400174f4: c2 26 20 74 st %g1, [ %i0 + 0x74 ] _ISR_Enable( level ); 400174f8: 7f ff df c7 call 4000f414 400174fc: 01 00 00 00 nop _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 40017500: 90 06 20 68 add %i0, 0x68, %o0 40017504: 40 00 11 61 call 4001ba88 <_Watchdog_Insert> 40017508: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 4001750c: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 40017510: 80 a0 60 00 cmp %g1, 0 40017514: 12 80 00 04 bne 40017524 <_Timer_server_Schedule_operation_method+0x128> 40017518: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 4001751c: 7f ff ff 30 call 400171dc <_Timer_server_Reset_tod_system_watchdog> 40017520: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 40017524: 40 00 0c c2 call 4001a82c <_Thread_Enable_dispatch> 40017528: 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 ); 4001752c: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 40017530: 40 00 02 31 call 40017df4 <_Chain_Append> 40017534: 81 e8 00 00 restore =============================================================================== 40009d5c <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 40009d5c: 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 ); } } 40009d60: 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 ); 40009d64: b2 0e 60 ff and %i1, 0xff, %i1 } } 40009d68: a2 14 62 18 or %l1, 0x218, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 40009d6c: 10 80 00 09 b 40009d90 <_User_extensions_Fatal+0x34> 40009d70: 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 ) 40009d74: 80 a0 60 00 cmp %g1, 0 40009d78: 02 80 00 05 be 40009d8c <_User_extensions_Fatal+0x30> 40009d7c: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 40009d80: 92 10 00 19 mov %i1, %o1 40009d84: 9f c0 40 00 call %g1 40009d88: 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 ) { 40009d8c: 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 ); 40009d90: 80 a4 00 11 cmp %l0, %l1 40009d94: 32 bf ff f8 bne,a 40009d74 <_User_extensions_Fatal+0x18> <== ALWAYS TAKEN 40009d98: 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 ); } } 40009d9c: 81 c7 e0 08 ret <== NOT EXECUTED 40009da0: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40009c20 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 40009c20: 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; 40009c24: 03 10 00 56 sethi %hi(0x40015800), %g1 40009c28: 82 10 61 58 or %g1, 0x158, %g1 ! 40015958 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40009c2c: 05 10 00 59 sethi %hi(0x40016400), %g2 initial_extensions = Configuration.User_extension_table; 40009c30: e6 00 60 40 ld [ %g1 + 0x40 ], %l3 User_extensions_Control *extension; uint32_t i; uint32_t number_of_extensions; User_extensions_Table *initial_extensions; number_of_extensions = Configuration.number_of_initial_extensions; 40009c34: e4 00 60 3c ld [ %g1 + 0x3c ], %l2 40009c38: 82 10 a2 18 or %g2, 0x218, %g1 40009c3c: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40009c40: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 40009c44: 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; 40009c48: c6 20 a2 18 st %g3, [ %g2 + 0x218 ] 40009c4c: 05 10 00 59 sethi %hi(0x40016400), %g2 40009c50: 82 10 a0 14 or %g2, 0x14, %g1 ! 40016414 <_User_extensions_Switches_list> 40009c54: 86 00 60 04 add %g1, 4, %g3 head->previous = NULL; 40009c58: c0 20 60 04 clr [ %g1 + 4 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40009c5c: c6 20 a0 14 st %g3, [ %g2 + 0x14 ] initial_extensions = Configuration.User_extension_table; _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 40009c60: 80 a4 e0 00 cmp %l3, 0 40009c64: 02 80 00 1b be 40009cd0 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 40009c68: c2 20 60 08 st %g1, [ %g1 + 8 ] extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) 40009c6c: 83 2c a0 02 sll %l2, 2, %g1 40009c70: a1 2c a0 04 sll %l2, 4, %l0 40009c74: a0 24 00 01 sub %l0, %g1, %l0 40009c78: a0 04 00 12 add %l0, %l2, %l0 40009c7c: 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( 40009c80: 40 00 01 6a call 4000a228 <_Workspace_Allocate_or_fatal_error> 40009c84: 90 10 00 10 mov %l0, %o0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40009c88: 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( 40009c8c: a2 10 00 08 mov %o0, %l1 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 40009c90: 92 10 20 00 clr %o1 40009c94: 40 00 17 88 call 4000fab4 40009c98: a0 10 20 00 clr %l0 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 40009c9c: 10 80 00 0b b 40009cc8 <_User_extensions_Handler_initialization+0xa8> 40009ca0: 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; 40009ca4: 90 04 60 14 add %l1, 0x14, %o0 40009ca8: 92 04 c0 09 add %l3, %o1, %o1 40009cac: 40 00 17 49 call 4000f9d0 40009cb0: 94 10 20 20 mov 0x20, %o2 _User_extensions_Add_set( extension ); 40009cb4: 90 10 00 11 mov %l1, %o0 40009cb8: 40 00 0e 26 call 4000d550 <_User_extensions_Add_set> 40009cbc: a0 04 20 01 inc %l0 _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; 40009cc0: 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++ ) { 40009cc4: 80 a4 00 12 cmp %l0, %l2 40009cc8: 0a bf ff f7 bcs 40009ca4 <_User_extensions_Handler_initialization+0x84> 40009ccc: 93 2c 20 05 sll %l0, 5, %o1 40009cd0: 81 c7 e0 08 ret 40009cd4: 81 e8 00 00 restore =============================================================================== 4000bf00 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4000bf00: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 4000bf04: 7f ff db 97 call 40002d60 4000bf08: a0 10 00 18 mov %i0, %l0 } } _ISR_Enable( level ); } 4000bf0c: 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 ); 4000bf10: 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 ) ) { 4000bf14: 80 a0 40 11 cmp %g1, %l1 4000bf18: 02 80 00 1f be 4000bf94 <_Watchdog_Adjust+0x94> 4000bf1c: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 4000bf20: 02 80 00 1a be 4000bf88 <_Watchdog_Adjust+0x88> 4000bf24: a4 10 20 01 mov 1, %l2 4000bf28: 80 a6 60 01 cmp %i1, 1 4000bf2c: 12 80 00 1a bne 4000bf94 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000bf30: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4000bf34: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000bf38: 10 80 00 07 b 4000bf54 <_Watchdog_Adjust+0x54> 4000bf3c: b4 00 80 1a add %g2, %i2, %i2 break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { 4000bf40: f2 00 60 10 ld [ %g1 + 0x10 ], %i1 4000bf44: 80 a6 80 19 cmp %i2, %i1 4000bf48: 3a 80 00 05 bcc,a 4000bf5c <_Watchdog_Adjust+0x5c> 4000bf4c: e4 20 60 10 st %l2, [ %g1 + 0x10 ] _Watchdog_First( header )->delta_interval -= units; 4000bf50: b4 26 40 1a sub %i1, %i2, %i2 break; 4000bf54: 10 80 00 10 b 4000bf94 <_Watchdog_Adjust+0x94> 4000bf58: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; _ISR_Enable( level ); 4000bf5c: 7f ff db 85 call 40002d70 4000bf60: 01 00 00 00 nop _Watchdog_Tickle( header ); 4000bf64: 40 00 00 92 call 4000c1ac <_Watchdog_Tickle> 4000bf68: 90 10 00 10 mov %l0, %o0 _ISR_Disable( level ); 4000bf6c: 7f ff db 7d call 40002d60 4000bf70: 01 00 00 00 nop if ( _Chain_Is_empty( header ) ) 4000bf74: c2 04 00 00 ld [ %l0 ], %g1 4000bf78: 80 a0 40 11 cmp %g1, %l1 4000bf7c: 02 80 00 06 be 4000bf94 <_Watchdog_Adjust+0x94> 4000bf80: 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; 4000bf84: 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 ) { 4000bf88: 80 a6 a0 00 cmp %i2, 0 4000bf8c: 32 bf ff ed bne,a 4000bf40 <_Watchdog_Adjust+0x40> <== ALWAYS TAKEN 4000bf90: c2 04 00 00 ld [ %l0 ], %g1 } break; } } _ISR_Enable( level ); 4000bf94: 7f ff db 77 call 40002d70 4000bf98: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 4000a03c <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 4000a03c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 4000a040: 7f ff df 3d call 40001d34 4000a044: a0 10 00 18 mov %i0, %l0 previous_state = the_watchdog->state; 4000a048: f0 06 20 08 ld [ %i0 + 8 ], %i0 switch ( previous_state ) { 4000a04c: 80 a6 20 01 cmp %i0, 1 4000a050: 22 80 00 1d be,a 4000a0c4 <_Watchdog_Remove+0x88> 4000a054: c0 24 20 08 clr [ %l0 + 8 ] 4000a058: 0a 80 00 1c bcs 4000a0c8 <_Watchdog_Remove+0x8c> 4000a05c: 03 10 00 59 sethi %hi(0x40016400), %g1 4000a060: 80 a6 20 03 cmp %i0, 3 4000a064: 18 80 00 19 bgu 4000a0c8 <_Watchdog_Remove+0x8c> <== NEVER TAKEN 4000a068: 01 00 00 00 nop 4000a06c: c2 04 00 00 ld [ %l0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 4000a070: c0 24 20 08 clr [ %l0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 4000a074: c4 00 40 00 ld [ %g1 ], %g2 4000a078: 80 a0 a0 00 cmp %g2, 0 4000a07c: 02 80 00 07 be 4000a098 <_Watchdog_Remove+0x5c> 4000a080: 05 10 00 59 sethi %hi(0x40016400), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 4000a084: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 4000a088: c4 04 20 10 ld [ %l0 + 0x10 ], %g2 4000a08c: 84 00 c0 02 add %g3, %g2, %g2 4000a090: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 4000a094: 05 10 00 59 sethi %hi(0x40016400), %g2 4000a098: c4 00 a1 3c ld [ %g2 + 0x13c ], %g2 ! 4001653c <_Watchdog_Sync_count> 4000a09c: 80 a0 a0 00 cmp %g2, 0 4000a0a0: 22 80 00 07 be,a 4000a0bc <_Watchdog_Remove+0x80> 4000a0a4: c4 04 20 04 ld [ %l0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 4000a0a8: 05 10 00 5a sethi %hi(0x40016800), %g2 4000a0ac: c6 00 a1 70 ld [ %g2 + 0x170 ], %g3 ! 40016970 <_Per_CPU_Information+0x8> 4000a0b0: 05 10 00 59 sethi %hi(0x40016400), %g2 4000a0b4: c6 20 a0 d4 st %g3, [ %g2 + 0xd4 ] ! 400164d4 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4000a0b8: c4 04 20 04 ld [ %l0 + 4 ], %g2 next->previous = previous; 4000a0bc: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 4000a0c0: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000a0c4: 03 10 00 59 sethi %hi(0x40016400), %g1 4000a0c8: c2 00 61 40 ld [ %g1 + 0x140 ], %g1 ! 40016540 <_Watchdog_Ticks_since_boot> 4000a0cc: c2 24 20 18 st %g1, [ %l0 + 0x18 ] _ISR_Enable( level ); 4000a0d0: 7f ff df 1d call 40001d44 4000a0d4: 01 00 00 00 nop return( previous_state ); } 4000a0d8: 81 c7 e0 08 ret 4000a0dc: 81 e8 00 00 restore =============================================================================== 4000b71c <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4000b71c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4000b720: 7f ff dc 67 call 400028bc 4000b724: a0 10 00 18 mov %i0, %l0 4000b728: b0 10 00 08 mov %o0, %i0 printk( "Watchdog Chain: %s %p\n", name, header ); 4000b72c: 11 10 00 79 sethi %hi(0x4001e400), %o0 4000b730: 94 10 00 19 mov %i1, %o2 4000b734: 90 12 23 28 or %o0, 0x328, %o0 4000b738: 7f ff e6 3c call 40005028 4000b73c: 92 10 00 10 mov %l0, %o1 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 4000b740: 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 ); 4000b744: 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 ) ) { 4000b748: 80 a4 40 19 cmp %l1, %i1 4000b74c: 02 80 00 0e be 4000b784 <_Watchdog_Report_chain+0x68> 4000b750: 11 10 00 79 sethi %hi(0x4001e400), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4000b754: 92 10 00 11 mov %l1, %o1 4000b758: 40 00 00 10 call 4000b798 <_Watchdog_Report> 4000b75c: 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 ) 4000b760: 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 ) ; 4000b764: 80 a4 40 19 cmp %l1, %i1 4000b768: 12 bf ff fc bne 4000b758 <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 4000b76c: 92 10 00 11 mov %l1, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4000b770: 11 10 00 79 sethi %hi(0x4001e400), %o0 4000b774: 92 10 00 10 mov %l0, %o1 4000b778: 7f ff e6 2c call 40005028 4000b77c: 90 12 23 40 or %o0, 0x340, %o0 4000b780: 30 80 00 03 b,a 4000b78c <_Watchdog_Report_chain+0x70> } else { printk( "Chain is empty\n" ); 4000b784: 7f ff e6 29 call 40005028 4000b788: 90 12 23 50 or %o0, 0x350, %o0 } _ISR_Enable( level ); 4000b78c: 7f ff dc 50 call 400028cc 4000b790: 81 e8 00 00 restore =============================================================================== 40007344 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 40007344: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 40007348: 21 10 00 64 sethi %hi(0x40019000), %l0 4000734c: 40 00 04 60 call 400084cc 40007350: 90 14 23 44 or %l0, 0x344, %o0 ! 40019344 if (aiocbp == NULL) 40007354: 80 a6 60 00 cmp %i1, 0 40007358: 32 80 00 3f bne,a 40007454 4000735c: e2 06 40 00 ld [ %i1 ], %l1 { if (fcntl (fildes, F_GETFL) < 0) { 40007360: 90 10 00 18 mov %i0, %o0 40007364: 40 00 1c 6e call 4000e51c 40007368: 92 10 20 03 mov 3, %o1 4000736c: 80 a2 20 00 cmp %o0, 0 40007370: 36 80 00 08 bge,a 40007390 <== NEVER TAKEN 40007374: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED pthread_mutex_unlock(&aio_request_queue.mutex); 40007378: 40 00 04 76 call 40008550 4000737c: 90 14 23 44 or %l0, 0x344, %o0 rtems_set_errno_and_return_minus_one (EBADF); 40007380: 40 00 2a 18 call 40011be0 <__errno> 40007384: 01 00 00 00 nop 40007388: 10 80 00 50 b 400074c8 4000738c: 82 10 20 09 mov 9, %g1 ! 9 } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40007390: 92 10 00 18 mov %i0, %o1 <== NOT EXECUTED 40007394: 90 12 23 8c or %o0, 0x38c, %o0 <== NOT EXECUTED 40007398: 40 00 00 be call 40007690 <== NOT EXECUTED 4000739c: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) 400073a0: a2 92 20 00 orcc %o0, 0, %l1 <== NOT EXECUTED 400073a4: 12 80 00 1f bne 40007420 <== NOT EXECUTED 400073a8: b2 04 60 1c add %l1, 0x1c, %i1 <== NOT EXECUTED return result; } return AIO_ALLDONE; } 400073ac: a0 14 23 44 or %l0, 0x344, %l0 <== NOT EXECUTED r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) 400073b0: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 <== NOT EXECUTED 400073b4: 82 04 20 58 add %l0, 0x58, %g1 <== NOT EXECUTED 400073b8: 80 a0 80 01 cmp %g2, %g1 <== NOT EXECUTED 400073bc: 02 80 00 14 be 4000740c <== NOT EXECUTED 400073c0: 90 04 20 54 add %l0, 0x54, %o0 <== NOT EXECUTED { r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, 400073c4: 92 10 00 18 mov %i0, %o1 <== NOT EXECUTED 400073c8: 40 00 00 b2 call 40007690 <== NOT EXECUTED 400073cc: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) { 400073d0: a2 92 20 00 orcc %o0, 0, %l1 <== NOT EXECUTED 400073d4: 22 80 00 0f be,a 40007410 <== NOT EXECUTED 400073d8: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 400073dc: 40 00 0a bc call 40009ecc <_Chain_Extract> <== NOT EXECUTED 400073e0: b2 04 60 1c add %l1, 0x1c, %i1 <== NOT EXECUTED pthread_mutex_unlock(&aio_request_queue.mutex); return AIO_ALLDONE; } rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 400073e4: 40 00 01 8f call 40007a20 <== NOT EXECUTED 400073e8: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_mutex_destroy (&r_chain->mutex); 400073ec: 40 00 03 8f call 40008228 <== NOT EXECUTED 400073f0: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED pthread_cond_destroy (&r_chain->mutex); 400073f4: 40 00 02 b1 call 40007eb8 <== NOT EXECUTED 400073f8: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED free (r_chain); 400073fc: 7f ff f3 2c call 400040ac <== NOT EXECUTED 40007400: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 40007404: 10 80 00 10 b 40007444 <== NOT EXECUTED 40007408: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return AIO_CANCELED; } pthread_mutex_unlock (&aio_request_queue.mutex); 4000740c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40007410: 40 00 04 50 call 40008550 <== NOT EXECUTED 40007414: b0 10 20 02 mov 2, %i0 <== NOT EXECUTED return AIO_ALLDONE; 40007418: 81 c7 e0 08 ret <== NOT EXECUTED 4000741c: 81 e8 00 00 restore <== NOT EXECUTED } pthread_mutex_lock (&r_chain->mutex); 40007420: 40 00 04 2b call 400084cc <== NOT EXECUTED 40007424: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 40007428: 40 00 0a a9 call 40009ecc <_Chain_Extract> <== NOT EXECUTED 4000742c: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40007430: 40 00 01 7c call 40007a20 <== NOT EXECUTED 40007434: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); 40007438: 40 00 04 46 call 40008550 <== NOT EXECUTED 4000743c: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 40007440: 90 14 23 44 or %l0, 0x344, %o0 <== NOT EXECUTED 40007444: 40 00 04 43 call 40008550 <== NOT EXECUTED 40007448: b0 10 20 00 clr %i0 <== NOT EXECUTED return AIO_CANCELED; 4000744c: 81 c7 e0 08 ret <== NOT EXECUTED 40007450: 81 e8 00 00 restore <== NOT EXECUTED } else { if (aiocbp->aio_fildes != fildes) { 40007454: 80 a4 40 18 cmp %l1, %i0 40007458: 12 80 00 17 bne 400074b4 <== ALWAYS TAKEN 4000745c: 90 14 23 44 or %l0, 0x344, %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, 40007460: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED 40007464: 92 10 00 11 mov %l1, %o1 <== NOT EXECUTED 40007468: 90 12 23 8c or %o0, 0x38c, %o0 <== NOT EXECUTED 4000746c: 40 00 00 89 call 40007690 <== NOT EXECUTED 40007470: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) 40007474: b0 92 20 00 orcc %o0, 0, %i0 <== NOT EXECUTED 40007478: 32 80 00 1f bne,a 400074f4 <== NOT EXECUTED 4000747c: a0 06 20 1c add %i0, 0x1c, %l0 <== NOT EXECUTED return result; } return AIO_ALLDONE; } 40007480: a0 14 23 44 or %l0, 0x344, %l0 <== NOT EXECUTED r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) 40007484: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 <== NOT EXECUTED 40007488: 82 04 20 58 add %l0, 0x58, %g1 <== NOT EXECUTED 4000748c: 80 a0 80 01 cmp %g2, %g1 <== NOT EXECUTED 40007490: 02 80 00 18 be 400074f0 <== NOT EXECUTED 40007494: 92 10 00 11 mov %l1, %o1 <== NOT EXECUTED { r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, 40007498: 90 04 20 54 add %l0, 0x54, %o0 <== NOT EXECUTED 4000749c: 40 00 00 7d call 40007690 <== NOT EXECUTED 400074a0: 94 10 20 00 clr %o2 <== NOT EXECUTED fildes, 0); if (r_chain == NULL) 400074a4: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 400074a8: 12 80 00 0b bne 400074d4 <== NOT EXECUTED 400074ac: 01 00 00 00 nop <== NOT EXECUTED { pthread_mutex_unlock (&aio_request_queue.mutex); 400074b0: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 400074b4: 40 00 04 27 call 40008550 400074b8: 01 00 00 00 nop rtems_set_errno_and_return_minus_one (EINVAL); 400074bc: 40 00 29 c9 call 40011be0 <__errno> 400074c0: 01 00 00 00 nop 400074c4: 82 10 20 16 mov 0x16, %g1 ! 16 400074c8: c2 22 00 00 st %g1, [ %o0 ] 400074cc: 81 c7 e0 08 ret 400074d0: 91 e8 3f ff restore %g0, -1, %o0 } result = rtems_aio_remove_req (&r_chain->next_fd, aiocbp); 400074d4: 40 00 01 65 call 40007a68 <== NOT EXECUTED 400074d8: 92 10 00 19 mov %i1, %o1 <== NOT EXECUTED 400074dc: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 400074e0: 40 00 04 1c call 40008550 <== NOT EXECUTED 400074e4: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return result; 400074e8: 81 c7 e0 08 ret <== NOT EXECUTED 400074ec: 81 e8 00 00 restore <== NOT EXECUTED } pthread_mutex_lock (&r_chain->mutex); 400074f0: a0 06 20 1c add %i0, 0x1c, %l0 <== NOT EXECUTED 400074f4: 40 00 03 f6 call 400084cc <== NOT EXECUTED 400074f8: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED result = rtems_aio_remove_req (&r_chain->next_fd, aiocbp); 400074fc: 92 10 00 19 mov %i1, %o1 <== NOT EXECUTED 40007500: 40 00 01 5a call 40007a68 <== NOT EXECUTED 40007504: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED 40007508: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); 4000750c: 40 00 04 11 call 40008550 <== NOT EXECUTED 40007510: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 40007514: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED 40007518: 40 00 04 0e call 40008550 <== NOT EXECUTED 4000751c: 90 12 23 44 or %o0, 0x344, %o0 ! 40019344 <== NOT EXECUTED return result; } return AIO_ALLDONE; } 40007520: 81 c7 e0 08 ret <== NOT EXECUTED 40007524: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40007530 : int aio_fsync( int op, struct aiocb *aiocbp ) { 40007530: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; if (op != O_SYNC) 40007534: 03 00 00 08 sethi %hi(0x2000), %g1 40007538: 80 a6 00 01 cmp %i0, %g1 4000753c: 12 80 00 10 bne 4000757c 40007540: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007544: d0 06 40 00 ld [ %i1 ], %o0 40007548: 40 00 1b f5 call 4000e51c 4000754c: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40007550: 90 0a 20 03 and %o0, 3, %o0 40007554: 90 02 3f ff add %o0, -1, %o0 40007558: 80 a2 20 01 cmp %o0, 1 4000755c: 18 80 00 08 bgu 4000757c <== ALWAYS TAKEN 40007560: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007564: 7f ff f4 52 call 400046ac <== NOT EXECUTED 40007568: 90 10 20 18 mov 0x18, %o0 <== NOT EXECUTED if (req == NULL) 4000756c: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40007570: 32 80 00 0b bne,a 4000759c <== NOT EXECUTED 40007574: f2 22 20 14 st %i1, [ %o0 + 0x14 ] <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007578: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED 4000757c: 82 10 3f ff mov -1, %g1 40007580: e0 26 60 34 st %l0, [ %i1 + 0x34 ] 40007584: c2 26 60 38 st %g1, [ %i1 + 0x38 ] 40007588: 40 00 29 96 call 40011be0 <__errno> 4000758c: b0 10 3f ff mov -1, %i0 40007590: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } 40007594: 81 c7 e0 08 ret 40007598: 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; 4000759c: 82 10 20 03 mov 3, %g1 <== NOT EXECUTED 400075a0: c2 26 60 30 st %g1, [ %i1 + 0x30 ] <== NOT EXECUTED return rtems_aio_enqueue (req); 400075a4: 40 00 01 49 call 40007ac8 <== NOT EXECUTED 400075a8: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED =============================================================================== 40007cf4 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 40007cf4: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007cf8: d0 06 00 00 ld [ %i0 ], %o0 40007cfc: 40 00 1a 08 call 4000e51c 40007d00: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40007d04: 90 0a 20 03 and %o0, 3, %o0 40007d08: 80 a2 20 02 cmp %o0, 2 40007d0c: 02 80 00 05 be 40007d20 40007d10: a0 10 00 18 mov %i0, %l0 40007d14: 80 a2 20 00 cmp %o0, 0 40007d18: 12 80 00 10 bne 40007d58 <== ALWAYS TAKEN 40007d1c: 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) 40007d20: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40007d24: 80 a0 60 00 cmp %g1, 0 40007d28: 32 80 00 0c bne,a 40007d58 40007d2c: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007d30: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007d34: 80 a0 60 00 cmp %g1, 0 40007d38: 26 80 00 08 bl,a 40007d58 40007d3c: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007d40: 7f ff f2 5b call 400046ac 40007d44: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007d48: 80 a2 20 00 cmp %o0, 0 40007d4c: 32 80 00 0b bne,a 40007d78 <== ALWAYS TAKEN 40007d50: e0 22 20 14 st %l0, [ %o0 + 0x14 ] 40007d54: a2 10 20 0b mov 0xb, %l1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007d58: 82 10 3f ff mov -1, %g1 40007d5c: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40007d60: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40007d64: 40 00 27 9f call 40011be0 <__errno> 40007d68: b0 10 3f ff mov -1, %i0 40007d6c: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; return rtems_aio_enqueue (req); } 40007d70: 81 c7 e0 08 ret 40007d74: 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; 40007d78: 82 10 20 01 mov 1, %g1 40007d7c: c2 24 20 30 st %g1, [ %l0 + 0x30 ] return rtems_aio_enqueue (req); 40007d80: 7f ff ff 52 call 40007ac8 40007d84: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40007d94 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40007d94: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007d98: d0 06 00 00 ld [ %i0 ], %o0 40007d9c: 40 00 19 e0 call 4000e51c 40007da0: 92 10 20 03 mov 3, %o1 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40007da4: 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))) 40007da8: 90 0a 20 03 and %o0, 3, %o0 40007dac: 90 02 3f ff add %o0, -1, %o0 40007db0: 80 a2 20 01 cmp %o0, 1 40007db4: 18 80 00 10 bgu 40007df4 40007db8: 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) 40007dbc: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 40007dc0: 80 a0 60 00 cmp %g1, 0 40007dc4: 32 80 00 0c bne,a 40007df4 40007dc8: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007dcc: c2 06 20 08 ld [ %i0 + 8 ], %g1 40007dd0: 80 a0 60 00 cmp %g1, 0 40007dd4: 26 80 00 08 bl,a 40007df4 40007dd8: a2 10 20 16 mov 0x16, %l1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007ddc: 7f ff f2 34 call 400046ac 40007de0: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007de4: 80 a2 20 00 cmp %o0, 0 40007de8: 32 80 00 0b bne,a 40007e14 <== ALWAYS TAKEN 40007dec: f0 22 20 14 st %i0, [ %o0 + 0x14 ] 40007df0: a2 10 20 0b mov 0xb, %l1 <== NOT EXECUTED rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007df4: 82 10 3f ff mov -1, %g1 40007df8: e2 24 20 34 st %l1, [ %l0 + 0x34 ] 40007dfc: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40007e00: 40 00 27 78 call 40011be0 <__errno> 40007e04: b0 10 3f ff mov -1, %i0 40007e08: e2 22 00 00 st %l1, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; return rtems_aio_enqueue (req); } 40007e0c: 81 c7 e0 08 ret 40007e10: 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; 40007e14: 82 10 20 02 mov 2, %g1 40007e18: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 40007e1c: 7f ff ff 2b call 40007ac8 40007e20: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006958 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 40006958: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 4000695c: 90 96 60 00 orcc %i1, 0, %o0 40006960: 12 80 00 06 bne 40006978 40006964: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); 40006968: 40 00 26 60 call 400102e8 <__errno> 4000696c: 01 00 00 00 nop 40006970: 10 80 00 15 b 400069c4 40006974: 82 10 20 16 mov 0x16, %g1 ! 16 if ( clock_id == CLOCK_REALTIME ) { 40006978: 12 80 00 05 bne 4000698c 4000697c: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); 40006980: 40 00 07 dc call 400088f0 <_TOD_Get> 40006984: b0 10 20 00 clr %i0 40006988: 30 80 00 16 b,a 400069e0 return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 4000698c: 02 80 00 05 be 400069a0 <== NEVER TAKEN 40006990: 01 00 00 00 nop return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 40006994: 80 a6 20 02 cmp %i0, 2 40006998: 12 80 00 06 bne 400069b0 4000699c: 80 a6 20 03 cmp %i0, 3 _TOD_Get_uptime_as_timespec( tp ); 400069a0: 40 00 07 f3 call 4000896c <_TOD_Get_uptime_as_timespec> 400069a4: b0 10 20 00 clr %i0 return 0; 400069a8: 81 c7 e0 08 ret 400069ac: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 400069b0: 12 80 00 08 bne 400069d0 400069b4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 400069b8: 40 00 26 4c call 400102e8 <__errno> 400069bc: 01 00 00 00 nop 400069c0: 82 10 20 58 mov 0x58, %g1 ! 58 400069c4: c2 22 00 00 st %g1, [ %o0 ] 400069c8: 81 c7 e0 08 ret 400069cc: 91 e8 3f ff restore %g0, -1, %o0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); 400069d0: 40 00 26 46 call 400102e8 <__errno> 400069d4: b0 10 3f ff mov -1, %i0 400069d8: 82 10 20 16 mov 0x16, %g1 400069dc: c2 22 00 00 st %g1, [ %o0 ] return 0; } 400069e0: 81 c7 e0 08 ret 400069e4: 81 e8 00 00 restore =============================================================================== 400069e8 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 400069e8: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 400069ec: 90 96 60 00 orcc %i1, 0, %o0 400069f0: 02 80 00 0b be 40006a1c <== NEVER TAKEN 400069f4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 400069f8: 80 a6 20 01 cmp %i0, 1 400069fc: 12 80 00 15 bne 40006a50 40006a00: 80 a6 20 02 cmp %i0, 2 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 40006a04: c4 02 00 00 ld [ %o0 ], %g2 40006a08: 03 08 76 b9 sethi %hi(0x21dae400), %g1 40006a0c: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 40006a10: 80 a0 80 01 cmp %g2, %g1 40006a14: 38 80 00 06 bgu,a 40006a2c 40006a18: 03 10 00 80 sethi %hi(0x40020000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 40006a1c: 40 00 26 33 call 400102e8 <__errno> 40006a20: 01 00 00 00 nop 40006a24: 10 80 00 13 b 40006a70 40006a28: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006a2c: c4 00 60 b0 ld [ %g1 + 0xb0 ], %g2 40006a30: 84 00 a0 01 inc %g2 40006a34: c4 20 60 b0 st %g2, [ %g1 + 0xb0 ] _Thread_Disable_dispatch(); _TOD_Set( tp ); 40006a38: 40 00 07 e3 call 400089c4 <_TOD_Set> 40006a3c: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40006a40: 40 00 0d 6d call 40009ff4 <_Thread_Enable_dispatch> 40006a44: 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; 40006a48: 81 c7 e0 08 ret 40006a4c: 81 e8 00 00 restore _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 40006a50: 02 80 00 05 be 40006a64 40006a54: 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 ) 40006a58: 80 a6 20 03 cmp %i0, 3 40006a5c: 12 80 00 08 bne 40006a7c 40006a60: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 40006a64: 40 00 26 21 call 400102e8 <__errno> 40006a68: 01 00 00 00 nop 40006a6c: 82 10 20 58 mov 0x58, %g1 ! 58 40006a70: c2 22 00 00 st %g1, [ %o0 ] 40006a74: 81 c7 e0 08 ret 40006a78: 91 e8 3f ff restore %g0, -1, %o0 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 40006a7c: 40 00 26 1b call 400102e8 <__errno> 40006a80: b0 10 3f ff mov -1, %i0 40006a84: 82 10 20 16 mov 0x16, %g1 40006a88: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40006a8c: 81 c7 e0 08 ret 40006a90: 81 e8 00 00 restore =============================================================================== 40023fac : int killinfo( pid_t pid, int sig, const union sigval *value ) { 40023fac: 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() ) 40023fb0: 7f ff ff 37 call 40023c8c 40023fb4: 01 00 00 00 nop 40023fb8: 80 a6 00 08 cmp %i0, %o0 40023fbc: 02 80 00 06 be 40023fd4 40023fc0: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40023fc4: 7f ff c2 2e call 4001487c <__errno> 40023fc8: 01 00 00 00 nop 40023fcc: 10 80 00 07 b 40023fe8 40023fd0: 82 10 20 03 mov 3, %g1 ! 3 /* * Validate the signal passed. */ if ( !sig ) 40023fd4: 12 80 00 08 bne 40023ff4 40023fd8: a0 06 7f ff add %i1, -1, %l0 rtems_set_errno_and_return_minus_one( EINVAL ); 40023fdc: 7f ff c2 28 call 4001487c <__errno> 40023fe0: 01 00 00 00 nop 40023fe4: 82 10 20 16 mov 0x16, %g1 ! 16 40023fe8: c2 22 00 00 st %g1, [ %o0 ] 40023fec: 10 80 00 a6 b 40024284 40023ff0: 90 10 3f ff mov -1, %o0 if ( !is_valid_signo(sig) ) 40023ff4: 80 a4 20 1f cmp %l0, 0x1f 40023ff8: 18 bf ff f9 bgu 40023fdc 40023ffc: 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 ) 40024000: 83 2e 60 02 sll %i1, 2, %g1 40024004: 85 2e 60 04 sll %i1, 4, %g2 40024008: 84 20 80 01 sub %g2, %g1, %g2 4002400c: 03 10 00 9f sethi %hi(0x40027c00), %g1 40024010: 82 10 63 c0 or %g1, 0x3c0, %g1 ! 40027fc0 <_POSIX_signals_Vectors> 40024014: 82 00 40 02 add %g1, %g2, %g1 40024018: c2 00 60 08 ld [ %g1 + 8 ], %g1 4002401c: 80 a0 60 01 cmp %g1, 1 40024020: 02 80 00 99 be 40024284 40024024: 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 ) ) 40024028: 80 a6 60 04 cmp %i1, 4 4002402c: 02 80 00 06 be 40024044 40024030: 80 a6 60 08 cmp %i1, 8 40024034: 02 80 00 04 be 40024044 40024038: 80 a6 60 0b cmp %i1, 0xb 4002403c: 12 80 00 08 bne 4002405c 40024040: 82 10 20 01 mov 1, %g1 return pthread_kill( pthread_self(), sig ); 40024044: 40 00 01 27 call 400244e0 40024048: 01 00 00 00 nop 4002404c: 40 00 00 ea call 400243f4 40024050: 92 10 00 19 mov %i1, %o1 40024054: 81 c7 e0 08 ret 40024058: 91 e8 00 08 restore %g0, %o0, %o0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 4002405c: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 40024060: c2 27 bf f8 st %g1, [ %fp + -8 ] if ( !value ) { 40024064: 80 a6 a0 00 cmp %i2, 0 40024068: 12 80 00 04 bne 40024078 4002406c: a1 28 40 10 sll %g1, %l0, %l0 siginfo->si_value.sival_int = 0; 40024070: 10 80 00 04 b 40024080 40024074: c0 27 bf fc clr [ %fp + -4 ] } else { siginfo->si_value = *value; 40024078: c2 06 80 00 ld [ %i2 ], %g1 4002407c: c2 27 bf fc st %g1, [ %fp + -4 ] 40024080: 03 10 00 9e sethi %hi(0x40027800), %g1 40024084: c4 00 62 10 ld [ %g1 + 0x210 ], %g2 ! 40027a10 <_Thread_Dispatch_disable_level> 40024088: 84 00 a0 01 inc %g2 4002408c: c4 20 62 10 st %g2, [ %g1 + 0x210 ] /* * 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; 40024090: 03 10 00 9f sethi %hi(0x40027c00), %g1 40024094: d0 00 63 74 ld [ %g1 + 0x374 ], %o0 ! 40027f74 <_Per_CPU_Information+0xc> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 40024098: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 4002409c: c2 00 60 d0 ld [ %g1 + 0xd0 ], %g1 400240a0: 80 ac 00 01 andncc %l0, %g1, %g0 400240a4: 12 80 00 51 bne 400241e8 400240a8: 03 10 00 a0 sethi %hi(0x40028000), %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 ); 400240ac: 05 10 00 a0 sethi %hi(0x40028000), %g2 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 400240b0: c2 00 61 4c ld [ %g1 + 0x14c ], %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 ); 400240b4: 10 80 00 0b b 400240e0 400240b8: 84 10 a1 50 or %g2, 0x150, %g2 !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 400240bc: 90 10 00 01 mov %g1, %o0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 400240c0: 80 8c 00 04 btst %l0, %g4 400240c4: 12 80 00 49 bne 400241e8 400240c8: 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) 400240cc: c6 00 e0 d0 ld [ %g3 + 0xd0 ], %g3 400240d0: 80 ac 00 03 andncc %l0, %g3, %g0 400240d4: 12 80 00 46 bne 400241ec 400240d8: 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 ) { 400240dc: 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 ); 400240e0: 80 a0 40 02 cmp %g1, %g2 400240e4: 32 bf ff f6 bne,a 400240bc 400240e8: c8 00 60 30 ld [ %g1 + 0x30 ], %g4 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 400240ec: 03 10 00 9b sethi %hi(0x40026c00), %g1 400240f0: c6 08 61 e4 ldub [ %g1 + 0x1e4 ], %g3 ! 40026de4 400240f4: 05 10 00 9e sethi %hi(0x40027800), %g2 400240f8: 86 00 e0 01 inc %g3 400240fc: 84 10 a1 80 or %g2, 0x180, %g2 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 40024100: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 40024104: 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); 40024108: 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 ] ) 4002410c: c2 00 80 00 ld [ %g2 ], %g1 40024110: 80 a0 60 00 cmp %g1, 0 40024114: 22 80 00 2f be,a 400241d0 <== NEVER TAKEN 40024118: 84 00 a0 04 add %g2, 4, %g2 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 4002411c: 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++ ) { 40024120: 9a 10 20 01 mov 1, %o5 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 40024124: f4 10 60 10 lduh [ %g1 + 0x10 ], %i2 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40024128: 10 80 00 26 b 400241c0 4002412c: de 00 60 1c ld [ %g1 + 0x1c ], %o7 the_thread = (Thread_Control *) object_table[ index ]; 40024130: c2 03 c0 01 ld [ %o7 + %g1 ], %g1 if ( !the_thread ) 40024134: 80 a0 60 00 cmp %g1, 0 40024138: 22 80 00 22 be,a 400241c0 4002413c: 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 ) 40024140: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 40024144: 80 a1 00 03 cmp %g4, %g3 40024148: 38 80 00 1e bgu,a 400241c0 4002414c: 9a 03 60 01 inc %o5 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 40024150: d6 00 61 58 ld [ %g1 + 0x158 ], %o3 40024154: d6 02 e0 d0 ld [ %o3 + 0xd0 ], %o3 40024158: 80 ac 00 0b andncc %l0, %o3, %g0 4002415c: 22 80 00 19 be,a 400241c0 40024160: 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 ) { 40024164: 80 a1 00 03 cmp %g4, %g3 40024168: 2a 80 00 14 bcs,a 400241b8 4002416c: 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 ) ) { 40024170: 80 a2 20 00 cmp %o0, 0 40024174: 22 80 00 13 be,a 400241c0 <== NEVER TAKEN 40024178: 9a 03 60 01 inc %o5 <== NOT EXECUTED 4002417c: d4 02 20 10 ld [ %o0 + 0x10 ], %o2 40024180: 80 a2 a0 00 cmp %o2, 0 40024184: 22 80 00 0f be,a 400241c0 <== NEVER TAKEN 40024188: 9a 03 60 01 inc %o5 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 4002418c: d6 00 60 10 ld [ %g1 + 0x10 ], %o3 40024190: 80 a2 e0 00 cmp %o3, 0 40024194: 22 80 00 09 be,a 400241b8 40024198: 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) ) { 4002419c: 80 8a 80 0c btst %o2, %o4 400241a0: 32 80 00 08 bne,a 400241c0 400241a4: 9a 03 60 01 inc %o5 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 400241a8: 80 8a c0 0c btst %o3, %o4 400241ac: 22 80 00 05 be,a 400241c0 400241b0: 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 ) ) { 400241b4: 86 10 00 04 mov %g4, %g3 400241b8: 90 10 00 01 mov %g1, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 400241bc: 9a 03 60 01 inc %o5 400241c0: 80 a3 40 1a cmp %o5, %i2 400241c4: 08 bf ff db bleu 40024130 400241c8: 83 2b 60 02 sll %o5, 2, %g1 400241cc: 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++) { 400241d0: 80 a0 80 09 cmp %g2, %o1 400241d4: 32 bf ff cf bne,a 40024110 400241d8: c2 00 80 00 ld [ %g2 ], %g1 } } } } if ( interested ) { 400241dc: 80 a2 20 00 cmp %o0, 0 400241e0: 02 80 00 08 be 40024200 400241e4: 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 ) ) { 400241e8: 92 10 00 19 mov %i1, %o1 400241ec: 40 00 00 33 call 400242b8 <_POSIX_signals_Unblock_thread> 400241f0: 94 07 bf f4 add %fp, -12, %o2 400241f4: 80 8a 20 ff btst 0xff, %o0 400241f8: 12 80 00 20 bne 40024278 400241fc: 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 ); 40024200: 40 00 00 24 call 40024290 <_POSIX_signals_Set_process_signals> 40024204: 90 10 00 10 mov %l0, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 40024208: 83 2e 60 02 sll %i1, 2, %g1 4002420c: b3 2e 60 04 sll %i1, 4, %i1 40024210: b2 26 40 01 sub %i1, %g1, %i1 40024214: 03 10 00 9f sethi %hi(0x40027c00), %g1 40024218: 82 10 63 c0 or %g1, 0x3c0, %g1 ! 40027fc0 <_POSIX_signals_Vectors> 4002421c: c2 00 40 19 ld [ %g1 + %i1 ], %g1 40024220: 80 a0 60 02 cmp %g1, 2 40024224: 12 80 00 15 bne 40024278 40024228: 11 10 00 a0 sethi %hi(0x40028000), %o0 psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 4002422c: 7f ff a2 67 call 4000cbc8 <_Chain_Get> 40024230: 90 12 21 40 or %o0, 0x140, %o0 ! 40028140 <_POSIX_signals_Inactive_siginfo> if ( !psiginfo ) { 40024234: a0 92 20 00 orcc %o0, 0, %l0 40024238: 12 80 00 08 bne 40024258 4002423c: 92 07 bf f4 add %fp, -12, %o1 _Thread_Enable_dispatch(); 40024240: 7f ff a9 28 call 4000e6e0 <_Thread_Enable_dispatch> 40024244: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 40024248: 7f ff c1 8d call 4001487c <__errno> 4002424c: 01 00 00 00 nop 40024250: 10 bf ff 66 b 40023fe8 40024254: 82 10 20 0b mov 0xb, %g1 ! b } psiginfo->Info = *siginfo; 40024258: 90 04 20 08 add %l0, 8, %o0 4002425c: 7f ff c3 e2 call 400151e4 40024260: 94 10 20 0c mov 0xc, %o2 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 40024264: 11 10 00 a0 sethi %hi(0x40028000), %o0 40024268: 92 10 00 10 mov %l0, %o1 4002426c: 90 12 21 b8 or %o0, 0x1b8, %o0 40024270: 7f ff a2 40 call 4000cb70 <_Chain_Append> 40024274: 90 02 00 19 add %o0, %i1, %o0 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 40024278: 7f ff a9 1a call 4000e6e0 <_Thread_Enable_dispatch> 4002427c: 01 00 00 00 nop return 0; 40024280: 90 10 20 00 clr %o0 ! 0 } 40024284: b0 10 00 08 mov %o0, %i0 40024288: 81 c7 e0 08 ret 4002428c: 81 e8 00 00 restore =============================================================================== 4000c13c : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 4000c13c: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 4000c140: 80 a0 60 00 cmp %g1, 0 4000c144: 02 80 00 0f be 4000c180 4000c148: 90 10 20 16 mov 0x16, %o0 4000c14c: c4 00 40 00 ld [ %g1 ], %g2 4000c150: 80 a0 a0 00 cmp %g2, 0 4000c154: 02 80 00 0b be 4000c180 4000c158: 80 a2 60 04 cmp %o1, 4 return EINVAL; switch ( policy ) { 4000c15c: 18 80 00 09 bgu 4000c180 4000c160: 90 10 20 86 mov 0x86, %o0 4000c164: 84 10 20 01 mov 1, %g2 4000c168: 85 28 80 09 sll %g2, %o1, %g2 4000c16c: 80 88 a0 17 btst 0x17, %g2 4000c170: 02 80 00 04 be 4000c180 <== NEVER TAKEN 4000c174: 01 00 00 00 nop case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 4000c178: d2 20 60 14 st %o1, [ %g1 + 0x14 ] 4000c17c: 90 10 20 00 clr %o0 return 0; default: return ENOTSUP; } } 4000c180: 81 c3 e0 08 retl =============================================================================== 40006fac : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 40006fac: 9d e3 bf 90 save %sp, -112, %sp 40006fb0: a0 10 00 18 mov %i0, %l0 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 40006fb4: 80 a4 20 00 cmp %l0, 0 40006fb8: 02 80 00 1f be 40007034 40006fbc: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( count == 0 ) 40006fc0: 80 a6 a0 00 cmp %i2, 0 40006fc4: 02 80 00 1c be 40007034 40006fc8: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40006fcc: 32 80 00 06 bne,a 40006fe4 40006fd0: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 40006fd4: b2 07 bf f0 add %fp, -16, %i1 40006fd8: 7f ff ff bd call 40006ecc 40006fdc: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40006fe0: c2 06 40 00 ld [ %i1 ], %g1 40006fe4: 80 a0 60 00 cmp %g1, 0 40006fe8: 02 80 00 13 be 40007034 40006fec: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40006ff0: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006ff4: 80 a0 60 00 cmp %g1, 0 40006ff8: 12 80 00 0f bne 40007034 <== NEVER TAKEN 40006ffc: 03 10 00 5f sethi %hi(0x40017c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007000: c4 00 61 e0 ld [ %g1 + 0x1e0 ], %g2 ! 40017de0 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 40007004: c0 27 bf f8 clr [ %fp + -8 ] the_attributes.maximum_count = count; 40007008: f4 27 bf fc st %i2, [ %fp + -4 ] 4000700c: 84 00 a0 01 inc %g2 40007010: c4 20 61 e0 st %g2, [ %g1 + 0x1e0 ] * 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 ); 40007014: 25 10 00 60 sethi %hi(0x40018000), %l2 40007018: 40 00 08 69 call 400091bc <_Objects_Allocate> 4000701c: 90 14 a1 c0 or %l2, 0x1c0, %o0 ! 400181c0 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 40007020: a2 92 20 00 orcc %o0, 0, %l1 40007024: 12 80 00 06 bne 4000703c 40007028: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 4000702c: 40 00 0c 89 call 4000a250 <_Thread_Enable_dispatch> 40007030: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40007034: 81 c7 e0 08 ret 40007038: 81 e8 00 00 restore } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 4000703c: 40 00 05 cf call 40008778 <_CORE_barrier_Initialize> 40007040: 92 07 bf f8 add %fp, -8, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007044: 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; } 40007048: a4 14 a1 c0 or %l2, 0x1c0, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000704c: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007050: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007054: 85 28 a0 02 sll %g2, 2, %g2 40007058: 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; 4000705c: c0 24 60 0c clr [ %l1 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 40007060: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40007064: 40 00 0c 7b call 4000a250 <_Thread_Enable_dispatch> 40007068: b0 10 20 00 clr %i0 return 0; } 4000706c: 81 c7 e0 08 ret 40007070: 81 e8 00 00 restore =============================================================================== 4000676c : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 4000676c: 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 ) 40006770: 80 a6 20 00 cmp %i0, 0 40006774: 02 80 00 14 be 400067c4 40006778: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4000677c: 03 10 00 60 sethi %hi(0x40018000), %g1 40006780: c4 00 61 b0 ld [ %g1 + 0x1b0 ], %g2 ! 400181b0 <_Thread_Dispatch_disable_level> 40006784: 84 00 a0 01 inc %g2 40006788: c4 20 61 b0 st %g2, [ %g1 + 0x1b0 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 4000678c: 40 00 11 71 call 4000ad50 <_Workspace_Allocate> 40006790: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 40006794: 92 92 20 00 orcc %o0, 0, %o1 40006798: 02 80 00 09 be 400067bc <== NEVER TAKEN 4000679c: 01 00 00 00 nop thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 400067a0: 03 10 00 61 sethi %hi(0x40018400), %g1 400067a4: c2 00 63 14 ld [ %g1 + 0x314 ], %g1 ! 40018714 <_Per_CPU_Information+0xc> handler_stack = &thread_support->Cancellation_Handlers; 400067a8: d0 00 61 58 ld [ %g1 + 0x158 ], %o0 handler->routine = routine; 400067ac: f0 22 60 08 st %i0, [ %o1 + 8 ] handler->arg = arg; 400067b0: f2 22 60 0c st %i1, [ %o1 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 400067b4: 40 00 06 06 call 40007fcc <_Chain_Append> 400067b8: 90 02 20 e4 add %o0, 0xe4, %o0 } _Thread_Enable_dispatch(); 400067bc: 40 00 0c b0 call 40009a7c <_Thread_Enable_dispatch> 400067c0: 81 e8 00 00 restore 400067c4: 81 c7 e0 08 ret 400067c8: 81 e8 00 00 restore =============================================================================== 4000786c : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 4000786c: 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; 40007870: 80 a6 60 00 cmp %i1, 0 40007874: 12 80 00 04 bne 40007884 40007878: a0 10 00 18 mov %i0, %l0 else the_attr = &_POSIX_Condition_variables_Default_attributes; 4000787c: 33 10 00 5e sethi %hi(0x40017800), %i1 40007880: b2 16 61 9c or %i1, 0x19c, %i1 ! 4001799c <_POSIX_Condition_variables_Default_attributes> /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 40007884: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007888: 80 a0 60 01 cmp %g1, 1 4000788c: 02 80 00 11 be 400078d0 <== NEVER TAKEN 40007890: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !the_attr->is_initialized ) 40007894: c2 06 40 00 ld [ %i1 ], %g1 40007898: 80 a0 60 00 cmp %g1, 0 4000789c: 02 80 00 0d be 400078d0 400078a0: 03 10 00 63 sethi %hi(0x40018c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400078a4: c4 00 63 c0 ld [ %g1 + 0x3c0 ], %g2 ! 40018fc0 <_Thread_Dispatch_disable_level> 400078a8: 84 00 a0 01 inc %g2 400078ac: c4 20 63 c0 st %g2, [ %g1 + 0x3c0 ] RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 400078b0: 25 10 00 65 sethi %hi(0x40019400), %l2 400078b4: 40 00 09 d4 call 4000a004 <_Objects_Allocate> 400078b8: 90 14 a0 38 or %l2, 0x38, %o0 ! 40019438 <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 400078bc: a2 92 20 00 orcc %o0, 0, %l1 400078c0: 32 80 00 06 bne,a 400078d8 400078c4: c2 06 60 04 ld [ %i1 + 4 ], %g1 _Thread_Enable_dispatch(); 400078c8: 40 00 0d f4 call 4000b098 <_Thread_Enable_dispatch> 400078cc: b0 10 20 0c mov 0xc, %i0 return ENOMEM; 400078d0: 81 c7 e0 08 ret 400078d4: 81 e8 00 00 restore the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 400078d8: 90 04 60 18 add %l1, 0x18, %o0 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 400078dc: c2 24 60 10 st %g1, [ %l1 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 400078e0: 92 10 20 00 clr %o1 400078e4: 15 04 00 02 sethi %hi(0x10000800), %o2 400078e8: 96 10 20 74 mov 0x74, %o3 400078ec: 40 00 0f f3 call 4000b8b8 <_Thread_queue_Initialize> 400078f0: c0 24 60 14 clr [ %l1 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400078f4: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 400078f8: a4 14 a0 38 or %l2, 0x38, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400078fc: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007900: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007904: 85 28 a0 02 sll %g2, 2, %g2 40007908: 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; 4000790c: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 40007910: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40007914: 40 00 0d e1 call 4000b098 <_Thread_Enable_dispatch> 40007918: b0 10 20 00 clr %i0 return 0; } 4000791c: 81 c7 e0 08 ret 40007920: 81 e8 00 00 restore =============================================================================== 400076d0 : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 400076d0: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 400076d4: 80 a0 60 00 cmp %g1, 0 400076d8: 02 80 00 08 be 400076f8 400076dc: 90 10 20 16 mov 0x16, %o0 400076e0: c4 00 40 00 ld [ %g1 ], %g2 400076e4: 80 a0 a0 00 cmp %g2, 0 400076e8: 02 80 00 04 be 400076f8 <== NEVER TAKEN 400076ec: 01 00 00 00 nop return EINVAL; attr->is_initialized = false; 400076f0: c0 20 40 00 clr [ %g1 ] return 0; 400076f4: 90 10 20 00 clr %o0 } 400076f8: 81 c3 e0 08 retl =============================================================================== 40006c38 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 40006c38: 9d e3 bf 58 save %sp, -168, %sp 40006c3c: a0 10 00 18 mov %i0, %l0 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 40006c40: 80 a6 a0 00 cmp %i2, 0 40006c44: 02 80 00 66 be 40006ddc 40006c48: b0 10 20 0e mov 0xe, %i0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 40006c4c: 80 a6 60 00 cmp %i1, 0 40006c50: 32 80 00 05 bne,a 40006c64 40006c54: c2 06 40 00 ld [ %i1 ], %g1 40006c58: 33 10 00 76 sethi %hi(0x4001d800), %i1 40006c5c: b2 16 60 94 or %i1, 0x94, %i1 ! 4001d894 <_POSIX_Threads_Default_attributes> if ( !the_attr->is_initialized ) 40006c60: c2 06 40 00 ld [ %i1 ], %g1 40006c64: 80 a0 60 00 cmp %g1, 0 40006c68: 02 80 00 5d be 40006ddc 40006c6c: 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) ) 40006c70: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006c74: 80 a0 60 00 cmp %g1, 0 40006c78: 02 80 00 07 be 40006c94 40006c7c: 03 10 00 79 sethi %hi(0x4001e400), %g1 40006c80: c4 06 60 08 ld [ %i1 + 8 ], %g2 40006c84: c2 00 62 24 ld [ %g1 + 0x224 ], %g1 40006c88: 80 a0 80 01 cmp %g2, %g1 40006c8c: 0a 80 00 79 bcs 40006e70 40006c90: 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 ) { 40006c94: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 40006c98: 80 a0 60 01 cmp %g1, 1 40006c9c: 02 80 00 06 be 40006cb4 40006ca0: 80 a0 60 02 cmp %g1, 2 40006ca4: 12 80 00 4e bne 40006ddc 40006ca8: b0 10 20 16 mov 0x16, %i0 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 40006cac: 10 80 00 09 b 40006cd0 40006cb0: 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 ]; 40006cb4: 03 10 00 7d sethi %hi(0x4001f400), %g1 40006cb8: c2 00 62 14 ld [ %g1 + 0x214 ], %g1 ! 4001f614 <_Per_CPU_Information+0xc> schedpolicy = api->schedpolicy; schedparam = api->schedparam; 40006cbc: 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 ]; 40006cc0: d2 00 61 58 ld [ %g1 + 0x158 ], %o1 schedpolicy = api->schedpolicy; 40006cc4: e4 02 60 84 ld [ %o1 + 0x84 ], %l2 schedparam = api->schedparam; 40006cc8: 10 80 00 04 b 40006cd8 40006ccc: 92 02 60 88 add %o1, 0x88, %o1 break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 40006cd0: 90 07 bf dc add %fp, -36, %o0 40006cd4: 92 06 60 18 add %i1, 0x18, %o1 40006cd8: 40 00 26 d2 call 40010820 40006cdc: 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 ) 40006ce0: c2 06 60 0c ld [ %i1 + 0xc ], %g1 40006ce4: 80 a0 60 00 cmp %g1, 0 40006ce8: 12 80 00 3d bne 40006ddc 40006cec: b0 10 20 86 mov 0x86, %i0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 40006cf0: d0 07 bf dc ld [ %fp + -36 ], %o0 40006cf4: 40 00 1a 19 call 4000d558 <_POSIX_Priority_Is_valid> 40006cf8: b0 10 20 16 mov 0x16, %i0 40006cfc: 80 8a 20 ff btst 0xff, %o0 40006d00: 02 80 00 37 be 40006ddc <== NEVER TAKEN 40006d04: 03 10 00 79 sethi %hi(0x4001e400), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 40006d08: 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); 40006d0c: e6 08 62 28 ldub [ %g1 + 0x228 ], %l3 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 40006d10: 90 10 00 12 mov %l2, %o0 40006d14: 92 07 bf dc add %fp, -36, %o1 40006d18: 94 07 bf fc add %fp, -4, %o2 40006d1c: 40 00 1a 1a call 4000d584 <_POSIX_Thread_Translate_sched_param> 40006d20: 96 07 bf f8 add %fp, -8, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 40006d24: b0 92 20 00 orcc %o0, 0, %i0 40006d28: 12 80 00 2d bne 40006ddc 40006d2c: 2b 10 00 7c sethi %hi(0x4001f000), %l5 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 40006d30: 40 00 06 0e call 40008568 <_API_Mutex_Lock> 40006d34: d0 05 61 70 ld [ %l5 + 0x170 ], %o0 ! 4001f170 <_RTEMS_Allocator_Mutex> * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 40006d38: 11 10 00 7c sethi %hi(0x4001f000), %o0 40006d3c: 40 00 08 b4 call 4000900c <_Objects_Allocate> 40006d40: 90 12 23 10 or %o0, 0x310, %o0 ! 4001f310 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 40006d44: a2 92 20 00 orcc %o0, 0, %l1 40006d48: 32 80 00 04 bne,a 40006d58 40006d4c: c2 06 60 08 ld [ %i1 + 8 ], %g1 _RTEMS_Unlock_allocator(); 40006d50: 10 80 00 21 b 40006dd4 40006d54: d0 05 61 70 ld [ %l5 + 0x170 ], %o0 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 40006d58: 05 10 00 79 sethi %hi(0x4001e400), %g2 40006d5c: d6 00 a2 24 ld [ %g2 + 0x224 ], %o3 ! 4001e624 40006d60: 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( 40006d64: 80 a2 c0 01 cmp %o3, %g1 40006d68: 1a 80 00 03 bcc 40006d74 40006d6c: d4 06 60 04 ld [ %i1 + 4 ], %o2 40006d70: 96 10 00 01 mov %g1, %o3 40006d74: 82 10 20 01 mov 1, %g1 40006d78: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40006d7c: c2 07 bf fc ld [ %fp + -4 ], %g1 40006d80: 9a 0c e0 ff and %l3, 0xff, %o5 40006d84: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 40006d88: c2 07 bf f8 ld [ %fp + -8 ], %g1 40006d8c: c0 27 bf d4 clr [ %fp + -44 ] 40006d90: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40006d94: 82 07 bf d4 add %fp, -44, %g1 40006d98: c0 23 a0 68 clr [ %sp + 0x68 ] 40006d9c: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40006da0: 27 10 00 7c sethi %hi(0x4001f000), %l3 40006da4: 92 10 00 11 mov %l1, %o1 40006da8: 90 14 e3 10 or %l3, 0x310, %o0 40006dac: 98 10 20 00 clr %o4 40006db0: 40 00 0c f0 call 4000a170 <_Thread_Initialize> 40006db4: 9a 23 40 14 sub %o5, %l4, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 40006db8: 80 8a 20 ff btst 0xff, %o0 40006dbc: 12 80 00 0a bne 40006de4 40006dc0: 90 14 e3 10 or %l3, 0x310, %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 40006dc4: 40 00 09 6c call 40009374 <_Objects_Free> 40006dc8: 92 10 00 11 mov %l1, %o1 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 40006dcc: 03 10 00 7c sethi %hi(0x4001f000), %g1 40006dd0: d0 00 61 70 ld [ %g1 + 0x170 ], %o0 ! 4001f170 <_RTEMS_Allocator_Mutex> 40006dd4: 40 00 05 fb call 400085c0 <_API_Mutex_Unlock> 40006dd8: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40006ddc: 81 c7 e0 08 ret 40006de0: 81 e8 00 00 restore } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40006de4: e6 04 61 58 ld [ %l1 + 0x158 ], %l3 api->Attributes = *the_attr; 40006de8: 92 10 00 19 mov %i1, %o1 40006dec: 94 10 20 40 mov 0x40, %o2 40006df0: 40 00 26 8c call 40010820 40006df4: 90 10 00 13 mov %l3, %o0 api->detachstate = the_attr->detachstate; 40006df8: c2 06 60 3c ld [ %i1 + 0x3c ], %g1 api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006dfc: 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; 40006e00: c2 24 e0 40 st %g1, [ %l3 + 0x40 ] api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40006e04: 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; 40006e08: e4 24 e0 84 st %l2, [ %l3 + 0x84 ] api->schedparam = schedparam; 40006e0c: 40 00 26 85 call 40010820 40006e10: 90 04 e0 88 add %l3, 0x88, %o0 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40006e14: 90 10 00 11 mov %l1, %o0 40006e18: 92 10 20 01 mov 1, %o1 40006e1c: 94 10 00 1a mov %i2, %o2 40006e20: 96 10 00 1b mov %i3, %o3 40006e24: 40 00 0f 4b call 4000ab50 <_Thread_Start> 40006e28: 98 10 20 00 clr %o4 _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 40006e2c: 80 a4 a0 04 cmp %l2, 4 40006e30: 32 80 00 0a bne,a 40006e58 40006e34: c2 04 60 08 ld [ %l1 + 8 ], %g1 _Watchdog_Insert_ticks( 40006e38: 40 00 0f c6 call 4000ad50 <_Timespec_To_ticks> 40006e3c: 90 04 e0 90 add %l3, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006e40: 92 04 e0 a8 add %l3, 0xa8, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006e44: d0 24 e0 b4 st %o0, [ %l3 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006e48: 11 10 00 7c sethi %hi(0x4001f000), %o0 40006e4c: 40 00 10 9a call 4000b0b4 <_Watchdog_Insert> 40006e50: 90 12 21 90 or %o0, 0x190, %o0 ! 4001f190 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 40006e54: c2 04 60 08 ld [ %l1 + 8 ], %g1 40006e58: c2 24 00 00 st %g1, [ %l0 ] _RTEMS_Unlock_allocator(); 40006e5c: 03 10 00 7c sethi %hi(0x4001f000), %g1 40006e60: 40 00 05 d8 call 400085c0 <_API_Mutex_Unlock> 40006e64: d0 00 61 70 ld [ %g1 + 0x170 ], %o0 ! 4001f170 <_RTEMS_Allocator_Mutex> return 0; 40006e68: 81 c7 e0 08 ret 40006e6c: 81 e8 00 00 restore } 40006e70: 81 c7 e0 08 ret 40006e74: 81 e8 00 00 restore =============================================================================== 40008e78 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 40008e78: 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 ); 40008e7c: 92 07 bf fc add %fp, -4, %o1 40008e80: 40 00 00 37 call 40008f5c <_POSIX_Absolute_timeout_to_ticks> 40008e84: 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 ); 40008e88: 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, 40008e8c: 82 1a 20 03 xor %o0, 3, %g1 40008e90: 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 ); 40008e94: 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 ); 40008e98: a2 60 3f ff subx %g0, -1, %l1 40008e9c: 90 10 00 18 mov %i0, %o0 40008ea0: 7f ff ff bd call 40008d94 <_POSIX_Mutex_Lock_support> 40008ea4: 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) ) { 40008ea8: 80 a4 60 00 cmp %l1, 0 40008eac: 12 80 00 0c bne 40008edc 40008eb0: 80 a2 20 10 cmp %o0, 0x10 40008eb4: 12 80 00 0a bne 40008edc <== NEVER TAKEN 40008eb8: 80 a4 20 00 cmp %l0, 0 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40008ebc: 02 80 00 07 be 40008ed8 <== NEVER TAKEN 40008ec0: a0 04 3f ff add %l0, -1, %l0 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40008ec4: 80 a4 20 01 cmp %l0, 1 40008ec8: 18 80 00 05 bgu 40008edc <== NEVER TAKEN 40008ecc: 01 00 00 00 nop status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 40008ed0: 10 80 00 03 b 40008edc 40008ed4: 90 10 20 74 mov 0x74, %o0 ! 74 40008ed8: 90 10 20 16 mov 0x16, %o0 <== NOT EXECUTED } return lock_status; } 40008edc: 81 c7 e0 08 ret 40008ee0: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40006650 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 40006650: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40006654: 80 a0 60 00 cmp %g1, 0 40006658: 02 80 00 0b be 40006684 4000665c: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40006660: c4 00 40 00 ld [ %g1 ], %g2 40006664: 80 a0 a0 00 cmp %g2, 0 40006668: 02 80 00 07 be 40006684 4000666c: 80 a2 60 00 cmp %o1, 0 return EINVAL; if ( !type ) 40006670: 02 80 00 05 be 40006684 <== NEVER TAKEN 40006674: 01 00 00 00 nop return EINVAL; *type = attr->type; 40006678: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 4000667c: 90 10 20 00 clr %o0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 40006680: c2 22 40 00 st %g1, [ %o1 ] return 0; } 40006684: 81 c3 e0 08 retl =============================================================================== 40008a54 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 40008a54: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40008a58: 80 a0 60 00 cmp %g1, 0 40008a5c: 02 80 00 0a be 40008a84 40008a60: 90 10 20 16 mov 0x16, %o0 40008a64: c4 00 40 00 ld [ %g1 ], %g2 40008a68: 80 a0 a0 00 cmp %g2, 0 40008a6c: 02 80 00 06 be 40008a84 40008a70: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40008a74: 18 80 00 04 bgu 40008a84 <== NEVER TAKEN 40008a78: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40008a7c: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 40008a80: 90 10 20 00 clr %o0 default: return EINVAL; } } 40008a84: 81 c3 e0 08 retl =============================================================================== 400066bc : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 400066bc: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 400066c0: 80 a0 60 00 cmp %g1, 0 400066c4: 02 80 00 0a be 400066ec 400066c8: 90 10 20 16 mov 0x16, %o0 400066cc: c4 00 40 00 ld [ %g1 ], %g2 400066d0: 80 a0 a0 00 cmp %g2, 0 400066d4: 02 80 00 06 be 400066ec <== NEVER TAKEN 400066d8: 80 a2 60 03 cmp %o1, 3 return EINVAL; switch ( type ) { 400066dc: 18 80 00 04 bgu 400066ec 400066e0: 01 00 00 00 nop case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 400066e4: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; 400066e8: 90 10 20 00 clr %o0 default: return EINVAL; } } 400066ec: 81 c3 e0 08 retl =============================================================================== 40007260 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 40007260: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 40007264: 80 a6 60 00 cmp %i1, 0 40007268: 02 80 00 1c be 400072d8 4000726c: a0 10 00 18 mov %i0, %l0 40007270: 80 a6 20 00 cmp %i0, 0 40007274: 22 80 00 17 be,a 400072d0 40007278: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !once_control->init_executed ) { 4000727c: c2 06 20 04 ld [ %i0 + 4 ], %g1 40007280: 80 a0 60 00 cmp %g1, 0 40007284: 12 80 00 13 bne 400072d0 40007288: b0 10 20 00 clr %i0 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 4000728c: 90 10 21 00 mov 0x100, %o0 40007290: 92 10 21 00 mov 0x100, %o1 40007294: 40 00 03 0a call 40007ebc 40007298: 94 07 bf fc add %fp, -4, %o2 if ( !once_control->init_executed ) { 4000729c: c2 04 20 04 ld [ %l0 + 4 ], %g1 400072a0: 80 a0 60 00 cmp %g1, 0 400072a4: 12 80 00 07 bne 400072c0 <== NEVER TAKEN 400072a8: d0 07 bf fc ld [ %fp + -4 ], %o0 once_control->is_initialized = true; 400072ac: 82 10 20 01 mov 1, %g1 400072b0: c2 24 00 00 st %g1, [ %l0 ] once_control->init_executed = true; (*init_routine)(); 400072b4: 9f c6 40 00 call %i1 400072b8: c2 24 20 04 st %g1, [ %l0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 400072bc: d0 07 bf fc ld [ %fp + -4 ], %o0 400072c0: 92 10 21 00 mov 0x100, %o1 400072c4: 94 07 bf fc add %fp, -4, %o2 400072c8: 40 00 02 fd call 40007ebc 400072cc: b0 10 20 00 clr %i0 400072d0: 81 c7 e0 08 ret 400072d4: 81 e8 00 00 restore pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) return EINVAL; 400072d8: b0 10 20 16 mov 0x16, %i0 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 400072dc: 81 c7 e0 08 ret 400072e0: 81 e8 00 00 restore =============================================================================== 40007d30 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 40007d30: 9d e3 bf 90 save %sp, -112, %sp 40007d34: a0 10 00 18 mov %i0, %l0 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 40007d38: 80 a4 20 00 cmp %l0, 0 40007d3c: 02 80 00 1c be 40007dac 40007d40: b0 10 20 16 mov 0x16, %i0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 40007d44: 80 a6 60 00 cmp %i1, 0 40007d48: 32 80 00 06 bne,a 40007d60 40007d4c: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 40007d50: b2 07 bf f4 add %fp, -12, %i1 40007d54: 40 00 02 6d call 40008708 40007d58: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40007d5c: c2 06 40 00 ld [ %i1 ], %g1 40007d60: 80 a0 60 00 cmp %g1, 0 40007d64: 02 80 00 12 be 40007dac <== NEVER TAKEN 40007d68: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 40007d6c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007d70: 80 a0 60 00 cmp %g1, 0 40007d74: 12 80 00 0e bne 40007dac <== NEVER TAKEN 40007d78: 03 10 00 69 sethi %hi(0x4001a400), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007d7c: c4 00 61 50 ld [ %g1 + 0x150 ], %g2 ! 4001a550 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 40007d80: c0 27 bf fc clr [ %fp + -4 ] 40007d84: 84 00 a0 01 inc %g2 40007d88: c4 20 61 50 st %g2, [ %g1 + 0x150 ] * 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 ); 40007d8c: 25 10 00 69 sethi %hi(0x4001a400), %l2 40007d90: 40 00 09 f2 call 4000a558 <_Objects_Allocate> 40007d94: 90 14 a3 70 or %l2, 0x370, %o0 ! 4001a770 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 40007d98: a2 92 20 00 orcc %o0, 0, %l1 40007d9c: 12 80 00 06 bne 40007db4 40007da0: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 40007da4: 40 00 0e 12 call 4000b5ec <_Thread_Enable_dispatch> 40007da8: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40007dac: 81 c7 e0 08 ret 40007db0: 81 e8 00 00 restore } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 40007db4: 40 00 07 96 call 40009c0c <_CORE_RWLock_Initialize> 40007db8: 92 07 bf fc add %fp, -4, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007dbc: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 40007dc0: a4 14 a3 70 or %l2, 0x370, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007dc4: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007dc8: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007dcc: 85 28 a0 02 sll %g2, 2, %g2 40007dd0: 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; 40007dd4: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 40007dd8: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40007ddc: 40 00 0e 04 call 4000b5ec <_Thread_Enable_dispatch> 40007de0: b0 10 20 00 clr %i0 return 0; } 40007de4: 81 c7 e0 08 ret 40007de8: 81 e8 00 00 restore =============================================================================== 40007e5c : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007e5c: 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; 40007e60: 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 ) 40007e64: 80 a6 20 00 cmp %i0, 0 40007e68: 02 80 00 2b be 40007f14 40007e6c: 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 ); 40007e70: 40 00 1a 9d call 4000e8e4 <_POSIX_Absolute_timeout_to_ticks> 40007e74: 92 07 bf f8 add %fp, -8, %o1 40007e78: d2 06 00 00 ld [ %i0 ], %o1 40007e7c: a2 10 00 08 mov %o0, %l1 40007e80: 94 07 bf fc add %fp, -4, %o2 40007e84: 11 10 00 69 sethi %hi(0x4001a400), %o0 40007e88: 40 00 0a f3 call 4000aa54 <_Objects_Get> 40007e8c: 90 12 23 70 or %o0, 0x370, %o0 ! 4001a770 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007e90: c2 07 bf fc ld [ %fp + -4 ], %g1 40007e94: 80 a0 60 00 cmp %g1, 0 40007e98: 12 80 00 1f bne 40007f14 40007e9c: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 40007ea0: 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, 40007ea4: 82 1c 60 03 xor %l1, 3, %g1 40007ea8: 90 02 20 10 add %o0, 0x10, %o0 40007eac: 80 a0 00 01 cmp %g0, %g1 40007eb0: 98 10 20 00 clr %o4 40007eb4: a4 60 3f ff subx %g0, -1, %l2 40007eb8: 40 00 07 60 call 40009c38 <_CORE_RWLock_Obtain_for_reading> 40007ebc: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40007ec0: 40 00 0d cb call 4000b5ec <_Thread_Enable_dispatch> 40007ec4: 01 00 00 00 nop if ( !do_wait ) { 40007ec8: 80 a4 a0 00 cmp %l2, 0 40007ecc: 12 80 00 0d bne 40007f00 40007ed0: 03 10 00 6a sethi %hi(0x4001a800), %g1 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 40007ed4: c2 00 62 b4 ld [ %g1 + 0x2b4 ], %g1 ! 4001aab4 <_Per_CPU_Information+0xc> 40007ed8: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007edc: 80 a0 60 02 cmp %g1, 2 40007ee0: 32 80 00 09 bne,a 40007f04 40007ee4: 03 10 00 6a sethi %hi(0x4001a800), %g1 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40007ee8: 80 a4 60 00 cmp %l1, 0 40007eec: 02 80 00 0a be 40007f14 <== NEVER TAKEN 40007ef0: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40007ef4: 80 a4 60 01 cmp %l1, 1 40007ef8: 08 80 00 07 bleu 40007f14 <== ALWAYS TAKEN 40007efc: 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 40007f00: 03 10 00 6a sethi %hi(0x4001a800), %g1 40007f04: c2 00 62 b4 ld [ %g1 + 0x2b4 ], %g1 ! 4001aab4 <_Per_CPU_Information+0xc> status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 40007f08: 40 00 00 35 call 40007fdc <_POSIX_RWLock_Translate_core_RWLock_return_code> 40007f0c: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 40007f10: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40007f14: 81 c7 e0 08 ret 40007f18: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40007f1c : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007f1c: 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; 40007f20: 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 ) 40007f24: 80 a6 20 00 cmp %i0, 0 40007f28: 02 80 00 2b be 40007fd4 40007f2c: 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 ); 40007f30: 40 00 1a 6d call 4000e8e4 <_POSIX_Absolute_timeout_to_ticks> 40007f34: 92 07 bf f8 add %fp, -8, %o1 40007f38: d2 06 00 00 ld [ %i0 ], %o1 40007f3c: a2 10 00 08 mov %o0, %l1 40007f40: 94 07 bf fc add %fp, -4, %o2 40007f44: 11 10 00 69 sethi %hi(0x4001a400), %o0 40007f48: 40 00 0a c3 call 4000aa54 <_Objects_Get> 40007f4c: 90 12 23 70 or %o0, 0x370, %o0 ! 4001a770 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007f50: c2 07 bf fc ld [ %fp + -4 ], %g1 40007f54: 80 a0 60 00 cmp %g1, 0 40007f58: 12 80 00 1f bne 40007fd4 40007f5c: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 40007f60: 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, 40007f64: 82 1c 60 03 xor %l1, 3, %g1 40007f68: 90 02 20 10 add %o0, 0x10, %o0 40007f6c: 80 a0 00 01 cmp %g0, %g1 40007f70: 98 10 20 00 clr %o4 40007f74: a4 60 3f ff subx %g0, -1, %l2 40007f78: 40 00 07 64 call 40009d08 <_CORE_RWLock_Obtain_for_writing> 40007f7c: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40007f80: 40 00 0d 9b call 4000b5ec <_Thread_Enable_dispatch> 40007f84: 01 00 00 00 nop if ( !do_wait && 40007f88: 80 a4 a0 00 cmp %l2, 0 40007f8c: 12 80 00 0d bne 40007fc0 40007f90: 03 10 00 6a sethi %hi(0x4001a800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 40007f94: c2 00 62 b4 ld [ %g1 + 0x2b4 ], %g1 ! 4001aab4 <_Per_CPU_Information+0xc> ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 40007f98: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007f9c: 80 a0 60 02 cmp %g1, 2 40007fa0: 32 80 00 09 bne,a 40007fc4 40007fa4: 03 10 00 6a sethi %hi(0x4001a800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40007fa8: 80 a4 60 00 cmp %l1, 0 40007fac: 02 80 00 0a be 40007fd4 <== NEVER TAKEN 40007fb0: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40007fb4: 80 a4 60 01 cmp %l1, 1 40007fb8: 08 80 00 07 bleu 40007fd4 <== ALWAYS TAKEN 40007fbc: 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 40007fc0: 03 10 00 6a sethi %hi(0x4001a800), %g1 40007fc4: c2 00 62 b4 ld [ %g1 + 0x2b4 ], %g1 ! 4001aab4 <_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( 40007fc8: 40 00 00 05 call 40007fdc <_POSIX_RWLock_Translate_core_RWLock_return_code> 40007fcc: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 40007fd0: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40007fd4: 81 c7 e0 08 ret 40007fd8: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 40008730 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 40008730: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40008734: 80 a0 60 00 cmp %g1, 0 40008738: 02 80 00 0a be 40008760 4000873c: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40008740: c4 00 40 00 ld [ %g1 ], %g2 40008744: 80 a0 a0 00 cmp %g2, 0 40008748: 02 80 00 06 be 40008760 4000874c: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40008750: 18 80 00 04 bgu 40008760 <== NEVER TAKEN 40008754: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40008758: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 4000875c: 90 10 20 00 clr %o0 default: return EINVAL; } } 40008760: 81 c3 e0 08 retl =============================================================================== 400096b0 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 400096b0: 9d e3 bf 90 save %sp, -112, %sp 400096b4: a0 10 00 18 mov %i0, %l0 int rc; /* * Check all the parameters */ if ( !param ) 400096b8: 80 a6 a0 00 cmp %i2, 0 400096bc: 02 80 00 3f be 400097b8 400096c0: b0 10 20 16 mov 0x16, %i0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 400096c4: 90 10 00 19 mov %i1, %o0 400096c8: 92 10 00 1a mov %i2, %o1 400096cc: 94 07 bf fc add %fp, -4, %o2 400096d0: 40 00 18 98 call 4000f930 <_POSIX_Thread_Translate_sched_param> 400096d4: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 400096d8: b0 92 20 00 orcc %o0, 0, %i0 400096dc: 12 80 00 37 bne 400097b8 400096e0: 11 10 00 6f sethi %hi(0x4001bc00), %o0 400096e4: 92 10 00 10 mov %l0, %o1 400096e8: 90 12 22 a0 or %o0, 0x2a0, %o0 400096ec: 40 00 08 48 call 4000b80c <_Objects_Get> 400096f0: 94 07 bf f4 add %fp, -12, %o2 /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 400096f4: c2 07 bf f4 ld [ %fp + -12 ], %g1 400096f8: 80 a0 60 00 cmp %g1, 0 400096fc: 12 80 00 31 bne 400097c0 40009700: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40009704: e0 02 21 58 ld [ %o0 + 0x158 ], %l0 if ( api->schedpolicy == SCHED_SPORADIC ) 40009708: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 4000970c: 80 a0 60 04 cmp %g1, 4 40009710: 32 80 00 05 bne,a 40009724 40009714: f2 24 20 84 st %i1, [ %l0 + 0x84 ] (void) _Watchdog_Remove( &api->Sporadic_timer ); 40009718: 40 00 0f b7 call 4000d5f4 <_Watchdog_Remove> 4000971c: 90 04 20 a8 add %l0, 0xa8, %o0 api->schedpolicy = policy; 40009720: f2 24 20 84 st %i1, [ %l0 + 0x84 ] api->schedparam = *param; 40009724: 90 04 20 88 add %l0, 0x88, %o0 40009728: 92 10 00 1a mov %i2, %o1 4000972c: 40 00 25 86 call 40012d44 40009730: 94 10 20 1c mov 0x1c, %o2 the_thread->budget_algorithm = budget_algorithm; 40009734: c2 07 bf fc ld [ %fp + -4 ], %g1 the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40009738: 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; 4000973c: c2 24 60 7c st %g1, [ %l1 + 0x7c ] the_thread->budget_callout = budget_callout; 40009740: c2 07 bf f8 ld [ %fp + -8 ], %g1 switch ( api->schedpolicy ) { 40009744: 06 80 00 1b bl 400097b0 <== NEVER TAKEN 40009748: c2 24 60 80 st %g1, [ %l1 + 0x80 ] 4000974c: 80 a6 60 02 cmp %i1, 2 40009750: 04 80 00 07 ble 4000976c 40009754: 03 10 00 6e sethi %hi(0x4001b800), %g1 40009758: 80 a6 60 04 cmp %i1, 4 4000975c: 12 80 00 15 bne 400097b0 <== NEVER TAKEN 40009760: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 40009764: 10 80 00 0d b 40009798 40009768: 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; 4000976c: c2 00 63 a4 ld [ %g1 + 0x3a4 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40009770: 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; 40009774: c2 24 60 78 st %g1, [ %l1 + 0x78 ] 40009778: 03 10 00 6c sethi %hi(0x4001b000), %g1 4000977c: d2 08 61 58 ldub [ %g1 + 0x158 ], %o1 ! 4001b158 40009780: c2 04 20 88 ld [ %l0 + 0x88 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40009784: 94 10 20 01 mov 1, %o2 40009788: 92 22 40 01 sub %o1, %g1, %o1 4000978c: 40 00 09 d9 call 4000bef0 <_Thread_Change_priority> 40009790: d2 24 60 18 st %o1, [ %l1 + 0x18 ] the_thread, the_thread->real_priority, true ); break; 40009794: 30 80 00 07 b,a 400097b0 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; _Watchdog_Remove( &api->Sporadic_timer ); 40009798: 90 04 20 a8 add %l0, 0xa8, %o0 4000979c: 40 00 0f 96 call 4000d5f4 <_Watchdog_Remove> 400097a0: c2 24 20 a4 st %g1, [ %l0 + 0xa4 ] _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 400097a4: 90 10 20 00 clr %o0 400097a8: 7f ff ff 7c call 40009598 <_POSIX_Threads_Sporadic_budget_TSR> 400097ac: 92 10 00 11 mov %l1, %o1 break; } _Thread_Enable_dispatch(); 400097b0: 40 00 0a fd call 4000c3a4 <_Thread_Enable_dispatch> 400097b4: 01 00 00 00 nop return 0; 400097b8: 81 c7 e0 08 ret 400097bc: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return ESRCH; 400097c0: b0 10 20 03 mov 3, %i0 } 400097c4: 81 c7 e0 08 ret 400097c8: 81 e8 00 00 restore =============================================================================== 40006eec : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 40006eec: 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() ) 40006ef0: 03 10 00 61 sethi %hi(0x40018400), %g1 40006ef4: 82 10 63 08 or %g1, 0x308, %g1 ! 40018708 <_Per_CPU_Information> 40006ef8: c4 00 60 08 ld [ %g1 + 8 ], %g2 40006efc: 80 a0 a0 00 cmp %g2, 0 40006f00: 12 80 00 18 bne 40006f60 <== NEVER TAKEN 40006f04: 01 00 00 00 nop 40006f08: 05 10 00 60 sethi %hi(0x40018000), %g2 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40006f0c: c2 00 60 0c ld [ %g1 + 0xc ], %g1 40006f10: c6 00 a1 b0 ld [ %g2 + 0x1b0 ], %g3 40006f14: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 40006f18: 86 00 e0 01 inc %g3 40006f1c: c6 20 a1 b0 st %g3, [ %g2 + 0x1b0 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 40006f20: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 40006f24: 80 a0 a0 00 cmp %g2, 0 40006f28: 12 80 00 05 bne 40006f3c <== NEVER TAKEN 40006f2c: 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)); 40006f30: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 40006f34: 80 a0 00 01 cmp %g0, %g1 40006f38: a0 40 20 00 addx %g0, 0, %l0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 40006f3c: 40 00 0a d0 call 40009a7c <_Thread_Enable_dispatch> 40006f40: 01 00 00 00 nop if ( cancel ) 40006f44: 80 8c 20 ff btst 0xff, %l0 40006f48: 02 80 00 06 be 40006f60 40006f4c: 01 00 00 00 nop _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 40006f50: 03 10 00 61 sethi %hi(0x40018400), %g1 40006f54: f0 00 63 14 ld [ %g1 + 0x314 ], %i0 ! 40018714 <_Per_CPU_Information+0xc> 40006f58: 40 00 18 73 call 4000d124 <_POSIX_Thread_Exit> 40006f5c: 93 e8 3f ff restore %g0, -1, %o1 40006f60: 81 c7 e0 08 ret 40006f64: 81 e8 00 00 restore =============================================================================== 40007ac8 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 40007ac8: 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); 40007acc: 21 10 00 64 sethi %hi(0x40019000), %l0 40007ad0: 40 00 02 7f call 400084cc 40007ad4: 90 14 23 44 or %l0, 0x344, %o0 ! 40019344 if (result != 0) { 40007ad8: a2 92 20 00 orcc %o0, 0, %l1 40007adc: 02 80 00 06 be 40007af4 <== ALWAYS TAKEN 40007ae0: 01 00 00 00 nop free (req); 40007ae4: 7f ff f1 72 call 400040ac <== NOT EXECUTED 40007ae8: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED return result; 40007aec: 81 c7 e0 08 ret <== NOT EXECUTED 40007af0: 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); 40007af4: 40 00 04 82 call 40008cfc 40007af8: a0 14 23 44 or %l0, 0x344, %l0 40007afc: 92 07 bf f8 add %fp, -8, %o1 40007b00: 40 00 03 86 call 40008918 40007b04: 94 07 bf dc add %fp, -36, %o2 req->caller_thread = pthread_self (); 40007b08: 40 00 04 7d call 40008cfc 40007b0c: 01 00 00 00 nop req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40007b10: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40007b14: c6 07 bf dc ld [ %fp + -36 ], %g3 40007b18: 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 (); 40007b1c: d0 26 20 10 st %o0, [ %i0 + 0x10 ] req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40007b20: 84 20 c0 02 sub %g3, %g2, %g2 40007b24: c4 26 20 0c st %g2, [ %i0 + 0xc ] req->policy = policy; 40007b28: c4 07 bf f8 ld [ %fp + -8 ], %g2 40007b2c: c4 26 20 08 st %g2, [ %i0 + 8 ] req->aiocbp->error_code = EINPROGRESS; 40007b30: 84 10 20 77 mov 0x77, %g2 40007b34: c4 20 60 34 st %g2, [ %g1 + 0x34 ] req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 40007b38: c4 04 20 68 ld [ %l0 + 0x68 ], %g2 40007b3c: 80 a0 a0 00 cmp %g2, 0 40007b40: 12 80 00 34 bne 40007c10 40007b44: c0 20 60 38 clr [ %g1 + 0x38 ] 40007b48: c4 04 20 64 ld [ %l0 + 0x64 ], %g2 40007b4c: 80 a0 a0 04 cmp %g2, 4 40007b50: 14 80 00 31 bg 40007c14 40007b54: 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); 40007b58: 90 04 20 48 add %l0, 0x48, %o0 40007b5c: 7f ff fe cd call 40007690 40007b60: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40007b64: 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); 40007b68: a4 10 00 08 mov %o0, %l2 if (r_chain->new_fd == 1) { 40007b6c: 80 a0 60 01 cmp %g1, 1 40007b70: aa 02 20 08 add %o0, 8, %l5 40007b74: a6 02 20 1c add %o0, 0x1c, %l3 40007b78: 12 80 00 1d bne 40007bec 40007b7c: 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); 40007b80: 90 10 00 15 mov %l5, %o0 40007b84: 40 00 08 eb call 40009f30 <_Chain_Insert> 40007b88: 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); 40007b8c: 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; 40007b90: c0 24 a0 18 clr [ %l2 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40007b94: 40 00 01 f6 call 4000836c 40007b98: 90 10 00 13 mov %l3, %o0 pthread_cond_init (&r_chain->cond, NULL); 40007b9c: 92 10 20 00 clr %o1 40007ba0: 40 00 00 fb call 40007f8c 40007ba4: 90 10 00 14 mov %l4, %o0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 40007ba8: 96 10 00 12 mov %l2, %o3 40007bac: 90 07 bf fc add %fp, -4, %o0 40007bb0: 92 04 20 08 add %l0, 8, %o1 40007bb4: 15 10 00 1d sethi %hi(0x40007400), %o2 40007bb8: 40 00 02 c8 call 400086d8 40007bbc: 94 12 a3 40 or %o2, 0x340, %o2 ! 40007740 rtems_aio_handle, (void *) r_chain); if (result != 0) { 40007bc0: a4 92 20 00 orcc %o0, 0, %l2 40007bc4: 22 80 00 07 be,a 40007be0 <== ALWAYS TAKEN 40007bc8: c2 04 20 64 ld [ %l0 + 0x64 ], %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 40007bcc: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40007bd0: 40 00 02 60 call 40008550 <== NOT EXECUTED 40007bd4: a2 10 00 12 mov %l2, %l1 <== NOT EXECUTED return result; 40007bd8: 81 c7 e0 08 ret <== NOT EXECUTED 40007bdc: 91 e8 00 11 restore %g0, %l1, %o0 <== NOT EXECUTED } ++aio_request_queue.active_threads; 40007be0: 82 00 60 01 inc %g1 40007be4: 10 80 00 3e b 40007cdc 40007be8: c2 24 20 64 st %g1, [ %l0 + 0x64 ] } else { /* put request in the fd chain it belongs to */ pthread_mutex_lock (&r_chain->mutex); 40007bec: 40 00 02 38 call 400084cc 40007bf0: 90 10 00 13 mov %l3, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40007bf4: 90 10 00 15 mov %l5, %o0 40007bf8: 7f ff ff 73 call 400079c4 40007bfc: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 40007c00: 40 00 01 11 call 40008044 40007c04: 90 10 00 14 mov %l4, %o0 pthread_mutex_unlock (&r_chain->mutex); 40007c08: 10 80 00 12 b 40007c50 40007c0c: 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, 40007c10: d2 00 40 00 ld [ %g1 ], %o1 40007c14: 11 10 00 64 sethi %hi(0x40019000), %o0 40007c18: 94 10 20 00 clr %o2 40007c1c: 7f ff fe 9d call 40007690 40007c20: 90 12 23 8c or %o0, 0x38c, %o0 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 40007c24: a0 92 20 00 orcc %o0, 0, %l0 40007c28: 02 80 00 0e be 40007c60 <== ALWAYS TAKEN 40007c2c: a4 04 20 1c add %l0, 0x1c, %l2 { pthread_mutex_lock (&r_chain->mutex); 40007c30: 40 00 02 27 call 400084cc <== NOT EXECUTED 40007c34: 90 10 00 12 mov %l2, %o0 <== NOT EXECUTED rtems_aio_insert_prio (&r_chain->perfd, req); 40007c38: 90 04 20 08 add %l0, 8, %o0 <== NOT EXECUTED 40007c3c: 7f ff ff 62 call 400079c4 <== NOT EXECUTED 40007c40: 92 10 00 18 mov %i0, %o1 <== NOT EXECUTED pthread_cond_signal (&r_chain->cond); 40007c44: 40 00 01 00 call 40008044 <== NOT EXECUTED 40007c48: 90 04 20 20 add %l0, 0x20, %o0 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); 40007c4c: 90 10 00 12 mov %l2, %o0 <== NOT EXECUTED 40007c50: 40 00 02 40 call 40008550 40007c54: 01 00 00 00 nop /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); } } pthread_mutex_unlock (&aio_request_queue.mutex); 40007c58: 10 80 00 22 b 40007ce0 40007c5c: 11 10 00 64 sethi %hi(0x40019000), %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); 40007c60: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 40007c64: 11 10 00 64 sethi %hi(0x40019000), %o0 40007c68: d2 00 40 00 ld [ %g1 ], %o1 40007c6c: 90 12 23 98 or %o0, 0x398, %o0 40007c70: 7f ff fe 88 call 40007690 40007c74: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40007c78: 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); 40007c7c: a0 10 00 08 mov %o0, %l0 if (r_chain->new_fd == 1) { 40007c80: 80 a0 60 01 cmp %g1, 1 40007c84: 12 80 00 14 bne 40007cd4 40007c88: 90 02 20 08 add %o0, 8, %o0 40007c8c: 40 00 08 a9 call 40009f30 <_Chain_Insert> 40007c90: 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); 40007c94: 92 10 20 00 clr %o1 if (r_chain->new_fd == 1) { /* If this is a new fd chain we signal the idle threads that might be waiting for requests */ AIO_printf (" New chain on waiting queue \n "); rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; 40007c98: c0 24 20 18 clr [ %l0 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40007c9c: 40 00 01 b4 call 4000836c 40007ca0: 90 04 20 1c add %l0, 0x1c, %o0 pthread_cond_init (&r_chain->cond, NULL); 40007ca4: 92 10 20 00 clr %o1 40007ca8: 40 00 00 b9 call 40007f8c 40007cac: 90 04 20 20 add %l0, 0x20, %o0 pthread_cond_signal (&aio_request_queue.new_req); 40007cb0: 11 10 00 64 sethi %hi(0x40019000), %o0 40007cb4: 40 00 00 e4 call 40008044 40007cb8: 90 12 23 48 or %o0, 0x348, %o0 ! 40019348 ++aio_request_queue.idle_threads; 40007cbc: 03 10 00 64 sethi %hi(0x40019000), %g1 40007cc0: 82 10 63 44 or %g1, 0x344, %g1 ! 40019344 40007cc4: c4 00 60 68 ld [ %g1 + 0x68 ], %g2 40007cc8: 84 00 a0 01 inc %g2 40007ccc: 10 80 00 04 b 40007cdc 40007cd0: c4 20 60 68 st %g2, [ %g1 + 0x68 ] } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); 40007cd4: 7f ff ff 3c call 400079c4 40007cd8: 92 10 00 18 mov %i0, %o1 } } pthread_mutex_unlock (&aio_request_queue.mutex); 40007cdc: 11 10 00 64 sethi %hi(0x40019000), %o0 40007ce0: 40 00 02 1c call 40008550 40007ce4: 90 12 23 44 or %o0, 0x344, %o0 ! 40019344 return 0; } 40007ce8: b0 10 00 11 mov %l1, %i0 40007cec: 81 c7 e0 08 ret 40007cf0: 81 e8 00 00 restore =============================================================================== 40007740 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 40007740: 9d e3 bf 78 save %sp, -136, %sp <== NOT EXECUTED The fd chain is already unlocked */ struct timespec timeout; pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 40007744: 21 10 00 64 sethi %hi(0x40019000), %l0 <== NOT EXECUTED if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 40007748: a4 07 bf f4 add %fp, -12, %l2 <== NOT EXECUTED The fd chain is already unlocked */ struct timespec timeout; pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 4000774c: a0 14 23 44 or %l0, 0x344, %l0 <== NOT EXECUTED node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 40007750: a8 07 bf fc add %fp, -4, %l4 <== NOT EXECUTED pthread_cond_destroy (&r_chain->cond); free (r_chain); /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40007754: ae 04 20 58 add %l0, 0x58, %l7 <== NOT EXECUTED ++aio_request_queue.idle_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40007758: ac 04 20 04 add %l0, 4, %l6 <== NOT EXECUTED /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 4000775c: aa 04 20 48 add %l0, 0x48, %l5 <== NOT EXECUTED node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 40007760: a6 07 bf d8 add %fp, -40, %l3 <== NOT EXECUTED default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 40007764: ba 10 3f ff mov -1, %i5 <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); 40007768: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED 4000776c: 40 00 03 58 call 400084cc <== NOT EXECUTED 40007770: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED if (result != 0) 40007774: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40007778: 12 80 00 90 bne 400079b8 <== NOT EXECUTED 4000777c: 82 06 20 0c add %i0, 0xc, %g1 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40007780: e2 06 20 08 ld [ %i0 + 8 ], %l1 <== NOT EXECUTED /* If the locked chain is not empty, take the first request extract it, unlock the chain and process the request, in this way the user can supply more requests to this fd chain */ if (!rtems_chain_is_empty (chain)) { 40007784: 80 a4 40 01 cmp %l1, %g1 <== NOT EXECUTED 40007788: 02 80 00 3a be 40007870 <== NOT EXECUTED 4000778c: 01 00 00 00 nop <== NOT EXECUTED node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 40007790: 40 00 05 5b call 40008cfc <== NOT EXECUTED 40007794: 01 00 00 00 nop <== NOT EXECUTED 40007798: 92 10 00 14 mov %l4, %o1 <== NOT EXECUTED 4000779c: 40 00 04 5f call 40008918 <== NOT EXECUTED 400077a0: 94 10 00 13 mov %l3, %o2 <== NOT EXECUTED param.sched_priority = req->priority; 400077a4: c2 04 60 0c ld [ %l1 + 0xc ], %g1 <== NOT EXECUTED pthread_setschedparam (pthread_self(), req->policy, ¶m); 400077a8: 40 00 05 55 call 40008cfc <== NOT EXECUTED 400077ac: c2 27 bf d8 st %g1, [ %fp + -40 ] <== NOT EXECUTED 400077b0: d2 04 60 08 ld [ %l1 + 8 ], %o1 <== NOT EXECUTED 400077b4: 40 00 05 56 call 40008d0c <== NOT EXECUTED 400077b8: 94 10 00 13 mov %l3, %o2 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 400077bc: 40 00 09 c4 call 40009ecc <_Chain_Extract> <== NOT EXECUTED 400077c0: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 400077c4: 40 00 03 63 call 40008550 <== NOT EXECUTED 400077c8: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED switch (req->aiocbp->aio_lio_opcode) { 400077cc: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 <== NOT EXECUTED 400077d0: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 <== NOT EXECUTED 400077d4: 80 a0 a0 02 cmp %g2, 2 <== NOT EXECUTED 400077d8: 22 80 00 10 be,a 40007818 <== NOT EXECUTED 400077dc: c4 18 60 08 ldd [ %g1 + 8 ], %g2 <== NOT EXECUTED 400077e0: 80 a0 a0 03 cmp %g2, 3 <== NOT EXECUTED 400077e4: 02 80 00 15 be 40007838 <== NOT EXECUTED 400077e8: 80 a0 a0 01 cmp %g2, 1 <== NOT EXECUTED 400077ec: 32 80 00 19 bne,a 40007850 <== NOT EXECUTED 400077f0: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED case LIO_READ: result = pread (req->aiocbp->aio_fildes, 400077f4: c4 18 60 08 ldd [ %g1 + 8 ], %g2 <== NOT EXECUTED 400077f8: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED 400077fc: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 <== NOT EXECUTED 40007800: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 <== NOT EXECUTED 40007804: 96 10 00 02 mov %g2, %o3 <== NOT EXECUTED 40007808: 40 00 2c 2a call 400128b0 <== NOT EXECUTED 4000780c: 98 10 00 03 mov %g3, %o4 <== NOT EXECUTED (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 40007810: 10 80 00 0d b 40007844 <== NOT EXECUTED 40007814: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED case LIO_WRITE: result = pwrite (req->aiocbp->aio_fildes, 40007818: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED 4000781c: d2 00 60 10 ld [ %g1 + 0x10 ], %o1 <== NOT EXECUTED 40007820: d4 00 60 14 ld [ %g1 + 0x14 ], %o2 <== NOT EXECUTED 40007824: 96 10 00 02 mov %g2, %o3 <== NOT EXECUTED 40007828: 40 00 2c 5e call 400129a0 <== NOT EXECUTED 4000782c: 98 10 00 03 mov %g3, %o4 <== NOT EXECUTED (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 40007830: 10 80 00 05 b 40007844 <== NOT EXECUTED 40007834: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED case LIO_SYNC: result = fsync (req->aiocbp->aio_fildes); 40007838: 40 00 1b a9 call 4000e6dc <== NOT EXECUTED 4000783c: d0 00 40 00 ld [ %g1 ], %o0 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { 40007840: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED 40007844: 32 80 00 08 bne,a 40007864 <== NOT EXECUTED 40007848: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 <== NOT EXECUTED req->aiocbp->return_value = -1; 4000784c: e2 04 60 14 ld [ %l1 + 0x14 ], %l1 <== NOT EXECUTED req->aiocbp->error_code = errno; 40007850: 40 00 28 e4 call 40011be0 <__errno> <== NOT EXECUTED 40007854: fa 24 60 38 st %i5, [ %l1 + 0x38 ] <== NOT EXECUTED 40007858: c2 02 00 00 ld [ %o0 ], %g1 <== NOT EXECUTED 4000785c: 10 bf ff c3 b 40007768 <== NOT EXECUTED 40007860: c2 24 60 34 st %g1, [ %l1 + 0x34 ] <== NOT EXECUTED } else { req->aiocbp->return_value = result; 40007864: d0 20 60 38 st %o0, [ %g1 + 0x38 ] <== NOT EXECUTED req->aiocbp->error_code = 0; 40007868: 10 bf ff c0 b 40007768 <== NOT EXECUTED 4000786c: c0 20 60 34 clr [ %g1 + 0x34 ] <== NOT EXECUTED wait for a signal on chain, this will unlock the queue. The fd chain is already unlocked */ struct timespec timeout; pthread_mutex_unlock (&r_chain->mutex); 40007870: 40 00 03 38 call 40008550 <== NOT EXECUTED 40007874: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED pthread_mutex_lock (&aio_request_queue.mutex); 40007878: 40 00 03 15 call 400084cc <== NOT EXECUTED 4000787c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED if (rtems_chain_is_empty (chain)) 40007880: c2 06 20 08 ld [ %i0 + 8 ], %g1 <== NOT EXECUTED 40007884: 80 a0 40 11 cmp %g1, %l1 <== NOT EXECUTED 40007888: 32 bf ff b9 bne,a 4000776c <== NOT EXECUTED 4000788c: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED { clock_gettime (CLOCK_REALTIME, &timeout); 40007890: 92 10 00 12 mov %l2, %o1 <== NOT EXECUTED 40007894: 40 00 01 65 call 40007e28 <== NOT EXECUTED 40007898: 90 10 20 01 mov 1, %o0 <== NOT EXECUTED timeout.tv_sec += 3; 4000789c: c2 07 bf f4 ld [ %fp + -12 ], %g1 <== NOT EXECUTED timeout.tv_nsec = 0; 400078a0: c0 27 bf f8 clr [ %fp + -8 ] <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 400078a4: 82 00 60 03 add %g1, 3, %g1 <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 400078a8: a2 06 20 20 add %i0, 0x20, %l1 <== NOT EXECUTED pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 400078ac: c2 27 bf f4 st %g1, [ %fp + -12 ] <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 400078b0: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED 400078b4: 92 10 00 10 mov %l0, %o1 <== NOT EXECUTED 400078b8: 40 00 02 02 call 400080c0 <== NOT EXECUTED 400078bc: 94 10 00 12 mov %l2, %o2 <== NOT EXECUTED &aio_request_queue.mutex, &timeout); /* If no requests were added to the chain we delete the fd chain from the queue and start working with idle fd chains */ if (result == ETIMEDOUT) { 400078c0: 80 a2 20 74 cmp %o0, 0x74 <== NOT EXECUTED 400078c4: 32 bf ff aa bne,a 4000776c <== NOT EXECUTED 400078c8: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED 400078cc: 40 00 09 80 call 40009ecc <_Chain_Extract> <== NOT EXECUTED 400078d0: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 400078d4: 40 00 02 55 call 40008228 <== NOT EXECUTED 400078d8: 90 10 00 1c mov %i4, %o0 <== NOT EXECUTED pthread_cond_destroy (&r_chain->cond); 400078dc: 40 00 01 77 call 40007eb8 <== NOT EXECUTED 400078e0: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED free (r_chain); 400078e4: 7f ff f1 f2 call 400040ac <== NOT EXECUTED 400078e8: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { 400078ec: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 <== NOT EXECUTED 400078f0: 80 a0 40 17 cmp %g1, %l7 <== NOT EXECUTED 400078f4: 12 80 00 2d bne 400079a8 <== NOT EXECUTED 400078f8: 92 10 00 12 mov %l2, %o1 <== NOT EXECUTED ++aio_request_queue.idle_threads; 400078fc: c2 04 20 68 ld [ %l0 + 0x68 ], %g1 <== NOT EXECUTED 40007900: 82 00 60 01 inc %g1 <== NOT EXECUTED clock_gettime (CLOCK_REALTIME, &timeout); 40007904: 90 10 20 01 mov 1, %o0 <== NOT EXECUTED 40007908: 40 00 01 48 call 40007e28 <== NOT EXECUTED 4000790c: c2 24 20 68 st %g1, [ %l0 + 0x68 ] <== NOT EXECUTED timeout.tv_sec += 3; 40007910: c2 07 bf f4 ld [ %fp + -12 ], %g1 <== NOT EXECUTED timeout.tv_nsec = 0; 40007914: c0 27 bf f8 clr [ %fp + -8 ] <== NOT EXECUTED /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { ++aio_request_queue.idle_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40007918: 82 00 60 03 add %g1, 3, %g1 <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 4000791c: 90 10 00 16 mov %l6, %o0 <== NOT EXECUTED /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { ++aio_request_queue.idle_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40007920: c2 27 bf f4 st %g1, [ %fp + -12 ] <== NOT EXECUTED timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40007924: 92 10 00 10 mov %l0, %o1 <== NOT EXECUTED 40007928: 40 00 01 e6 call 400080c0 <== NOT EXECUTED 4000792c: 94 10 00 12 mov %l2, %o2 <== NOT EXECUTED &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { 40007930: 80 a2 20 74 cmp %o0, 0x74 <== NOT EXECUTED 40007934: 32 80 00 06 bne,a 4000794c <== NOT EXECUTED 40007938: c2 04 20 68 ld [ %l0 + 0x68 ], %g1 <== NOT EXECUTED pthread_mutex_unlock (&aio_request_queue.mutex); 4000793c: 40 00 03 05 call 40008550 <== NOT EXECUTED 40007940: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return NULL; 40007944: 81 c7 e0 08 ret <== NOT EXECUTED 40007948: 91 e8 20 00 restore %g0, 0, %o0 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 4000794c: e2 04 20 54 ld [ %l0 + 0x54 ], %l1 <== NOT EXECUTED return NULL; } /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; 40007950: 82 00 7f ff add %g1, -1, %g1 <== NOT EXECUTED 40007954: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED 40007958: 40 00 09 5d call 40009ecc <_Chain_Extract> <== NOT EXECUTED 4000795c: c2 24 20 68 st %g1, [ %l0 + 0x68 ] <== NOT EXECUTED node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40007960: d2 04 60 14 ld [ %l1 + 0x14 ], %o1 <== NOT EXECUTED 40007964: 94 10 20 01 mov 1, %o2 <== NOT EXECUTED 40007968: 7f ff ff 4a call 40007690 <== NOT EXECUTED 4000796c: 90 10 00 15 mov %l5, %o0 <== NOT EXECUTED ((rtems_aio_request_chain *)node)->fildes, 1); r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); 40007970: 92 10 20 00 clr %o1 <== NOT EXECUTED /* Otherwise move this chain to the working chain and start the loop all over again */ --aio_request_queue.idle_threads; node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40007974: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED ((rtems_aio_request_chain *)node)->fildes, 1); r_chain->new_fd = 0; 40007978: c0 22 20 18 clr [ %o0 + 0x18 ] <== NOT EXECUTED pthread_mutex_init (&r_chain->mutex, NULL); 4000797c: 40 00 02 7c call 4000836c <== NOT EXECUTED 40007980: 90 02 20 1c add %o0, 0x1c, %o0 <== NOT EXECUTED pthread_cond_init (&r_chain->cond, NULL); 40007984: 90 06 20 20 add %i0, 0x20, %o0 <== NOT EXECUTED 40007988: 40 00 01 81 call 40007f8c <== NOT EXECUTED 4000798c: 92 10 20 00 clr %o1 <== NOT EXECUTED r_chain->perfd = ((rtems_aio_request_chain *)node)->perfd; 40007990: 90 06 20 08 add %i0, 8, %o0 <== NOT EXECUTED 40007994: 92 04 60 08 add %l1, 8, %o1 <== NOT EXECUTED 40007998: 40 00 2b 1b call 40012604 <== NOT EXECUTED 4000799c: 94 10 20 0c mov 0xc, %o2 <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); 400079a0: 10 bf ff 73 b 4000776c <== NOT EXECUTED 400079a4: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED r_chain->perfd = ((rtems_aio_request_chain *)node)->perfd; } else /* If there was a request added in the initial fd chain then release the mutex and process it */ pthread_mutex_unlock (&aio_request_queue.mutex); 400079a8: 40 00 02 ea call 40008550 <== NOT EXECUTED 400079ac: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); 400079b0: 10 bf ff 6f b 4000776c <== NOT EXECUTED 400079b4: b8 06 20 1c add %i0, 0x1c, %i4 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 400079b8: b0 10 20 00 clr %i0 <== NOT EXECUTED 400079bc: 81 c7 e0 08 ret <== NOT EXECUTED 400079c0: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 400075b0 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 400075b0: 9d e3 bf a0 save %sp, -96, %sp int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 400075b4: 21 10 00 64 sethi %hi(0x40019000), %l0 400075b8: 40 00 04 2e call 40008670 400075bc: 90 14 23 4c or %l0, 0x34c, %o0 ! 4001934c if (result != 0) 400075c0: b0 92 20 00 orcc %o0, 0, %i0 400075c4: 12 80 00 31 bne 40007688 <== NEVER TAKEN 400075c8: 90 14 23 4c or %l0, 0x34c, %o0 return result; result = 400075cc: 40 00 04 35 call 400086a0 400075d0: 92 10 20 00 clr %o1 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 400075d4: 80 a2 20 00 cmp %o0, 0 400075d8: 22 80 00 05 be,a 400075ec <== ALWAYS TAKEN 400075dc: 11 10 00 64 sethi %hi(0x40019000), %o0 pthread_attr_destroy (&aio_request_queue.attr); 400075e0: 40 00 04 18 call 40008640 <== NOT EXECUTED 400075e4: 90 14 23 4c or %l0, 0x34c, %o0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 400075e8: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED 400075ec: 92 10 20 00 clr %o1 400075f0: 40 00 03 5f call 4000836c 400075f4: 90 12 23 44 or %o0, 0x344, %o0 if (result != 0) 400075f8: 80 a2 20 00 cmp %o0, 0 400075fc: 22 80 00 06 be,a 40007614 <== ALWAYS TAKEN 40007600: 11 10 00 64 sethi %hi(0x40019000), %o0 pthread_attr_destroy (&aio_request_queue.attr); 40007604: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED 40007608: 40 00 04 0e call 40008640 <== NOT EXECUTED 4000760c: 90 12 23 4c or %o0, 0x34c, %o0 ! 4001934c <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 40007610: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED 40007614: 92 10 20 00 clr %o1 40007618: 40 00 02 5d call 40007f8c 4000761c: 90 12 23 48 or %o0, 0x348, %o0 if (result != 0) { 40007620: b0 92 20 00 orcc %o0, 0, %i0 40007624: 02 80 00 09 be 40007648 <== ALWAYS TAKEN 40007628: 03 10 00 64 sethi %hi(0x40019000), %g1 pthread_mutex_destroy (&aio_request_queue.mutex); 4000762c: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED 40007630: 40 00 02 fe call 40008228 <== NOT EXECUTED 40007634: 90 12 23 44 or %o0, 0x344, %o0 ! 40019344 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40007638: 11 10 00 64 sethi %hi(0x40019000), %o0 <== NOT EXECUTED 4000763c: 40 00 04 01 call 40008640 <== NOT EXECUTED 40007640: 90 12 23 4c or %o0, 0x34c, %o0 ! 4001934c <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007644: 03 10 00 64 sethi %hi(0x40019000), %g1 <== NOT EXECUTED 40007648: 82 10 63 44 or %g1, 0x344, %g1 ! 40019344 4000764c: 84 00 60 4c add %g1, 0x4c, %g2 40007650: c4 20 60 48 st %g2, [ %g1 + 0x48 ] head->previous = NULL; tail->previous = head; 40007654: 84 00 60 48 add %g1, 0x48, %g2 40007658: 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; 4000765c: 84 00 60 58 add %g1, 0x58, %g2 40007660: c4 20 60 54 st %g2, [ %g1 + 0x54 ] head->previous = NULL; tail->previous = head; 40007664: 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; 40007668: c0 20 60 4c clr [ %g1 + 0x4c ] tail->previous = head; 4000766c: 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; 40007670: 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; 40007674: 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; 40007678: c0 20 60 64 clr [ %g1 + 0x64 ] aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 4000767c: 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; 40007680: c0 20 60 68 clr [ %g1 + 0x68 ] aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 40007684: c4 20 60 60 st %g2, [ %g1 + 0x60 ] return result; } 40007688: 81 c7 e0 08 ret 4000768c: 81 e8 00 00 restore =============================================================================== 400079c4 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 400079c4: 9d e3 bf a0 save %sp, -96, %sp } AIO_printf ("Thread finished\n"); return NULL; } 400079c8: c2 06 00 00 ld [ %i0 ], %g1 400079cc: 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)) { 400079d0: 80 a0 40 03 cmp %g1, %g3 400079d4: 02 80 00 10 be 40007a14 <== NEVER TAKEN 400079d8: 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; 400079dc: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 while (req->aiocbp->aio_reqprio > prio && 400079e0: 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; 400079e4: c8 01 20 18 ld [ %g4 + 0x18 ], %g4 while (req->aiocbp->aio_reqprio > prio && 400079e8: 10 80 00 04 b 400079f8 400079ec: 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; 400079f0: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 400079f4: 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 && 400079f8: 80 a3 40 04 cmp %o5, %g4 400079fc: 04 80 00 04 ble 40007a0c <== ALWAYS TAKEN 40007a00: 80 a0 40 03 cmp %g1, %g3 40007a04: 32 bf ff fb bne,a 400079f0 <== NOT EXECUTED 40007a08: 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 ); 40007a0c: f0 00 60 04 ld [ %g1 + 4 ], %i0 40007a10: b2 10 00 02 mov %g2, %i1 40007a14: 40 00 09 47 call 40009f30 <_Chain_Insert> 40007a18: 81 e8 00 00 restore =============================================================================== 40007a20 : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { 40007a20: 9d e3 bf a0 save %sp, -96, %sp <== NOT EXECUTED while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; 40007a24: a4 10 20 8c mov 0x8c, %l2 <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40007a28: e0 06 20 08 ld [ %i0 + 8 ], %l0 <== NOT EXECUTED while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; 40007a2c: a2 10 3f ff mov -1, %l1 <== NOT EXECUTED rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 40007a30: 10 80 00 09 b 40007a54 <== NOT EXECUTED 40007a34: b0 06 20 0c add %i0, 0xc, %i0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40007a38: 40 00 09 25 call 40009ecc <_Chain_Extract> <== NOT EXECUTED 40007a3c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; 40007a40: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 <== NOT EXECUTED req->aiocbp->return_value = -1; free (req); 40007a44: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; 40007a48: e4 20 60 34 st %l2, [ %g1 + 0x34 ] <== NOT EXECUTED req->aiocbp->return_value = -1; free (req); 40007a4c: 7f ff f1 98 call 400040ac <== NOT EXECUTED 40007a50: e2 20 60 38 st %l1, [ %g1 + 0x38 ] <== NOT EXECUTED rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 40007a54: 80 a4 00 18 cmp %l0, %i0 <== NOT EXECUTED 40007a58: 12 bf ff f8 bne 40007a38 <== NOT EXECUTED 40007a5c: 01 00 00 00 nop <== NOT EXECUTED rtems_aio_request *req = (rtems_aio_request *) node; req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); } } 40007a60: 81 c7 e0 08 ret <== NOT EXECUTED 40007a64: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40007a68 : * 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) { 40007a68: 9d e3 bf a0 save %sp, -96, %sp <== NOT EXECUTED } AIO_printf ("Thread finished\n"); return NULL; } 40007a6c: e0 06 00 00 ld [ %i0 ], %l0 <== NOT EXECUTED 40007a70: b0 06 20 04 add %i0, 4, %i0 <== NOT EXECUTED rtems_chain_node *node = rtems_chain_first (chain); rtems_aio_request *current; current = (rtems_aio_request *) node; while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) { 40007a74: 80 a4 00 18 cmp %l0, %i0 <== NOT EXECUTED 40007a78: 02 80 00 12 be 40007ac0 <== NOT EXECUTED 40007a7c: 01 00 00 00 nop <== NOT EXECUTED 40007a80: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 <== NOT EXECUTED 40007a84: 80 a0 40 19 cmp %g1, %i1 <== NOT EXECUTED 40007a88: 32 bf ff fb bne,a 40007a74 <== NOT EXECUTED 40007a8c: e0 04 00 00 ld [ %l0 ], %l0 <== NOT EXECUTED 40007a90: 40 00 09 0f call 40009ecc <_Chain_Extract> <== NOT EXECUTED 40007a94: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 40007a98: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 <== NOT EXECUTED 40007a9c: 84 10 20 8c mov 0x8c, %g2 <== NOT EXECUTED 40007aa0: c4 20 60 34 st %g2, [ %g1 + 0x34 ] <== NOT EXECUTED current->aiocbp->return_value = -1; 40007aa4: 84 10 3f ff mov -1, %g2 <== NOT EXECUTED free (current); 40007aa8: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; current->aiocbp->return_value = -1; 40007aac: c4 20 60 38 st %g2, [ %g1 + 0x38 ] <== NOT EXECUTED free (current); 40007ab0: 7f ff f1 7f call 400040ac <== NOT EXECUTED 40007ab4: b0 10 20 00 clr %i0 <== NOT EXECUTED } return AIO_CANCELED; 40007ab8: 81 c7 e0 08 ret <== NOT EXECUTED 40007abc: 81 e8 00 00 restore <== NOT EXECUTED } 40007ac0: 81 c7 e0 08 ret <== NOT EXECUTED 40007ac4: 91 e8 20 01 restore %g0, 1, %o0 <== NOT EXECUTED =============================================================================== 40007710 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 40007710: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE bool rtems_chain_append_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Append_with_empty_check( chain, node ); 40007714: 90 10 00 18 mov %i0, %o0 40007718: 40 00 01 67 call 40007cb4 <_Chain_Append_with_empty_check> 4000771c: 92 10 00 19 mov %i1, %o1 rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { 40007720: 80 8a 20 ff btst 0xff, %o0 40007724: 02 80 00 05 be 40007738 <== NEVER TAKEN 40007728: 01 00 00 00 nop sc = rtems_event_send( task, events ); 4000772c: b0 10 00 1a mov %i2, %i0 40007730: 7f ff fd 75 call 40006d04 40007734: 93 e8 00 1b restore %g0, %i3, %o1 } return sc; } 40007738: 81 c7 e0 08 ret 4000773c: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 40007770 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 40007770: 9d e3 bf 98 save %sp, -104, %sp 40007774: 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( 40007778: 10 80 00 09 b 4000779c 4000777c: a4 07 bf fc add %fp, -4, %l2 40007780: 92 10 20 00 clr %o1 40007784: 94 10 00 1a mov %i2, %o2 40007788: 7f ff fc fb call 40006b74 4000778c: 96 10 00 12 mov %l2, %o3 ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 40007790: 80 a2 20 00 cmp %o0, 0 40007794: 32 80 00 09 bne,a 400077b8 <== ALWAYS TAKEN 40007798: 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 ); 4000779c: 40 00 01 82 call 40007da4 <_Chain_Get> 400077a0: 90 10 00 10 mov %l0, %o0 sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 400077a4: a2 92 20 00 orcc %o0, 0, %l1 400077a8: 02 bf ff f6 be 40007780 400077ac: 90 10 00 19 mov %i1, %o0 400077b0: 90 10 20 00 clr %o0 timeout, &out ); } *node_ptr = node; 400077b4: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 400077b8: 81 c7 e0 08 ret 400077bc: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 400077c0 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 400077c0: 9d e3 bf a0 save %sp, -96, %sp RTEMS_INLINE_ROUTINE bool rtems_chain_prepend_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Prepend_with_empty_check( chain, node ); 400077c4: 90 10 00 18 mov %i0, %o0 400077c8: 40 00 01 91 call 40007e0c <_Chain_Prepend_with_empty_check> 400077cc: 92 10 00 19 mov %i1, %o1 rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { 400077d0: 80 8a 20 ff btst 0xff, %o0 400077d4: 02 80 00 05 be 400077e8 <== NEVER TAKEN 400077d8: 01 00 00 00 nop sc = rtems_event_send( task, events ); 400077dc: b0 10 00 1a mov %i2, %i0 400077e0: 7f ff fd 49 call 40006d04 400077e4: 93 e8 00 1b restore %g0, %i3, %o1 } return sc; } 400077e8: 81 c7 e0 08 ret <== NOT EXECUTED 400077ec: 91 e8 20 00 restore %g0, 0, %o0 <== NOT EXECUTED =============================================================================== 40009aa8 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 40009aa8: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 40009aac: 80 a6 20 00 cmp %i0, 0 40009ab0: 02 80 00 1a be 40009b18 <== NEVER TAKEN 40009ab4: 21 10 00 a2 sethi %hi(0x40028800), %l0 40009ab8: a0 14 23 3c or %l0, 0x33c, %l0 ! 40028b3c <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 40009abc: 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 ]; 40009ac0: c2 04 00 00 ld [ %l0 ], %g1 40009ac4: e4 00 60 04 ld [ %g1 + 4 ], %l2 if ( !information ) 40009ac8: 80 a4 a0 00 cmp %l2, 0 40009acc: 12 80 00 0b bne 40009af8 40009ad0: a2 10 20 01 mov 1, %l1 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40009ad4: 10 80 00 0e b 40009b0c 40009ad8: a0 04 20 04 add %l0, 4, %l0 the_thread = (Thread_Control *)information->local_table[ i ]; 40009adc: 83 2c 60 02 sll %l1, 2, %g1 40009ae0: d0 00 80 01 ld [ %g2 + %g1 ], %o0 if ( !the_thread ) 40009ae4: 80 a2 20 00 cmp %o0, 0 40009ae8: 02 80 00 04 be 40009af8 <== NEVER TAKEN 40009aec: a2 04 60 01 inc %l1 continue; (*routine)(the_thread); 40009af0: 9f c6 00 00 call %i0 40009af4: 01 00 00 00 nop information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 40009af8: c2 14 a0 10 lduh [ %l2 + 0x10 ], %g1 40009afc: 80 a4 40 01 cmp %l1, %g1 40009b00: 28 bf ff f7 bleu,a 40009adc 40009b04: c4 04 a0 1c ld [ %l2 + 0x1c ], %g2 40009b08: 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++ ) { 40009b0c: 80 a4 00 13 cmp %l0, %l3 40009b10: 32 bf ff ed bne,a 40009ac4 40009b14: c2 04 00 00 ld [ %l0 ], %g1 40009b18: 81 c7 e0 08 ret 40009b1c: 81 e8 00 00 restore =============================================================================== 40014be4 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 40014be4: 9d e3 bf a0 save %sp, -96, %sp 40014be8: a0 10 00 18 mov %i0, %l0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 40014bec: 80 a4 20 00 cmp %l0, 0 40014bf0: 02 80 00 1f be 40014c6c 40014bf4: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !starting_address ) 40014bf8: 80 a6 60 00 cmp %i1, 0 40014bfc: 02 80 00 1c be 40014c6c 40014c00: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !id ) 40014c04: 80 a7 60 00 cmp %i5, 0 40014c08: 02 80 00 19 be 40014c6c <== NEVER TAKEN 40014c0c: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 40014c10: 02 80 00 32 be 40014cd8 40014c14: 80 a6 a0 00 cmp %i2, 0 40014c18: 02 80 00 30 be 40014cd8 40014c1c: 80 a6 80 1b cmp %i2, %i3 40014c20: 0a 80 00 13 bcs 40014c6c 40014c24: b0 10 20 08 mov 8, %i0 40014c28: 80 8e e0 07 btst 7, %i3 40014c2c: 12 80 00 10 bne 40014c6c 40014c30: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 40014c34: 12 80 00 0e bne 40014c6c 40014c38: b0 10 20 09 mov 9, %i0 40014c3c: 03 10 00 fb sethi %hi(0x4003ec00), %g1 40014c40: c4 00 62 c0 ld [ %g1 + 0x2c0 ], %g2 ! 4003eec0 <_Thread_Dispatch_disable_level> 40014c44: 84 00 a0 01 inc %g2 40014c48: c4 20 62 c0 st %g2, [ %g1 + 0x2c0 ] * 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 ); 40014c4c: 25 10 00 fb sethi %hi(0x4003ec00), %l2 40014c50: 40 00 12 94 call 400196a0 <_Objects_Allocate> 40014c54: 90 14 a0 d4 or %l2, 0xd4, %o0 ! 4003ecd4 <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 40014c58: a2 92 20 00 orcc %o0, 0, %l1 40014c5c: 12 80 00 06 bne 40014c74 40014c60: 92 10 00 1b mov %i3, %o1 _Thread_Enable_dispatch(); 40014c64: 40 00 16 f2 call 4001a82c <_Thread_Enable_dispatch> 40014c68: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 40014c6c: 81 c7 e0 08 ret 40014c70: 81 e8 00 00 restore _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 40014c74: f2 24 60 10 st %i1, [ %l1 + 0x10 ] the_partition->length = length; 40014c78: f4 24 60 14 st %i2, [ %l1 + 0x14 ] the_partition->buffer_size = buffer_size; 40014c7c: f6 24 60 18 st %i3, [ %l1 + 0x18 ] the_partition->attribute_set = attribute_set; 40014c80: f8 24 60 1c st %i4, [ %l1 + 0x1c ] the_partition->number_of_used_blocks = 0; 40014c84: c0 24 60 20 clr [ %l1 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 40014c88: 40 00 62 a7 call 4002d724 <.udiv> 40014c8c: 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, 40014c90: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 40014c94: 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, 40014c98: 96 10 00 1b mov %i3, %o3 40014c9c: a6 04 60 24 add %l1, 0x24, %l3 40014ca0: 40 00 0c 7a call 40017e88 <_Chain_Initialize> 40014ca4: 90 10 00 13 mov %l3, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40014ca8: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40014cac: a4 14 a0 d4 or %l2, 0xd4, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40014cb0: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40014cb4: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40014cb8: 85 28 a0 02 sll %g2, 2, %g2 40014cbc: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40014cc0: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 40014cc4: c2 27 40 00 st %g1, [ %i5 ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 40014cc8: 40 00 16 d9 call 4001a82c <_Thread_Enable_dispatch> 40014ccc: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40014cd0: 81 c7 e0 08 ret 40014cd4: 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; 40014cd8: b0 10 20 08 mov 8, %i0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40014cdc: 81 c7 e0 08 ret 40014ce0: 81 e8 00 00 restore =============================================================================== 40007cc8 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 40007cc8: 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 ); 40007ccc: 11 10 00 81 sethi %hi(0x40020400), %o0 40007cd0: 92 10 00 18 mov %i0, %o1 40007cd4: 90 12 20 7c or %o0, 0x7c, %o0 40007cd8: 40 00 09 15 call 4000a12c <_Objects_Get> 40007cdc: 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 ) { 40007ce0: c2 07 bf fc ld [ %fp + -4 ], %g1 40007ce4: 80 a0 60 00 cmp %g1, 0 40007ce8: 12 80 00 66 bne 40007e80 40007cec: a0 10 00 08 mov %o0, %l0 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40007cf0: 25 10 00 82 sethi %hi(0x40020800), %l2 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 40007cf4: c4 02 20 40 ld [ %o0 + 0x40 ], %g2 40007cf8: a4 14 a3 38 or %l2, 0x338, %l2 40007cfc: c2 04 a0 0c ld [ %l2 + 0xc ], %g1 40007d00: 80 a0 80 01 cmp %g2, %g1 40007d04: 02 80 00 06 be 40007d1c 40007d08: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 40007d0c: 40 00 0c 1a call 4000ad74 <_Thread_Enable_dispatch> 40007d10: b0 10 20 17 mov 0x17, %i0 return RTEMS_NOT_OWNER_OF_RESOURCE; 40007d14: 81 c7 e0 08 ret 40007d18: 81 e8 00 00 restore } if ( length == RTEMS_PERIOD_STATUS ) { 40007d1c: 12 80 00 0e bne 40007d54 40007d20: 01 00 00 00 nop switch ( the_period->state ) { 40007d24: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40007d28: 80 a0 60 04 cmp %g1, 4 40007d2c: 18 80 00 06 bgu 40007d44 <== NEVER TAKEN 40007d30: b0 10 20 00 clr %i0 40007d34: 83 28 60 02 sll %g1, 2, %g1 40007d38: 05 10 00 79 sethi %hi(0x4001e400), %g2 40007d3c: 84 10 a0 7c or %g2, 0x7c, %g2 ! 4001e47c 40007d40: 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(); 40007d44: 40 00 0c 0c call 4000ad74 <_Thread_Enable_dispatch> 40007d48: 01 00 00 00 nop return( return_value ); 40007d4c: 81 c7 e0 08 ret 40007d50: 81 e8 00 00 restore } _ISR_Disable( level ); 40007d54: 7f ff eb bd call 40002c48 40007d58: 01 00 00 00 nop 40007d5c: a6 10 00 08 mov %o0, %l3 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 40007d60: e2 04 20 38 ld [ %l0 + 0x38 ], %l1 40007d64: 80 a4 60 00 cmp %l1, 0 40007d68: 12 80 00 15 bne 40007dbc 40007d6c: 80 a4 60 02 cmp %l1, 2 _ISR_Enable( level ); 40007d70: 7f ff eb ba call 40002c58 40007d74: 01 00 00 00 nop /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 40007d78: 7f ff ff 7a call 40007b60 <_Rate_monotonic_Initiate_statistics> 40007d7c: 90 10 00 10 mov %l0, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40007d80: 82 10 20 02 mov 2, %g1 40007d84: c2 24 20 38 st %g1, [ %l0 + 0x38 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40007d88: 03 10 00 20 sethi %hi(0x40008000), %g1 40007d8c: 82 10 61 50 or %g1, 0x150, %g1 ! 40008150 <_Rate_monotonic_Timeout> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40007d90: c0 24 20 18 clr [ %l0 + 0x18 ] the_watchdog->routine = routine; 40007d94: c2 24 20 2c st %g1, [ %l0 + 0x2c ] the_watchdog->id = id; 40007d98: f0 24 20 30 st %i0, [ %l0 + 0x30 ] the_watchdog->user_data = user_data; 40007d9c: c0 24 20 34 clr [ %l0 + 0x34 ] _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 40007da0: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007da4: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007da8: 11 10 00 81 sethi %hi(0x40020400), %o0 40007dac: 92 04 20 10 add %l0, 0x10, %o1 40007db0: 40 00 10 2d call 4000be64 <_Watchdog_Insert> 40007db4: 90 12 22 c0 or %o0, 0x2c0, %o0 40007db8: 30 80 00 1b b,a 40007e24 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 40007dbc: 12 80 00 1e bne 40007e34 40007dc0: 80 a4 60 04 cmp %l1, 4 /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 40007dc4: 7f ff ff 83 call 40007bd0 <_Rate_monotonic_Update_statistics> 40007dc8: 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; 40007dcc: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 40007dd0: 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; 40007dd4: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 40007dd8: 7f ff eb a0 call 40002c58 40007ddc: 90 10 00 13 mov %l3, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 40007de0: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40007de4: c2 04 20 08 ld [ %l0 + 8 ], %g1 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40007de8: 13 00 00 10 sethi %hi(0x4000), %o1 40007dec: 40 00 0e 1b call 4000b658 <_Thread_Set_state> 40007df0: c2 22 20 20 st %g1, [ %o0 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 40007df4: 7f ff eb 95 call 40002c48 40007df8: 01 00 00 00 nop local_state = the_period->state; 40007dfc: e6 04 20 38 ld [ %l0 + 0x38 ], %l3 the_period->state = RATE_MONOTONIC_ACTIVE; 40007e00: e2 24 20 38 st %l1, [ %l0 + 0x38 ] _ISR_Enable( level ); 40007e04: 7f ff eb 95 call 40002c58 40007e08: 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 ) 40007e0c: 80 a4 e0 03 cmp %l3, 3 40007e10: 12 80 00 05 bne 40007e24 40007e14: 01 00 00 00 nop _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40007e18: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 40007e1c: 40 00 0b 0a call 4000aa44 <_Thread_Clear_state> 40007e20: 13 00 00 10 sethi %hi(0x4000), %o1 _Thread_Enable_dispatch(); 40007e24: 40 00 0b d4 call 4000ad74 <_Thread_Enable_dispatch> 40007e28: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40007e2c: 81 c7 e0 08 ret 40007e30: 81 e8 00 00 restore } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 40007e34: 12 bf ff b8 bne 40007d14 <== NEVER TAKEN 40007e38: b0 10 20 04 mov 4, %i0 /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 40007e3c: 7f ff ff 65 call 40007bd0 <_Rate_monotonic_Update_statistics> 40007e40: 90 10 00 10 mov %l0, %o0 _ISR_Enable( level ); 40007e44: 7f ff eb 85 call 40002c58 40007e48: 90 10 00 13 mov %l3, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40007e4c: 82 10 20 02 mov 2, %g1 40007e50: 92 04 20 10 add %l0, 0x10, %o1 40007e54: 11 10 00 81 sethi %hi(0x40020400), %o0 40007e58: 90 12 22 c0 or %o0, 0x2c0, %o0 ! 400206c0 <_Watchdog_Ticks_chain> 40007e5c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; 40007e60: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007e64: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007e68: 40 00 0f ff call 4000be64 <_Watchdog_Insert> 40007e6c: b0 10 20 06 mov 6, %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 40007e70: 40 00 0b c1 call 4000ad74 <_Thread_Enable_dispatch> 40007e74: 01 00 00 00 nop return RTEMS_TIMEOUT; 40007e78: 81 c7 e0 08 ret 40007e7c: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 40007e80: b0 10 20 04 mov 4, %i0 } 40007e84: 81 c7 e0 08 ret 40007e88: 81 e8 00 00 restore =============================================================================== 40007e8c : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 40007e8c: 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 ) 40007e90: 80 a6 60 00 cmp %i1, 0 40007e94: 02 80 00 79 be 40008078 <== NEVER TAKEN 40007e98: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 40007e9c: 13 10 00 79 sethi %hi(0x4001e400), %o1 40007ea0: 9f c6 40 00 call %i1 40007ea4: 92 12 60 90 or %o1, 0x90, %o1 ! 4001e490 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 40007ea8: 90 10 00 18 mov %i0, %o0 40007eac: 13 10 00 79 sethi %hi(0x4001e400), %o1 40007eb0: 9f c6 40 00 call %i1 40007eb4: 92 12 60 b0 or %o1, 0xb0, %o1 ! 4001e4b0 (*print)( context, "--- Wall times are in seconds ---\n" ); 40007eb8: 90 10 00 18 mov %i0, %o0 40007ebc: 13 10 00 79 sethi %hi(0x4001e400), %o1 40007ec0: 9f c6 40 00 call %i1 40007ec4: 92 12 60 d8 or %o1, 0xd8, %o1 ! 4001e4d8 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 40007ec8: 90 10 00 18 mov %i0, %o0 40007ecc: 13 10 00 79 sethi %hi(0x4001e400), %o1 40007ed0: 9f c6 40 00 call %i1 40007ed4: 92 12 61 00 or %o1, 0x100, %o1 ! 4001e500 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 40007ed8: 90 10 00 18 mov %i0, %o0 40007edc: 13 10 00 79 sethi %hi(0x4001e400), %o1 40007ee0: 9f c6 40 00 call %i1 40007ee4: 92 12 61 50 or %o1, 0x150, %o1 ! 4001e550 /* * 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 ; 40007ee8: 3b 10 00 81 sethi %hi(0x40020400), %i5 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007eec: 2b 10 00 79 sethi %hi(0x4001e400), %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 ; 40007ef0: 82 17 60 7c or %i5, 0x7c, %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, 40007ef4: 27 10 00 79 sethi %hi(0x4001e400), %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, 40007ef8: 35 10 00 79 sethi %hi(0x4001e400), %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 ; 40007efc: e0 00 60 08 ld [ %g1 + 8 ], %l0 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 40007f00: 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 ); 40007f04: ac 07 bf d8 add %fp, -40, %l6 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007f08: a4 07 bf f8 add %fp, -8, %l2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007f0c: aa 15 61 a0 or %l5, 0x1a0, %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; 40007f10: a8 07 bf b8 add %fp, -72, %l4 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 40007f14: a2 07 bf f0 add %fp, -16, %l1 (*print)( context, 40007f18: a6 14 e1 b8 or %l3, 0x1b8, %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; 40007f1c: 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 ; 40007f20: 10 80 00 52 b 40008068 40007f24: b4 16 a1 d8 or %i2, 0x1d8, %i2 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 40007f28: 40 00 19 fb call 4000e714 40007f2c: 92 10 00 17 mov %l7, %o1 if ( status != RTEMS_SUCCESSFUL ) 40007f30: 80 a2 20 00 cmp %o0, 0 40007f34: 32 80 00 4c bne,a 40008064 40007f38: 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 ); 40007f3c: 92 10 00 16 mov %l6, %o1 40007f40: 40 00 1a 22 call 4000e7c8 40007f44: 90 10 00 10 mov %l0, %o0 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40007f48: d0 07 bf d8 ld [ %fp + -40 ], %o0 40007f4c: 92 10 20 05 mov 5, %o1 40007f50: 40 00 00 ae call 40008208 40007f54: 94 10 00 12 mov %l2, %o2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40007f58: d8 1f bf a0 ldd [ %fp + -96 ], %o4 40007f5c: 92 10 00 15 mov %l5, %o1 40007f60: 90 10 00 18 mov %i0, %o0 40007f64: 94 10 00 10 mov %l0, %o2 40007f68: 9f c6 40 00 call %i1 40007f6c: 96 10 00 12 mov %l2, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 40007f70: d2 07 bf a0 ld [ %fp + -96 ], %o1 40007f74: 80 a2 60 00 cmp %o1, 0 40007f78: 12 80 00 08 bne 40007f98 40007f7c: 94 10 00 11 mov %l1, %o2 (*print)( context, "\n" ); 40007f80: 90 10 00 18 mov %i0, %o0 40007f84: 13 10 00 75 sethi %hi(0x4001d400), %o1 40007f88: 9f c6 40 00 call %i1 40007f8c: 92 12 63 68 or %o1, 0x368, %o1 ! 4001d768 <_rodata_start+0x158> continue; 40007f90: 10 80 00 35 b 40008064 40007f94: 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 ); 40007f98: 40 00 0e 90 call 4000b9d8 <_Timespec_Divide_by_integer> 40007f9c: 90 10 00 14 mov %l4, %o0 (*print)( context, 40007fa0: d0 07 bf ac ld [ %fp + -84 ], %o0 40007fa4: 40 00 47 b0 call 40019e64 <.div> 40007fa8: 92 10 23 e8 mov 0x3e8, %o1 40007fac: 96 10 00 08 mov %o0, %o3 40007fb0: d0 07 bf b4 ld [ %fp + -76 ], %o0 40007fb4: d6 27 bf 9c st %o3, [ %fp + -100 ] 40007fb8: 40 00 47 ab call 40019e64 <.div> 40007fbc: 92 10 23 e8 mov 0x3e8, %o1 40007fc0: c2 07 bf f0 ld [ %fp + -16 ], %g1 40007fc4: b6 10 00 08 mov %o0, %i3 40007fc8: d0 07 bf f4 ld [ %fp + -12 ], %o0 40007fcc: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007fd0: 40 00 47 a5 call 40019e64 <.div> 40007fd4: 92 10 23 e8 mov 0x3e8, %o1 40007fd8: d8 07 bf b0 ld [ %fp + -80 ], %o4 40007fdc: d6 07 bf 9c ld [ %fp + -100 ], %o3 40007fe0: d4 07 bf a8 ld [ %fp + -88 ], %o2 40007fe4: 9a 10 00 1b mov %i3, %o5 40007fe8: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40007fec: 92 10 00 13 mov %l3, %o1 40007ff0: 9f c6 40 00 call %i1 40007ff4: 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); 40007ff8: d2 07 bf a0 ld [ %fp + -96 ], %o1 40007ffc: 94 10 00 11 mov %l1, %o2 40008000: 40 00 0e 76 call 4000b9d8 <_Timespec_Divide_by_integer> 40008004: 90 10 00 1c mov %i4, %o0 (*print)( context, 40008008: d0 07 bf c4 ld [ %fp + -60 ], %o0 4000800c: 40 00 47 96 call 40019e64 <.div> 40008010: 92 10 23 e8 mov 0x3e8, %o1 40008014: 96 10 00 08 mov %o0, %o3 40008018: d0 07 bf cc ld [ %fp + -52 ], %o0 4000801c: d6 27 bf 9c st %o3, [ %fp + -100 ] 40008020: 40 00 47 91 call 40019e64 <.div> 40008024: 92 10 23 e8 mov 0x3e8, %o1 40008028: c2 07 bf f0 ld [ %fp + -16 ], %g1 4000802c: b6 10 00 08 mov %o0, %i3 40008030: d0 07 bf f4 ld [ %fp + -12 ], %o0 40008034: 92 10 23 e8 mov 0x3e8, %o1 40008038: 40 00 47 8b call 40019e64 <.div> 4000803c: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40008040: d4 07 bf c0 ld [ %fp + -64 ], %o2 40008044: d6 07 bf 9c ld [ %fp + -100 ], %o3 40008048: d8 07 bf c8 ld [ %fp + -56 ], %o4 4000804c: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40008050: 92 10 00 1a mov %i2, %o1 40008054: 90 10 00 18 mov %i0, %o0 40008058: 9f c6 40 00 call %i1 4000805c: 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++ ) { 40008060: 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 ; 40008064: 82 17 60 7c or %i5, 0x7c, %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 ; 40008068: c2 00 60 0c ld [ %g1 + 0xc ], %g1 4000806c: 80 a4 00 01 cmp %l0, %g1 40008070: 08 bf ff ae bleu 40007f28 40008074: 90 10 00 10 mov %l0, %o0 40008078: 81 c7 e0 08 ret 4000807c: 81 e8 00 00 restore =============================================================================== 40016188 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 40016188: 9d e3 bf 98 save %sp, -104, %sp 4001618c: 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 ) 40016190: 80 a6 60 00 cmp %i1, 0 40016194: 02 80 00 2e be 4001624c 40016198: b0 10 20 0a mov 0xa, %i0 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 4001619c: 40 00 11 b1 call 4001a860 <_Thread_Get> 400161a0: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 400161a4: c2 07 bf fc ld [ %fp + -4 ], %g1 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 400161a8: a2 10 00 08 mov %o0, %l1 switch ( location ) { 400161ac: 80 a0 60 00 cmp %g1, 0 400161b0: 12 80 00 27 bne 4001624c 400161b4: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 400161b8: e0 02 21 54 ld [ %o0 + 0x154 ], %l0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 400161bc: c2 04 20 0c ld [ %l0 + 0xc ], %g1 400161c0: 80 a0 60 00 cmp %g1, 0 400161c4: 02 80 00 24 be 40016254 400161c8: 01 00 00 00 nop if ( asr->is_enabled ) { 400161cc: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 400161d0: 80 a0 60 00 cmp %g1, 0 400161d4: 02 80 00 15 be 40016228 400161d8: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 400161dc: 7f ff e4 8a call 4000f404 400161e0: 01 00 00 00 nop *signal_set |= signals; 400161e4: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 400161e8: b2 10 40 19 or %g1, %i1, %i1 400161ec: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _ISR_Enable( _level ); 400161f0: 7f ff e4 89 call 4000f414 400161f4: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 400161f8: 03 10 00 fd sethi %hi(0x4003f400), %g1 400161fc: 82 10 60 20 or %g1, 0x20, %g1 ! 4003f420 <_Per_CPU_Information> 40016200: c4 00 60 08 ld [ %g1 + 8 ], %g2 40016204: 80 a0 a0 00 cmp %g2, 0 40016208: 02 80 00 0f be 40016244 4001620c: 01 00 00 00 nop 40016210: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40016214: 80 a4 40 02 cmp %l1, %g2 40016218: 12 80 00 0b bne 40016244 <== NEVER TAKEN 4001621c: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 40016220: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 40016224: 30 80 00 08 b,a 40016244 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 40016228: 7f ff e4 77 call 4000f404 4001622c: 01 00 00 00 nop *signal_set |= signals; 40016230: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 40016234: b2 10 40 19 or %g1, %i1, %i1 40016238: f2 24 20 18 st %i1, [ %l0 + 0x18 ] _ISR_Enable( _level ); 4001623c: 7f ff e4 76 call 4000f414 40016240: 01 00 00 00 nop } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 40016244: 40 00 11 7a call 4001a82c <_Thread_Enable_dispatch> 40016248: b0 10 20 00 clr %i0 ! 0 return RTEMS_SUCCESSFUL; 4001624c: 81 c7 e0 08 ret 40016250: 81 e8 00 00 restore } _Thread_Enable_dispatch(); 40016254: 40 00 11 76 call 4001a82c <_Thread_Enable_dispatch> 40016258: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; 4001625c: 81 c7 e0 08 ret 40016260: 81 e8 00 00 restore =============================================================================== 4000eb10 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4000eb10: 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 ) 4000eb14: 80 a6 a0 00 cmp %i2, 0 4000eb18: 02 80 00 5a be 4000ec80 4000eb1c: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4000eb20: 03 10 00 5a sethi %hi(0x40016800), %g1 4000eb24: e2 00 61 74 ld [ %g1 + 0x174 ], %l1 ! 40016974 <_Per_CPU_Information+0xc> api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000eb28: 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 ]; 4000eb2c: e0 04 61 54 ld [ %l1 + 0x154 ], %l0 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000eb30: 80 a0 00 01 cmp %g0, %g1 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000eb34: 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; 4000eb38: a4 60 3f ff subx %g0, -1, %l2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000eb3c: 80 a0 60 00 cmp %g1, 0 4000eb40: 02 80 00 03 be 4000eb4c 4000eb44: a5 2c a0 08 sll %l2, 8, %l2 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4000eb48: a4 14 a2 00 or %l2, 0x200, %l2 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000eb4c: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 4000eb50: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000eb54: 7f ff ee c7 call 4000a670 <_CPU_ISR_Get_level> 4000eb58: 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; 4000eb5c: a7 2c e0 0a sll %l3, 0xa, %l3 4000eb60: a6 14 c0 08 or %l3, %o0, %l3 old_mode |= _ISR_Get_level(); 4000eb64: a4 14 c0 12 or %l3, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000eb68: 80 8e 61 00 btst 0x100, %i1 4000eb6c: 02 80 00 06 be 4000eb84 4000eb70: 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; 4000eb74: 82 0e 21 00 and %i0, 0x100, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4000eb78: 80 a0 00 01 cmp %g0, %g1 4000eb7c: 82 60 3f ff subx %g0, -1, %g1 4000eb80: c2 2c 60 74 stb %g1, [ %l1 + 0x74 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 4000eb84: 80 8e 62 00 btst 0x200, %i1 4000eb88: 02 80 00 0b be 4000ebb4 4000eb8c: 80 8e 60 0f btst 0xf, %i1 if ( _Modes_Is_timeslice(mode_set) ) { 4000eb90: 80 8e 22 00 btst 0x200, %i0 4000eb94: 22 80 00 07 be,a 4000ebb0 4000eb98: c0 24 60 7c clr [ %l1 + 0x7c ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000eb9c: 82 10 20 01 mov 1, %g1 4000eba0: c2 24 60 7c st %g1, [ %l1 + 0x7c ] executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000eba4: 03 10 00 58 sethi %hi(0x40016000), %g1 4000eba8: c2 00 63 74 ld [ %g1 + 0x374 ], %g1 ! 40016374 <_Thread_Ticks_per_timeslice> 4000ebac: c2 24 60 78 st %g1, [ %l1 + 0x78 ] } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4000ebb0: 80 8e 60 0f btst 0xf, %i1 4000ebb4: 02 80 00 06 be 4000ebcc 4000ebb8: 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 ); 4000ebbc: 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 ) ); 4000ebc0: 7f ff cc 61 call 40001d44 4000ebc4: 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 ) { 4000ebc8: 80 8e 64 00 btst 0x400, %i1 4000ebcc: 02 80 00 14 be 4000ec1c 4000ebd0: 88 10 20 00 clr %g4 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4000ebd4: 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; 4000ebd8: 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( 4000ebdc: 80 a0 00 18 cmp %g0, %i0 4000ebe0: 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 ) { 4000ebe4: 80 a0 40 02 cmp %g1, %g2 4000ebe8: 22 80 00 0e be,a 4000ec20 4000ebec: 03 10 00 59 sethi %hi(0x40016400), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4000ebf0: 7f ff cc 51 call 40001d34 4000ebf4: c2 2c 20 08 stb %g1, [ %l0 + 8 ] _signals = information->signals_pending; 4000ebf8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 information->signals_pending = information->signals_posted; 4000ebfc: c4 04 20 14 ld [ %l0 + 0x14 ], %g2 information->signals_posted = _signals; 4000ec00: 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; 4000ec04: c4 24 20 18 st %g2, [ %l0 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 4000ec08: 7f ff cc 4f call 40001d44 4000ec0c: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 4000ec10: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4000ec14: 80 a0 00 01 cmp %g0, %g1 4000ec18: 88 40 20 00 addx %g0, 0, %g4 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4000ec1c: 03 10 00 59 sethi %hi(0x40016400), %g1 4000ec20: c4 00 61 88 ld [ %g1 + 0x188 ], %g2 ! 40016588 <_System_state_Current> 4000ec24: 80 a0 a0 03 cmp %g2, 3 4000ec28: 12 80 00 16 bne 4000ec80 <== NEVER TAKEN 4000ec2c: 82 10 20 00 clr %g1 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000ec30: 07 10 00 5a sethi %hi(0x40016800), %g3 if ( are_signals_pending || 4000ec34: 80 89 20 ff btst 0xff, %g4 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 4000ec38: 86 10 e1 68 or %g3, 0x168, %g3 if ( are_signals_pending || 4000ec3c: 12 80 00 0a bne 4000ec64 4000ec40: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 4000ec44: c6 00 e0 10 ld [ %g3 + 0x10 ], %g3 4000ec48: 80 a0 80 03 cmp %g2, %g3 4000ec4c: 02 80 00 0d be 4000ec80 4000ec50: 01 00 00 00 nop (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 4000ec54: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 4000ec58: 80 a0 a0 00 cmp %g2, 0 4000ec5c: 02 80 00 09 be 4000ec80 <== NEVER TAKEN 4000ec60: 01 00 00 00 nop _Thread_Dispatch_necessary = true; 4000ec64: 84 10 20 01 mov 1, %g2 ! 1 4000ec68: 03 10 00 5a sethi %hi(0x40016800), %g1 4000ec6c: 82 10 61 68 or %g1, 0x168, %g1 ! 40016968 <_Per_CPU_Information> 4000ec70: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 4000ec74: 7f ff e8 90 call 40008eb4 <_Thread_Dispatch> 4000ec78: 01 00 00 00 nop } return RTEMS_SUCCESSFUL; 4000ec7c: 82 10 20 00 clr %g1 ! 0 } 4000ec80: 81 c7 e0 08 ret 4000ec84: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 4000b4d4 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4000b4d4: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4000b4d8: 80 a6 60 00 cmp %i1, 0 4000b4dc: 02 80 00 07 be 4000b4f8 4000b4e0: 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 ) ); 4000b4e4: 03 10 00 68 sethi %hi(0x4001a000), %g1 4000b4e8: c2 08 60 f4 ldub [ %g1 + 0xf4 ], %g1 ! 4001a0f4 4000b4ec: 80 a6 40 01 cmp %i1, %g1 4000b4f0: 18 80 00 1c bgu 4000b560 4000b4f4: b0 10 20 13 mov 0x13, %i0 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4000b4f8: 80 a6 a0 00 cmp %i2, 0 4000b4fc: 02 80 00 19 be 4000b560 4000b500: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4000b504: 40 00 08 e3 call 4000d890 <_Thread_Get> 4000b508: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000b50c: c2 07 bf fc ld [ %fp + -4 ], %g1 4000b510: 80 a0 60 00 cmp %g1, 0 4000b514: 12 80 00 13 bne 4000b560 4000b518: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4000b51c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4000b520: 80 a6 60 00 cmp %i1, 0 4000b524: 02 80 00 0d be 4000b558 4000b528: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 4000b52c: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4000b530: 80 a0 60 00 cmp %g1, 0 4000b534: 02 80 00 06 be 4000b54c 4000b538: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 4000b53c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000b540: 80 a0 40 19 cmp %g1, %i1 4000b544: 08 80 00 05 bleu 4000b558 <== ALWAYS TAKEN 4000b548: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4000b54c: 92 10 00 19 mov %i1, %o1 4000b550: 40 00 07 96 call 4000d3a8 <_Thread_Change_priority> 4000b554: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 4000b558: 40 00 08 c1 call 4000d85c <_Thread_Enable_dispatch> 4000b55c: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 4000b560: 81 c7 e0 08 ret 4000b564: 81 e8 00 00 restore =============================================================================== 40016b98 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 40016b98: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 40016b9c: 11 10 00 fe sethi %hi(0x4003f800), %o0 40016ba0: 92 10 00 18 mov %i0, %o1 40016ba4: 90 12 20 54 or %o0, 0x54, %o0 40016ba8: 40 00 0c 0f call 40019be4 <_Objects_Get> 40016bac: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40016bb0: c2 07 bf fc ld [ %fp + -4 ], %g1 40016bb4: 80 a0 60 00 cmp %g1, 0 40016bb8: 12 80 00 0c bne 40016be8 40016bbc: 01 00 00 00 nop case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 40016bc0: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40016bc4: 80 a0 60 04 cmp %g1, 4 40016bc8: 02 80 00 04 be 40016bd8 <== NEVER TAKEN 40016bcc: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 40016bd0: 40 00 14 08 call 4001bbf0 <_Watchdog_Remove> 40016bd4: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 40016bd8: 40 00 0f 15 call 4001a82c <_Thread_Enable_dispatch> 40016bdc: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40016be0: 81 c7 e0 08 ret 40016be4: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40016be8: 81 c7 e0 08 ret 40016bec: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 40017080 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 40017080: 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; 40017084: 03 10 00 fe sethi %hi(0x4003f800), %g1 40017088: e2 00 60 94 ld [ %g1 + 0x94 ], %l1 ! 4003f894 <_Timer_server> rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 4001708c: 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 ) 40017090: 80 a4 60 00 cmp %l1, 0 40017094: 02 80 00 33 be 40017160 40017098: b0 10 20 0e mov 0xe, %i0 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 4001709c: 03 10 00 fb sethi %hi(0x4003ec00), %g1 400170a0: c2 08 62 d0 ldub [ %g1 + 0x2d0 ], %g1 ! 4003eed0 <_TOD_Is_set> 400170a4: 80 a0 60 00 cmp %g1, 0 400170a8: 02 80 00 2e be 40017160 <== NEVER TAKEN 400170ac: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; if ( !routine ) 400170b0: 80 a6 a0 00 cmp %i2, 0 400170b4: 02 80 00 2b be 40017160 400170b8: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 400170bc: 90 10 00 19 mov %i1, %o0 400170c0: 7f ff f4 06 call 400140d8 <_TOD_Validate> 400170c4: b0 10 20 14 mov 0x14, %i0 400170c8: 80 8a 20 ff btst 0xff, %o0 400170cc: 02 80 00 27 be 40017168 400170d0: 01 00 00 00 nop return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 400170d4: 7f ff f3 cd call 40014008 <_TOD_To_seconds> 400170d8: 90 10 00 19 mov %i1, %o0 if ( seconds <= _TOD_Seconds_since_epoch() ) 400170dc: 27 10 00 fb sethi %hi(0x4003ec00), %l3 400170e0: c2 04 e3 68 ld [ %l3 + 0x368 ], %g1 ! 4003ef68 <_TOD_Now> 400170e4: 80 a2 00 01 cmp %o0, %g1 400170e8: 08 80 00 1e bleu 40017160 400170ec: a4 10 00 08 mov %o0, %l2 400170f0: 11 10 00 fe sethi %hi(0x4003f800), %o0 400170f4: 92 10 00 10 mov %l0, %o1 400170f8: 90 12 20 54 or %o0, 0x54, %o0 400170fc: 40 00 0a ba call 40019be4 <_Objects_Get> 40017100: 94 07 bf fc add %fp, -4, %o2 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40017104: c2 07 bf fc ld [ %fp + -4 ], %g1 40017108: b2 10 00 08 mov %o0, %i1 4001710c: 80 a0 60 00 cmp %g1, 0 40017110: 12 80 00 14 bne 40017160 40017114: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 40017118: 40 00 12 b6 call 4001bbf0 <_Watchdog_Remove> 4001711c: 90 02 20 10 add %o0, 0x10, %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 40017120: 82 10 20 03 mov 3, %g1 40017124: 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(); 40017128: c2 04 e3 68 ld [ %l3 + 0x368 ], %g1 (*timer_server->schedule_operation)( timer_server, the_timer ); 4001712c: 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(); 40017130: a4 24 80 01 sub %l2, %g1, %l2 (*timer_server->schedule_operation)( timer_server, the_timer ); 40017134: c2 04 60 04 ld [ %l1 + 4 ], %g1 40017138: 92 10 00 19 mov %i1, %o1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 4001713c: c0 26 60 18 clr [ %i1 + 0x18 ] the_watchdog->routine = routine; 40017140: f4 26 60 2c st %i2, [ %i1 + 0x2c ] the_watchdog->id = id; 40017144: e0 26 60 30 st %l0, [ %i1 + 0x30 ] the_watchdog->user_data = user_data; 40017148: 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(); 4001714c: e4 26 60 1c st %l2, [ %i1 + 0x1c ] (*timer_server->schedule_operation)( timer_server, the_timer ); 40017150: 9f c0 40 00 call %g1 40017154: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40017158: 40 00 0d b5 call 4001a82c <_Thread_Enable_dispatch> 4001715c: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40017160: 81 c7 e0 08 ret 40017164: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40017168: 81 c7 e0 08 ret 4001716c: 81 e8 00 00 restore =============================================================================== 400072f4 : #include int sched_get_priority_max( int policy ) { 400072f4: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 400072f8: 80 a6 20 04 cmp %i0, 4 400072fc: 18 80 00 06 bgu 40007314 40007300: 82 10 20 01 mov 1, %g1 40007304: b1 28 40 18 sll %g1, %i0, %i0 40007308: 80 8e 20 17 btst 0x17, %i0 4000730c: 12 80 00 08 bne 4000732c <== ALWAYS TAKEN 40007310: 03 10 00 79 sethi %hi(0x4001e400), %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40007314: 40 00 22 e9 call 4000feb8 <__errno> 40007318: b0 10 3f ff mov -1, %i0 4000731c: 82 10 20 16 mov 0x16, %g1 40007320: c2 22 00 00 st %g1, [ %o0 ] 40007324: 81 c7 e0 08 ret 40007328: 81 e8 00 00 restore } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 4000732c: f0 08 62 28 ldub [ %g1 + 0x228 ], %i0 } 40007330: 81 c7 e0 08 ret 40007334: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 40007338 : #include int sched_get_priority_min( int policy ) { 40007338: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 4000733c: 80 a6 20 04 cmp %i0, 4 40007340: 18 80 00 06 bgu 40007358 40007344: 82 10 20 01 mov 1, %g1 40007348: 83 28 40 18 sll %g1, %i0, %g1 4000734c: 80 88 60 17 btst 0x17, %g1 40007350: 12 80 00 06 bne 40007368 <== ALWAYS TAKEN 40007354: b0 10 20 01 mov 1, %i0 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40007358: 40 00 22 d8 call 4000feb8 <__errno> 4000735c: b0 10 3f ff mov -1, %i0 40007360: 82 10 20 16 mov 0x16, %g1 40007364: c2 22 00 00 st %g1, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40007368: 81 c7 e0 08 ret 4000736c: 81 e8 00 00 restore =============================================================================== 40007370 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 40007370: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 40007374: 80 a6 20 00 cmp %i0, 0 40007378: 02 80 00 0b be 400073a4 <== NEVER TAKEN 4000737c: 80 a6 60 00 cmp %i1, 0 40007380: 7f ff f2 5f call 40003cfc 40007384: 01 00 00 00 nop 40007388: 80 a6 00 08 cmp %i0, %o0 4000738c: 02 80 00 06 be 400073a4 40007390: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40007394: 40 00 22 c9 call 4000feb8 <__errno> 40007398: 01 00 00 00 nop 4000739c: 10 80 00 07 b 400073b8 400073a0: 82 10 20 03 mov 3, %g1 ! 3 if ( !interval ) 400073a4: 12 80 00 08 bne 400073c4 400073a8: 03 10 00 7c sethi %hi(0x4001f000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 400073ac: 40 00 22 c3 call 4000feb8 <__errno> 400073b0: 01 00 00 00 nop 400073b4: 82 10 20 16 mov 0x16, %g1 ! 16 400073b8: c2 22 00 00 st %g1, [ %o0 ] 400073bc: 81 c7 e0 08 ret 400073c0: 91 e8 3f ff restore %g0, -1, %o0 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 400073c4: d0 00 60 14 ld [ %g1 + 0x14 ], %o0 400073c8: 92 10 00 19 mov %i1, %o1 400073cc: 40 00 0e 3a call 4000acb4 <_Timespec_From_ticks> 400073d0: b0 10 20 00 clr %i0 return 0; } 400073d4: 81 c7 e0 08 ret 400073d8: 81 e8 00 00 restore =============================================================================== 40009d1c : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 40009d1c: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40009d20: 03 10 00 90 sethi %hi(0x40024000), %g1 40009d24: c4 00 60 b0 ld [ %g1 + 0xb0 ], %g2 ! 400240b0 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40009d28: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 40009d2c: 84 00 a0 01 inc %g2 40009d30: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 40009d34: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40009d38: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 40009d3c: c4 20 60 b0 st %g2, [ %g1 + 0xb0 ] POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 40009d40: a2 8e 62 00 andcc %i1, 0x200, %l1 40009d44: 02 80 00 05 be 40009d58 40009d48: a0 10 20 00 clr %l0 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 40009d4c: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 40009d50: 82 07 a0 54 add %fp, 0x54, %g1 40009d54: c2 27 bf fc st %g1, [ %fp + -4 ] va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 40009d58: 90 10 00 18 mov %i0, %o0 40009d5c: 40 00 1a 2a call 40010604 <_POSIX_Semaphore_Name_to_id> 40009d60: 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 ) { 40009d64: a4 92 20 00 orcc %o0, 0, %l2 40009d68: 22 80 00 0e be,a 40009da0 40009d6c: 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) ) ) { 40009d70: 80 a4 a0 02 cmp %l2, 2 40009d74: 12 80 00 04 bne 40009d84 <== NEVER TAKEN 40009d78: 80 a4 60 00 cmp %l1, 0 40009d7c: 12 80 00 21 bne 40009e00 40009d80: 94 10 00 10 mov %l0, %o2 _Thread_Enable_dispatch(); 40009d84: 40 00 0b 84 call 4000cb94 <_Thread_Enable_dispatch> 40009d88: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 40009d8c: 40 00 26 01 call 40013590 <__errno> 40009d90: 01 00 00 00 nop 40009d94: e4 22 00 00 st %l2, [ %o0 ] 40009d98: 81 c7 e0 08 ret 40009d9c: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 40009da0: 80 a6 6a 00 cmp %i1, 0xa00 40009da4: 12 80 00 0a bne 40009dcc 40009da8: d2 07 bf f8 ld [ %fp + -8 ], %o1 _Thread_Enable_dispatch(); 40009dac: 40 00 0b 7a call 4000cb94 <_Thread_Enable_dispatch> 40009db0: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 40009db4: 40 00 25 f7 call 40013590 <__errno> 40009db8: 01 00 00 00 nop 40009dbc: 82 10 20 11 mov 0x11, %g1 ! 11 40009dc0: c2 22 00 00 st %g1, [ %o0 ] 40009dc4: 81 c7 e0 08 ret 40009dc8: 81 e8 00 00 restore 40009dcc: 94 07 bf f0 add %fp, -16, %o2 40009dd0: 11 10 00 90 sethi %hi(0x40024000), %o0 40009dd4: 40 00 08 6c call 4000bf84 <_Objects_Get> 40009dd8: 90 12 23 90 or %o0, 0x390, %o0 ! 40024390 <_POSIX_Semaphore_Information> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 40009ddc: 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 ); 40009de0: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 40009de4: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 40009de8: 40 00 0b 6b call 4000cb94 <_Thread_Enable_dispatch> 40009dec: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 40009df0: 40 00 0b 69 call 4000cb94 <_Thread_Enable_dispatch> 40009df4: 01 00 00 00 nop goto return_id; 40009df8: 10 80 00 0c b 40009e28 40009dfc: 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( 40009e00: 90 10 00 18 mov %i0, %o0 40009e04: 92 10 20 00 clr %o1 40009e08: 40 00 19 a8 call 400104a8 <_POSIX_Semaphore_Create_support> 40009e0c: 96 07 bf f4 add %fp, -12, %o3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 40009e10: 40 00 0b 61 call 4000cb94 <_Thread_Enable_dispatch> 40009e14: a0 10 00 08 mov %o0, %l0 if ( status == -1 ) 40009e18: 80 a4 3f ff cmp %l0, -1 40009e1c: 02 bf ff ea be 40009dc4 40009e20: 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; 40009e24: f0 07 bf f4 ld [ %fp + -12 ], %i0 40009e28: b0 06 20 08 add %i0, 8, %i0 #endif return id; } 40009e2c: 81 c7 e0 08 ret 40009e30: 81 e8 00 00 restore =============================================================================== 4000726c : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 4000726c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 40007270: 90 96 a0 00 orcc %i2, 0, %o0 40007274: 02 80 00 0a be 4000729c 40007278: a0 10 00 18 mov %i0, %l0 *oact = _POSIX_signals_Vectors[ sig ]; 4000727c: 83 2e 20 02 sll %i0, 2, %g1 40007280: 85 2e 20 04 sll %i0, 4, %g2 40007284: 82 20 80 01 sub %g2, %g1, %g1 40007288: 13 10 00 81 sethi %hi(0x40020400), %o1 4000728c: 94 10 20 0c mov 0xc, %o2 40007290: 92 12 62 60 or %o1, 0x260, %o1 40007294: 40 00 26 74 call 40010c64 40007298: 92 02 40 01 add %o1, %g1, %o1 if ( !sig ) 4000729c: 80 a4 20 00 cmp %l0, 0 400072a0: 02 80 00 09 be 400072c4 400072a4: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 400072a8: 82 04 3f ff add %l0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 400072ac: 80 a0 60 1f cmp %g1, 0x1f 400072b0: 18 80 00 05 bgu 400072c4 400072b4: 01 00 00 00 nop * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 400072b8: 80 a4 20 09 cmp %l0, 9 400072bc: 12 80 00 08 bne 400072dc 400072c0: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 400072c4: 40 00 24 09 call 400102e8 <__errno> 400072c8: b0 10 3f ff mov -1, %i0 400072cc: 82 10 20 16 mov 0x16, %g1 400072d0: c2 22 00 00 st %g1, [ %o0 ] 400072d4: 81 c7 e0 08 ret 400072d8: 81 e8 00 00 restore /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 400072dc: 02 bf ff fe be 400072d4 <== NEVER TAKEN 400072e0: 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 ); 400072e4: 7f ff ec 26 call 4000237c 400072e8: 01 00 00 00 nop 400072ec: a2 10 00 08 mov %o0, %l1 if ( act->sa_handler == SIG_DFL ) { 400072f0: c2 06 60 08 ld [ %i1 + 8 ], %g1 400072f4: 25 10 00 81 sethi %hi(0x40020400), %l2 400072f8: 80 a0 60 00 cmp %g1, 0 400072fc: a4 14 a2 60 or %l2, 0x260, %l2 40007300: a7 2c 20 02 sll %l0, 2, %l3 40007304: 12 80 00 08 bne 40007324 40007308: a9 2c 20 04 sll %l0, 4, %l4 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 4000730c: a6 25 00 13 sub %l4, %l3, %l3 40007310: 13 10 00 7a sethi %hi(0x4001e800), %o1 40007314: 90 04 80 13 add %l2, %l3, %o0 40007318: 92 12 63 18 or %o1, 0x318, %o1 4000731c: 10 80 00 07 b 40007338 40007320: 92 02 40 13 add %o1, %l3, %o1 } else { _POSIX_signals_Clear_process_signals( sig ); 40007324: 40 00 17 d2 call 4000d26c <_POSIX_signals_Clear_process_signals> 40007328: 90 10 00 10 mov %l0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 4000732c: a6 25 00 13 sub %l4, %l3, %l3 40007330: 92 10 00 19 mov %i1, %o1 40007334: 90 04 80 13 add %l2, %l3, %o0 40007338: 40 00 26 4b call 40010c64 4000733c: 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; 40007340: 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 ); 40007344: 7f ff ec 12 call 4000238c 40007348: 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; } 4000734c: 81 c7 e0 08 ret 40007350: 81 e8 00 00 restore =============================================================================== 4000771c : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 4000771c: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 40007720: a0 96 20 00 orcc %i0, 0, %l0 40007724: 02 80 00 0f be 40007760 40007728: 01 00 00 00 nop /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 4000772c: 80 a6 a0 00 cmp %i2, 0 40007730: 02 80 00 12 be 40007778 40007734: a8 10 20 00 clr %l4 if ( !_Timespec_Is_valid( timeout ) ) 40007738: 40 00 0e 69 call 4000b0dc <_Timespec_Is_valid> 4000773c: 90 10 00 1a mov %i2, %o0 40007740: 80 8a 20 ff btst 0xff, %o0 40007744: 02 80 00 07 be 40007760 40007748: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 4000774c: 40 00 0e 87 call 4000b168 <_Timespec_To_ticks> 40007750: 90 10 00 1a mov %i2, %o0 if ( !interval ) 40007754: a8 92 20 00 orcc %o0, 0, %l4 40007758: 12 80 00 09 bne 4000777c <== ALWAYS TAKEN 4000775c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 40007760: 40 00 24 a6 call 400109f8 <__errno> 40007764: b0 10 3f ff mov -1, %i0 40007768: 82 10 20 16 mov 0x16, %g1 4000776c: c2 22 00 00 st %g1, [ %o0 ] 40007770: 81 c7 e0 08 ret 40007774: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40007778: 80 a6 60 00 cmp %i1, 0 4000777c: 22 80 00 02 be,a 40007784 40007780: b2 07 bf f4 add %fp, -12, %i1 the_thread = _Thread_Executing; 40007784: 31 10 00 83 sethi %hi(0x40020c00), %i0 40007788: b0 16 21 f8 or %i0, 0x1f8, %i0 ! 40020df8 <_Per_CPU_Information> 4000778c: e6 06 20 0c ld [ %i0 + 0xc ], %l3 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40007790: 7f ff eb d6 call 400026e8 40007794: e4 04 e1 58 ld [ %l3 + 0x158 ], %l2 40007798: a2 10 00 08 mov %o0, %l1 if ( *set & api->signals_pending ) { 4000779c: c4 04 00 00 ld [ %l0 ], %g2 400077a0: c2 04 a0 d4 ld [ %l2 + 0xd4 ], %g1 400077a4: 80 88 80 01 btst %g2, %g1 400077a8: 22 80 00 13 be,a 400077f4 400077ac: 03 10 00 84 sethi %hi(0x40021000), %g1 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 400077b0: 7f ff ff c3 call 400076bc <_POSIX_signals_Get_lowest> 400077b4: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( 400077b8: 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 ); 400077bc: 92 10 00 08 mov %o0, %o1 400077c0: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 400077c4: 96 10 20 00 clr %o3 400077c8: 90 10 00 12 mov %l2, %o0 400077cc: 40 00 18 9e call 4000da44 <_POSIX_signals_Clear_signals> 400077d0: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 400077d4: 7f ff eb c9 call 400026f8 400077d8: 90 10 00 11 mov %l1, %o0 the_info->si_code = SI_USER; 400077dc: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 400077e0: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 400077e4: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 400077e8: f0 06 40 00 ld [ %i1 ], %i0 400077ec: 81 c7 e0 08 ret 400077f0: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 400077f4: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 400077f8: 80 88 80 01 btst %g2, %g1 400077fc: 22 80 00 13 be,a 40007848 40007800: 82 10 3f ff mov -1, %g1 signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40007804: 7f ff ff ae call 400076bc <_POSIX_signals_Get_lowest> 40007808: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 4000780c: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40007810: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40007814: 96 10 20 01 mov 1, %o3 40007818: 90 10 00 12 mov %l2, %o0 4000781c: 92 10 00 18 mov %i0, %o1 40007820: 40 00 18 89 call 4000da44 <_POSIX_signals_Clear_signals> 40007824: 98 10 20 00 clr %o4 _ISR_Enable( level ); 40007828: 7f ff eb b4 call 400026f8 4000782c: 90 10 00 11 mov %l1, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 40007830: 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; 40007834: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 40007838: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 4000783c: c0 26 60 08 clr [ %i1 + 8 ] return signo; 40007840: 81 c7 e0 08 ret 40007844: 81 e8 00 00 restore } the_info->si_signo = -1; 40007848: c2 26 40 00 st %g1, [ %i1 ] 4000784c: 03 10 00 82 sethi %hi(0x40020800), %g1 40007850: c4 00 60 a0 ld [ %g1 + 0xa0 ], %g2 ! 400208a0 <_Thread_Dispatch_disable_level> 40007854: 84 00 a0 01 inc %g2 40007858: c4 20 60 a0 st %g2, [ %g1 + 0xa0 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 4000785c: 82 10 20 04 mov 4, %g1 40007860: c2 24 e0 34 st %g1, [ %l3 + 0x34 ] the_thread->Wait.option = *set; 40007864: c2 04 00 00 ld [ %l0 ], %g1 the_thread->Wait.return_argument = the_info; 40007868: 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; 4000786c: 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; 40007870: a2 10 20 01 mov 1, %l1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 40007874: 2b 10 00 83 sethi %hi(0x40020c00), %l5 40007878: aa 15 63 dc or %l5, 0x3dc, %l5 ! 40020fdc <_POSIX_signals_Wait_queue> 4000787c: ea 24 e0 44 st %l5, [ %l3 + 0x44 ] 40007880: 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 ); 40007884: 7f ff eb 9d call 400026f8 40007888: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 4000788c: 90 10 00 15 mov %l5, %o0 40007890: 92 10 00 14 mov %l4, %o1 40007894: 15 10 00 2b sethi %hi(0x4000ac00), %o2 40007898: 40 00 0c 4a call 4000a9c0 <_Thread_queue_Enqueue_with_handler> 4000789c: 94 12 a1 48 or %o2, 0x148, %o2 ! 4000ad48 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 400078a0: 40 00 0b 0a call 4000a4c8 <_Thread_Enable_dispatch> 400078a4: 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 ); 400078a8: d2 06 40 00 ld [ %i1 ], %o1 400078ac: 90 10 00 12 mov %l2, %o0 400078b0: 94 10 00 19 mov %i1, %o2 400078b4: 96 10 20 00 clr %o3 400078b8: 40 00 18 63 call 4000da44 <_POSIX_signals_Clear_signals> 400078bc: 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) 400078c0: c2 06 20 0c ld [ %i0 + 0xc ], %g1 400078c4: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 400078c8: 80 a0 60 04 cmp %g1, 4 400078cc: 12 80 00 09 bne 400078f0 400078d0: 01 00 00 00 nop || !(*set & signo_to_mask( the_info->si_signo )) ) { 400078d4: f0 06 40 00 ld [ %i1 ], %i0 400078d8: 82 06 3f ff add %i0, -1, %g1 400078dc: a3 2c 40 01 sll %l1, %g1, %l1 400078e0: c2 04 00 00 ld [ %l0 ], %g1 400078e4: 80 8c 40 01 btst %l1, %g1 400078e8: 12 80 00 08 bne 40007908 400078ec: 01 00 00 00 nop errno = _Thread_Executing->Wait.return_code; 400078f0: 40 00 24 42 call 400109f8 <__errno> 400078f4: b0 10 3f ff mov -1, %i0 ! ffffffff 400078f8: 03 10 00 83 sethi %hi(0x40020c00), %g1 400078fc: c2 00 62 04 ld [ %g1 + 0x204 ], %g1 ! 40020e04 <_Per_CPU_Information+0xc> 40007900: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007904: c2 22 00 00 st %g1, [ %o0 ] return -1; } return the_info->si_signo; } 40007908: 81 c7 e0 08 ret 4000790c: 81 e8 00 00 restore =============================================================================== 400098e8 : int sigwait( const sigset_t *set, int *sig ) { 400098e8: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 400098ec: 92 10 20 00 clr %o1 400098f0: 90 10 00 18 mov %i0, %o0 400098f4: 7f ff ff 7b call 400096e0 400098f8: 94 10 20 00 clr %o2 if ( status != -1 ) { 400098fc: 80 a2 3f ff cmp %o0, -1 40009900: 02 80 00 07 be 4000991c 40009904: 80 a6 60 00 cmp %i1, 0 if ( sig ) 40009908: 02 80 00 03 be 40009914 <== NEVER TAKEN 4000990c: b0 10 20 00 clr %i0 *sig = status; 40009910: d0 26 40 00 st %o0, [ %i1 ] 40009914: 81 c7 e0 08 ret 40009918: 81 e8 00 00 restore return 0; } return errno; 4000991c: 40 00 23 3d call 40012610 <__errno> 40009920: 01 00 00 00 nop 40009924: f0 02 00 00 ld [ %o0 ], %i0 } 40009928: 81 c7 e0 08 ret 4000992c: 81 e8 00 00 restore =============================================================================== 400065b4 : */ long sysconf( int name ) { 400065b4: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 400065b8: 80 a6 20 02 cmp %i0, 2 400065bc: 12 80 00 09 bne 400065e0 400065c0: 80 a6 20 04 cmp %i0, 4 return (TOD_MICROSECONDS_PER_SECOND / 400065c4: 03 10 00 5b sethi %hi(0x40016c00), %g1 400065c8: d2 00 60 b8 ld [ %g1 + 0xb8 ], %o1 ! 40016cb8 400065cc: 11 00 03 d0 sethi %hi(0xf4000), %o0 400065d0: 40 00 33 6e call 40013388 <.udiv> 400065d4: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 400065d8: 81 c7 e0 08 ret 400065dc: 91 e8 00 08 restore %g0, %o0, %o0 rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 400065e0: 12 80 00 05 bne 400065f4 400065e4: 80 a6 20 33 cmp %i0, 0x33 return rtems_libio_number_iops; 400065e8: 03 10 00 5a sethi %hi(0x40016800), %g1 400065ec: 10 80 00 0f b 40006628 400065f0: d0 00 63 d4 ld [ %g1 + 0x3d4 ], %o0 ! 40016bd4 if ( name == _SC_GETPW_R_SIZE_MAX ) 400065f4: 02 80 00 0d be 40006628 400065f8: 90 10 24 00 mov 0x400, %o0 return 1024; if ( name == _SC_PAGESIZE ) 400065fc: 80 a6 20 08 cmp %i0, 8 40006600: 02 80 00 0a be 40006628 40006604: 90 02 2c 00 add %o0, 0xc00, %o0 return PAGE_SIZE; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 40006608: 80 a6 22 03 cmp %i0, 0x203 4000660c: 02 80 00 07 be 40006628 <== NEVER TAKEN 40006610: 90 10 20 00 clr %o0 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40006614: 40 00 23 fe call 4000f60c <__errno> 40006618: 01 00 00 00 nop 4000661c: 82 10 20 16 mov 0x16, %g1 ! 16 40006620: c2 22 00 00 st %g1, [ %o0 ] 40006624: 90 10 3f ff mov -1, %o0 } 40006628: b0 10 00 08 mov %o0, %i0 4000662c: 81 c7 e0 08 ret 40006630: 81 e8 00 00 restore =============================================================================== 40006940 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 40006940: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 40006944: 80 a6 20 01 cmp %i0, 1 40006948: 12 80 00 15 bne 4000699c 4000694c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 40006950: 80 a6 a0 00 cmp %i2, 0 40006954: 02 80 00 12 be 4000699c 40006958: 01 00 00 00 nop /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 4000695c: 80 a6 60 00 cmp %i1, 0 40006960: 02 80 00 13 be 400069ac 40006964: 03 10 00 7c sethi %hi(0x4001f000), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 40006968: c2 06 40 00 ld [ %i1 ], %g1 4000696c: 82 00 7f ff add %g1, -1, %g1 40006970: 80 a0 60 01 cmp %g1, 1 40006974: 18 80 00 0a bgu 4000699c <== NEVER TAKEN 40006978: 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 ) 4000697c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006980: 80 a0 60 00 cmp %g1, 0 40006984: 02 80 00 06 be 4000699c <== NEVER TAKEN 40006988: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 4000698c: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 40006990: 80 a0 60 1f cmp %g1, 0x1f 40006994: 28 80 00 06 bleu,a 400069ac <== ALWAYS TAKEN 40006998: 03 10 00 7c sethi %hi(0x4001f000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 4000699c: 40 00 25 38 call 4000fe7c <__errno> 400069a0: 01 00 00 00 nop 400069a4: 10 80 00 10 b 400069e4 400069a8: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400069ac: c4 00 60 b0 ld [ %g1 + 0xb0 ], %g2 400069b0: 84 00 a0 01 inc %g2 400069b4: c4 20 60 b0 st %g2, [ %g1 + 0xb0 ] * 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 ); 400069b8: 11 10 00 7c sethi %hi(0x4001f000), %o0 400069bc: 40 00 07 ed call 40008970 <_Objects_Allocate> 400069c0: 90 12 23 d0 or %o0, 0x3d0, %o0 ! 4001f3d0 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 400069c4: 80 a2 20 00 cmp %o0, 0 400069c8: 12 80 00 0a bne 400069f0 400069cc: 82 10 20 02 mov 2, %g1 _Thread_Enable_dispatch(); 400069d0: 40 00 0c 0d call 40009a04 <_Thread_Enable_dispatch> 400069d4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 400069d8: 40 00 25 29 call 4000fe7c <__errno> 400069dc: 01 00 00 00 nop 400069e0: 82 10 20 0b mov 0xb, %g1 ! b 400069e4: c2 22 00 00 st %g1, [ %o0 ] 400069e8: 81 c7 e0 08 ret 400069ec: 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; 400069f0: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 400069f4: 03 10 00 7d sethi %hi(0x4001f400), %g1 400069f8: c2 00 62 14 ld [ %g1 + 0x214 ], %g1 ! 4001f614 <_Per_CPU_Information+0xc> if ( evp != NULL ) { 400069fc: 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; 40006a00: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 40006a04: 02 80 00 08 be 40006a24 40006a08: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 40006a0c: c2 06 40 00 ld [ %i1 ], %g1 40006a10: c2 22 20 40 st %g1, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 40006a14: c2 06 60 04 ld [ %i1 + 4 ], %g1 40006a18: c2 22 20 44 st %g1, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 40006a1c: c2 06 60 08 ld [ %i1 + 8 ], %g1 40006a20: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006a24: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006a28: 07 10 00 7c sethi %hi(0x4001f000), %g3 40006a2c: c6 00 e3 ec ld [ %g3 + 0x3ec ], %g3 ! 4001f3ec <_POSIX_Timer_Information+0x1c> } ptimer->overrun = 0; 40006a30: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 40006a34: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 40006a38: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 40006a3c: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 40006a40: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40006a44: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 40006a48: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 40006a4c: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 40006a50: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40006a54: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40006a58: 85 28 a0 02 sll %g2, 2, %g2 40006a5c: 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; 40006a60: 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; 40006a64: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 40006a68: 40 00 0b e7 call 40009a04 <_Thread_Enable_dispatch> 40006a6c: b0 10 20 00 clr %i0 return 0; } 40006a70: 81 c7 e0 08 ret 40006a74: 81 e8 00 00 restore =============================================================================== 40006a78 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 40006a78: 9d e3 bf 80 save %sp, -128, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 40006a7c: 80 a6 a0 00 cmp %i2, 0 40006a80: 02 80 00 22 be 40006b08 <== NEVER TAKEN 40006a84: 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) ) ) { 40006a88: 40 00 0e f5 call 4000a65c <_Timespec_Is_valid> 40006a8c: 90 06 a0 08 add %i2, 8, %o0 40006a90: 80 8a 20 ff btst 0xff, %o0 40006a94: 02 80 00 1d be 40006b08 40006a98: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 40006a9c: 40 00 0e f0 call 4000a65c <_Timespec_Is_valid> 40006aa0: 90 10 00 1a mov %i2, %o0 40006aa4: 80 8a 20 ff btst 0xff, %o0 40006aa8: 02 80 00 18 be 40006b08 <== NEVER TAKEN 40006aac: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40006ab0: 80 a6 60 00 cmp %i1, 0 40006ab4: 02 80 00 05 be 40006ac8 40006ab8: 90 07 bf e4 add %fp, -28, %o0 40006abc: 80 a6 60 04 cmp %i1, 4 40006ac0: 12 80 00 12 bne 40006b08 40006ac4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 40006ac8: 92 10 00 1a mov %i2, %o1 40006acc: 40 00 27 60 call 4001084c 40006ad0: 94 10 20 10 mov 0x10, %o2 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 40006ad4: 80 a6 60 04 cmp %i1, 4 40006ad8: 12 80 00 16 bne 40006b30 40006adc: 92 10 00 18 mov %i0, %o1 struct timespec now; _TOD_Get( &now ); 40006ae0: b2 07 bf f4 add %fp, -12, %i1 40006ae4: 40 00 06 30 call 400083a4 <_TOD_Get> 40006ae8: 90 10 00 19 mov %i1, %o0 /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 40006aec: a0 07 bf ec add %fp, -20, %l0 40006af0: 90 10 00 19 mov %i1, %o0 40006af4: 40 00 0e c9 call 4000a618 <_Timespec_Greater_than> 40006af8: 92 10 00 10 mov %l0, %o1 40006afc: 80 8a 20 ff btst 0xff, %o0 40006b00: 02 80 00 08 be 40006b20 40006b04: 90 10 00 19 mov %i1, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); 40006b08: 40 00 24 dd call 4000fe7c <__errno> 40006b0c: b0 10 3f ff mov -1, %i0 40006b10: 82 10 20 16 mov 0x16, %g1 40006b14: c2 22 00 00 st %g1, [ %o0 ] 40006b18: 81 c7 e0 08 ret 40006b1c: 81 e8 00 00 restore _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 40006b20: 92 10 00 10 mov %l0, %o1 40006b24: 40 00 0e df call 4000a6a0 <_Timespec_Subtract> 40006b28: 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 ); 40006b2c: 92 10 00 18 mov %i0, %o1 40006b30: 11 10 00 7c sethi %hi(0x4001f000), %o0 40006b34: 94 07 bf fc add %fp, -4, %o2 40006b38: 40 00 08 cd call 40008e6c <_Objects_Get> 40006b3c: 90 12 23 d0 or %o0, 0x3d0, %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 ) { 40006b40: c2 07 bf fc ld [ %fp + -4 ], %g1 40006b44: 80 a0 60 00 cmp %g1, 0 40006b48: 12 80 00 39 bne 40006c2c 40006b4c: 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 ) { 40006b50: c2 07 bf ec ld [ %fp + -20 ], %g1 40006b54: 80 a0 60 00 cmp %g1, 0 40006b58: 12 80 00 14 bne 40006ba8 40006b5c: c2 07 bf f0 ld [ %fp + -16 ], %g1 40006b60: 80 a0 60 00 cmp %g1, 0 40006b64: 12 80 00 11 bne 40006ba8 40006b68: 01 00 00 00 nop /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 40006b6c: 40 00 10 02 call 4000ab74 <_Watchdog_Remove> 40006b70: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 40006b74: 80 a6 e0 00 cmp %i3, 0 40006b78: 02 80 00 05 be 40006b8c 40006b7c: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40006b80: 92 06 20 54 add %i0, 0x54, %o1 40006b84: 40 00 27 32 call 4001084c 40006b88: 94 10 20 10 mov 0x10, %o2 /* The new data are set */ ptimer->timer_data = normalize; 40006b8c: 90 06 20 54 add %i0, 0x54, %o0 40006b90: 92 07 bf e4 add %fp, -28, %o1 40006b94: 40 00 27 2e call 4001084c 40006b98: 94 10 20 10 mov 0x10, %o2 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 40006b9c: 82 10 20 04 mov 4, %g1 40006ba0: 10 80 00 1f b 40006c1c 40006ba4: 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 ); 40006ba8: 40 00 0e d0 call 4000a6e8 <_Timespec_To_ticks> 40006bac: 90 10 00 1a mov %i2, %o0 40006bb0: d0 26 20 64 st %o0, [ %i0 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 40006bb4: 40 00 0e cd call 4000a6e8 <_Timespec_To_ticks> 40006bb8: 90 07 bf ec add %fp, -20, %o0 activated = _POSIX_Timer_Insert_helper( 40006bbc: 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 ); 40006bc0: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 40006bc4: 17 10 00 1b sethi %hi(0x40006c00), %o3 40006bc8: 90 06 20 10 add %i0, 0x10, %o0 40006bcc: 96 12 e0 44 or %o3, 0x44, %o3 40006bd0: 40 00 19 ae call 4000d288 <_POSIX_Timer_Insert_helper> 40006bd4: 98 10 00 18 mov %i0, %o4 initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 40006bd8: 80 8a 20 ff btst 0xff, %o0 40006bdc: 02 80 00 10 be 40006c1c 40006be0: 01 00 00 00 nop /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 40006be4: 80 a6 e0 00 cmp %i3, 0 40006be8: 02 80 00 05 be 40006bfc 40006bec: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 40006bf0: 92 06 20 54 add %i0, 0x54, %o1 40006bf4: 40 00 27 16 call 4001084c 40006bf8: 94 10 20 10 mov 0x10, %o2 ptimer->timer_data = normalize; 40006bfc: 90 06 20 54 add %i0, 0x54, %o0 40006c00: 92 07 bf e4 add %fp, -28, %o1 40006c04: 40 00 27 12 call 4001084c 40006c08: 94 10 20 10 mov 0x10, %o2 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40006c0c: 82 10 20 03 mov 3, %g1 _TOD_Get( &ptimer->time ); 40006c10: 90 06 20 6c add %i0, 0x6c, %o0 40006c14: 40 00 05 e4 call 400083a4 <_TOD_Get> 40006c18: c2 2e 20 3c stb %g1, [ %i0 + 0x3c ] _Thread_Enable_dispatch(); 40006c1c: 40 00 0b 7a call 40009a04 <_Thread_Enable_dispatch> 40006c20: b0 10 20 00 clr %i0 return 0; 40006c24: 81 c7 e0 08 ret 40006c28: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 40006c2c: 40 00 24 94 call 4000fe7c <__errno> 40006c30: b0 10 3f ff mov -1, %i0 40006c34: 82 10 20 16 mov 0x16, %g1 40006c38: c2 22 00 00 st %g1, [ %o0 ] } 40006c3c: 81 c7 e0 08 ret 40006c40: 81 e8 00 00 restore =============================================================================== 40006858 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 40006858: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 4000685c: 23 10 00 63 sethi %hi(0x40018c00), %l1 40006860: a2 14 62 e8 or %l1, 0x2e8, %l1 ! 40018ee8 <_POSIX_signals_Ualarm_timer> 40006864: c2 04 60 1c ld [ %l1 + 0x1c ], %g1 40006868: 80 a0 60 00 cmp %g1, 0 4000686c: 12 80 00 0a bne 40006894 40006870: a0 10 00 18 mov %i0, %l0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40006874: 03 10 00 1a sethi %hi(0x40006800), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40006878: c0 24 60 08 clr [ %l1 + 8 ] the_watchdog->routine = routine; 4000687c: 82 10 60 28 or %g1, 0x28, %g1 the_watchdog->id = id; 40006880: c0 24 60 20 clr [ %l1 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40006884: c2 24 60 1c st %g1, [ %l1 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 40006888: c0 24 60 24 clr [ %l1 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 4000688c: 10 80 00 1b b 400068f8 40006890: 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 ); 40006894: 40 00 0f 92 call 4000a6dc <_Watchdog_Remove> 40006898: 90 10 00 11 mov %l1, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 4000689c: 90 02 3f fe add %o0, -2, %o0 400068a0: 80 a2 20 01 cmp %o0, 1 400068a4: 18 80 00 15 bgu 400068f8 <== NEVER TAKEN 400068a8: 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); 400068ac: c2 04 60 0c ld [ %l1 + 0xc ], %g1 400068b0: d0 04 60 14 ld [ %l1 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 400068b4: 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); 400068b8: 90 02 00 01 add %o0, %g1, %o0 400068bc: c2 04 60 18 ld [ %l1 + 0x18 ], %g1 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 400068c0: 40 00 0e 15 call 4000a114 <_Timespec_From_ticks> 400068c4: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 400068c8: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 400068cc: 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; 400068d0: b1 28 60 08 sll %g1, 8, %i0 400068d4: 85 28 60 03 sll %g1, 3, %g2 400068d8: 84 26 00 02 sub %i0, %g2, %g2 remaining += tp.tv_nsec / 1000; 400068dc: 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; 400068e0: b1 28 a0 06 sll %g2, 6, %i0 400068e4: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 400068e8: 40 00 37 94 call 40014738 <.div> 400068ec: 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; 400068f0: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 400068f4: 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 ) { 400068f8: 80 a4 20 00 cmp %l0, 0 400068fc: 02 80 00 1a be 40006964 40006900: 23 00 03 d0 sethi %hi(0xf4000), %l1 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40006904: 90 10 00 10 mov %l0, %o0 40006908: 40 00 37 8a call 40014730 <.udiv> 4000690c: 92 14 62 40 or %l1, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006910: 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; 40006914: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006918: 40 00 38 32 call 400149e0 <.urem> 4000691c: 90 10 00 10 mov %l0, %o0 40006920: 85 2a 20 07 sll %o0, 7, %g2 40006924: 83 2a 20 02 sll %o0, 2, %g1 40006928: 82 20 80 01 sub %g2, %g1, %g1 4000692c: 90 00 40 08 add %g1, %o0, %o0 40006930: 91 2a 20 03 sll %o0, 3, %o0 ticks = _Timespec_To_ticks( &tp ); 40006934: 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; 40006938: d0 27 bf fc st %o0, [ %fp + -4 ] ticks = _Timespec_To_ticks( &tp ); 4000693c: 40 00 0e 1d call 4000a1b0 <_Timespec_To_ticks> 40006940: 90 10 00 10 mov %l0, %o0 if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 40006944: 40 00 0e 1b call 4000a1b0 <_Timespec_To_ticks> 40006948: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000694c: 13 10 00 63 sethi %hi(0x40018c00), %o1 40006950: 92 12 62 e8 or %o1, 0x2e8, %o1 ! 40018ee8 <_POSIX_signals_Ualarm_timer> 40006954: d0 22 60 0c st %o0, [ %o1 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006958: 11 10 00 61 sethi %hi(0x40018400), %o0 4000695c: 40 00 0f 06 call 4000a574 <_Watchdog_Insert> 40006960: 90 12 22 a0 or %o0, 0x2a0, %o0 ! 400186a0 <_Watchdog_Ticks_chain> } return remaining; } 40006964: 81 c7 e0 08 ret 40006968: 81 e8 00 00 restore