=============================================================================== 40007a54 <_API_extensions_Run_postdriver>: * * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { 40007a54: 9d e3 bf a0 save %sp, -96, %sp the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } 40007a58: 23 10 00 5e sethi %hi(0x40017800), %l1 40007a5c: e0 04 60 34 ld [ %l1 + 0x34 ], %l0 ! 40017834 <_API_extensions_List> 40007a60: a2 14 60 34 or %l1, 0x34, %l1 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40007a64: a2 04 60 04 add %l1, 4, %l1 40007a68: 80 a4 00 11 cmp %l0, %l1 40007a6c: 02 80 00 09 be 40007a90 <_API_extensions_Run_postdriver+0x3c><== NEVER TAKEN 40007a70: 01 00 00 00 nop * Currently all APIs configure this hook so it is always non-NULL. */ #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); 40007a74: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007a78: 9f c0 40 00 call %g1 40007a7c: 01 00 00 00 nop Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { 40007a80: e0 04 00 00 ld [ %l0 ], %l0 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40007a84: 80 a4 00 11 cmp %l0, %l1 40007a88: 32 bf ff fc bne,a 40007a78 <_API_extensions_Run_postdriver+0x24> 40007a8c: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007a90: 81 c7 e0 08 ret 40007a94: 81 e8 00 00 restore =============================================================================== 40007a98 <_API_extensions_Run_postswitch>: * * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { 40007a98: 9d e3 bf a0 save %sp, -96, %sp the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } 40007a9c: 23 10 00 5e sethi %hi(0x40017800), %l1 40007aa0: e0 04 60 34 ld [ %l1 + 0x34 ], %l0 ! 40017834 <_API_extensions_List> 40007aa4: a2 14 60 34 or %l1, 0x34, %l1 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40007aa8: a2 04 60 04 add %l1, 4, %l1 40007aac: 80 a4 00 11 cmp %l0, %l1 40007ab0: 02 80 00 0a be 40007ad8 <_API_extensions_Run_postswitch+0x40><== NEVER TAKEN 40007ab4: 25 10 00 5e sethi %hi(0x40017800), %l2 40007ab8: a4 14 a3 78 or %l2, 0x378, %l2 ! 40017b78 <_Per_CPU_Information> !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); 40007abc: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40007ac0: 9f c0 40 00 call %g1 40007ac4: d0 04 a0 0c ld [ %l2 + 0xc ], %o0 Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { 40007ac8: e0 04 00 00 ld [ %l0 ], %l0 void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40007acc: 80 a4 00 11 cmp %l0, %l1 40007ad0: 32 bf ff fc bne,a 40007ac0 <_API_extensions_Run_postswitch+0x28> 40007ad4: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40007ad8: 81 c7 e0 08 ret 40007adc: 81 e8 00 00 restore =============================================================================== 4000a3d8 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 4000a3d8: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 4000a3dc: 03 10 00 6e sethi %hi(0x4001b800), %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 ); 4000a3e0: 7f ff e4 38 call 400034c0 4000a3e4: e0 00 63 14 ld [ %g1 + 0x314 ], %l0 ! 4001bb14 <_Per_CPU_Information+0xc> 4000a3e8: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 4000a3ec: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 4000a3f0: 80 a0 60 00 cmp %g1, 0 4000a3f4: 02 80 00 2b be 4000a4a0 <_CORE_RWLock_Release+0xc8> 4000a3f8: 80 a0 60 01 cmp %g1, 1 _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 4000a3fc: 22 80 00 22 be,a 4000a484 <_CORE_RWLock_Release+0xac> 4000a400: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 return CORE_RWLOCK_SUCCESSFUL; } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 4000a404: 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; 4000a408: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 4000a40c: 7f ff e4 31 call 400034d0 4000a410: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 4000a414: 40 00 07 36 call 4000c0ec <_Thread_queue_Dequeue> 4000a418: 90 10 00 18 mov %i0, %o0 if ( next ) { 4000a41c: 80 a2 20 00 cmp %o0, 0 4000a420: 22 80 00 24 be,a 4000a4b0 <_CORE_RWLock_Release+0xd8> 4000a424: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 4000a428: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 4000a42c: 80 a0 60 01 cmp %g1, 1 4000a430: 02 80 00 22 be 4000a4b8 <_CORE_RWLock_Release+0xe0> 4000a434: 84 10 20 01 mov 1, %g2 } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 4000a438: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 4000a43c: 82 00 60 01 inc %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 4000a440: c4 26 20 44 st %g2, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 4000a444: 10 80 00 09 b 4000a468 <_CORE_RWLock_Release+0x90> 4000a448: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); if ( !next || 4000a44c: 80 a0 60 01 cmp %g1, 1 4000a450: 02 80 00 0b be 4000a47c <_CORE_RWLock_Release+0xa4> <== NEVER TAKEN 4000a454: 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; 4000a458: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 4000a45c: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 4000a460: 40 00 08 39 call 4000c544 <_Thread_queue_Extract> 4000a464: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); 4000a468: 40 00 08 8a call 4000c690 <_Thread_queue_First> 4000a46c: 90 10 00 18 mov %i0, %o0 if ( !next || 4000a470: 92 92 20 00 orcc %o0, 0, %o1 4000a474: 32 bf ff f6 bne,a 4000a44c <_CORE_RWLock_Release+0x74> 4000a478: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 4000a47c: 81 c7 e0 08 ret 4000a480: 91 e8 20 00 restore %g0, 0, %o0 _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { the_rwlock->number_of_readers -= 1; 4000a484: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 4000a488: 80 a0 60 00 cmp %g1, 0 4000a48c: 02 bf ff de be 4000a404 <_CORE_RWLock_Release+0x2c> 4000a490: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 4000a494: 7f ff e4 0f call 400034d0 4000a498: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 4000a49c: 30 80 00 05 b,a 4000a4b0 <_CORE_RWLock_Release+0xd8> * If any thread is waiting, then we wait. */ _ISR_Disable( level ); if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ _ISR_Enable( level ); 4000a4a0: 7f ff e4 0c call 400034d0 4000a4a4: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 4000a4a8: 82 10 20 02 mov 2, %g1 4000a4ac: c2 24 20 34 st %g1, [ %l0 + 0x34 ] } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 4000a4b0: 81 c7 e0 08 ret 4000a4b4: 81 e8 00 00 restore next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); if ( next ) { if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 4000a4b8: 82 10 20 02 mov 2, %g1 4000a4bc: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 4000a4c0: 81 c7 e0 08 ret 4000a4c4: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000a4c8 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 4000a4c8: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 4000a4cc: 90 10 00 18 mov %i0, %o0 4000a4d0: 40 00 06 37 call 4000bdac <_Thread_Get> 4000a4d4: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000a4d8: c2 07 bf fc ld [ %fp + -4 ], %g1 4000a4dc: 80 a0 60 00 cmp %g1, 0 4000a4e0: 12 80 00 08 bne 4000a500 <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 4000a4e4: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 4000a4e8: 40 00 08 b1 call 4000c7ac <_Thread_queue_Process_timeout> 4000a4ec: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000a4f0: 03 10 00 6d sethi %hi(0x4001b400), %g1 4000a4f4: c4 00 61 b0 ld [ %g1 + 0x1b0 ], %g2 ! 4001b5b0 <_Thread_Dispatch_disable_level> 4000a4f8: 84 00 bf ff add %g2, -1, %g2 4000a4fc: c4 20 61 b0 st %g2, [ %g1 + 0x1b0 ] 4000a500: 81 c7 e0 08 ret 4000a504: 81 e8 00 00 restore =============================================================================== 40018104 <_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 ) { 40018104: 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 ) { 40018108: 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 ) { 4001810c: 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 ) { 40018110: 80 a0 40 1a cmp %g1, %i2 40018114: 0a 80 00 17 bcs 40018170 <_CORE_message_queue_Broadcast+0x6c><== NEVER TAKEN 40018118: 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 ) { 4001811c: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40018120: 80 a0 60 00 cmp %g1, 0 40018124: 02 80 00 0a be 4001814c <_CORE_message_queue_Broadcast+0x48> 40018128: a4 10 20 00 clr %l2 *count = 0; 4001812c: c0 27 40 00 clr [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 40018130: 81 c7 e0 08 ret 40018134: 91 e8 20 00 restore %g0, 0, %o0 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 40018138: d0 04 60 2c ld [ %l1 + 0x2c ], %o0 4001813c: 40 00 27 22 call 40021dc4 40018140: a4 04 a0 01 inc %l2 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 40018144: c2 04 60 28 ld [ %l1 + 0x28 ], %g1 40018148: 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 = 4001814c: 40 00 0b b0 call 4001b00c <_Thread_queue_Dequeue> 40018150: 90 10 00 10 mov %l0, %o0 40018154: 92 10 00 19 mov %i1, %o1 40018158: a2 10 00 08 mov %o0, %l1 4001815c: 80 a2 20 00 cmp %o0, 0 40018160: 12 bf ff f6 bne 40018138 <_CORE_message_queue_Broadcast+0x34> 40018164: 94 10 00 1a mov %i2, %o2 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 40018168: e4 27 40 00 st %l2, [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 4001816c: b0 10 20 00 clr %i0 } 40018170: 81 c7 e0 08 ret 40018174: 81 e8 00 00 restore =============================================================================== 400119c4 <_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 ) { 400119c4: 9d e3 bf a0 save %sp, -96, %sp size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; the_message_queue->number_of_pending_messages = 0; 400119c8: c0 26 20 48 clr [ %i0 + 0x48 ] ) { size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; 400119cc: f4 26 20 44 st %i2, [ %i0 + 0x44 ] the_message_queue->number_of_pending_messages = 0; the_message_queue->maximum_message_size = maximum_message_size; 400119d0: 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; 400119d4: c0 26 20 60 clr [ %i0 + 0x60 ] the_message_queue->notify_argument = the_argument; 400119d8: 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 ) { 400119dc: 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)) { 400119e0: 80 8e e0 03 btst 3, %i3 400119e4: 02 80 00 07 be 40011a00 <_CORE_message_queue_Initialize+0x3c> 400119e8: a4 10 00 1b mov %i3, %l2 allocated_message_size += sizeof(uint32_t); 400119ec: a4 06 e0 04 add %i3, 4, %l2 allocated_message_size &= ~(sizeof(uint32_t) - 1); 400119f0: a4 0c bf fc and %l2, -4, %l2 } if (allocated_message_size < maximum_message_size) 400119f4: 80 a6 c0 12 cmp %i3, %l2 400119f8: 18 80 00 22 bgu 40011a80 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 400119fc: 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)); 40011a00: 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 * 40011a04: 92 10 00 1a mov %i2, %o1 40011a08: 90 10 00 11 mov %l1, %o0 40011a0c: 40 00 44 f7 call 40022de8 <.umul> 40011a10: b0 10 20 00 clr %i0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 40011a14: 80 a2 00 12 cmp %o0, %l2 40011a18: 0a 80 00 1a bcs 40011a80 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 40011a1c: 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 ); 40011a20: 40 00 0c c7 call 40014d3c <_Workspace_Allocate> 40011a24: 01 00 00 00 nop return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 40011a28: d0 24 20 5c st %o0, [ %l0 + 0x5c ] _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 40011a2c: 80 a2 20 00 cmp %o0, 0 40011a30: 02 80 00 14 be 40011a80 <_CORE_message_queue_Initialize+0xbc> 40011a34: 92 10 00 08 mov %o0, %o1 /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 40011a38: 90 04 20 68 add %l0, 0x68, %o0 40011a3c: 94 10 00 1a mov %i2, %o2 40011a40: 40 00 17 c5 call 40017954 <_Chain_Initialize> 40011a44: 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 ); 40011a48: 82 04 20 50 add %l0, 0x50, %g1 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 40011a4c: c0 24 20 54 clr [ %l0 + 0x54 ] RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 40011a50: 84 04 20 54 add %l0, 0x54, %g2 head->next = tail; head->previous = NULL; tail->previous = head; 40011a54: c2 24 20 58 st %g1, [ %l0 + 0x58 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40011a58: c4 24 20 50 st %g2, [ %l0 + 0x50 ] allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 40011a5c: c2 06 40 00 ld [ %i1 ], %g1 THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 40011a60: b0 10 20 01 mov 1, %i0 allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 40011a64: 82 18 60 01 xor %g1, 1, %g1 40011a68: 80 a0 00 01 cmp %g0, %g1 40011a6c: 90 10 00 10 mov %l0, %o0 40011a70: 94 10 20 80 mov 0x80, %o2 40011a74: 92 60 3f ff subx %g0, -1, %o1 40011a78: 40 00 09 cf call 400141b4 <_Thread_queue_Initialize> 40011a7c: 96 10 20 06 mov 6, %o3 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 40011a80: 81 c7 e0 08 ret 40011a84: 81 e8 00 00 restore =============================================================================== 40007de4 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 40007de4: 9d e3 bf a0 save %sp, -96, %sp _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 40007de8: 21 10 00 5d sethi %hi(0x40017400), %l0 40007dec: c2 04 22 20 ld [ %l0 + 0x220 ], %g1 ! 40017620 <_Thread_Dispatch_disable_level> 40007df0: 80 a0 60 00 cmp %g1, 0 40007df4: 02 80 00 05 be 40007e08 <_CORE_mutex_Seize+0x24> 40007df8: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40007dfc: 80 8e a0 ff btst 0xff, %i2 40007e00: 12 80 00 1a bne 40007e68 <_CORE_mutex_Seize+0x84> <== ALWAYS TAKEN 40007e04: 03 10 00 5d sethi %hi(0x40017400), %g1 40007e08: 90 10 00 18 mov %i0, %o0 40007e0c: 40 00 16 b6 call 4000d8e4 <_CORE_mutex_Seize_interrupt_trylock> 40007e10: 92 07 a0 54 add %fp, 0x54, %o1 40007e14: 80 a2 20 00 cmp %o0, 0 40007e18: 02 80 00 12 be 40007e60 <_CORE_mutex_Seize+0x7c> 40007e1c: 80 8e a0 ff btst 0xff, %i2 40007e20: 02 80 00 1a be 40007e88 <_CORE_mutex_Seize+0xa4> 40007e24: 01 00 00 00 nop 40007e28: c4 04 22 20 ld [ %l0 + 0x220 ], %g2 40007e2c: 03 10 00 5e sethi %hi(0x40017800), %g1 40007e30: c2 00 63 84 ld [ %g1 + 0x384 ], %g1 ! 40017b84 <_Per_CPU_Information+0xc> RTEMS_INLINE_ROUTINE void _Thread_queue_Enter_critical_section ( Thread_queue_Control *the_thread_queue ) { the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 40007e34: 86 10 20 01 mov 1, %g3 40007e38: c6 26 20 30 st %g3, [ %i0 + 0x30 ] 40007e3c: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 40007e40: f2 20 60 20 st %i1, [ %g1 + 0x20 ] 40007e44: 82 00 a0 01 add %g2, 1, %g1 40007e48: c2 24 22 20 st %g1, [ %l0 + 0x220 ] 40007e4c: 7f ff e7 f4 call 40001e1c 40007e50: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40007e54: 90 10 00 18 mov %i0, %o0 40007e58: 7f ff ff c0 call 40007d58 <_CORE_mutex_Seize_interrupt_blocking> 40007e5c: 92 10 00 1b mov %i3, %o1 40007e60: 81 c7 e0 08 ret 40007e64: 81 e8 00 00 restore 40007e68: c2 00 63 98 ld [ %g1 + 0x398 ], %g1 40007e6c: 80 a0 60 01 cmp %g1, 1 40007e70: 28 bf ff e7 bleu,a 40007e0c <_CORE_mutex_Seize+0x28> 40007e74: 90 10 00 18 mov %i0, %o0 40007e78: 90 10 20 00 clr %o0 40007e7c: 92 10 20 00 clr %o1 40007e80: 40 00 01 d8 call 400085e0 <_Internal_error_Occurred> 40007e84: 94 10 20 12 mov 0x12, %o2 40007e88: 7f ff e7 e5 call 40001e1c 40007e8c: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40007e90: 03 10 00 5e sethi %hi(0x40017800), %g1 40007e94: c2 00 63 84 ld [ %g1 + 0x384 ], %g1 ! 40017b84 <_Per_CPU_Information+0xc> 40007e98: 84 10 20 01 mov 1, %g2 40007e9c: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 40007ea0: 81 c7 e0 08 ret 40007ea4: 81 e8 00 00 restore =============================================================================== 40008024 <_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 ) { 40008024: 9d e3 bf a0 save %sp, -96, %sp 40008028: a0 10 00 18 mov %i0, %l0 Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 4000802c: b0 10 20 00 clr %i0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 40008030: 40 00 07 06 call 40009c48 <_Thread_queue_Dequeue> 40008034: 90 10 00 10 mov %l0, %o0 40008038: 80 a2 20 00 cmp %o0, 0 4000803c: 02 80 00 04 be 4000804c <_CORE_semaphore_Surrender+0x28> 40008040: 01 00 00 00 nop status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } 40008044: 81 c7 e0 08 ret 40008048: 81 e8 00 00 restore if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 4000804c: 7f ff e7 70 call 40001e0c 40008050: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 40008054: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 40008058: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 4000805c: 80 a0 40 02 cmp %g1, %g2 40008060: 1a 80 00 05 bcc 40008074 <_CORE_semaphore_Surrender+0x50> <== NEVER TAKEN 40008064: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 40008068: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 4000806c: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 40008070: c2 24 20 48 st %g1, [ %l0 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 40008074: 7f ff e7 6a call 40001e1c 40008078: 01 00 00 00 nop } return status; } 4000807c: 81 c7 e0 08 ret 40008080: 81 e8 00 00 restore =============================================================================== 4000d87c <_Chain_Initialize>: Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { 4000d87c: 9d e3 bf a0 save %sp, -96, %sp Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; 4000d880: c0 26 20 04 clr [ %i0 + 4 ] size_t node_size ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4000d884: a0 06 20 04 add %i0, 4, %l0 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000d888: 80 a6 a0 00 cmp %i2, 0 4000d88c: 02 80 00 12 be 4000d8d4 <_Chain_Initialize+0x58> <== NEVER TAKEN 4000d890: 90 10 00 18 mov %i0, %o0 4000d894: b4 06 bf ff add %i2, -1, %i2 { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; Chain_Node *next = starting_address; 4000d898: 82 10 00 19 mov %i1, %g1 head->previous = NULL; while ( count-- ) { 4000d89c: 92 10 00 1a mov %i2, %o1 ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; 4000d8a0: 10 80 00 05 b 4000d8b4 <_Chain_Initialize+0x38> 4000d8a4: 84 10 00 18 mov %i0, %g2 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000d8a8: 84 10 00 01 mov %g1, %g2 4000d8ac: b4 06 bf ff add %i2, -1, %i2 current->next = next; next->previous = current; current = next; next = (Chain_Node *) 4000d8b0: 82 10 00 03 mov %g3, %g1 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { current->next = next; 4000d8b4: c2 20 80 00 st %g1, [ %g2 ] next->previous = current; 4000d8b8: c4 20 60 04 st %g2, [ %g1 + 4 ] Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000d8bc: 80 a6 a0 00 cmp %i2, 0 4000d8c0: 12 bf ff fa bne 4000d8a8 <_Chain_Initialize+0x2c> 4000d8c4: 86 00 40 1b add %g1, %i3, %g3 * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( 4000d8c8: 40 00 18 27 call 40013964 <.umul> 4000d8cc: 90 10 00 1b mov %i3, %o0 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 4000d8d0: 90 06 40 08 add %i1, %o0, %o0 current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; 4000d8d4: e0 22 00 00 st %l0, [ %o0 ] tail->previous = current; 4000d8d8: d0 26 20 08 st %o0, [ %i0 + 8 ] } 4000d8dc: 81 c7 e0 08 ret 4000d8e0: 81 e8 00 00 restore =============================================================================== 40006c6c <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 40006c6c: 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 ]; 40006c70: e0 06 21 54 ld [ %i0 + 0x154 ], %l0 option_set = (rtems_option) the_thread->Wait.option; _ISR_Disable( level ); 40006c74: 7f ff ec 66 call 40001e0c 40006c78: e4 06 20 30 ld [ %i0 + 0x30 ], %l2 40006c7c: a2 10 00 08 mov %o0, %l1 pending_events = api->pending_events; 40006c80: c4 04 00 00 ld [ %l0 ], %g2 event_condition = (rtems_event_set) the_thread->Wait.count; 40006c84: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { 40006c88: 86 88 40 02 andcc %g1, %g2, %g3 40006c8c: 02 80 00 3e be 40006d84 <_Event_Surrender+0x118> 40006c90: 09 10 00 5e sethi %hi(0x40017800), %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() && 40006c94: 88 11 23 78 or %g4, 0x378, %g4 ! 40017b78 <_Per_CPU_Information> 40006c98: da 01 20 08 ld [ %g4 + 8 ], %o5 40006c9c: 80 a3 60 00 cmp %o5, 0 40006ca0: 32 80 00 1d bne,a 40006d14 <_Event_Surrender+0xa8> 40006ca4: c8 01 20 0c ld [ %g4 + 0xc ], %g4 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); 40006ca8: c8 06 20 10 ld [ %i0 + 0x10 ], %g4 } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 40006cac: 80 89 21 00 btst 0x100, %g4 40006cb0: 02 80 00 33 be 40006d7c <_Event_Surrender+0x110> 40006cb4: 80 a0 40 03 cmp %g1, %g3 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 40006cb8: 02 80 00 04 be 40006cc8 <_Event_Surrender+0x5c> 40006cbc: 80 8c a0 02 btst 2, %l2 40006cc0: 02 80 00 2f be 40006d7c <_Event_Surrender+0x110> <== NEVER TAKEN 40006cc4: 01 00 00 00 nop api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006cc8: c2 06 20 28 ld [ %i0 + 0x28 ], %g1 RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear( rtems_event_set the_event_set, rtems_event_set the_mask ) { return ( the_event_set & ~(the_mask) ); 40006ccc: 84 28 80 03 andn %g2, %g3, %g2 /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 40006cd0: c4 24 00 00 st %g2, [ %l0 ] the_thread->Wait.count = 0; 40006cd4: c0 26 20 24 clr [ %i0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006cd8: c6 20 40 00 st %g3, [ %g1 ] _ISR_Flash( level ); 40006cdc: 7f ff ec 50 call 40001e1c 40006ce0: 90 10 00 11 mov %l1, %o0 40006ce4: 7f ff ec 4a call 40001e0c 40006ce8: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 40006cec: c2 06 20 50 ld [ %i0 + 0x50 ], %g1 40006cf0: 80 a0 60 02 cmp %g1, 2 40006cf4: 02 80 00 26 be 40006d8c <_Event_Surrender+0x120> 40006cf8: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 40006cfc: 90 10 00 11 mov %l1, %o0 40006d00: 7f ff ec 47 call 40001e1c 40006d04: 33 04 00 ff sethi %hi(0x1003fc00), %i1 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40006d08: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 40006d0c: 40 00 0a 1a call 40009574 <_Thread_Clear_state> 40006d10: 81 e8 00 00 restore /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && 40006d14: 80 a6 00 04 cmp %i0, %g4 40006d18: 32 bf ff e5 bne,a 40006cac <_Event_Surrender+0x40> 40006d1c: c8 06 20 10 ld [ %i0 + 0x10 ], %g4 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 40006d20: 09 10 00 5f sethi %hi(0x40017c00), %g4 40006d24: da 01 23 70 ld [ %g4 + 0x370 ], %o5 ! 40017f70 <_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 ) && 40006d28: 80 a3 60 02 cmp %o5, 2 40006d2c: 02 80 00 07 be 40006d48 <_Event_Surrender+0xdc> <== NEVER TAKEN 40006d30: 80 a0 40 03 cmp %g1, %g3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 40006d34: da 01 23 70 ld [ %g4 + 0x370 ], %o5 * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 40006d38: 80 a3 60 01 cmp %o5, 1 40006d3c: 32 bf ff dc bne,a 40006cac <_Event_Surrender+0x40> 40006d40: c8 06 20 10 ld [ %i0 + 0x10 ], %g4 (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { 40006d44: 80 a0 40 03 cmp %g1, %g3 40006d48: 02 80 00 04 be 40006d58 <_Event_Surrender+0xec> 40006d4c: 80 8c a0 02 btst 2, %l2 40006d50: 02 80 00 09 be 40006d74 <_Event_Surrender+0x108> <== NEVER TAKEN 40006d54: 01 00 00 00 nop api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006d58: c2 06 20 28 ld [ %i0 + 0x28 ], %g1 40006d5c: 84 28 80 03 andn %g2, %g3, %g2 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 40006d60: c4 24 00 00 st %g2, [ %l0 ] the_thread->Wait.count = 0; 40006d64: c0 26 20 24 clr [ %i0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006d68: c6 20 40 00 st %g3, [ %g1 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 40006d6c: 82 10 20 03 mov 3, %g1 40006d70: c2 21 23 70 st %g1, [ %g4 + 0x370 ] } _ISR_Enable( level ); 40006d74: 7f ff ec 2a call 40001e1c 40006d78: 91 e8 00 11 restore %g0, %l1, %o0 _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 40006d7c: 7f ff ec 28 call 40001e1c 40006d80: 91 e8 00 11 restore %g0, %l1, %o0 /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { _ISR_Enable( level ); 40006d84: 7f ff ec 26 call 40001e1c 40006d88: 91 e8 00 08 restore %g0, %o0, %o0 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 40006d8c: c2 26 20 50 st %g1, [ %i0 + 0x50 ] if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 40006d90: 7f ff ec 23 call 40001e1c 40006d94: 90 10 00 11 mov %l1, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 40006d98: 40 00 0f 3d call 4000aa8c <_Watchdog_Remove> 40006d9c: 90 06 20 48 add %i0, 0x48, %o0 40006da0: 33 04 00 ff sethi %hi(0x1003fc00), %i1 40006da4: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 40006da8: 40 00 09 f3 call 40009574 <_Thread_Clear_state> 40006dac: 81 e8 00 00 restore =============================================================================== 40006db4 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 40006db4: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 40006db8: 90 10 00 18 mov %i0, %o0 40006dbc: 40 00 0a d3 call 40009908 <_Thread_Get> 40006dc0: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40006dc4: c2 07 bf fc ld [ %fp + -4 ], %g1 40006dc8: 80 a0 60 00 cmp %g1, 0 40006dcc: 12 80 00 15 bne 40006e20 <_Event_Timeout+0x6c> <== NEVER TAKEN 40006dd0: 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 ); 40006dd4: 7f ff ec 0e call 40001e0c 40006dd8: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40006ddc: 03 10 00 5e sethi %hi(0x40017800), %g1 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 40006de0: c2 00 63 84 ld [ %g1 + 0x384 ], %g1 ! 40017b84 <_Per_CPU_Information+0xc> 40006de4: 80 a4 00 01 cmp %l0, %g1 40006de8: 02 80 00 10 be 40006e28 <_Event_Timeout+0x74> 40006dec: c0 24 20 24 clr [ %l0 + 0x24 ] if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40006df0: 82 10 20 06 mov 6, %g1 40006df4: c2 24 20 34 st %g1, [ %l0 + 0x34 ] _ISR_Enable( level ); 40006df8: 7f ff ec 09 call 40001e1c 40006dfc: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40006e00: 90 10 00 10 mov %l0, %o0 40006e04: 13 04 00 ff sethi %hi(0x1003fc00), %o1 40006e08: 40 00 09 db call 40009574 <_Thread_Clear_state> 40006e0c: 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; 40006e10: 03 10 00 5d sethi %hi(0x40017400), %g1 40006e14: c4 00 62 20 ld [ %g1 + 0x220 ], %g2 ! 40017620 <_Thread_Dispatch_disable_level> 40006e18: 84 00 bf ff add %g2, -1, %g2 40006e1c: c4 20 62 20 st %g2, [ %g1 + 0x220 ] 40006e20: 81 c7 e0 08 ret 40006e24: 81 e8 00 00 restore } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 40006e28: 03 10 00 5f sethi %hi(0x40017c00), %g1 40006e2c: c4 00 63 70 ld [ %g1 + 0x370 ], %g2 ! 40017f70 <_Event_Sync_state> 40006e30: 80 a0 a0 01 cmp %g2, 1 40006e34: 32 bf ff f0 bne,a 40006df4 <_Event_Timeout+0x40> 40006e38: 82 10 20 06 mov 6, %g1 _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 40006e3c: 84 10 20 02 mov 2, %g2 40006e40: c4 20 63 70 st %g2, [ %g1 + 0x370 ] } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40006e44: 10 bf ff ec b 40006df4 <_Event_Timeout+0x40> 40006e48: 82 10 20 06 mov 6, %g1 =============================================================================== 4000dad4 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 4000dad4: 9d e3 bf 98 save %sp, -104, %sp 4000dad8: a0 10 00 18 mov %i0, %l0 Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE 4000dadc: a4 06 60 04 add %i1, 4, %l2 - HEAP_ALLOC_BONUS; uintptr_t const page_size = heap->page_size; 4000dae0: fa 06 20 10 ld [ %i0 + 0x10 ], %i5 Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { 4000dae4: 80 a6 40 12 cmp %i1, %l2 4000dae8: 18 80 00 6e bgu 4000dca0 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000daec: b0 10 20 00 clr %i0 /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { 4000daf0: 80 a6 e0 00 cmp %i3, 0 4000daf4: 12 80 00 75 bne 4000dcc8 <_Heap_Allocate_aligned_with_boundary+0x1f4> 4000daf8: 80 a6 40 1b cmp %i1, %i3 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4000dafc: e8 04 20 08 ld [ %l0 + 8 ], %l4 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000db00: 80 a4 00 14 cmp %l0, %l4 4000db04: 02 80 00 67 be 4000dca0 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000db08: b0 10 20 00 clr %i0 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4000db0c: 82 07 60 07 add %i5, 7, %g1 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4000db10: b8 10 20 04 mov 4, %i4 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000db14: a2 10 20 01 mov 1, %l1 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4000db18: c2 27 bf fc st %g1, [ %fp + -4 ] + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4000db1c: b8 27 00 19 sub %i4, %i1, %i4 /* * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { 4000db20: e6 05 20 04 ld [ %l4 + 4 ], %l3 4000db24: 80 a4 80 13 cmp %l2, %l3 4000db28: 3a 80 00 4b bcc,a 4000dc54 <_Heap_Allocate_aligned_with_boundary+0x180> 4000db2c: e8 05 20 08 ld [ %l4 + 8 ], %l4 if ( alignment == 0 ) { 4000db30: 80 a6 a0 00 cmp %i2, 0 4000db34: 02 80 00 44 be 4000dc44 <_Heap_Allocate_aligned_with_boundary+0x170> 4000db38: b0 05 20 08 add %l4, 8, %i0 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; 4000db3c: c4 07 bf fc ld [ %fp + -4 ], %g2 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4000db40: ee 04 20 14 ld [ %l0 + 0x14 ], %l7 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4000db44: a6 0c ff fe and %l3, -2, %l3 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; 4000db48: 82 20 80 17 sub %g2, %l7, %g1 uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; 4000db4c: a6 05 00 13 add %l4, %l3, %l3 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000db50: 92 10 00 1a mov %i2, %o1 uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; uintptr_t alloc_begin = alloc_end - alloc_size; 4000db54: b0 07 00 13 add %i4, %l3, %i0 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 4000db58: a6 00 40 13 add %g1, %l3, %l3 4000db5c: 40 00 18 68 call 40013cfc <.urem> 4000db60: 90 10 00 18 mov %i0, %o0 4000db64: b0 26 00 08 sub %i0, %o0, %i0 uintptr_t alloc_begin = alloc_end - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { 4000db68: 80 a4 c0 18 cmp %l3, %i0 4000db6c: 1a 80 00 06 bcc 4000db84 <_Heap_Allocate_aligned_with_boundary+0xb0> 4000db70: ac 05 20 08 add %l4, 8, %l6 4000db74: 90 10 00 13 mov %l3, %o0 4000db78: 40 00 18 61 call 40013cfc <.urem> 4000db7c: 92 10 00 1a mov %i2, %o1 4000db80: b0 24 c0 08 sub %l3, %o0, %i0 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { 4000db84: 80 a6 e0 00 cmp %i3, 0 4000db88: 02 80 00 24 be 4000dc18 <_Heap_Allocate_aligned_with_boundary+0x144> 4000db8c: 80 a5 80 18 cmp %l6, %i0 /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { alloc_begin = _Heap_Align_down( alloc_begin_ceiling, alignment ); } alloc_end = alloc_begin + alloc_size; 4000db90: a6 06 00 19 add %i0, %i1, %l3 4000db94: 92 10 00 1b mov %i3, %o1 4000db98: 40 00 18 59 call 40013cfc <.urem> 4000db9c: 90 10 00 13 mov %l3, %o0 4000dba0: 90 24 c0 08 sub %l3, %o0, %o0 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4000dba4: 80 a2 00 13 cmp %o0, %l3 4000dba8: 1a 80 00 1b bcc 4000dc14 <_Heap_Allocate_aligned_with_boundary+0x140> 4000dbac: 80 a6 00 08 cmp %i0, %o0 4000dbb0: 1a 80 00 1a bcc 4000dc18 <_Heap_Allocate_aligned_with_boundary+0x144> 4000dbb4: 80 a5 80 18 cmp %l6, %i0 alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; 4000dbb8: aa 05 80 19 add %l6, %i1, %l5 uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { 4000dbbc: 80 a5 40 08 cmp %l5, %o0 4000dbc0: 28 80 00 09 bleu,a 4000dbe4 <_Heap_Allocate_aligned_with_boundary+0x110> 4000dbc4: b0 22 00 19 sub %o0, %i1, %i0 if ( alloc_begin != 0 ) { break; } block = block->next; 4000dbc8: 10 80 00 23 b 4000dc54 <_Heap_Allocate_aligned_with_boundary+0x180> 4000dbcc: e8 05 20 08 ld [ %l4 + 8 ], %l4 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4000dbd0: 1a 80 00 11 bcc 4000dc14 <_Heap_Allocate_aligned_with_boundary+0x140> 4000dbd4: 80 a5 40 08 cmp %l5, %o0 if ( boundary_line < boundary_floor ) { 4000dbd8: 38 80 00 1f bgu,a 4000dc54 <_Heap_Allocate_aligned_with_boundary+0x180><== NEVER TAKEN 4000dbdc: e8 05 20 08 ld [ %l4 + 8 ], %l4 <== NOT EXECUTED return 0; } alloc_begin = boundary_line - alloc_size; 4000dbe0: b0 22 00 19 sub %o0, %i1, %i0 4000dbe4: 92 10 00 1a mov %i2, %o1 4000dbe8: 40 00 18 45 call 40013cfc <.urem> 4000dbec: 90 10 00 18 mov %i0, %o0 4000dbf0: 92 10 00 1b mov %i3, %o1 4000dbf4: b0 26 00 08 sub %i0, %o0, %i0 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; 4000dbf8: a6 06 00 19 add %i0, %i1, %l3 4000dbfc: 40 00 18 40 call 40013cfc <.urem> 4000dc00: 90 10 00 13 mov %l3, %o0 4000dc04: 90 24 c0 08 sub %l3, %o0, %o0 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 4000dc08: 80 a2 00 13 cmp %o0, %l3 4000dc0c: 0a bf ff f1 bcs 4000dbd0 <_Heap_Allocate_aligned_with_boundary+0xfc> 4000dc10: 80 a6 00 08 cmp %i0, %o0 boundary_line = _Heap_Align_down( alloc_end, boundary ); } } /* Ensure that the we have a valid new block at the beginning */ if ( alloc_begin >= alloc_begin_floor ) { 4000dc14: 80 a5 80 18 cmp %l6, %i0 4000dc18: 38 80 00 0f bgu,a 4000dc54 <_Heap_Allocate_aligned_with_boundary+0x180> 4000dc1c: e8 05 20 08 ld [ %l4 + 8 ], %l4 4000dc20: 82 10 3f f8 mov -8, %g1 4000dc24: 90 10 00 18 mov %i0, %o0 4000dc28: a6 20 40 14 sub %g1, %l4, %l3 4000dc2c: 92 10 00 1d mov %i5, %o1 4000dc30: 40 00 18 33 call 40013cfc <.urem> 4000dc34: a6 04 c0 18 add %l3, %i0, %l3 uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; if ( free_size >= min_block_size || free_size == 0 ) { 4000dc38: 90 a4 c0 08 subcc %l3, %o0, %o0 4000dc3c: 12 80 00 1b bne 4000dca8 <_Heap_Allocate_aligned_with_boundary+0x1d4> 4000dc40: 80 a2 00 17 cmp %o0, %l7 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { 4000dc44: 80 a6 20 00 cmp %i0, 0 4000dc48: 32 80 00 08 bne,a 4000dc68 <_Heap_Allocate_aligned_with_boundary+0x194><== ALWAYS TAKEN 4000dc4c: c4 04 20 48 ld [ %l0 + 0x48 ], %g2 break; } block = block->next; 4000dc50: e8 05 20 08 ld [ %l4 + 8 ], %l4 <== NOT EXECUTED do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000dc54: 80 a4 00 14 cmp %l0, %l4 4000dc58: 02 80 00 1a be 4000dcc0 <_Heap_Allocate_aligned_with_boundary+0x1ec> 4000dc5c: 82 04 60 01 add %l1, 1, %g1 4000dc60: 10 bf ff b0 b 4000db20 <_Heap_Allocate_aligned_with_boundary+0x4c> 4000dc64: a2 10 00 01 mov %g1, %l1 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; 4000dc68: c2 04 20 4c ld [ %l0 + 0x4c ], %g1 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4000dc6c: 84 00 a0 01 inc %g2 stats->searches += search_count; 4000dc70: 82 00 40 11 add %g1, %l1, %g1 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4000dc74: c4 24 20 48 st %g2, [ %l0 + 0x48 ] stats->searches += search_count; 4000dc78: c2 24 20 4c st %g1, [ %l0 + 0x4c ] block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 4000dc7c: 90 10 00 10 mov %l0, %o0 4000dc80: 92 10 00 14 mov %l4, %o1 4000dc84: 94 10 00 18 mov %i0, %o2 4000dc88: 7f ff ea 0a call 400084b0 <_Heap_Block_allocate> 4000dc8c: 96 10 00 19 mov %i1, %o3 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { 4000dc90: c2 04 20 44 ld [ %l0 + 0x44 ], %g1 4000dc94: 80 a0 40 11 cmp %g1, %l1 4000dc98: 2a 80 00 02 bcs,a 4000dca0 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000dc9c: e2 24 20 44 st %l1, [ %l0 + 0x44 ] stats->max_search = search_count; } return (void *) alloc_begin; } 4000dca0: 81 c7 e0 08 ret 4000dca4: 81 e8 00 00 restore if ( alloc_begin >= alloc_begin_floor ) { uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; if ( free_size >= min_block_size || free_size == 0 ) { 4000dca8: 1a bf ff e8 bcc 4000dc48 <_Heap_Allocate_aligned_with_boundary+0x174> 4000dcac: 80 a6 20 00 cmp %i0, 0 if ( alloc_begin != 0 ) { break; } block = block->next; 4000dcb0: e8 05 20 08 ld [ %l4 + 8 ], %l4 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000dcb4: 80 a4 00 14 cmp %l0, %l4 4000dcb8: 12 bf ff ea bne 4000dc60 <_Heap_Allocate_aligned_with_boundary+0x18c><== NEVER TAKEN 4000dcbc: 82 04 60 01 add %l1, 1, %g1 4000dcc0: 10 bf ff f4 b 4000dc90 <_Heap_Allocate_aligned_with_boundary+0x1bc> 4000dcc4: b0 10 20 00 clr %i0 /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { 4000dcc8: 18 bf ff f6 bgu 4000dca0 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000dccc: 80 a6 a0 00 cmp %i2, 0 return NULL; } if ( alignment == 0 ) { 4000dcd0: 22 bf ff 8b be,a 4000dafc <_Heap_Allocate_aligned_with_boundary+0x28> 4000dcd4: b4 10 00 1d mov %i5, %i2 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 4000dcd8: 10 bf ff 8a b 4000db00 <_Heap_Allocate_aligned_with_boundary+0x2c> 4000dcdc: e8 04 20 08 ld [ %l0 + 8 ], %l4 =============================================================================== 4000dfe8 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 4000dfe8: 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; 4000dfec: c0 27 bf fc clr [ %fp + -4 ] Heap_Block *extend_last_block = NULL; 4000dff0: 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 ) { 4000dff4: a0 10 00 18 mov %i0, %l0 Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; 4000dff8: a2 06 40 1a add %i1, %i2, %l1 uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4000dffc: 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; 4000e000: e6 06 20 10 ld [ %i0 + 0x10 ], %l3 uintptr_t const min_block_size = heap->min_block_size; 4000e004: d6 06 20 14 ld [ %i0 + 0x14 ], %o3 uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; uintptr_t const free_size = stats->free_size; 4000e008: e8 06 20 30 ld [ %i0 + 0x30 ], %l4 uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { 4000e00c: 80 a6 40 11 cmp %i1, %l1 4000e010: 18 80 00 86 bgu 4000e228 <_Heap_Extend+0x240> 4000e014: b0 10 20 00 clr %i0 return false; } extend_area_ok = _Heap_Get_first_and_last_block( 4000e018: 90 10 00 19 mov %i1, %o0 4000e01c: 92 10 00 1a mov %i2, %o1 4000e020: 94 10 00 13 mov %l3, %o2 4000e024: 98 07 bf fc add %fp, -4, %o4 4000e028: 7f ff e9 83 call 40008634 <_Heap_Get_first_and_last_block> 4000e02c: 9a 07 bf f8 add %fp, -8, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4000e030: 80 8a 20 ff btst 0xff, %o0 4000e034: 02 80 00 7d be 4000e228 <_Heap_Extend+0x240> 4000e038: ba 10 20 00 clr %i5 4000e03c: b0 10 00 12 mov %l2, %i0 4000e040: b8 10 20 00 clr %i4 4000e044: ac 10 20 00 clr %l6 4000e048: 10 80 00 14 b 4000e098 <_Heap_Extend+0xb0> 4000e04c: ae 10 20 00 clr %l7 return false; } if ( extend_area_end == sub_area_begin ) { merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4000e050: 2a 80 00 02 bcs,a 4000e058 <_Heap_Extend+0x70> 4000e054: b8 10 00 18 mov %i0, %i4 4000e058: 90 10 00 15 mov %l5, %o0 4000e05c: 40 00 18 7b call 40014248 <.urem> 4000e060: 92 10 00 13 mov %l3, %o1 4000e064: 82 05 7f f8 add %l5, -8, %g1 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000e068: 80 a5 40 19 cmp %l5, %i1 4000e06c: 02 80 00 1c be 4000e0dc <_Heap_Extend+0xf4> 4000e070: 82 20 40 08 sub %g1, %o0, %g1 start_block->prev_size = extend_area_end; merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4000e074: 80 a6 40 15 cmp %i1, %l5 4000e078: 38 80 00 02 bgu,a 4000e080 <_Heap_Extend+0x98> 4000e07c: ba 10 00 01 mov %g1, %i5 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4000e080: f0 00 60 04 ld [ %g1 + 4 ], %i0 4000e084: b0 0e 3f fe and %i0, -2, %i0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000e088: b0 00 40 18 add %g1, %i0, %i0 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4000e08c: 80 a4 80 18 cmp %l2, %i0 4000e090: 22 80 00 1b be,a 4000e0fc <_Heap_Extend+0x114> 4000e094: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 4000e098: 80 a6 00 12 cmp %i0, %l2 4000e09c: 02 80 00 65 be 4000e230 <_Heap_Extend+0x248> 4000e0a0: 82 10 00 18 mov %i0, %g1 uintptr_t const sub_area_end = start_block->prev_size; Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 4000e0a4: 80 a0 40 11 cmp %g1, %l1 4000e0a8: 0a 80 00 6f bcs 4000e264 <_Heap_Extend+0x27c> 4000e0ac: ea 06 00 00 ld [ %i0 ], %l5 sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { 4000e0b0: 80 a0 40 11 cmp %g1, %l1 4000e0b4: 12 bf ff e7 bne 4000e050 <_Heap_Extend+0x68> 4000e0b8: 80 a4 40 15 cmp %l1, %l5 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000e0bc: 90 10 00 15 mov %l5, %o0 4000e0c0: 40 00 18 62 call 40014248 <.urem> 4000e0c4: 92 10 00 13 mov %l3, %o1 4000e0c8: 82 05 7f f8 add %l5, -8, %g1 4000e0cc: ae 10 00 18 mov %i0, %l7 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000e0d0: 80 a5 40 19 cmp %l5, %i1 4000e0d4: 12 bf ff e8 bne 4000e074 <_Heap_Extend+0x8c> <== ALWAYS TAKEN 4000e0d8: 82 20 40 08 sub %g1, %o0, %g1 start_block->prev_size = extend_area_end; 4000e0dc: e2 26 00 00 st %l1, [ %i0 ] - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4000e0e0: f0 00 60 04 ld [ %g1 + 4 ], %i0 4000e0e4: b0 0e 3f fe and %i0, -2, %i0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000e0e8: b0 00 40 18 add %g1, %i0, %i0 } else if ( sub_area_end < extend_area_begin ) { link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4000e0ec: 80 a4 80 18 cmp %l2, %i0 4000e0f0: 12 bf ff ea bne 4000e098 <_Heap_Extend+0xb0> <== NEVER TAKEN 4000e0f4: ac 10 00 01 mov %g1, %l6 if ( extend_area_begin < heap->area_begin ) { 4000e0f8: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000e0fc: 80 a6 40 01 cmp %i1, %g1 4000e100: 3a 80 00 54 bcc,a 4000e250 <_Heap_Extend+0x268> 4000e104: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 4000e108: f2 24 20 18 st %i1, [ %l0 + 0x18 ] } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4000e10c: c2 07 bf fc ld [ %fp + -4 ], %g1 4000e110: c4 07 bf f8 ld [ %fp + -8 ], %g2 extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 4000e114: c8 04 20 20 ld [ %l0 + 0x20 ], %g4 heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 4000e118: 86 20 80 01 sub %g2, %g1, %g3 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; 4000e11c: e2 20 40 00 st %l1, [ %g1 ] extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4000e120: 9a 10 e0 01 or %g3, 1, %o5 extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = 4000e124: da 20 60 04 st %o5, [ %g1 + 4 ] extend_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; 4000e128: c6 20 80 00 st %g3, [ %g2 ] extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 4000e12c: 80 a1 00 01 cmp %g4, %g1 4000e130: 08 80 00 42 bleu 4000e238 <_Heap_Extend+0x250> 4000e134: c0 20 a0 04 clr [ %g2 + 4 ] heap->first_block = extend_first_block; 4000e138: c2 24 20 20 st %g1, [ %l0 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000e13c: 80 a5 e0 00 cmp %l7, 0 4000e140: 02 80 00 62 be 4000e2c8 <_Heap_Extend+0x2e0> 4000e144: 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; 4000e148: 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; 4000e14c: 92 10 00 12 mov %l2, %o1 4000e150: 40 00 18 3e call 40014248 <.urem> 4000e154: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 4000e158: 80 a2 20 00 cmp %o0, 0 4000e15c: 02 80 00 04 be 4000e16c <_Heap_Extend+0x184> <== ALWAYS TAKEN 4000e160: c4 05 c0 00 ld [ %l7 ], %g2 return value - remainder + alignment; 4000e164: b2 06 40 12 add %i1, %l2, %i1 <== NOT EXECUTED 4000e168: 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 = 4000e16c: 82 06 7f f8 add %i1, -8, %g1 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; 4000e170: c4 26 7f f8 st %g2, [ %i1 + -8 ] uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE; uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = 4000e174: 84 25 c0 01 sub %l7, %g1, %g2 first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; 4000e178: 84 10 a0 01 or %g2, 1, %g2 _Heap_Free_block( heap, new_first_block ); 4000e17c: 90 10 00 10 mov %l0, %o0 4000e180: 92 10 00 01 mov %g1, %o1 4000e184: 7f ff ff 8e call 4000dfbc <_Heap_Free_block> 4000e188: c4 20 60 04 st %g2, [ %g1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000e18c: 80 a5 a0 00 cmp %l6, 0 4000e190: 02 80 00 3a be 4000e278 <_Heap_Extend+0x290> 4000e194: 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); 4000e198: 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( 4000e19c: a2 24 40 16 sub %l1, %l6, %l1 4000e1a0: 40 00 18 2a call 40014248 <.urem> 4000e1a4: 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) 4000e1a8: c2 05 a0 04 ld [ %l6 + 4 ], %g1 4000e1ac: a2 24 40 08 sub %l1, %o0, %l1 4000e1b0: 82 20 40 11 sub %g1, %l1, %g1 | HEAP_PREV_BLOCK_USED; 4000e1b4: 82 10 60 01 or %g1, 1, %g1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 4000e1b8: 84 04 40 16 add %l1, %l6, %g2 4000e1bc: c2 20 a0 04 st %g1, [ %g2 + 4 ] RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000e1c0: c2 05 a0 04 ld [ %l6 + 4 ], %g1 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); 4000e1c4: 90 10 00 10 mov %l0, %o0 4000e1c8: 82 08 60 01 and %g1, 1, %g1 4000e1cc: 92 10 00 16 mov %l6, %o1 block->size_and_flag = size | flag; 4000e1d0: a2 14 40 01 or %l1, %g1, %l1 4000e1d4: 7f ff ff 7a call 4000dfbc <_Heap_Free_block> 4000e1d8: e2 25 a0 04 st %l1, [ %l6 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000e1dc: 80 a5 a0 00 cmp %l6, 0 4000e1e0: 02 80 00 33 be 4000e2ac <_Heap_Extend+0x2c4> 4000e1e4: 80 a5 e0 00 cmp %l7, 0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4000e1e8: 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( 4000e1ec: da 04 20 20 ld [ %l0 + 0x20 ], %o5 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000e1f0: c8 00 60 04 ld [ %g1 + 4 ], %g4 _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; 4000e1f4: c4 04 20 2c ld [ %l0 + 0x2c ], %g2 _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000e1f8: c6 04 20 30 ld [ %l0 + 0x30 ], %g3 * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 4000e1fc: 9a 23 40 01 sub %o5, %g1, %o5 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000e200: 88 09 20 01 and %g4, 1, %g4 block->size_and_flag = size | flag; 4000e204: 88 13 40 04 or %o5, %g4, %g4 4000e208: c8 20 60 04 st %g4, [ %g1 + 4 ] 4000e20c: a8 20 c0 14 sub %g3, %l4, %l4 /* Statistics */ stats->size += extended_size; 4000e210: 82 00 80 14 add %g2, %l4, %g1 4000e214: c2 24 20 2c st %g1, [ %l0 + 0x2c ] if ( extended_size_ptr != NULL ) 4000e218: 80 a6 e0 00 cmp %i3, 0 4000e21c: 02 80 00 03 be 4000e228 <_Heap_Extend+0x240> <== NEVER TAKEN 4000e220: b0 10 20 01 mov 1, %i0 *extended_size_ptr = extended_size; 4000e224: e8 26 c0 00 st %l4, [ %i3 ] 4000e228: 81 c7 e0 08 ret 4000e22c: 81 e8 00 00 restore return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 4000e230: 10 bf ff 9d b 4000e0a4 <_Heap_Extend+0xbc> 4000e234: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { heap->first_block = extend_first_block; } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 4000e238: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 4000e23c: 80 a0 40 02 cmp %g1, %g2 4000e240: 2a bf ff bf bcs,a 4000e13c <_Heap_Extend+0x154> 4000e244: c4 24 20 24 st %g2, [ %l0 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000e248: 10 bf ff be b 4000e140 <_Heap_Extend+0x158> 4000e24c: 80 a5 e0 00 cmp %l7, 0 start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); if ( extend_area_begin < heap->area_begin ) { heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { 4000e250: 80 a4 40 01 cmp %l1, %g1 4000e254: 38 bf ff ae bgu,a 4000e10c <_Heap_Extend+0x124> 4000e258: 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; 4000e25c: 10 bf ff ad b 4000e110 <_Heap_Extend+0x128> 4000e260: c2 07 bf fc ld [ %fp + -4 ], %g1 (uintptr_t) start_block : heap->area_begin; uintptr_t const sub_area_end = start_block->prev_size; Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 4000e264: 80 a6 40 15 cmp %i1, %l5 4000e268: 1a bf ff 93 bcc 4000e0b4 <_Heap_Extend+0xcc> 4000e26c: 80 a0 40 11 cmp %g1, %l1 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4000e270: 81 c7 e0 08 ret 4000e274: 91 e8 20 00 restore %g0, 0, %o0 ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { 4000e278: 80 a7 60 00 cmp %i5, 0 4000e27c: 02 bf ff d8 be 4000e1dc <_Heap_Extend+0x1f4> 4000e280: c4 07 bf fc ld [ %fp + -4 ], %g2 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000e284: c6 07 60 04 ld [ %i5 + 4 ], %g3 _Heap_Link_above( 4000e288: c2 07 bf f8 ld [ %fp + -8 ], %g1 4000e28c: 86 08 e0 01 and %g3, 1, %g3 ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); 4000e290: 84 20 80 1d sub %g2, %i5, %g2 block->size_and_flag = size | flag; 4000e294: 84 10 80 03 or %g2, %g3, %g2 4000e298: c4 27 60 04 st %g2, [ %i5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4000e29c: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000e2a0: 84 10 a0 01 or %g2, 1, %g2 4000e2a4: 10 bf ff ce b 4000e1dc <_Heap_Extend+0x1f4> 4000e2a8: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000e2ac: 32 bf ff d0 bne,a 4000e1ec <_Heap_Extend+0x204> 4000e2b0: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 4000e2b4: d2 07 bf fc ld [ %fp + -4 ], %o1 4000e2b8: 7f ff ff 41 call 4000dfbc <_Heap_Free_block> 4000e2bc: 90 10 00 10 mov %l0, %o0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 4000e2c0: 10 bf ff cb b 4000e1ec <_Heap_Extend+0x204> 4000e2c4: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { _Heap_Merge_below( heap, extend_area_begin, merge_below_block ); } else if ( link_below_block != NULL ) { 4000e2c8: 80 a7 20 00 cmp %i4, 0 4000e2cc: 02 bf ff b1 be 4000e190 <_Heap_Extend+0x1a8> 4000e2d0: 80 a5 a0 00 cmp %l6, 0 { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = (link_begin - last_block_begin) | HEAP_PREV_BLOCK_USED; 4000e2d4: b8 27 00 02 sub %i4, %g2, %i4 4000e2d8: 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 = 4000e2dc: 10 bf ff ad b 4000e190 <_Heap_Extend+0x1a8> 4000e2e0: f8 20 a0 04 st %i4, [ %g2 + 4 ] =============================================================================== 4000dce0 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4000dce0: 9d e3 bf a0 save %sp, -96, %sp 4000dce4: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 4000dce8: 40 00 18 05 call 40013cfc <.urem> 4000dcec: 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 4000dcf0: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 4000dcf4: a0 10 00 18 mov %i0, %l0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000dcf8: a2 06 7f f8 add %i1, -8, %l1 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4000dcfc: 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; 4000dd00: 80 a2 00 01 cmp %o0, %g1 4000dd04: 0a 80 00 4d bcs 4000de38 <_Heap_Free+0x158> 4000dd08: b0 10 20 00 clr %i0 4000dd0c: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 4000dd10: 80 a2 00 03 cmp %o0, %g3 4000dd14: 18 80 00 49 bgu 4000de38 <_Heap_Free+0x158> 4000dd18: 01 00 00 00 nop --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000dd1c: 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; 4000dd20: 88 0b 7f fe and %o5, -2, %g4 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000dd24: 84 02 00 04 add %o0, %g4, %g2 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 4000dd28: 80 a0 40 02 cmp %g1, %g2 4000dd2c: 18 80 00 43 bgu 4000de38 <_Heap_Free+0x158> <== NEVER TAKEN 4000dd30: 80 a0 c0 02 cmp %g3, %g2 4000dd34: 0a 80 00 41 bcs 4000de38 <_Heap_Free+0x158> <== NEVER TAKEN 4000dd38: 01 00 00 00 nop 4000dd3c: d8 00 a0 04 ld [ %g2 + 4 ], %o4 if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 4000dd40: 80 8b 20 01 btst 1, %o4 4000dd44: 02 80 00 3d be 4000de38 <_Heap_Free+0x158> <== NEVER TAKEN 4000dd48: 96 0b 3f fe and %o4, -2, %o3 return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4000dd4c: 80 a0 c0 02 cmp %g3, %g2 4000dd50: 02 80 00 06 be 4000dd68 <_Heap_Free+0x88> 4000dd54: 98 10 20 00 clr %o4 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000dd58: 98 00 80 0b add %g2, %o3, %o4 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000dd5c: d8 03 20 04 ld [ %o4 + 4 ], %o4 4000dd60: 98 0b 20 01 and %o4, 1, %o4 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) 4000dd64: 98 1b 20 01 xor %o4, 1, %o4 next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { 4000dd68: 80 8b 60 01 btst 1, %o5 4000dd6c: 12 80 00 1d bne 4000dde0 <_Heap_Free+0x100> 4000dd70: 80 8b 20 ff btst 0xff, %o4 uintptr_t const prev_size = block->prev_size; 4000dd74: d4 02 00 00 ld [ %o0 ], %o2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000dd78: 9a 22 00 0a sub %o0, %o2, %o5 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 4000dd7c: 80 a0 40 0d cmp %g1, %o5 4000dd80: 18 80 00 2e bgu 4000de38 <_Heap_Free+0x158> <== NEVER TAKEN 4000dd84: b0 10 20 00 clr %i0 4000dd88: 80 a0 c0 0d cmp %g3, %o5 4000dd8c: 0a 80 00 2b bcs 4000de38 <_Heap_Free+0x158> <== NEVER TAKEN 4000dd90: 01 00 00 00 nop block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 4000dd94: c2 03 60 04 ld [ %o5 + 4 ], %g1 return( false ); } /* As we always coalesce free blocks, the block that preceedes prev_block must have been used. */ if ( !_Heap_Is_prev_used ( prev_block) ) { 4000dd98: 80 88 60 01 btst 1, %g1 4000dd9c: 02 80 00 27 be 4000de38 <_Heap_Free+0x158> <== NEVER TAKEN 4000dda0: 80 8b 20 ff btst 0xff, %o4 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4000dda4: 22 80 00 39 be,a 4000de88 <_Heap_Free+0x1a8> 4000dda8: 94 01 00 0a add %g4, %o2, %o2 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000ddac: c2 00 a0 08 ld [ %g2 + 8 ], %g1 4000ddb0: c4 00 a0 0c ld [ %g2 + 0xc ], %g2 } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4000ddb4: c6 04 20 38 ld [ %l0 + 0x38 ], %g3 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 4000ddb8: c2 20 a0 08 st %g1, [ %g2 + 8 ] next->prev = prev; 4000ddbc: c4 20 60 0c st %g2, [ %g1 + 0xc ] 4000ddc0: 82 00 ff ff add %g3, -1, %g1 4000ddc4: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; 4000ddc8: 96 01 00 0b add %g4, %o3, %o3 4000ddcc: 94 02 c0 0a add %o3, %o2, %o2 _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000ddd0: 82 12 a0 01 or %o2, 1, %g1 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 4000ddd4: d4 23 40 0a st %o2, [ %o5 + %o2 ] if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000ddd8: 10 80 00 0e b 4000de10 <_Heap_Free+0x130> 4000dddc: c2 23 60 04 st %g1, [ %o5 + 4 ] uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 4000dde0: 22 80 00 18 be,a 4000de40 <_Heap_Free+0x160> 4000dde4: c6 04 20 08 ld [ %l0 + 8 ], %g3 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 4000dde8: c6 00 a0 08 ld [ %g2 + 8 ], %g3 4000ddec: c2 00 a0 0c ld [ %g2 + 0xc ], %g1 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; 4000ddf0: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = prev; 4000ddf4: c2 22 20 0c st %g1, [ %o0 + 0xc ] prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; 4000ddf8: 96 02 c0 04 add %o3, %g4, %o3 next->prev = new_block; 4000ddfc: d0 20 e0 0c st %o0, [ %g3 + 0xc ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000de00: 84 12 e0 01 or %o3, 1, %g2 prev->next = new_block; 4000de04: d0 20 60 08 st %o0, [ %g1 + 8 ] 4000de08: c4 22 20 04 st %g2, [ %o0 + 4 ] next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4000de0c: d6 22 00 0b st %o3, [ %o0 + %o3 ] stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000de10: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 ++stats->frees; 4000de14: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 stats->free_size += block_size; 4000de18: c6 04 20 30 ld [ %l0 + 0x30 ], %g3 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000de1c: 84 00 bf ff add %g2, -1, %g2 ++stats->frees; 4000de20: 82 00 60 01 inc %g1 stats->free_size += block_size; 4000de24: 88 00 c0 04 add %g3, %g4, %g4 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000de28: c4 24 20 40 st %g2, [ %l0 + 0x40 ] ++stats->frees; 4000de2c: c2 24 20 50 st %g1, [ %l0 + 0x50 ] stats->free_size += block_size; 4000de30: c8 24 20 30 st %g4, [ %l0 + 0x30 ] return( true ); 4000de34: b0 10 20 01 mov 1, %i0 } 4000de38: 81 c7 e0 08 ret 4000de3c: 81 e8 00 00 restore next_block->prev_size = size; } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 4000de40: 82 11 20 01 or %g4, 1, %g1 4000de44: c2 22 20 04 st %g1, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000de48: da 00 a0 04 ld [ %g2 + 4 ], %o5 next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000de4c: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 4000de50: e0 22 20 0c st %l0, [ %o0 + 0xc ] Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4000de54: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4000de58: d0 20 e0 0c st %o0, [ %g3 + 0xc ] /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; 4000de5c: c8 22 00 04 st %g4, [ %o0 + %g4 ] } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000de60: 86 0b 7f fe and %o5, -2, %g3 4000de64: c6 20 a0 04 st %g3, [ %g2 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { 4000de68: c4 04 20 3c ld [ %l0 + 0x3c ], %g2 block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000de6c: 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; 4000de70: d0 24 20 08 st %o0, [ %l0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 4000de74: 80 a0 40 02 cmp %g1, %g2 4000de78: 08 bf ff e6 bleu 4000de10 <_Heap_Free+0x130> 4000de7c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 4000de80: 10 bf ff e4 b 4000de10 <_Heap_Free+0x130> 4000de84: c2 24 20 3c st %g1, [ %l0 + 0x3c ] next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000de88: 82 12 a0 01 or %o2, 1, %g1 4000de8c: c2 23 60 04 st %g1, [ %o5 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000de90: c2 00 a0 04 ld [ %g2 + 4 ], %g1 next_block->prev_size = size; 4000de94: d4 22 00 04 st %o2, [ %o0 + %g4 ] _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000de98: 82 08 7f fe and %g1, -2, %g1 4000de9c: 10 bf ff dd b 4000de10 <_Heap_Free+0x130> 4000dea0: c2 20 a0 04 st %g1, [ %g2 + 4 ] =============================================================================== 4000ea04 <_Heap_Get_information>: void _Heap_Get_information( Heap_Control *the_heap, Heap_Information_block *the_info ) { 4000ea04: 9d e3 bf a0 save %sp, -96, %sp Heap_Block *the_block = the_heap->first_block; 4000ea08: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 Heap_Block *const end = the_heap->last_block; 4000ea0c: c4 06 20 24 ld [ %i0 + 0x24 ], %g2 memset(the_info, 0, sizeof(*the_info)); 4000ea10: c0 26 40 00 clr [ %i1 ] 4000ea14: c0 26 60 04 clr [ %i1 + 4 ] 4000ea18: c0 26 60 08 clr [ %i1 + 8 ] 4000ea1c: c0 26 60 0c clr [ %i1 + 0xc ] 4000ea20: c0 26 60 10 clr [ %i1 + 0x10 ] while ( the_block != end ) { 4000ea24: 80 a0 40 02 cmp %g1, %g2 4000ea28: 02 80 00 17 be 4000ea84 <_Heap_Get_information+0x80> <== NEVER TAKEN 4000ea2c: c0 26 60 14 clr [ %i1 + 0x14 ] 4000ea30: da 00 60 04 ld [ %g1 + 4 ], %o5 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 4000ea34: 88 0b 7f fe and %o5, -2, %g4 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000ea38: 82 00 40 04 add %g1, %g4, %g1 if ( info->largest < the_size ) info->largest = the_size; the_block = next_block; } } 4000ea3c: da 00 60 04 ld [ %g1 + 4 ], %o5 while ( the_block != end ) { uintptr_t const the_size = _Heap_Block_size(the_block); Heap_Block *const next_block = _Heap_Block_at(the_block, the_size); Heap_Information *info; if ( _Heap_Is_prev_used(next_block) ) 4000ea40: 80 8b 60 01 btst 1, %o5 4000ea44: 02 80 00 03 be 4000ea50 <_Heap_Get_information+0x4c> 4000ea48: 86 10 00 19 mov %i1, %g3 info = &the_info->Used; 4000ea4c: 86 06 60 0c add %i1, 0xc, %g3 else info = &the_info->Free; info->number++; 4000ea50: d4 00 c0 00 ld [ %g3 ], %o2 info->total += the_size; 4000ea54: d6 00 e0 08 ld [ %g3 + 8 ], %o3 if ( info->largest < the_size ) 4000ea58: d8 00 e0 04 ld [ %g3 + 4 ], %o4 if ( _Heap_Is_prev_used(next_block) ) info = &the_info->Used; else info = &the_info->Free; info->number++; 4000ea5c: 94 02 a0 01 inc %o2 info->total += the_size; 4000ea60: 96 02 c0 04 add %o3, %g4, %o3 if ( _Heap_Is_prev_used(next_block) ) info = &the_info->Used; else info = &the_info->Free; info->number++; 4000ea64: d4 20 c0 00 st %o2, [ %g3 ] info->total += the_size; if ( info->largest < the_size ) 4000ea68: 80 a3 00 04 cmp %o4, %g4 4000ea6c: 1a 80 00 03 bcc 4000ea78 <_Heap_Get_information+0x74> 4000ea70: d6 20 e0 08 st %o3, [ %g3 + 8 ] info->largest = the_size; 4000ea74: c8 20 e0 04 st %g4, [ %g3 + 4 ] Heap_Block *the_block = the_heap->first_block; Heap_Block *const end = the_heap->last_block; memset(the_info, 0, sizeof(*the_info)); while ( the_block != end ) { 4000ea78: 80 a0 80 01 cmp %g2, %g1 4000ea7c: 12 bf ff ef bne 4000ea38 <_Heap_Get_information+0x34> 4000ea80: 88 0b 7f fe and %o5, -2, %g4 4000ea84: 81 c7 e0 08 ret 4000ea88: 81 e8 00 00 restore =============================================================================== 400156dc <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 400156dc: 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); 400156e0: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 400156e4: 7f ff f9 86 call 40013cfc <.urem> 400156e8: 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 400156ec: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 400156f0: a0 10 00 18 mov %i0, %l0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 400156f4: 84 06 7f f8 add %i1, -8, %g2 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 400156f8: 84 20 80 08 sub %g2, %o0, %g2 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 400156fc: 80 a0 80 01 cmp %g2, %g1 40015700: 0a 80 00 15 bcs 40015754 <_Heap_Size_of_alloc_area+0x78> 40015704: b0 10 20 00 clr %i0 40015708: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 4001570c: 80 a0 80 03 cmp %g2, %g3 40015710: 18 80 00 11 bgu 40015754 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 40015714: 01 00 00 00 nop - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 40015718: c8 00 a0 04 ld [ %g2 + 4 ], %g4 4001571c: 88 09 3f fe and %g4, -2, %g4 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 40015720: 84 00 80 04 add %g2, %g4, %g2 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 40015724: 80 a0 40 02 cmp %g1, %g2 40015728: 18 80 00 0b bgu 40015754 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 4001572c: 80 a0 c0 02 cmp %g3, %g2 40015730: 0a 80 00 09 bcs 40015754 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 40015734: 01 00 00 00 nop block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 40015738: c2 00 a0 04 ld [ %g2 + 4 ], %g1 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 4001573c: 80 88 60 01 btst 1, %g1 40015740: 02 80 00 05 be 40015754 <_Heap_Size_of_alloc_area+0x78> <== NEVER TAKEN 40015744: 84 20 80 19 sub %g2, %i1, %g2 return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; 40015748: 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; 4001574c: 84 00 a0 04 add %g2, 4, %g2 40015750: c4 26 80 00 st %g2, [ %i2 ] return true; } 40015754: 81 c7 e0 08 ret 40015758: 81 e8 00 00 restore =============================================================================== 40009474 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40009474: 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; 40009478: 23 10 00 25 sethi %hi(0x40009400), %l1 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 4000947c: a0 10 00 18 mov %i0, %l0 uintptr_t const page_size = heap->page_size; 40009480: e8 06 20 10 ld [ %i0 + 0x10 ], %l4 uintptr_t const min_block_size = heap->min_block_size; 40009484: e6 06 20 14 ld [ %i0 + 0x14 ], %l3 Heap_Block *const first_block = heap->first_block; 40009488: e4 06 20 20 ld [ %i0 + 0x20 ], %l2 Heap_Block *const last_block = heap->last_block; 4000948c: 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; 40009490: 80 8e a0 ff btst 0xff, %i2 40009494: 02 80 00 04 be 400094a4 <_Heap_Walk+0x30> 40009498: a2 14 60 08 or %l1, 8, %l1 4000949c: 23 10 00 25 sethi %hi(0x40009400), %l1 400094a0: a2 14 60 10 or %l1, 0x10, %l1 ! 40009410 <_Heap_Walk_print> if ( !_System_state_Is_up( _System_state_Get() ) ) { 400094a4: 03 10 00 67 sethi %hi(0x40019c00), %g1 400094a8: c2 00 63 68 ld [ %g1 + 0x368 ], %g1 ! 40019f68 <_System_state_Current> 400094ac: 80 a0 60 03 cmp %g1, 3 400094b0: 12 80 00 33 bne 4000957c <_Heap_Walk+0x108> 400094b4: 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)( 400094b8: da 04 20 18 ld [ %l0 + 0x18 ], %o5 400094bc: c6 04 20 1c ld [ %l0 + 0x1c ], %g3 400094c0: c4 04 20 08 ld [ %l0 + 8 ], %g2 400094c4: c2 04 20 0c ld [ %l0 + 0xc ], %g1 400094c8: 90 10 00 19 mov %i1, %o0 400094cc: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 400094d0: e4 23 a0 60 st %l2, [ %sp + 0x60 ] 400094d4: ea 23 a0 64 st %l5, [ %sp + 0x64 ] 400094d8: c4 23 a0 68 st %g2, [ %sp + 0x68 ] 400094dc: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 400094e0: 92 10 20 00 clr %o1 400094e4: 96 10 00 14 mov %l4, %o3 400094e8: 15 10 00 5d sethi %hi(0x40017400), %o2 400094ec: 98 10 00 13 mov %l3, %o4 400094f0: 9f c4 40 00 call %l1 400094f4: 94 12 a0 d8 or %o2, 0xd8, %o2 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 400094f8: 80 a5 20 00 cmp %l4, 0 400094fc: 02 80 00 2a be 400095a4 <_Heap_Walk+0x130> 40009500: 80 8d 20 07 btst 7, %l4 (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 40009504: 12 80 00 30 bne 400095c4 <_Heap_Walk+0x150> 40009508: 90 10 00 13 mov %l3, %o0 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 4000950c: 7f ff e1 69 call 40001ab0 <.urem> 40009510: 92 10 00 14 mov %l4, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 40009514: 80 a2 20 00 cmp %o0, 0 40009518: 12 80 00 34 bne 400095e8 <_Heap_Walk+0x174> 4000951c: 90 04 a0 08 add %l2, 8, %o0 40009520: 7f ff e1 64 call 40001ab0 <.urem> 40009524: 92 10 00 14 mov %l4, %o1 ); return false; } if ( 40009528: 80 a2 20 00 cmp %o0, 0 4000952c: 32 80 00 38 bne,a 4000960c <_Heap_Walk+0x198> 40009530: 90 10 00 19 mov %i1, %o0 block = next_block; } while ( block != first_block ); return true; } 40009534: f8 04 a0 04 ld [ %l2 + 4 ], %i4 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 40009538: 80 8f 20 01 btst 1, %i4 4000953c: 22 80 00 4d be,a 40009670 <_Heap_Walk+0x1fc> 40009540: 90 10 00 19 mov %i1, %o0 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 40009544: c2 05 60 04 ld [ %l5 + 4 ], %g1 40009548: 82 08 7f fe and %g1, -2, %g1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000954c: 82 05 40 01 add %l5, %g1, %g1 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 40009550: c4 00 60 04 ld [ %g1 + 4 ], %g2 ); return false; } if ( _Heap_Is_free( last_block ) ) { 40009554: 80 88 a0 01 btst 1, %g2 40009558: 02 80 00 0b be 40009584 <_Heap_Walk+0x110> 4000955c: 80 a4 80 01 cmp %l2, %g1 ); return false; } if ( 40009560: 02 80 00 33 be 4000962c <_Heap_Walk+0x1b8> <== ALWAYS TAKEN 40009564: 90 10 00 19 mov %i1, %o0 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40009568: 92 10 20 01 mov 1, %o1 <== NOT EXECUTED 4000956c: 15 10 00 5d sethi %hi(0x40017400), %o2 <== NOT EXECUTED if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009570: b0 10 20 00 clr %i0 <== NOT EXECUTED } if ( _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40009574: 9f c4 40 00 call %l1 <== NOT EXECUTED 40009578: 94 12 a2 50 or %o2, 0x250, %o2 <== NOT EXECUTED 4000957c: 81 c7 e0 08 ret 40009580: 81 e8 00 00 restore return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( 40009584: 90 10 00 19 mov %i1, %o0 40009588: 92 10 20 01 mov 1, %o1 4000958c: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009590: b0 10 20 00 clr %i0 return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( 40009594: 9f c4 40 00 call %l1 40009598: 94 12 a2 38 or %o2, 0x238, %o2 4000959c: 81 c7 e0 08 ret 400095a0: 81 e8 00 00 restore first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); 400095a4: 90 10 00 19 mov %i1, %o0 400095a8: 92 10 20 01 mov 1, %o1 400095ac: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400095b0: b0 10 20 00 clr %i0 first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); 400095b4: 9f c4 40 00 call %l1 400095b8: 94 12 a1 70 or %o2, 0x170, %o2 400095bc: 81 c7 e0 08 ret 400095c0: 81 e8 00 00 restore return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( 400095c4: 90 10 00 19 mov %i1, %o0 400095c8: 92 10 20 01 mov 1, %o1 400095cc: 96 10 00 14 mov %l4, %o3 400095d0: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400095d4: b0 10 20 00 clr %i0 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( 400095d8: 9f c4 40 00 call %l1 400095dc: 94 12 a1 88 or %o2, 0x188, %o2 400095e0: 81 c7 e0 08 ret 400095e4: 81 e8 00 00 restore return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( 400095e8: 90 10 00 19 mov %i1, %o0 400095ec: 92 10 20 01 mov 1, %o1 400095f0: 96 10 00 13 mov %l3, %o3 400095f4: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400095f8: b0 10 20 00 clr %i0 return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( 400095fc: 9f c4 40 00 call %l1 40009600: 94 12 a1 a8 or %o2, 0x1a8, %o2 40009604: 81 c7 e0 08 ret 40009608: 81 e8 00 00 restore } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 4000960c: 92 10 20 01 mov 1, %o1 40009610: 96 10 00 12 mov %l2, %o3 40009614: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009618: b0 10 20 00 clr %i0 } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 4000961c: 9f c4 40 00 call %l1 40009620: 94 12 a1 d0 or %o2, 0x1d0, %o2 40009624: 81 c7 e0 08 ret 40009628: 81 e8 00 00 restore block = next_block; } while ( block != first_block ); return true; } 4000962c: ee 04 20 08 ld [ %l0 + 8 ], %l7 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 40009630: 80 a4 00 17 cmp %l0, %l7 40009634: 02 80 01 18 be 40009a94 <_Heap_Walk+0x620> 40009638: f6 04 20 10 ld [ %l0 + 0x10 ], %i3 block = next_block; } while ( block != first_block ); return true; } 4000963c: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 40009640: 80 a0 40 17 cmp %g1, %l7 40009644: 08 80 00 12 bleu 4000968c <_Heap_Walk+0x218> <== ALWAYS TAKEN 40009648: ac 10 00 17 mov %l7, %l6 const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( 4000964c: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 40009650: 92 10 20 01 mov 1, %o1 40009654: 96 10 00 16 mov %l6, %o3 40009658: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 4000965c: b0 10 20 00 clr %i0 const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( 40009660: 9f c4 40 00 call %l1 40009664: 94 12 a2 80 or %o2, 0x280, %o2 40009668: 81 c7 e0 08 ret 4000966c: 81 e8 00 00 restore return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( 40009670: 92 10 20 01 mov 1, %o1 40009674: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009678: b0 10 20 00 clr %i0 return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( 4000967c: 9f c4 40 00 call %l1 40009680: 94 12 a2 08 or %o2, 0x208, %o2 40009684: 81 c7 e0 08 ret 40009688: 81 e8 00 00 restore 4000968c: fa 04 20 24 ld [ %l0 + 0x24 ], %i5 40009690: 80 a7 40 17 cmp %i5, %l7 40009694: 0a bf ff ef bcs 40009650 <_Heap_Walk+0x1dc> <== NEVER TAKEN 40009698: 90 10 00 19 mov %i1, %o0 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 4000969c: c2 27 bf fc st %g1, [ %fp + -4 ] 400096a0: 90 05 e0 08 add %l7, 8, %o0 400096a4: 7f ff e1 03 call 40001ab0 <.urem> 400096a8: 92 10 00 1b mov %i3, %o1 ); return false; } if ( 400096ac: 80 a2 20 00 cmp %o0, 0 400096b0: 12 80 00 2d bne 40009764 <_Heap_Walk+0x2f0> <== NEVER TAKEN 400096b4: c2 07 bf fc ld [ %fp + -4 ], %g1 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 400096b8: c4 05 e0 04 ld [ %l7 + 4 ], %g2 400096bc: 84 08 bf fe and %g2, -2, %g2 block = next_block; } while ( block != first_block ); return true; } 400096c0: 84 05 c0 02 add %l7, %g2, %g2 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 400096c4: c4 00 a0 04 ld [ %g2 + 4 ], %g2 ); return false; } if ( _Heap_Is_used( free_block ) ) { 400096c8: 80 88 a0 01 btst 1, %g2 400096cc: 12 80 00 2f bne 40009788 <_Heap_Walk+0x314> <== NEVER TAKEN 400096d0: 84 10 00 10 mov %l0, %g2 400096d4: 10 80 00 17 b 40009730 <_Heap_Walk+0x2bc> 400096d8: b4 10 00 01 mov %g1, %i2 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 400096dc: 80 a4 00 16 cmp %l0, %l6 400096e0: 02 80 00 33 be 400097ac <_Heap_Walk+0x338> 400096e4: 80 a6 80 16 cmp %i2, %l6 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 400096e8: 18 bf ff da bgu 40009650 <_Heap_Walk+0x1dc> 400096ec: 90 10 00 19 mov %i1, %o0 400096f0: 80 a5 80 1d cmp %l6, %i5 400096f4: 18 bf ff d8 bgu 40009654 <_Heap_Walk+0x1e0> <== NEVER TAKEN 400096f8: 92 10 20 01 mov 1, %o1 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 400096fc: 90 05 a0 08 add %l6, 8, %o0 40009700: 7f ff e0 ec call 40001ab0 <.urem> 40009704: 92 10 00 1b mov %i3, %o1 ); return false; } if ( 40009708: 80 a2 20 00 cmp %o0, 0 4000970c: 12 80 00 16 bne 40009764 <_Heap_Walk+0x2f0> 40009710: 84 10 00 17 mov %l7, %g2 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 40009714: c2 05 a0 04 ld [ %l6 + 4 ], %g1 40009718: 82 08 7f fe and %g1, -2, %g1 block = next_block; } while ( block != first_block ); return true; } 4000971c: 82 00 40 16 add %g1, %l6, %g1 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 40009720: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 40009724: 80 88 60 01 btst 1, %g1 40009728: 12 80 00 18 bne 40009788 <_Heap_Walk+0x314> 4000972c: ae 10 00 16 mov %l6, %l7 ); return false; } if ( free_block->prev != prev_block ) { 40009730: d8 05 e0 0c ld [ %l7 + 0xc ], %o4 40009734: 80 a3 00 02 cmp %o4, %g2 40009738: 22 bf ff e9 be,a 400096dc <_Heap_Walk+0x268> 4000973c: ec 05 e0 08 ld [ %l7 + 8 ], %l6 (*printer)( 40009740: 90 10 00 19 mov %i1, %o0 40009744: 92 10 20 01 mov 1, %o1 40009748: 96 10 00 17 mov %l7, %o3 4000974c: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009750: b0 10 20 00 clr %i0 return false; } if ( free_block->prev != prev_block ) { (*printer)( 40009754: 9f c4 40 00 call %l1 40009758: 94 12 a2 f0 or %o2, 0x2f0, %o2 4000975c: 81 c7 e0 08 ret 40009760: 81 e8 00 00 restore } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 40009764: 90 10 00 19 mov %i1, %o0 40009768: 92 10 20 01 mov 1, %o1 4000976c: 96 10 00 16 mov %l6, %o3 40009770: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009774: b0 10 20 00 clr %i0 } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 40009778: 9f c4 40 00 call %l1 4000977c: 94 12 a2 a0 or %o2, 0x2a0, %o2 40009780: 81 c7 e0 08 ret 40009784: 81 e8 00 00 restore return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( 40009788: 90 10 00 19 mov %i1, %o0 4000978c: 92 10 20 01 mov 1, %o1 40009790: 96 10 00 16 mov %l6, %o3 40009794: 15 10 00 5d sethi %hi(0x40017400), %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009798: b0 10 20 00 clr %i0 return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( 4000979c: 9f c4 40 00 call %l1 400097a0: 94 12 a2 d0 or %o2, 0x2d0, %o2 400097a4: 81 c7 e0 08 ret 400097a8: 81 e8 00 00 restore 400097ac: 82 10 00 1a mov %i2, %g1 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 400097b0: 35 10 00 5e sethi %hi(0x40017800), %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)( 400097b4: 31 10 00 5e sethi %hi(0x40017800), %i0 ); return false; } if ( _Heap_Is_used( free_block ) ) { 400097b8: ae 10 00 12 mov %l2, %l7 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 400097bc: b4 16 a0 b0 or %i2, 0xb0, %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)( 400097c0: b0 16 20 98 or %i0, 0x98, %i0 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 400097c4: 37 10 00 5e sethi %hi(0x40017800), %i3 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 400097c8: ba 0f 3f fe and %i4, -2, %i5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 400097cc: ac 07 40 17 add %i5, %l7, %l6 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 400097d0: 80 a0 40 16 cmp %g1, %l6 400097d4: 28 80 00 0c bleu,a 40009804 <_Heap_Walk+0x390> <== ALWAYS TAKEN 400097d8: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { (*printer)( 400097dc: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 400097e0: 92 10 20 01 mov 1, %o1 400097e4: 96 10 00 17 mov %l7, %o3 400097e8: 15 10 00 5d sethi %hi(0x40017400), %o2 400097ec: 98 10 00 16 mov %l6, %o4 400097f0: 94 12 a3 28 or %o2, 0x328, %o2 400097f4: 9f c4 40 00 call %l1 400097f8: b0 10 20 00 clr %i0 "block 0x%08x: next block 0x%08x not in heap\n", block, next_block ); return false; 400097fc: 81 c7 e0 08 ret 40009800: 81 e8 00 00 restore 40009804: 80 a0 40 16 cmp %g1, %l6 40009808: 0a bf ff f6 bcs 400097e0 <_Heap_Walk+0x36c> 4000980c: 90 10 00 19 mov %i1, %o0 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; 40009810: 82 1d c0 15 xor %l7, %l5, %g1 40009814: 80 a0 00 01 cmp %g0, %g1 40009818: 82 40 20 00 addx %g0, 0, %g1 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 4000981c: 90 10 00 1d mov %i5, %o0 40009820: c2 27 bf fc st %g1, [ %fp + -4 ] 40009824: 7f ff e0 a3 call 40001ab0 <.urem> 40009828: 92 10 00 14 mov %l4, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 4000982c: 80 a2 20 00 cmp %o0, 0 40009830: 02 80 00 05 be 40009844 <_Heap_Walk+0x3d0> 40009834: c2 07 bf fc ld [ %fp + -4 ], %g1 40009838: 80 88 60 ff btst 0xff, %g1 4000983c: 12 80 00 79 bne 40009a20 <_Heap_Walk+0x5ac> 40009840: 90 10 00 19 mov %i1, %o0 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 40009844: 80 a4 c0 1d cmp %l3, %i5 40009848: 08 80 00 05 bleu 4000985c <_Heap_Walk+0x3e8> 4000984c: 80 a5 c0 16 cmp %l7, %l6 40009850: 80 88 60 ff btst 0xff, %g1 40009854: 12 80 00 7c bne 40009a44 <_Heap_Walk+0x5d0> <== ALWAYS TAKEN 40009858: 80 a5 c0 16 cmp %l7, %l6 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 4000985c: 2a 80 00 06 bcs,a 40009874 <_Heap_Walk+0x400> 40009860: c2 05 a0 04 ld [ %l6 + 4 ], %g1 40009864: 80 88 60 ff btst 0xff, %g1 40009868: 12 80 00 82 bne 40009a70 <_Heap_Walk+0x5fc> 4000986c: 90 10 00 19 mov %i1, %o0 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 40009870: c2 05 a0 04 ld [ %l6 + 4 ], %g1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 40009874: 80 88 60 01 btst 1, %g1 40009878: 02 80 00 19 be 400098dc <_Heap_Walk+0x468> 4000987c: b8 0f 20 01 and %i4, 1, %i4 if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 40009880: 80 a7 20 00 cmp %i4, 0 40009884: 22 80 00 0e be,a 400098bc <_Heap_Walk+0x448> 40009888: da 05 c0 00 ld [ %l7 ], %o5 (*printer)( 4000988c: 90 10 00 19 mov %i1, %o0 40009890: 92 10 20 00 clr %o1 40009894: 94 10 00 18 mov %i0, %o2 40009898: 96 10 00 17 mov %l7, %o3 4000989c: 9f c4 40 00 call %l1 400098a0: 98 10 00 1d mov %i5, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 400098a4: 80 a4 80 16 cmp %l2, %l6 400098a8: 02 80 00 43 be 400099b4 <_Heap_Walk+0x540> 400098ac: ae 10 00 16 mov %l6, %l7 400098b0: f8 05 a0 04 ld [ %l6 + 4 ], %i4 400098b4: 10 bf ff c5 b 400097c8 <_Heap_Walk+0x354> 400098b8: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 400098bc: 96 10 00 17 mov %l7, %o3 400098c0: 90 10 00 19 mov %i1, %o0 400098c4: 92 10 20 00 clr %o1 400098c8: 94 10 00 1a mov %i2, %o2 400098cc: 9f c4 40 00 call %l1 400098d0: 98 10 00 1d mov %i5, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 400098d4: 10 bf ff f5 b 400098a8 <_Heap_Walk+0x434> 400098d8: 80 a4 80 16 cmp %l2, %l6 false, "block 0x%08x: size %u, prev 0x%08x%s, next 0x%08x%s\n", block, block_size, block->prev, block->prev == first_free_block ? 400098dc: da 05 e0 0c ld [ %l7 + 0xc ], %o5 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 400098e0: c2 04 20 08 ld [ %l0 + 8 ], %g1 400098e4: 05 10 00 5d sethi %hi(0x40017400), %g2 block = next_block; } while ( block != first_block ); return true; } 400098e8: 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)( 400098ec: 80 a0 40 0d cmp %g1, %o5 400098f0: 02 80 00 05 be 40009904 <_Heap_Walk+0x490> 400098f4: 86 10 a0 98 or %g2, 0x98, %g3 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 400098f8: 80 a4 00 0d cmp %l0, %o5 400098fc: 02 80 00 3e be 400099f4 <_Heap_Walk+0x580> 40009900: 86 16 e0 60 or %i3, 0x60, %g3 block->next, block->next == last_free_block ? 40009904: c2 05 e0 08 ld [ %l7 + 8 ], %g1 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 40009908: 19 10 00 5d sethi %hi(0x40017400), %o4 4000990c: 80 a1 00 01 cmp %g4, %g1 40009910: 02 80 00 05 be 40009924 <_Heap_Walk+0x4b0> 40009914: 84 13 20 b8 or %o4, 0xb8, %g2 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40009918: 80 a4 00 01 cmp %l0, %g1 4000991c: 02 80 00 33 be 400099e8 <_Heap_Walk+0x574> 40009920: 84 16 e0 60 or %i3, 0x60, %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)( 40009924: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 40009928: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 4000992c: c4 23 a0 64 st %g2, [ %sp + 0x64 ] 40009930: 90 10 00 19 mov %i1, %o0 40009934: 92 10 20 00 clr %o1 40009938: 15 10 00 5d sethi %hi(0x40017400), %o2 4000993c: 96 10 00 17 mov %l7, %o3 40009940: 94 12 a3 f0 or %o2, 0x3f0, %o2 40009944: 9f c4 40 00 call %l1 40009948: 98 10 00 1d mov %i5, %o4 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 4000994c: da 05 80 00 ld [ %l6 ], %o5 40009950: 80 a7 40 0d cmp %i5, %o5 40009954: 12 80 00 1a bne 400099bc <_Heap_Walk+0x548> 40009958: 80 a7 20 00 cmp %i4, 0 ); return false; } if ( !prev_used ) { 4000995c: 02 80 00 29 be 40009a00 <_Heap_Walk+0x58c> 40009960: 90 10 00 19 mov %i1, %o0 block = next_block; } while ( block != first_block ); return true; } 40009964: c2 04 20 08 ld [ %l0 + 8 ], %g1 ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 40009968: 80 a4 00 01 cmp %l0, %g1 4000996c: 02 80 00 0b be 40009998 <_Heap_Walk+0x524> <== NEVER TAKEN 40009970: 92 10 20 01 mov 1, %o1 if ( free_block == block ) { 40009974: 80 a5 c0 01 cmp %l7, %g1 40009978: 02 bf ff cc be 400098a8 <_Heap_Walk+0x434> 4000997c: 80 a4 80 16 cmp %l2, %l6 return true; } free_block = free_block->next; 40009980: 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 ) { 40009984: 80 a4 00 01 cmp %l0, %g1 40009988: 12 bf ff fc bne 40009978 <_Heap_Walk+0x504> 4000998c: 80 a5 c0 01 cmp %l7, %g1 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 40009990: 90 10 00 19 mov %i1, %o0 40009994: 92 10 20 01 mov 1, %o1 40009998: 96 10 00 17 mov %l7, %o3 4000999c: 15 10 00 5e sethi %hi(0x40017800), %o2 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 400099a0: b0 10 20 00 clr %i0 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 400099a4: 9f c4 40 00 call %l1 400099a8: 94 12 a0 d8 or %o2, 0xd8, %o2 400099ac: 81 c7 e0 08 ret 400099b0: 81 e8 00 00 restore block = next_block; } while ( block != first_block ); return true; } 400099b4: 81 c7 e0 08 ret 400099b8: 91 e8 20 01 restore %g0, 1, %o0 " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( 400099bc: ec 23 a0 5c st %l6, [ %sp + 0x5c ] 400099c0: 90 10 00 19 mov %i1, %o0 400099c4: 92 10 20 01 mov 1, %o1 400099c8: 96 10 00 17 mov %l7, %o3 400099cc: 15 10 00 5e sethi %hi(0x40017800), %o2 400099d0: 98 10 00 1d mov %i5, %o4 400099d4: 94 12 a0 28 or %o2, 0x28, %o2 400099d8: 9f c4 40 00 call %l1 400099dc: b0 10 20 00 clr %i0 400099e0: 81 c7 e0 08 ret 400099e4: 81 e8 00 00 restore " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 400099e8: 09 10 00 5d sethi %hi(0x40017400), %g4 400099ec: 10 bf ff ce b 40009924 <_Heap_Walk+0x4b0> 400099f0: 84 11 20 c8 or %g4, 0xc8, %g2 ! 400174c8 <_Status_Object_name_errors_to_status+0x68> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 400099f4: 19 10 00 5d sethi %hi(0x40017400), %o4 400099f8: 10 bf ff c3 b 40009904 <_Heap_Walk+0x490> 400099fc: 86 13 20 a8 or %o4, 0xa8, %g3 ! 400174a8 <_Status_Object_name_errors_to_status+0x48> return false; } if ( !prev_used ) { (*printer)( 40009a00: 92 10 20 01 mov 1, %o1 40009a04: 96 10 00 17 mov %l7, %o3 40009a08: 15 10 00 5e sethi %hi(0x40017800), %o2 return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; 40009a0c: b0 10 20 00 clr %i0 return false; } if ( !prev_used ) { (*printer)( 40009a10: 9f c4 40 00 call %l1 40009a14: 94 12 a0 68 or %o2, 0x68, %o2 40009a18: 81 c7 e0 08 ret 40009a1c: 81 e8 00 00 restore return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( 40009a20: 92 10 20 01 mov 1, %o1 40009a24: 96 10 00 17 mov %l7, %o3 40009a28: 15 10 00 5d sethi %hi(0x40017400), %o2 40009a2c: 98 10 00 1d mov %i5, %o4 40009a30: 94 12 a3 58 or %o2, 0x358, %o2 40009a34: 9f c4 40 00 call %l1 40009a38: b0 10 20 00 clr %i0 "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; 40009a3c: 81 c7 e0 08 ret 40009a40: 81 e8 00 00 restore } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( 40009a44: 90 10 00 19 mov %i1, %o0 40009a48: 92 10 20 01 mov 1, %o1 40009a4c: 96 10 00 17 mov %l7, %o3 40009a50: 15 10 00 5d sethi %hi(0x40017400), %o2 40009a54: 98 10 00 1d mov %i5, %o4 40009a58: 94 12 a3 88 or %o2, 0x388, %o2 40009a5c: 9a 10 00 13 mov %l3, %o5 40009a60: 9f c4 40 00 call %l1 40009a64: b0 10 20 00 clr %i0 block, block_size, min_block_size ); return false; 40009a68: 81 c7 e0 08 ret 40009a6c: 81 e8 00 00 restore } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( 40009a70: 92 10 20 01 mov 1, %o1 40009a74: 96 10 00 17 mov %l7, %o3 40009a78: 15 10 00 5d sethi %hi(0x40017400), %o2 40009a7c: 98 10 00 16 mov %l6, %o4 40009a80: 94 12 a3 b8 or %o2, 0x3b8, %o2 40009a84: 9f c4 40 00 call %l1 40009a88: b0 10 20 00 clr %i0 "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 40009a8c: 81 c7 e0 08 ret 40009a90: 81 e8 00 00 restore const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 40009a94: 10 bf ff 47 b 400097b0 <_Heap_Walk+0x33c> 40009a98: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 =============================================================================== 400078fc <_IO_Initialize_all_drivers>: * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { 400078fc: 9d e3 bf a0 save %sp, -96, %sp rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 40007900: 23 10 00 5f sethi %hi(0x40017c00), %l1 40007904: c2 04 63 b4 ld [ %l1 + 0x3b4 ], %g1 ! 40017fb4 <_IO_Number_of_drivers> 40007908: 80 a0 60 00 cmp %g1, 0 4000790c: 02 80 00 0c be 4000793c <_IO_Initialize_all_drivers+0x40> <== NEVER TAKEN 40007910: a0 10 20 00 clr %l0 40007914: a2 14 63 b4 or %l1, 0x3b4, %l1 (void) rtems_io_initialize( major, 0, NULL ); 40007918: 90 10 00 10 mov %l0, %o0 4000791c: 92 10 20 00 clr %o1 40007920: 40 00 17 c0 call 4000d820 40007924: 94 10 20 00 clr %o2 void _IO_Initialize_all_drivers( void ) { rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 40007928: c2 04 40 00 ld [ %l1 ], %g1 4000792c: a0 04 20 01 inc %l0 40007930: 80 a0 40 10 cmp %g1, %l0 40007934: 18 bf ff fa bgu 4000791c <_IO_Initialize_all_drivers+0x20> 40007938: 90 10 00 10 mov %l0, %o0 4000793c: 81 c7 e0 08 ret 40007940: 81 e8 00 00 restore =============================================================================== 40007830 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { 40007830: 9d e3 bf a0 save %sp, -96, %sp uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; 40007834: 03 10 00 5a sethi %hi(0x40016800), %g1 40007838: 82 10 63 38 or %g1, 0x338, %g1 ! 40016b38 drivers_in_table = Configuration.number_of_device_drivers; 4000783c: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 number_of_drivers = Configuration.maximum_drivers; 40007840: e8 00 60 30 ld [ %g1 + 0x30 ], %l4 /* * If the user claims there are less drivers than are actually in * the table, then let's just go with the table's count. */ if ( number_of_drivers <= drivers_in_table ) 40007844: 80 a4 40 14 cmp %l1, %l4 40007848: 0a 80 00 08 bcs 40007868 <_IO_Manager_initialization+0x38> 4000784c: e0 00 60 38 ld [ %g1 + 0x38 ], %l0 * If the maximum number of driver is the same as the number in the * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { _IO_Driver_address_table = driver_table; 40007850: 03 10 00 5f sethi %hi(0x40017c00), %g1 40007854: e0 20 63 b8 st %l0, [ %g1 + 0x3b8 ] ! 40017fb8 <_IO_Driver_address_table> _IO_Number_of_drivers = number_of_drivers; 40007858: 03 10 00 5f sethi %hi(0x40017c00), %g1 4000785c: e2 20 63 b4 st %l1, [ %g1 + 0x3b4 ] ! 40017fb4 <_IO_Number_of_drivers> return; 40007860: 81 c7 e0 08 ret 40007864: 81 e8 00 00 restore * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) 40007868: 83 2d 20 03 sll %l4, 3, %g1 4000786c: a7 2d 20 05 sll %l4, 5, %l3 40007870: a6 24 c0 01 sub %l3, %g1, %l3 * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( 40007874: 40 00 0d 12 call 4000acbc <_Workspace_Allocate_or_fatal_error> 40007878: 90 10 00 13 mov %l3, %o0 sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 4000787c: 03 10 00 5f sethi %hi(0x40017c00), %g1 /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 40007880: 25 10 00 5f sethi %hi(0x40017c00), %l2 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 40007884: e8 20 63 b4 st %l4, [ %g1 + 0x3b4 ] /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 40007888: d0 24 a3 b8 st %o0, [ %l2 + 0x3b8 ] _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 4000788c: 92 10 20 00 clr %o1 40007890: 40 00 24 b6 call 40010b68 40007894: 94 10 00 13 mov %l3, %o2 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 40007898: 80 a4 60 00 cmp %l1, 0 4000789c: 02 bf ff f1 be 40007860 <_IO_Manager_initialization+0x30> <== NEVER TAKEN 400078a0: da 04 a3 b8 ld [ %l2 + 0x3b8 ], %o5 400078a4: 82 10 20 00 clr %g1 400078a8: 88 10 20 00 clr %g4 _IO_Driver_address_table[index] = driver_table[index]; 400078ac: c4 04 00 01 ld [ %l0 + %g1 ], %g2 400078b0: 86 04 00 01 add %l0, %g1, %g3 400078b4: c4 23 40 01 st %g2, [ %o5 + %g1 ] 400078b8: d8 00 e0 04 ld [ %g3 + 4 ], %o4 400078bc: 84 03 40 01 add %o5, %g1, %g2 400078c0: d8 20 a0 04 st %o4, [ %g2 + 4 ] 400078c4: d8 00 e0 08 ld [ %g3 + 8 ], %o4 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 400078c8: 88 01 20 01 inc %g4 _IO_Driver_address_table[index] = driver_table[index]; 400078cc: d8 20 a0 08 st %o4, [ %g2 + 8 ] 400078d0: d8 00 e0 0c ld [ %g3 + 0xc ], %o4 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 400078d4: 82 00 60 18 add %g1, 0x18, %g1 _IO_Driver_address_table[index] = driver_table[index]; 400078d8: d8 20 a0 0c st %o4, [ %g2 + 0xc ] 400078dc: d8 00 e0 10 ld [ %g3 + 0x10 ], %o4 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 400078e0: 80 a4 40 04 cmp %l1, %g4 _IO_Driver_address_table[index] = driver_table[index]; 400078e4: d8 20 a0 10 st %o4, [ %g2 + 0x10 ] 400078e8: c6 00 e0 14 ld [ %g3 + 0x14 ], %g3 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 400078ec: 18 bf ff f0 bgu 400078ac <_IO_Manager_initialization+0x7c> 400078f0: c6 20 a0 14 st %g3, [ %g2 + 0x14 ] 400078f4: 81 c7 e0 08 ret 400078f8: 81 e8 00 00 restore =============================================================================== 400085e0 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 400085e0: 9d e3 bf a0 save %sp, -96, %sp _Internal_errors_What_happened.the_source = the_source; 400085e4: 1b 10 00 5d sethi %hi(0x40017400), %o5 400085e8: 86 13 62 d4 or %o5, 0x2d4, %g3 ! 400176d4 <_Internal_errors_What_happened> _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 400085ec: 90 10 00 18 mov %i0, %o0 400085f0: 92 0e 60 ff and %i1, 0xff, %o1 400085f4: 94 10 00 1a mov %i2, %o2 bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; 400085f8: f0 23 62 d4 st %i0, [ %o5 + 0x2d4 ] _Internal_errors_What_happened.is_internal = is_internal; 400085fc: f2 28 e0 04 stb %i1, [ %g3 + 4 ] _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); 40008600: 40 00 08 4d call 4000a734 <_User_extensions_Fatal> 40008604: f4 20 e0 08 st %i2, [ %g3 + 8 ] RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 40008608: 84 10 20 05 mov 5, %g2 <== NOT EXECUTED 4000860c: 03 10 00 5d sethi %hi(0x40017400), %g1 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 40008610: 7f ff e5 ff call 40001e0c <== NOT EXECUTED 40008614: c4 20 63 98 st %g2, [ %g1 + 0x398 ] ! 40017798 <_System_state_Current><== NOT EXECUTED 40008618: 82 10 00 08 mov %o0, %g1 <== NOT EXECUTED 4000861c: 30 80 00 00 b,a 4000861c <_Internal_error_Occurred+0x3c> <== NOT EXECUTED =============================================================================== 40008694 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 40008694: 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 ) 40008698: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 4000869c: 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 ) 400086a0: 80 a0 60 00 cmp %g1, 0 400086a4: 02 80 00 19 be 40008708 <_Objects_Allocate+0x74> <== NEVER TAKEN 400086a8: 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 ); 400086ac: a2 04 20 20 add %l0, 0x20, %l1 400086b0: 7f ff fd 5c call 40007c20 <_Chain_Get> 400086b4: 90 10 00 11 mov %l1, %o0 if ( information->auto_extend ) { 400086b8: c2 0c 20 12 ldub [ %l0 + 0x12 ], %g1 400086bc: 80 a0 60 00 cmp %g1, 0 400086c0: 02 80 00 12 be 40008708 <_Objects_Allocate+0x74> 400086c4: 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 ) { 400086c8: 80 a2 20 00 cmp %o0, 0 400086cc: 02 80 00 11 be 40008710 <_Objects_Allocate+0x7c> 400086d0: 01 00 00 00 nop } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 400086d4: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 400086d8: d0 16 20 0a lduh [ %i0 + 0xa ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 400086dc: d2 14 20 14 lduh [ %l0 + 0x14 ], %o1 400086e0: 40 00 2c db call 40013a4c <.udiv> 400086e4: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 400086e8: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 400086ec: 91 2a 20 02 sll %o0, 2, %o0 400086f0: c6 00 40 08 ld [ %g1 + %o0 ], %g3 information->inactive--; 400086f4: c4 14 20 2c lduh [ %l0 + 0x2c ], %g2 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 400086f8: 86 00 ff ff add %g3, -1, %g3 400086fc: c6 20 40 08 st %g3, [ %g1 + %o0 ] information->inactive--; 40008700: 82 00 bf ff add %g2, -1, %g1 40008704: c2 34 20 2c sth %g1, [ %l0 + 0x2c ] ); } #endif return the_object; } 40008708: 81 c7 e0 08 ret 4000870c: 81 e8 00 00 restore * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { _Objects_Extend_information( information ); 40008710: 40 00 00 11 call 40008754 <_Objects_Extend_information> 40008714: 90 10 00 10 mov %l0, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 40008718: 7f ff fd 42 call 40007c20 <_Chain_Get> 4000871c: 90 10 00 11 mov %l1, %o0 } if ( the_object ) { 40008720: b0 92 20 00 orcc %o0, 0, %i0 40008724: 32 bf ff ed bne,a 400086d8 <_Objects_Allocate+0x44> 40008728: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 ); } #endif return the_object; } 4000872c: 81 c7 e0 08 ret 40008730: 81 e8 00 00 restore =============================================================================== 40008754 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { 40008754: 9d e3 bf 90 save %sp, -112, %sp minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 40008758: e8 06 20 34 ld [ %i0 + 0x34 ], %l4 4000875c: 80 a5 20 00 cmp %l4, 0 40008760: 02 80 00 a9 be 40008a04 <_Objects_Extend_information+0x2b0> 40008764: e4 16 20 0a lduh [ %i0 + 0xa ], %l2 block_count = 0; else { block_count = information->maximum / information->allocation_size; 40008768: ea 16 20 10 lduh [ %i0 + 0x10 ], %l5 4000876c: e6 16 20 14 lduh [ %i0 + 0x14 ], %l3 40008770: ab 2d 60 10 sll %l5, 0x10, %l5 40008774: 92 10 00 13 mov %l3, %o1 40008778: 40 00 2c b5 call 40013a4c <.udiv> 4000877c: 91 35 60 10 srl %l5, 0x10, %o0 40008780: bb 2a 20 10 sll %o0, 0x10, %i5 40008784: bb 37 60 10 srl %i5, 0x10, %i5 for ( ; block < block_count; block++ ) { 40008788: 80 a7 60 00 cmp %i5, 0 4000878c: 02 80 00 a6 be 40008a24 <_Objects_Extend_information+0x2d0><== NEVER TAKEN 40008790: 90 10 00 13 mov %l3, %o0 if ( information->object_blocks[ block ] == NULL ) { 40008794: c2 05 00 00 ld [ %l4 ], %g1 40008798: 80 a0 60 00 cmp %g1, 0 4000879c: 02 80 00 a6 be 40008a34 <_Objects_Extend_information+0x2e0><== NEVER TAKEN 400087a0: a2 10 00 12 mov %l2, %l1 * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 400087a4: 10 80 00 06 b 400087bc <_Objects_Extend_information+0x68> 400087a8: a0 10 20 00 clr %l0 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { 400087ac: c2 05 00 01 ld [ %l4 + %g1 ], %g1 400087b0: 80 a0 60 00 cmp %g1, 0 400087b4: 22 80 00 08 be,a 400087d4 <_Objects_Extend_information+0x80> 400087b8: a8 10 20 00 clr %l4 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 400087bc: a0 04 20 01 inc %l0 if ( information->object_blocks[ block ] == NULL ) { do_extend = false; break; } else index_base += information->allocation_size; 400087c0: a2 04 40 13 add %l1, %l3, %l1 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 400087c4: 80 a7 40 10 cmp %i5, %l0 400087c8: 18 bf ff f9 bgu 400087ac <_Objects_Extend_information+0x58> 400087cc: 83 2c 20 02 sll %l0, 2, %g1 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 400087d0: a8 10 20 01 mov 1, %l4 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 400087d4: ab 35 60 10 srl %l5, 0x10, %l5 /* * We need to limit the number of objects to the maximum number * representable in the index portion of the object Id. In the * case of 16-bit Ids, this is only 256 object instances. */ if ( maximum > OBJECTS_ID_FINAL_INDEX ) { 400087d8: 03 00 00 3f sethi %hi(0xfc00), %g1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 400087dc: aa 05 40 08 add %l5, %o0, %l5 /* * We need to limit the number of objects to the maximum number * representable in the index portion of the object Id. In the * case of 16-bit Ids, this is only 256 object instances. */ if ( maximum > OBJECTS_ID_FINAL_INDEX ) { 400087e0: 82 10 63 ff or %g1, 0x3ff, %g1 400087e4: 80 a5 40 01 cmp %l5, %g1 400087e8: 18 80 00 98 bgu 40008a48 <_Objects_Extend_information+0x2f4> 400087ec: 01 00 00 00 nop /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; 400087f0: 40 00 2c 5d call 40013964 <.umul> 400087f4: d2 06 20 18 ld [ %i0 + 0x18 ], %o1 if ( information->auto_extend ) { 400087f8: c2 0e 20 12 ldub [ %i0 + 0x12 ], %g1 400087fc: 80 a0 60 00 cmp %g1, 0 40008800: 02 80 00 6d be 400089b4 <_Objects_Extend_information+0x260> 40008804: 01 00 00 00 nop new_object_block = _Workspace_Allocate( block_size ); 40008808: 40 00 09 1d call 4000ac7c <_Workspace_Allocate> 4000880c: 01 00 00 00 nop if ( !new_object_block ) 40008810: a6 92 20 00 orcc %o0, 0, %l3 40008814: 02 80 00 8d be 40008a48 <_Objects_Extend_information+0x2f4> 40008818: 01 00 00 00 nop } /* * Do we need to grow the tables? */ if ( do_extend ) { 4000881c: 80 8d 20 ff btst 0xff, %l4 40008820: 22 80 00 42 be,a 40008928 <_Objects_Extend_information+0x1d4> 40008824: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 */ /* * Up the block count and maximum */ block_count++; 40008828: a8 07 60 01 add %i5, 1, %l4 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 4000882c: 91 2d 20 01 sll %l4, 1, %o0 40008830: 90 02 00 14 add %o0, %l4, %o0 ((maximum + minimum_index) * sizeof(Objects_Control *)); 40008834: 90 05 40 08 add %l5, %o0, %o0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 40008838: 90 02 00 12 add %o0, %l2, %o0 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); 4000883c: 40 00 09 10 call 4000ac7c <_Workspace_Allocate> 40008840: 91 2a 20 02 sll %o0, 2, %o0 if ( !object_blocks ) { 40008844: ac 92 20 00 orcc %o0, 0, %l6 40008848: 02 80 00 7e be 40008a40 <_Objects_Extend_information+0x2ec> 4000884c: a9 2d 20 02 sll %l4, 2, %l4 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 40008850: c2 16 20 10 lduh [ %i0 + 0x10 ], %g1 40008854: 80 a4 80 01 cmp %l2, %g1 40008858: ae 05 80 14 add %l6, %l4, %l7 4000885c: 0a 80 00 5a bcs 400089c4 <_Objects_Extend_information+0x270> 40008860: a8 05 c0 14 add %l7, %l4, %l4 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 40008864: 80 a4 a0 00 cmp %l2, 0 40008868: 02 80 00 07 be 40008884 <_Objects_Extend_information+0x130><== NEVER TAKEN 4000886c: 82 10 20 00 clr %g1 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 40008870: 85 28 60 02 sll %g1, 2, %g2 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 40008874: 82 00 60 01 inc %g1 40008878: 80 a4 80 01 cmp %l2, %g1 4000887c: 18 bf ff fd bgu 40008870 <_Objects_Extend_information+0x11c><== NEVER TAKEN 40008880: c0 20 80 14 clr [ %g2 + %l4 ] 40008884: bb 2f 60 02 sll %i5, 2, %i5 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 40008888: c6 16 20 14 lduh [ %i0 + 0x14 ], %g3 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 4000888c: c0 25 80 1d clr [ %l6 + %i5 ] inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 40008890: 86 04 40 03 add %l1, %g3, %g3 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 40008894: 80 a4 40 03 cmp %l1, %g3 40008898: 1a 80 00 0a bcc 400088c0 <_Objects_Extend_information+0x16c><== NEVER TAKEN 4000889c: c0 25 c0 1d clr [ %l7 + %i5 ] * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 400088a0: 83 2c 60 02 sll %l1, 2, %g1 400088a4: 84 10 00 11 mov %l1, %g2 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 400088a8: 82 05 00 01 add %l4, %g1, %g1 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; 400088ac: c0 20 40 00 clr [ %g1 ] object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { 400088b0: 84 00 a0 01 inc %g2 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 400088b4: 80 a0 80 03 cmp %g2, %g3 400088b8: 0a bf ff fd bcs 400088ac <_Objects_Extend_information+0x158> 400088bc: 82 00 60 04 add %g1, 4, %g1 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; } _ISR_Disable( level ); 400088c0: 7f ff e5 53 call 40001e0c 400088c4: 01 00 00 00 nop uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 400088c8: c6 06 00 00 ld [ %i0 ], %g3 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 400088cc: c4 16 20 04 lduh [ %i0 + 4 ], %g2 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; 400088d0: e4 06 20 34 ld [ %i0 + 0x34 ], %l2 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; 400088d4: ea 36 20 10 sth %l5, [ %i0 + 0x10 ] 400088d8: 87 28 e0 18 sll %g3, 0x18, %g3 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 400088dc: 85 28 a0 1b sll %g2, 0x1b, %g2 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; 400088e0: ec 26 20 34 st %l6, [ %i0 + 0x34 ] information->inactive_per_block = inactive_per_block; 400088e4: ee 26 20 30 st %l7, [ %i0 + 0x30 ] information->local_table = local_table; 400088e8: e8 26 20 1c st %l4, [ %i0 + 0x1c ] information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 400088ec: ab 2d 60 10 sll %l5, 0x10, %l5 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 400088f0: 03 00 00 40 sethi %hi(0x10000), %g1 400088f4: ab 35 60 10 srl %l5, 0x10, %l5 400088f8: 82 10 c0 01 or %g3, %g1, %g1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 400088fc: 82 10 40 02 or %g1, %g2, %g1 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 40008900: 82 10 40 15 or %g1, %l5, %g1 40008904: c2 26 20 0c st %g1, [ %i0 + 0xc ] information->the_class, _Objects_Local_node, information->maximum ); _ISR_Enable( level ); 40008908: 7f ff e5 45 call 40001e1c 4000890c: 01 00 00 00 nop if ( old_tables ) 40008910: 80 a4 a0 00 cmp %l2, 0 40008914: 22 80 00 05 be,a 40008928 <_Objects_Extend_information+0x1d4> 40008918: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 _Workspace_Free( old_tables ); 4000891c: 40 00 08 e1 call 4000aca0 <_Workspace_Free> 40008920: 90 10 00 12 mov %l2, %o0 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 40008924: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 40008928: d4 16 20 14 lduh [ %i0 + 0x14 ], %o2 4000892c: d6 06 20 18 ld [ %i0 + 0x18 ], %o3 40008930: 92 10 00 13 mov %l3, %o1 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 40008934: a1 2c 20 02 sll %l0, 2, %l0 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 40008938: a4 07 bf f4 add %fp, -12, %l2 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 4000893c: e6 20 40 10 st %l3, [ %g1 + %l0 ] /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 40008940: 90 10 00 12 mov %l2, %o0 40008944: 40 00 13 ce call 4000d87c <_Chain_Initialize> 40008948: 29 00 00 40 sethi %hi(0x10000), %l4 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 4000894c: 10 80 00 0d b 40008980 <_Objects_Extend_information+0x22c> 40008950: a6 06 20 20 add %i0, 0x20, %l3 the_object->id = _Objects_Build_id( 40008954: c6 16 20 04 lduh [ %i0 + 4 ], %g3 40008958: 85 28 a0 18 sll %g2, 0x18, %g2 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 4000895c: 87 28 e0 1b sll %g3, 0x1b, %g3 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 40008960: 84 10 80 14 or %g2, %l4, %g2 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 40008964: 84 10 80 03 or %g2, %g3, %g2 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 40008968: 84 10 80 11 or %g2, %l1, %g2 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 4000896c: 90 10 00 13 mov %l3, %o0 40008970: 92 10 00 01 mov %g1, %o1 index++; 40008974: a2 04 60 01 inc %l1 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 40008978: 7f ff fc 94 call 40007bc8 <_Chain_Append> 4000897c: c4 20 60 08 st %g2, [ %g1 + 8 ] /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 40008980: 7f ff fc a8 call 40007c20 <_Chain_Get> 40008984: 90 10 00 12 mov %l2, %o0 40008988: 82 92 20 00 orcc %o0, 0, %g1 4000898c: 32 bf ff f2 bne,a 40008954 <_Objects_Extend_information+0x200> 40008990: c4 06 00 00 ld [ %i0 ], %g2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 40008994: c8 16 20 14 lduh [ %i0 + 0x14 ], %g4 40008998: c6 06 20 30 ld [ %i0 + 0x30 ], %g3 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 4000899c: c4 16 20 2c lduh [ %i0 + 0x2c ], %g2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 400089a0: c8 20 c0 10 st %g4, [ %g3 + %l0 ] information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 400089a4: 82 00 80 04 add %g2, %g4, %g1 index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = 400089a8: c2 36 20 2c sth %g1, [ %i0 + 0x2c ] 400089ac: 81 c7 e0 08 ret 400089b0: 81 e8 00 00 restore if ( information->auto_extend ) { new_object_block = _Workspace_Allocate( block_size ); if ( !new_object_block ) return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); 400089b4: 40 00 08 c2 call 4000acbc <_Workspace_Allocate_or_fatal_error> 400089b8: 01 00 00 00 nop 400089bc: 10 bf ff 98 b 4000881c <_Objects_Extend_information+0xc8> 400089c0: a6 10 00 08 mov %o0, %l3 /* * Copy each section of the table over. This has to be performed as * separate parts as size of each block has changed. */ memcpy( object_blocks, 400089c4: d2 06 20 34 ld [ %i0 + 0x34 ], %o1 information->object_blocks, block_count * sizeof(void*) ); 400089c8: bb 2f 60 02 sll %i5, 2, %i5 /* * Copy each section of the table over. This has to be performed as * separate parts as size of each block has changed. */ memcpy( object_blocks, 400089cc: 40 00 20 2e call 40010a84 400089d0: 94 10 00 1d mov %i5, %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, 400089d4: d2 06 20 30 ld [ %i0 + 0x30 ], %o1 400089d8: 94 10 00 1d mov %i5, %o2 400089dc: 40 00 20 2a call 40010a84 400089e0: 90 10 00 17 mov %l7, %o0 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 400089e4: d4 16 20 10 lduh [ %i0 + 0x10 ], %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 400089e8: d2 06 20 1c ld [ %i0 + 0x1c ], %o1 information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 400089ec: 94 04 80 0a add %l2, %o2, %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 400089f0: 90 10 00 14 mov %l4, %o0 400089f4: 40 00 20 24 call 40010a84 400089f8: 95 2a a0 02 sll %o2, 2, %o2 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 400089fc: 10 bf ff a4 b 4000888c <_Objects_Extend_information+0x138> 40008a00: c6 16 20 14 lduh [ %i0 + 0x14 ], %g3 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 40008a04: ea 16 20 10 lduh [ %i0 + 0x10 ], %l5 40008a08: d0 16 20 14 lduh [ %i0 + 0x14 ], %o0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 40008a0c: a2 10 00 12 mov %l2, %l1 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 40008a10: a8 10 20 01 mov 1, %l4 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 40008a14: a0 10 20 00 clr %l0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; 40008a18: ba 10 20 00 clr %i5 40008a1c: 10 bf ff 6e b 400087d4 <_Objects_Extend_information+0x80> 40008a20: ab 2d 60 10 sll %l5, 0x10, %l5 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); 40008a24: a2 10 00 12 mov %l2, %l1 <== NOT EXECUTED /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; 40008a28: a8 10 20 01 mov 1, %l4 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 40008a2c: 10 bf ff 6a b 400087d4 <_Objects_Extend_information+0x80> <== NOT EXECUTED 40008a30: a0 10 20 00 clr %l0 <== NOT EXECUTED else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { do_extend = false; 40008a34: a8 10 20 00 clr %l4 <== NOT EXECUTED * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 40008a38: 10 bf ff 67 b 400087d4 <_Objects_Extend_information+0x80> <== NOT EXECUTED 40008a3c: a0 10 20 00 clr %l0 <== NOT EXECUTED (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); if ( !object_blocks ) { _Workspace_Free( new_object_block ); 40008a40: 40 00 08 98 call 4000aca0 <_Workspace_Free> 40008a44: 90 10 00 13 mov %l3, %o0 return; 40008a48: 81 c7 e0 08 ret 40008a4c: 81 e8 00 00 restore =============================================================================== 40008afc <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 40008afc: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 40008b00: b3 2e 60 10 sll %i1, 0x10, %i1 40008b04: b3 36 60 10 srl %i1, 0x10, %i1 40008b08: 80 a6 60 00 cmp %i1, 0 40008b0c: 12 80 00 04 bne 40008b1c <_Objects_Get_information+0x20> 40008b10: a0 10 20 00 clr %l0 if ( info->maximum == 0 ) return NULL; #endif return info; } 40008b14: 81 c7 e0 08 ret 40008b18: 91 e8 00 10 restore %g0, %l0, %o0 /* * This call implicitly validates the_api so we do not call * _Objects_Is_api_valid above here. */ the_class_api_maximum = _Objects_API_maximum_class( the_api ); 40008b1c: 40 00 14 e2 call 4000dea4 <_Objects_API_maximum_class> 40008b20: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 40008b24: 80 a2 20 00 cmp %o0, 0 40008b28: 02 bf ff fb be 40008b14 <_Objects_Get_information+0x18> 40008b2c: 80 a2 00 19 cmp %o0, %i1 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 40008b30: 0a bf ff f9 bcs 40008b14 <_Objects_Get_information+0x18> 40008b34: 03 10 00 5d sethi %hi(0x40017400), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 40008b38: b1 2e 20 02 sll %i0, 2, %i0 40008b3c: 82 10 61 88 or %g1, 0x188, %g1 40008b40: c2 00 40 18 ld [ %g1 + %i0 ], %g1 40008b44: 80 a0 60 00 cmp %g1, 0 40008b48: 02 bf ff f3 be 40008b14 <_Objects_Get_information+0x18> <== NEVER TAKEN 40008b4c: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 40008b50: e0 00 40 19 ld [ %g1 + %i1 ], %l0 if ( !info ) 40008b54: 80 a4 20 00 cmp %l0, 0 40008b58: 02 bf ff ef be 40008b14 <_Objects_Get_information+0x18> <== NEVER TAKEN 40008b5c: 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 ) 40008b60: c2 14 20 10 lduh [ %l0 + 0x10 ], %g1 return NULL; 40008b64: 80 a0 00 01 cmp %g0, %g1 40008b68: 82 60 20 00 subx %g0, 0, %g1 40008b6c: 10 bf ff ea b 40008b14 <_Objects_Get_information+0x18> 40008b70: a0 0c 00 01 and %l0, %g1, %l0 =============================================================================== 4000a894 <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { 4000a894: 9d e3 bf 90 save %sp, -112, %sp char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) 4000a898: 80 a6 60 00 cmp %i1, 0 4000a89c: 12 80 00 05 bne 4000a8b0 <_Objects_Get_name_as_string+0x1c> 4000a8a0: 80 a6 a0 00 cmp %i2, 0 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; 4000a8a4: b4 10 20 00 clr %i2 _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } 4000a8a8: 81 c7 e0 08 ret 4000a8ac: 91 e8 00 1a restore %g0, %i2, %o0 Objects_Id tmpId; if ( length == 0 ) return NULL; if ( name == NULL ) 4000a8b0: 02 bf ff fe be 4000a8a8 <_Objects_Get_name_as_string+0x14> 4000a8b4: 80 a6 20 00 cmp %i0, 0 return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 4000a8b8: 12 80 00 04 bne 4000a8c8 <_Objects_Get_name_as_string+0x34> 4000a8bc: 03 10 00 aa sethi %hi(0x4002a800), %g1 4000a8c0: c2 00 60 94 ld [ %g1 + 0x94 ], %g1 ! 4002a894 <_Per_CPU_Information+0xc> 4000a8c4: f0 00 60 08 ld [ %g1 + 8 ], %i0 information = _Objects_Get_information_id( tmpId ); 4000a8c8: 7f ff ff b1 call 4000a78c <_Objects_Get_information_id> 4000a8cc: 90 10 00 18 mov %i0, %o0 if ( !information ) 4000a8d0: a0 92 20 00 orcc %o0, 0, %l0 4000a8d4: 22 bf ff f5 be,a 4000a8a8 <_Objects_Get_name_as_string+0x14> 4000a8d8: b4 10 20 00 clr %i2 return NULL; the_object = _Objects_Get( information, tmpId, &location ); 4000a8dc: 92 10 00 18 mov %i0, %o1 4000a8e0: 40 00 00 36 call 4000a9b8 <_Objects_Get> 4000a8e4: 94 07 bf fc add %fp, -4, %o2 switch ( location ) { 4000a8e8: c2 07 bf fc ld [ %fp + -4 ], %g1 4000a8ec: 80 a0 60 00 cmp %g1, 0 4000a8f0: 32 bf ff ee bne,a 4000a8a8 <_Objects_Get_name_as_string+0x14> 4000a8f4: b4 10 20 00 clr %i2 return NULL; case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 4000a8f8: c2 0c 20 38 ldub [ %l0 + 0x38 ], %g1 4000a8fc: 80 a0 60 00 cmp %g1, 0 4000a900: 22 80 00 24 be,a 4000a990 <_Objects_Get_name_as_string+0xfc> 4000a904: c2 02 20 0c ld [ %o0 + 0xc ], %g1 s = the_object->name.name_p; 4000a908: c8 02 20 0c ld [ %o0 + 0xc ], %g4 lname[ 4 ] = '\0'; s = lname; } d = name; if ( s ) { 4000a90c: 80 a1 20 00 cmp %g4, 0 4000a910: 02 80 00 1d be 4000a984 <_Objects_Get_name_as_string+0xf0> 4000a914: 84 10 00 1a mov %i2, %g2 for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 4000a918: b2 86 7f ff addcc %i1, -1, %i1 4000a91c: 02 80 00 1a be 4000a984 <_Objects_Get_name_as_string+0xf0><== NEVER TAKEN 4000a920: 84 10 00 1a mov %i2, %g2 4000a924: c2 49 00 00 ldsb [ %g4 ], %g1 4000a928: 80 a0 60 00 cmp %g1, 0 4000a92c: 02 80 00 16 be 4000a984 <_Objects_Get_name_as_string+0xf0> 4000a930: c6 09 00 00 ldub [ %g4 ], %g3 4000a934: 17 10 00 86 sethi %hi(0x40021800), %o3 4000a938: 82 10 20 00 clr %g1 4000a93c: 10 80 00 06 b 4000a954 <_Objects_Get_name_as_string+0xc0> 4000a940: 96 12 e3 60 or %o3, 0x360, %o3 4000a944: da 49 00 01 ldsb [ %g4 + %g1 ], %o5 4000a948: 80 a3 60 00 cmp %o5, 0 4000a94c: 02 80 00 0e be 4000a984 <_Objects_Get_name_as_string+0xf0> 4000a950: c6 09 00 01 ldub [ %g4 + %g1 ], %g3 *d = (isprint((unsigned char)*s)) ? *s : '*'; 4000a954: d8 02 c0 00 ld [ %o3 ], %o4 4000a958: 9a 08 e0 ff and %g3, 0xff, %o5 4000a95c: 9a 03 00 0d add %o4, %o5, %o5 4000a960: da 4b 60 01 ldsb [ %o5 + 1 ], %o5 4000a964: 80 8b 60 97 btst 0x97, %o5 4000a968: 22 80 00 02 be,a 4000a970 <_Objects_Get_name_as_string+0xdc> 4000a96c: 86 10 20 2a mov 0x2a, %g3 4000a970: c6 28 80 00 stb %g3, [ %g2 ] s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 4000a974: 82 00 60 01 inc %g1 4000a978: 80 a0 40 19 cmp %g1, %i1 4000a97c: 0a bf ff f2 bcs 4000a944 <_Objects_Get_name_as_string+0xb0> 4000a980: 84 00 a0 01 inc %g2 *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; _Thread_Enable_dispatch(); 4000a984: 40 00 03 1b call 4000b5f0 <_Thread_Enable_dispatch> 4000a988: c0 28 80 00 clrb [ %g2 ] return name; 4000a98c: 30 bf ff c7 b,a 4000a8a8 <_Objects_Get_name_as_string+0x14> lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; 4000a990: c0 2f bf f4 clrb [ %fp + -12 ] } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; 4000a994: 89 30 60 18 srl %g1, 0x18, %g4 lname[ 1 ] = (u32_name >> 16) & 0xff; 4000a998: 87 30 60 10 srl %g1, 0x10, %g3 lname[ 2 ] = (u32_name >> 8) & 0xff; 4000a99c: 85 30 60 08 srl %g1, 8, %g2 } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; 4000a9a0: c8 2f bf f0 stb %g4, [ %fp + -16 ] lname[ 1 ] = (u32_name >> 16) & 0xff; 4000a9a4: c6 2f bf f1 stb %g3, [ %fp + -15 ] lname[ 2 ] = (u32_name >> 8) & 0xff; 4000a9a8: c4 2f bf f2 stb %g2, [ %fp + -14 ] lname[ 3 ] = (u32_name >> 0) & 0xff; 4000a9ac: c2 2f bf f3 stb %g1, [ %fp + -13 ] lname[ 4 ] = '\0'; s = lname; 4000a9b0: 10 bf ff da b 4000a918 <_Objects_Get_name_as_string+0x84> 4000a9b4: 88 07 bf f0 add %fp, -16, %g4 =============================================================================== 40019f64 <_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; 40019f64: c4 02 20 08 ld [ %o0 + 8 ], %g2 if ( information->maximum >= index ) { 40019f68: c2 12 20 10 lduh [ %o0 + 0x10 ], %g1 /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; 40019f6c: 84 22 40 02 sub %o1, %g2, %g2 40019f70: 84 00 a0 01 inc %g2 if ( information->maximum >= index ) { 40019f74: 80 a0 80 01 cmp %g2, %g1 40019f78: 18 80 00 09 bgu 40019f9c <_Objects_Get_no_protection+0x38> 40019f7c: 85 28 a0 02 sll %g2, 2, %g2 if ( (the_object = information->local_table[ index ]) != NULL ) { 40019f80: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 40019f84: d0 00 40 02 ld [ %g1 + %g2 ], %o0 40019f88: 80 a2 20 00 cmp %o0, 0 40019f8c: 02 80 00 05 be 40019fa0 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 40019f90: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 40019f94: 81 c3 e0 08 retl 40019f98: 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; 40019f9c: 82 10 20 01 mov 1, %g1 return NULL; 40019fa0: 90 10 20 00 clr %o0 } 40019fa4: 81 c3 e0 08 retl 40019fa8: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 4000a3a0 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 4000a3a0: 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; 4000a3a4: 80 a6 20 00 cmp %i0, 0 4000a3a8: 12 80 00 06 bne 4000a3c0 <_Objects_Id_to_name+0x20> 4000a3ac: 83 36 20 18 srl %i0, 0x18, %g1 4000a3b0: 03 10 00 86 sethi %hi(0x40021800), %g1 4000a3b4: c2 00 63 94 ld [ %g1 + 0x394 ], %g1 ! 40021b94 <_Per_CPU_Information+0xc> 4000a3b8: f0 00 60 08 ld [ %g1 + 8 ], %i0 4000a3bc: 83 36 20 18 srl %i0, 0x18, %g1 4000a3c0: 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 ) 4000a3c4: 84 00 7f ff add %g1, -1, %g2 4000a3c8: 80 a0 a0 02 cmp %g2, 2 4000a3cc: 18 80 00 12 bgu 4000a414 <_Objects_Id_to_name+0x74> 4000a3d0: 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 ] ) 4000a3d4: 83 28 60 02 sll %g1, 2, %g1 4000a3d8: 05 10 00 85 sethi %hi(0x40021400), %g2 4000a3dc: 84 10 a1 98 or %g2, 0x198, %g2 ! 40021598 <_Objects_Information_table> 4000a3e0: c2 00 80 01 ld [ %g2 + %g1 ], %g1 4000a3e4: 80 a0 60 00 cmp %g1, 0 4000a3e8: 02 80 00 0b be 4000a414 <_Objects_Id_to_name+0x74> 4000a3ec: 85 36 20 1b srl %i0, 0x1b, %g2 return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 4000a3f0: 85 28 a0 02 sll %g2, 2, %g2 4000a3f4: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 4000a3f8: 80 a2 20 00 cmp %o0, 0 4000a3fc: 02 80 00 06 be 4000a414 <_Objects_Id_to_name+0x74> <== NEVER TAKEN 4000a400: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 4000a404: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 4000a408: 80 a0 60 00 cmp %g1, 0 4000a40c: 02 80 00 04 be 4000a41c <_Objects_Id_to_name+0x7c> <== ALWAYS TAKEN 4000a410: 92 10 00 18 mov %i0, %o1 return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 4000a414: 81 c7 e0 08 ret 4000a418: 91 e8 00 10 restore %g0, %l0, %o0 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 4000a41c: 7f ff ff c4 call 4000a32c <_Objects_Get> 4000a420: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 4000a424: 80 a2 20 00 cmp %o0, 0 4000a428: 02 bf ff fb be 4000a414 <_Objects_Id_to_name+0x74> 4000a42c: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 4000a430: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 4000a434: 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; 4000a438: c2 26 40 00 st %g1, [ %i1 ] _Thread_Enable_dispatch(); 4000a43c: 40 00 03 21 call 4000b0c0 <_Thread_Enable_dispatch> 4000a440: b0 10 00 10 mov %l0, %i0 return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 4000a444: 81 c7 e0 08 ret 4000a448: 81 e8 00 00 restore =============================================================================== 40008e60 <_Objects_Shrink_information>: */ void _Objects_Shrink_information( Objects_Information *information ) { 40008e60: 9d e3 bf a0 save %sp, -96, %sp /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); 40008e64: e0 16 20 0a lduh [ %i0 + 0xa ], %l0 block_count = (information->maximum - index_base) / 40008e68: e2 16 20 14 lduh [ %i0 + 0x14 ], %l1 40008e6c: d0 16 20 10 lduh [ %i0 + 0x10 ], %o0 40008e70: 92 10 00 11 mov %l1, %o1 40008e74: 40 00 2a f6 call 40013a4c <.udiv> 40008e78: 90 22 00 10 sub %o0, %l0, %o0 information->allocation_size; for ( block = 0; block < block_count; block++ ) { 40008e7c: 80 a2 20 00 cmp %o0, 0 40008e80: 02 80 00 34 be 40008f50 <_Objects_Shrink_information+0xf0><== NEVER TAKEN 40008e84: 01 00 00 00 nop if ( information->inactive_per_block[ block ] == 40008e88: c8 06 20 30 ld [ %i0 + 0x30 ], %g4 40008e8c: c2 01 00 00 ld [ %g4 ], %g1 40008e90: 80 a4 40 01 cmp %l1, %g1 40008e94: 02 80 00 0f be 40008ed0 <_Objects_Shrink_information+0x70><== NEVER TAKEN 40008e98: 82 10 20 00 clr %g1 40008e9c: 10 80 00 07 b 40008eb8 <_Objects_Shrink_information+0x58> 40008ea0: a4 10 20 04 mov 4, %l2 information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; 40008ea4: 86 04 a0 04 add %l2, 4, %g3 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { if ( information->inactive_per_block[ block ] == 40008ea8: 80 a4 40 02 cmp %l1, %g2 40008eac: 02 80 00 0a be 40008ed4 <_Objects_Shrink_information+0x74> 40008eb0: a0 04 00 11 add %l0, %l1, %l0 40008eb4: a4 10 00 03 mov %g3, %l2 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 40008eb8: 82 00 60 01 inc %g1 40008ebc: 80 a2 00 01 cmp %o0, %g1 40008ec0: 38 bf ff f9 bgu,a 40008ea4 <_Objects_Shrink_information+0x44> 40008ec4: c4 01 00 12 ld [ %g4 + %l2 ], %g2 40008ec8: 81 c7 e0 08 ret 40008ecc: 81 e8 00 00 restore if ( information->inactive_per_block[ block ] == 40008ed0: a4 10 20 00 clr %l2 <== NOT EXECUTED information->allocation_size ) { /* * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); 40008ed4: 10 80 00 06 b 40008eec <_Objects_Shrink_information+0x8c> 40008ed8: d0 06 20 20 ld [ %i0 + 0x20 ], %o0 if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); 40008edc: 80 a4 60 00 cmp %l1, 0 40008ee0: 22 80 00 12 be,a 40008f28 <_Objects_Shrink_information+0xc8> 40008ee4: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 index = _Objects_Get_index( the_object->id ); /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; 40008ee8: 90 10 00 11 mov %l1, %o0 * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); do { index = _Objects_Get_index( the_object->id ); 40008eec: c2 12 20 0a lduh [ %o0 + 0xa ], %g1 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && 40008ef0: 80 a0 40 10 cmp %g1, %l0 40008ef4: 0a bf ff fa bcs 40008edc <_Objects_Shrink_information+0x7c> 40008ef8: e2 02 00 00 ld [ %o0 ], %l1 (index < (index_base + information->allocation_size))) { 40008efc: c4 16 20 14 lduh [ %i0 + 0x14 ], %g2 40008f00: 84 04 00 02 add %l0, %g2, %g2 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && 40008f04: 80 a0 40 02 cmp %g1, %g2 40008f08: 1a bf ff f6 bcc 40008ee0 <_Objects_Shrink_information+0x80> 40008f0c: 80 a4 60 00 cmp %l1, 0 (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); 40008f10: 7f ff fb 3a call 40007bf8 <_Chain_Extract> 40008f14: 01 00 00 00 nop } } while ( the_object ); 40008f18: 80 a4 60 00 cmp %l1, 0 40008f1c: 12 bf ff f4 bne 40008eec <_Objects_Shrink_information+0x8c><== ALWAYS TAKEN 40008f20: 90 10 00 11 mov %l1, %o0 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); 40008f24: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 <== NOT EXECUTED 40008f28: 40 00 07 5e call 4000aca0 <_Workspace_Free> 40008f2c: d0 00 40 12 ld [ %g1 + %l2 ], %o0 information->object_blocks[ block ] = NULL; 40008f30: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 information->inactive_per_block[ block ] = 0; 40008f34: c6 06 20 30 ld [ %i0 + 0x30 ], %g3 information->inactive -= information->allocation_size; 40008f38: c4 16 20 2c lduh [ %i0 + 0x2c ], %g2 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; 40008f3c: c0 20 40 12 clr [ %g1 + %l2 ] information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; 40008f40: c2 16 20 14 lduh [ %i0 + 0x14 ], %g1 * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; 40008f44: c0 20 c0 12 clr [ %g3 + %l2 ] information->inactive -= information->allocation_size; 40008f48: 82 20 80 01 sub %g2, %g1, %g1 40008f4c: c2 36 20 2c sth %g1, [ %i0 + 0x2c ] return; 40008f50: 81 c7 e0 08 ret 40008f54: 81 e8 00 00 restore =============================================================================== 4000c2a4 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4000c2a4: 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( 4000c2a8: 11 10 00 a8 sethi %hi(0x4002a000), %o0 4000c2ac: 92 10 00 18 mov %i0, %o1 4000c2b0: 90 12 21 0c or %o0, 0x10c, %o0 4000c2b4: 40 00 0d 5a call 4000f81c <_Objects_Get> 4000c2b8: 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 ) { 4000c2bc: c2 07 bf fc ld [ %fp + -4 ], %g1 4000c2c0: 80 a0 60 00 cmp %g1, 0 4000c2c4: 22 80 00 08 be,a 4000c2e4 <_POSIX_Message_queue_Receive_support+0x40> 4000c2c8: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000c2cc: 40 00 2d 1c call 4001773c <__errno> 4000c2d0: b0 10 3f ff mov -1, %i0 4000c2d4: 82 10 20 09 mov 9, %g1 4000c2d8: c2 22 00 00 st %g1, [ %o0 ] } 4000c2dc: 81 c7 e0 08 ret 4000c2e0: 81 e8 00 00 restore the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 4000c2e4: 84 08 60 03 and %g1, 3, %g2 4000c2e8: 80 a0 a0 01 cmp %g2, 1 4000c2ec: 02 80 00 36 be 4000c3c4 <_POSIX_Message_queue_Receive_support+0x120> 4000c2f0: 01 00 00 00 nop _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 4000c2f4: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 4000c2f8: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 4000c2fc: 80 a0 80 1a cmp %g2, %i2 4000c300: 18 80 00 20 bgu 4000c380 <_POSIX_Message_queue_Receive_support+0xdc> 4000c304: 84 10 3f ff mov -1, %g2 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 4000c308: c4 27 bf f8 st %g2, [ %fp + -8 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000c30c: 80 8f 20 ff btst 0xff, %i4 4000c310: 12 80 00 17 bne 4000c36c <_POSIX_Message_queue_Receive_support+0xc8><== ALWAYS TAKEN 4000c314: 98 10 20 00 clr %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4000c318: 9a 10 00 1d mov %i5, %o5 4000c31c: 90 02 20 1c add %o0, 0x1c, %o0 4000c320: 92 10 00 18 mov %i0, %o1 4000c324: 94 10 00 19 mov %i1, %o2 4000c328: 40 00 08 ca call 4000e650 <_CORE_message_queue_Seize> 4000c32c: 96 07 bf f8 add %fp, -8, %o3 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 4000c330: 40 00 10 67 call 400104cc <_Thread_Enable_dispatch> 4000c334: 3b 10 00 a8 sethi %hi(0x4002a000), %i5 *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 4000c338: ba 17 61 78 or %i5, 0x178, %i5 ! 4002a178 <_Per_CPU_Information> 4000c33c: 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); 4000c340: c4 00 60 24 ld [ %g1 + 0x24 ], %g2 if ( !_Thread_Executing->Wait.return_code ) 4000c344: c6 00 60 34 ld [ %g1 + 0x34 ], %g3 4000c348: 83 38 a0 1f sra %g2, 0x1f, %g1 4000c34c: 84 18 40 02 xor %g1, %g2, %g2 4000c350: 82 20 80 01 sub %g2, %g1, %g1 4000c354: 80 a0 e0 00 cmp %g3, 0 4000c358: 12 80 00 12 bne 4000c3a0 <_POSIX_Message_queue_Receive_support+0xfc> 4000c35c: c2 26 c0 00 st %g1, [ %i3 ] return length_out; 4000c360: f0 07 bf f8 ld [ %fp + -8 ], %i0 4000c364: 81 c7 e0 08 ret 4000c368: 81 e8 00 00 restore /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000c36c: 05 00 00 10 sethi %hi(0x4000), %g2 4000c370: 82 08 40 02 and %g1, %g2, %g1 length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000c374: 80 a0 00 01 cmp %g0, %g1 4000c378: 10 bf ff e8 b 4000c318 <_POSIX_Message_queue_Receive_support+0x74> 4000c37c: 98 60 3f ff subx %g0, -1, %o4 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { _Thread_Enable_dispatch(); 4000c380: 40 00 10 53 call 400104cc <_Thread_Enable_dispatch> 4000c384: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EMSGSIZE ); 4000c388: 40 00 2c ed call 4001773c <__errno> 4000c38c: 01 00 00 00 nop 4000c390: 82 10 20 7a mov 0x7a, %g1 ! 7a 4000c394: c2 22 00 00 st %g1, [ %o0 ] 4000c398: 81 c7 e0 08 ret 4000c39c: 81 e8 00 00 restore _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) return length_out; rtems_set_errno_and_return_minus_one( 4000c3a0: 40 00 2c e7 call 4001773c <__errno> 4000c3a4: b0 10 3f ff mov -1, %i0 4000c3a8: c2 07 60 0c ld [ %i5 + 0xc ], %g1 4000c3ac: b6 10 00 08 mov %o0, %i3 4000c3b0: 40 00 00 b1 call 4000c674 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000c3b4: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000c3b8: d0 26 c0 00 st %o0, [ %i3 ] 4000c3bc: 81 c7 e0 08 ret 4000c3c0: 81 e8 00 00 restore the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { _Thread_Enable_dispatch(); 4000c3c4: 40 00 10 42 call 400104cc <_Thread_Enable_dispatch> 4000c3c8: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EBADF ); 4000c3cc: 40 00 2c dc call 4001773c <__errno> 4000c3d0: 01 00 00 00 nop 4000c3d4: 82 10 20 09 mov 9, %g1 ! 9 4000c3d8: c2 22 00 00 st %g1, [ %o0 ] 4000c3dc: 81 c7 e0 08 ret 4000c3e0: 81 e8 00 00 restore =============================================================================== 4000c3fc <_POSIX_Message_queue_Send_support>: size_t msg_len, uint32_t msg_prio, bool wait, Watchdog_Interval timeout ) { 4000c3fc: 9d e3 bf 90 save %sp, -112, %sp /* * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) 4000c400: 80 a6 e0 20 cmp %i3, 0x20 4000c404: 18 80 00 48 bgu 4000c524 <_POSIX_Message_queue_Send_support+0x128> 4000c408: 92 10 00 18 mov %i0, %o1 RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd *_POSIX_Message_queue_Get_fd ( mqd_t id, Objects_Locations *location ) { return (POSIX_Message_queue_Control_fd *) _Objects_Get( 4000c40c: 11 10 00 a8 sethi %hi(0x4002a000), %o0 4000c410: 94 07 bf fc add %fp, -4, %o2 4000c414: 40 00 0d 02 call 4000f81c <_Objects_Get> 4000c418: 90 12 21 0c or %o0, 0x10c, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 4000c41c: c2 07 bf fc ld [ %fp + -4 ], %g1 4000c420: 80 a0 60 00 cmp %g1, 0 4000c424: 12 80 00 32 bne 4000c4ec <_POSIX_Message_queue_Send_support+0xf0> 4000c428: 01 00 00 00 nop case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { 4000c42c: c4 02 20 14 ld [ %o0 + 0x14 ], %g2 4000c430: 80 88 a0 03 btst 3, %g2 4000c434: 02 80 00 42 be 4000c53c <_POSIX_Message_queue_Send_support+0x140> 4000c438: 80 8f 20 ff btst 0xff, %i4 _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 4000c43c: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000c440: 12 80 00 15 bne 4000c494 <_POSIX_Message_queue_Send_support+0x98> 4000c444: 82 10 20 00 clr %g1 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( 4000c448: 92 10 00 19 mov %i1, %o1 4000c44c: 94 10 00 1a mov %i2, %o2 4000c450: 96 10 00 18 mov %i0, %o3 4000c454: 98 10 20 00 clr %o4 4000c458: 9a 20 00 1b neg %i3, %o5 4000c45c: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 4000c460: fa 23 a0 60 st %i5, [ %sp + 0x60 ] 4000c464: 40 00 08 bc call 4000e754 <_CORE_message_queue_Submit> 4000c468: 90 02 20 1c add %o0, 0x1c, %o0 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); 4000c46c: 40 00 10 18 call 400104cc <_Thread_Enable_dispatch> 4000c470: ba 10 00 08 mov %o0, %i5 * after it wakes up. The returned status is correct for * non-blocking operations but if we blocked, then we need * to look at the status in our TCB. */ if ( msg_status == CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT ) 4000c474: 80 a7 60 07 cmp %i5, 7 4000c478: 02 80 00 1a be 4000c4e0 <_POSIX_Message_queue_Send_support+0xe4><== NEVER TAKEN 4000c47c: 03 10 00 a8 sethi %hi(0x4002a000), %g1 msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) 4000c480: 80 a7 60 00 cmp %i5, 0 4000c484: 12 80 00 20 bne 4000c504 <_POSIX_Message_queue_Send_support+0x108> 4000c488: b0 10 20 00 clr %i0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } 4000c48c: 81 c7 e0 08 ret 4000c490: 81 e8 00 00 restore /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 4000c494: 03 00 00 10 sethi %hi(0x4000), %g1 4000c498: 84 08 80 01 and %g2, %g1, %g2 the_mq = the_mq_fd->Queue; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000c49c: 80 a0 00 02 cmp %g0, %g2 4000c4a0: 82 60 3f ff subx %g0, -1, %g1 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( 4000c4a4: 92 10 00 19 mov %i1, %o1 4000c4a8: 94 10 00 1a mov %i2, %o2 4000c4ac: 96 10 00 18 mov %i0, %o3 4000c4b0: 98 10 20 00 clr %o4 4000c4b4: 9a 20 00 1b neg %i3, %o5 4000c4b8: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 4000c4bc: fa 23 a0 60 st %i5, [ %sp + 0x60 ] 4000c4c0: 40 00 08 a5 call 4000e754 <_CORE_message_queue_Submit> 4000c4c4: 90 02 20 1c add %o0, 0x1c, %o0 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); 4000c4c8: 40 00 10 01 call 400104cc <_Thread_Enable_dispatch> 4000c4cc: ba 10 00 08 mov %o0, %i5 * after it wakes up. The returned status is correct for * non-blocking operations but if we blocked, then we need * to look at the status in our TCB. */ if ( msg_status == CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT ) 4000c4d0: 80 a7 60 07 cmp %i5, 7 4000c4d4: 12 bf ff ec bne 4000c484 <_POSIX_Message_queue_Send_support+0x88> 4000c4d8: 80 a7 60 00 cmp %i5, 0 msg_status = _Thread_Executing->Wait.return_code; 4000c4dc: 03 10 00 a8 sethi %hi(0x4002a000), %g1 4000c4e0: c2 00 61 84 ld [ %g1 + 0x184 ], %g1 ! 4002a184 <_Per_CPU_Information+0xc> 4000c4e4: 10 bf ff e7 b 4000c480 <_POSIX_Message_queue_Send_support+0x84> 4000c4e8: fa 00 60 34 ld [ %g1 + 0x34 ], %i5 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000c4ec: 40 00 2c 94 call 4001773c <__errno> 4000c4f0: b0 10 3f ff mov -1, %i0 4000c4f4: 82 10 20 09 mov 9, %g1 4000c4f8: c2 22 00 00 st %g1, [ %o0 ] } 4000c4fc: 81 c7 e0 08 ret 4000c500: 81 e8 00 00 restore msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) return msg_status; rtems_set_errno_and_return_minus_one( 4000c504: 40 00 2c 8e call 4001773c <__errno> 4000c508: b0 10 3f ff mov -1, %i0 4000c50c: b8 10 00 08 mov %o0, %i4 4000c510: 40 00 00 59 call 4000c674 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000c514: 90 10 00 1d mov %i5, %o0 4000c518: d0 27 00 00 st %o0, [ %i4 ] 4000c51c: 81 c7 e0 08 ret 4000c520: 81 e8 00 00 restore * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) rtems_set_errno_and_return_minus_one( EINVAL ); 4000c524: 40 00 2c 86 call 4001773c <__errno> 4000c528: b0 10 3f ff mov -1, %i0 4000c52c: 82 10 20 16 mov 0x16, %g1 4000c530: c2 22 00 00 st %g1, [ %o0 ] 4000c534: 81 c7 e0 08 ret 4000c538: 81 e8 00 00 restore the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { _Thread_Enable_dispatch(); 4000c53c: 40 00 0f e4 call 400104cc <_Thread_Enable_dispatch> 4000c540: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EBADF ); 4000c544: 40 00 2c 7e call 4001773c <__errno> 4000c548: 01 00 00 00 nop 4000c54c: 82 10 20 09 mov 9, %g1 ! 9 4000c550: c2 22 00 00 st %g1, [ %o0 ] 4000c554: 81 c7 e0 08 ret 4000c558: 81 e8 00 00 restore =============================================================================== 4000ce0c <_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 ]; 4000ce0c: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000ce10: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 4000ce14: 80 a0 a0 00 cmp %g2, 0 4000ce18: 12 80 00 06 bne 4000ce30 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x24><== NEVER TAKEN 4000ce1c: 01 00 00 00 nop 4000ce20: c4 00 60 dc ld [ %g1 + 0xdc ], %g2 4000ce24: 80 a0 a0 01 cmp %g2, 1 4000ce28: 22 80 00 05 be,a 4000ce3c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x30> 4000ce2c: c2 00 60 e0 ld [ %g1 + 0xe0 ], %g1 thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); } else _Thread_Enable_dispatch(); 4000ce30: 82 13 c0 00 mov %o7, %g1 4000ce34: 7f ff f3 8c call 40009c64 <_Thread_Enable_dispatch> 4000ce38: 9e 10 40 00 mov %g1, %o7 POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 4000ce3c: 80 a0 60 00 cmp %g1, 0 4000ce40: 02 bf ff fc be 4000ce30 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x24> 4000ce44: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000ce48: 03 10 00 62 sethi %hi(0x40018800), %g1 4000ce4c: c4 00 63 40 ld [ %g1 + 0x340 ], %g2 ! 40018b40 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 4000ce50: 92 10 3f ff mov -1, %o1 4000ce54: 84 00 bf ff add %g2, -1, %g2 4000ce58: c4 20 63 40 st %g2, [ %g1 + 0x340 ] 4000ce5c: 82 13 c0 00 mov %o7, %g1 4000ce60: 40 00 02 27 call 4000d6fc <_POSIX_Thread_Exit> 4000ce64: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000e3cc <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4000e3cc: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4000e3d0: d0 06 40 00 ld [ %i1 ], %o0 4000e3d4: 7f ff ff f1 call 4000e398 <_POSIX_Priority_Is_valid> 4000e3d8: a0 10 00 18 mov %i0, %l0 4000e3dc: 80 8a 20 ff btst 0xff, %o0 4000e3e0: 02 80 00 0e be 4000e418 <_POSIX_Thread_Translate_sched_param+0x4c><== NEVER TAKEN 4000e3e4: b0 10 20 16 mov 0x16, %i0 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 4000e3e8: c0 26 80 00 clr [ %i2 ] *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 4000e3ec: 80 a4 20 00 cmp %l0, 0 4000e3f0: 02 80 00 0c be 4000e420 <_POSIX_Thread_Translate_sched_param+0x54> 4000e3f4: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { 4000e3f8: 80 a4 20 01 cmp %l0, 1 4000e3fc: 02 80 00 07 be 4000e418 <_POSIX_Thread_Translate_sched_param+0x4c> 4000e400: b0 10 20 00 clr %i0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 4000e404: 80 a4 20 02 cmp %l0, 2 4000e408: 02 80 00 2e be 4000e4c0 <_POSIX_Thread_Translate_sched_param+0xf4> 4000e40c: 80 a4 20 04 cmp %l0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { 4000e410: 02 80 00 08 be 4000e430 <_POSIX_Thread_Translate_sched_param+0x64> 4000e414: b0 10 20 16 mov 0x16, %i0 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } 4000e418: 81 c7 e0 08 ret 4000e41c: 81 e8 00 00 restore *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000e420: 82 10 20 01 mov 1, %g1 4000e424: c2 26 80 00 st %g1, [ %i2 ] return 0; 4000e428: 81 c7 e0 08 ret 4000e42c: 91 e8 20 00 restore %g0, 0, %o0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { if ( (param->sched_ss_repl_period.tv_sec == 0) && 4000e430: c2 06 60 08 ld [ %i1 + 8 ], %g1 4000e434: 80 a0 60 00 cmp %g1, 0 4000e438: 32 80 00 07 bne,a 4000e454 <_POSIX_Thread_Translate_sched_param+0x88> 4000e43c: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000e440: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000e444: 80 a0 60 00 cmp %g1, 0 4000e448: 02 80 00 1f be 4000e4c4 <_POSIX_Thread_Translate_sched_param+0xf8> 4000e44c: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4000e450: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000e454: 80 a0 60 00 cmp %g1, 0 4000e458: 12 80 00 06 bne 4000e470 <_POSIX_Thread_Translate_sched_param+0xa4> 4000e45c: 01 00 00 00 nop 4000e460: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000e464: 80 a0 60 00 cmp %g1, 0 4000e468: 02 bf ff ec be 4000e418 <_POSIX_Thread_Translate_sched_param+0x4c> 4000e46c: 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 ) < 4000e470: 7f ff f4 e4 call 4000b800 <_Timespec_To_ticks> 4000e474: 90 06 60 08 add %i1, 8, %o0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; 4000e478: 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 ) < 4000e47c: a0 10 00 08 mov %o0, %l0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 4000e480: 7f ff f4 e0 call 4000b800 <_Timespec_To_ticks> 4000e484: 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 ) < 4000e488: 80 a4 00 08 cmp %l0, %o0 4000e48c: 0a 80 00 0e bcs 4000e4c4 <_POSIX_Thread_Translate_sched_param+0xf8> 4000e490: 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 ) ) 4000e494: 7f ff ff c1 call 4000e398 <_POSIX_Priority_Is_valid> 4000e498: d0 06 60 04 ld [ %i1 + 4 ], %o0 4000e49c: 80 8a 20 ff btst 0xff, %o0 4000e4a0: 02 bf ff de be 4000e418 <_POSIX_Thread_Translate_sched_param+0x4c> 4000e4a4: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4000e4a8: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 4000e4ac: 03 10 00 1e sethi %hi(0x40007800), %g1 4000e4b0: 82 10 61 24 or %g1, 0x124, %g1 ! 40007924 <_POSIX_Threads_Sporadic_budget_callout> 4000e4b4: c2 26 c0 00 st %g1, [ %i3 ] return 0; } return EINVAL; } 4000e4b8: 81 c7 e0 08 ret 4000e4bc: 91 e8 20 00 restore %g0, 0, %o0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 4000e4c0: e0 26 80 00 st %l0, [ %i2 ] return 0; 4000e4c4: 81 c7 e0 08 ret 4000e4c8: 81 e8 00 00 restore =============================================================================== 40007614 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 40007614: 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; 40007618: 03 10 00 7f sethi %hi(0x4001fc00), %g1 4000761c: 82 10 62 1c or %g1, 0x21c, %g1 ! 4001fe1c maximum = Configuration_POSIX_API.number_of_initialization_threads; 40007620: e6 00 60 30 ld [ %g1 + 0x30 ], %l3 if ( !user_threads || maximum == 0 ) 40007624: 80 a4 e0 00 cmp %l3, 0 40007628: 02 80 00 1a be 40007690 <_POSIX_Threads_Initialize_user_threads_body+0x7c><== NEVER TAKEN 4000762c: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 40007630: 80 a4 60 00 cmp %l1, 0 40007634: 02 80 00 17 be 40007690 <_POSIX_Threads_Initialize_user_threads_body+0x7c><== NEVER TAKEN 40007638: a4 10 20 00 clr %l2 4000763c: a0 07 bf bc add %fp, -68, %l0 40007640: 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 ); 40007644: 40 00 1b a2 call 4000e4cc 40007648: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 4000764c: 92 10 20 02 mov 2, %o1 40007650: 40 00 1b ab call 4000e4fc 40007654: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 40007658: d2 04 60 04 ld [ %l1 + 4 ], %o1 4000765c: 40 00 1b b8 call 4000e53c 40007660: 90 10 00 10 mov %l0, %o0 status = pthread_create( 40007664: d4 04 40 00 ld [ %l1 ], %o2 40007668: 90 10 00 14 mov %l4, %o0 4000766c: 92 10 00 10 mov %l0, %o1 40007670: 7f ff ff 1b call 400072dc 40007674: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 40007678: 94 92 20 00 orcc %o0, 0, %o2 4000767c: 12 80 00 07 bne 40007698 <_POSIX_Threads_Initialize_user_threads_body+0x84> 40007680: a4 04 a0 01 inc %l2 * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { 40007684: 80 a4 c0 12 cmp %l3, %l2 40007688: 18 bf ff ef bgu 40007644 <_POSIX_Threads_Initialize_user_threads_body+0x30><== NEVER TAKEN 4000768c: a2 04 60 08 add %l1, 8, %l1 40007690: 81 c7 e0 08 ret 40007694: 81 e8 00 00 restore &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 40007698: 90 10 20 02 mov 2, %o0 4000769c: 40 00 08 70 call 4000985c <_Internal_error_Occurred> 400076a0: 92 10 20 01 mov 1, %o1 =============================================================================== 4000d194 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 4000d194: 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 ]; 4000d198: 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 ); 4000d19c: 40 00 04 60 call 4000e31c <_Timespec_To_ticks> 4000d1a0: 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); 4000d1a4: c4 04 20 88 ld [ %l0 + 0x88 ], %g2 4000d1a8: 03 10 00 5a sethi %hi(0x40016800), %g1 4000d1ac: d2 08 63 34 ldub [ %g1 + 0x334 ], %o1 ! 40016b34 */ #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 ) { 4000d1b0: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 4000d1b4: 92 22 40 02 sub %o1, %g2, %o1 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); the_thread->cpu_time_budget = ticks; 4000d1b8: d0 26 60 78 st %o0, [ %i1 + 0x78 ] */ #if 0 printk( "TSR %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 4000d1bc: 80 a0 60 00 cmp %g1, 0 4000d1c0: 12 80 00 06 bne 4000d1d8 <_POSIX_Threads_Sporadic_budget_TSR+0x44><== NEVER TAKEN 4000d1c4: 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 ) { 4000d1c8: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000d1cc: 80 a0 40 09 cmp %g1, %o1 4000d1d0: 38 80 00 09 bgu,a 4000d1f4 <_POSIX_Threads_Sporadic_budget_TSR+0x60> 4000d1d4: 90 10 00 19 mov %i1, %o0 #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); 4000d1d8: 40 00 04 51 call 4000e31c <_Timespec_To_ticks> 4000d1dc: 90 04 20 90 add %l0, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000d1e0: 31 10 00 5d sethi %hi(0x40017400), %i0 4000d1e4: b2 04 20 a8 add %l0, 0xa8, %i1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000d1e8: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000d1ec: 7f ff f5 bd call 4000a8e0 <_Watchdog_Insert> 4000d1f0: 91 ee 23 00 restore %i0, 0x300, %o0 if ( the_thread->resource_count == 0 ) { /* * If this would make them less important, then do not change it. */ if ( the_thread->current_priority > new_priority ) { _Thread_Change_priority( the_thread, new_priority, true ); 4000d1f4: 7f ff f0 79 call 400093d8 <_Thread_Change_priority> 4000d1f8: 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 ); 4000d1fc: 40 00 04 48 call 4000e31c <_Timespec_To_ticks> 4000d200: 90 04 20 90 add %l0, 0x90, %o0 4000d204: 31 10 00 5d sethi %hi(0x40017400), %i0 4000d208: b2 04 20 a8 add %l0, 0xa8, %i1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000d20c: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000d210: 7f ff f5 b4 call 4000a8e0 <_Watchdog_Insert> 4000d214: 91 ee 23 00 restore %i0, 0x300, %o0 =============================================================================== 4000d21c <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000d21c: c4 02 21 58 ld [ %o0 + 0x158 ], %g2 4000d220: c6 00 a0 8c ld [ %g2 + 0x8c ], %g3 4000d224: 05 10 00 5a sethi %hi(0x40016800), %g2 4000d228: d2 08 a3 34 ldub [ %g2 + 0x334 ], %o1 ! 40016b34 */ #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 ) { 4000d22c: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 4000d230: 92 22 40 03 sub %o1, %g3, %o1 /* * This will prevent the thread from consuming its entire "budget" * while at low priority. */ the_thread->cpu_time_budget = 0xFFFFFFFF; /* XXX should be based on MAX_U32 */ 4000d234: 86 10 3f ff mov -1, %g3 new_priority = _POSIX_Priority_To_core(api->schedparam.sched_ss_low_priority); the_thread->real_priority = new_priority; 4000d238: d2 22 20 18 st %o1, [ %o0 + 0x18 ] */ #if 0 printk( "callout %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 4000d23c: 80 a0 a0 00 cmp %g2, 0 4000d240: 12 80 00 06 bne 4000d258 <_POSIX_Threads_Sporadic_budget_callout+0x3c><== NEVER TAKEN 4000d244: c6 22 20 78 st %g3, [ %o0 + 0x78 ] /* * Make sure we are actually lowering it. If they have lowered it * to logically lower than sched_ss_low_priority, then we do not want to * change it. */ if ( the_thread->current_priority < new_priority ) { 4000d248: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000d24c: 80 a0 40 09 cmp %g1, %o1 4000d250: 0a 80 00 04 bcs 4000d260 <_POSIX_Threads_Sporadic_budget_callout+0x44><== ALWAYS TAKEN 4000d254: 94 10 20 01 mov 1, %o2 4000d258: 81 c3 e0 08 retl <== NOT EXECUTED 4000d25c: 01 00 00 00 nop <== NOT EXECUTED _Thread_Change_priority( the_thread, new_priority, true ); 4000d260: 82 13 c0 00 mov %o7, %g1 4000d264: 7f ff f0 5d call 400093d8 <_Thread_Change_priority> 4000d268: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000f78c <_POSIX_Threads_cancel_run>: #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { 4000f78c: 9d e3 bf a0 save %sp, -96, %sp POSIX_Cancel_Handler_control *handler; Chain_Control *handler_stack; POSIX_API_Control *thread_support; ISR_Level level; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000f790: e2 06 21 58 ld [ %i0 + 0x158 ], %l1 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; 4000f794: 84 10 20 01 mov 1, %g2 while ( !_Chain_Is_empty( handler_stack ) ) { 4000f798: c2 04 60 e4 ld [ %l1 + 0xe4 ], %g1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000f79c: a4 04 60 e8 add %l1, 0xe8, %l2 4000f7a0: 80 a0 40 12 cmp %g1, %l2 4000f7a4: 02 80 00 14 be 4000f7f4 <_POSIX_Threads_cancel_run+0x68> 4000f7a8: c4 24 60 d8 st %g2, [ %l1 + 0xd8 ] _ISR_Disable( level ); 4000f7ac: 7f ff c9 98 call 40001e0c 4000f7b0: 01 00 00 00 nop handler = (POSIX_Cancel_Handler_control *) 4000f7b4: e0 04 60 ec ld [ %l1 + 0xec ], %l0 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4000f7b8: c4 04 00 00 ld [ %l0 ], %g2 previous = the_node->previous; 4000f7bc: c2 04 20 04 ld [ %l0 + 4 ], %g1 next->previous = previous; 4000f7c0: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000f7c4: c4 20 40 00 st %g2, [ %g1 ] _Chain_Tail( handler_stack )->previous; _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); 4000f7c8: 7f ff c9 95 call 40001e1c 4000f7cc: 01 00 00 00 nop (*handler->routine)( handler->arg ); 4000f7d0: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000f7d4: 9f c0 40 00 call %g1 4000f7d8: d0 04 20 0c ld [ %l0 + 0xc ], %o0 _Workspace_Free( handler ); 4000f7dc: 7f ff ed 31 call 4000aca0 <_Workspace_Free> 4000f7e0: 90 10 00 10 mov %l0, %o0 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { 4000f7e4: c2 04 60 e4 ld [ %l1 + 0xe4 ], %g1 4000f7e8: 80 a0 40 12 cmp %g1, %l2 4000f7ec: 12 bf ff f0 bne 4000f7ac <_POSIX_Threads_cancel_run+0x20> <== NEVER TAKEN 4000f7f0: 01 00 00 00 nop 4000f7f4: 81 c7 e0 08 ret 4000f7f8: 81 e8 00 00 restore =============================================================================== 40007394 <_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) { 40007394: 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; 40007398: c4 06 60 68 ld [ %i1 + 0x68 ], %g2 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 4000739c: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 400073a0: 84 00 a0 01 inc %g2 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 400073a4: 80 a0 60 00 cmp %g1, 0 400073a8: 12 80 00 0e bne 400073e0 <_POSIX_Timer_TSR+0x4c> 400073ac: c4 26 60 68 st %g2, [ %i1 + 0x68 ] 400073b0: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 400073b4: 80 a0 60 00 cmp %g1, 0 400073b8: 32 80 00 0b bne,a 400073e4 <_POSIX_Timer_TSR+0x50> <== ALWAYS TAKEN 400073bc: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 400073c0: 82 10 20 04 mov 4, %g1 400073c4: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] <== NOT EXECUTED /* * The sending of the signal to the process running the handling function * specified for that signal is simulated */ if ( pthread_kill ( ptimer->thread_id, ptimer->inf.sigev_signo ) ) { 400073c8: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 400073cc: 40 00 1a 1f call 4000dc48 400073d0: d2 06 60 44 ld [ %i1 + 0x44 ], %o1 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 400073d4: c0 26 60 68 clr [ %i1 + 0x68 ] 400073d8: 81 c7 e0 08 ret 400073dc: 81 e8 00 00 restore ptimer->overrun = ptimer->overrun + 1; /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 400073e0: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 400073e4: d4 06 60 08 ld [ %i1 + 8 ], %o2 400073e8: 90 06 60 10 add %i1, 0x10, %o0 400073ec: 98 10 00 19 mov %i1, %o4 400073f0: 17 10 00 1c sethi %hi(0x40007000), %o3 400073f4: 40 00 1b 42 call 4000e0fc <_POSIX_Timer_Insert_helper> 400073f8: 96 12 e3 94 or %o3, 0x394, %o3 ! 40007394 <_POSIX_Timer_TSR> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 400073fc: 80 8a 20 ff btst 0xff, %o0 40007400: 02 bf ff f6 be 400073d8 <_POSIX_Timer_TSR+0x44> <== NEVER TAKEN 40007404: 01 00 00 00 nop return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 40007408: 40 00 06 03 call 40008c14 <_TOD_Get> 4000740c: 90 06 60 6c add %i1, 0x6c, %o0 /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40007410: 82 10 20 03 mov 3, %g1 40007414: 10 bf ff ed b 400073c8 <_POSIX_Timer_TSR+0x34> 40007418: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] =============================================================================== 4000f8ac <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000f8ac: 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, 4000f8b0: 98 10 20 01 mov 1, %o4 4000f8b4: 90 10 00 18 mov %i0, %o0 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000f8b8: 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, 4000f8bc: a2 07 bf f4 add %fp, -12, %l1 4000f8c0: 92 10 00 19 mov %i1, %o1 4000f8c4: 94 10 00 11 mov %l1, %o2 4000f8c8: 96 0e a0 ff and %i2, 0xff, %o3 4000f8cc: 40 00 00 2d call 4000f980 <_POSIX_signals_Clear_signals> 4000f8d0: b0 10 20 00 clr %i0 4000f8d4: 80 8a 20 ff btst 0xff, %o0 4000f8d8: 02 80 00 23 be 4000f964 <_POSIX_signals_Check_signal+0xb8> 4000f8dc: 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 ) 4000f8e0: 29 10 00 5e sethi %hi(0x40017800), %l4 4000f8e4: a7 2e 60 04 sll %i1, 4, %l3 4000f8e8: a8 15 23 d0 or %l4, 0x3d0, %l4 4000f8ec: a6 24 c0 01 sub %l3, %g1, %l3 4000f8f0: 82 05 00 13 add %l4, %l3, %g1 4000f8f4: e4 00 60 08 ld [ %g1 + 8 ], %l2 4000f8f8: 80 a4 a0 01 cmp %l2, 1 4000f8fc: 02 80 00 1a be 4000f964 <_POSIX_signals_Check_signal+0xb8><== NEVER TAKEN 4000f900: 2f 10 00 5e sethi %hi(0x40017800), %l7 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 4000f904: ea 04 20 d0 ld [ %l0 + 0xd0 ], %l5 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000f908: c2 00 60 04 ld [ %g1 + 4 ], %g1 /* * We have to save the blocking information of the current wait queue * because the signal handler may subsequently go on and put the thread * on a wait queue, for its own purposes. */ memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait, 4000f90c: ae 15 e3 78 or %l7, 0x378, %l7 4000f910: d2 05 e0 0c ld [ %l7 + 0xc ], %o1 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000f914: 82 10 40 15 or %g1, %l5, %g1 /* * We have to save the blocking information of the current wait queue * because the signal handler may subsequently go on and put the thread * on a wait queue, for its own purposes. */ memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait, 4000f918: ac 07 bf cc add %fp, -52, %l6 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000f91c: 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, 4000f920: 90 10 00 16 mov %l6, %o0 4000f924: 92 02 60 20 add %o1, 0x20, %o1 4000f928: 40 00 04 57 call 40010a84 4000f92c: 94 10 20 28 mov 0x28, %o2 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 4000f930: c2 05 00 13 ld [ %l4 + %l3 ], %g1 4000f934: 80 a0 60 02 cmp %g1, 2 4000f938: 02 80 00 0d be 4000f96c <_POSIX_signals_Check_signal+0xc0> 4000f93c: 90 10 00 19 mov %i1, %o0 &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 4000f940: 9f c4 80 00 call %l2 4000f944: 90 10 00 19 mov %i1, %o0 } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 4000f948: d0 05 e0 0c ld [ %l7 + 0xc ], %o0 4000f94c: 92 10 00 16 mov %l6, %o1 4000f950: 90 02 20 20 add %o0, 0x20, %o0 4000f954: 94 10 20 28 mov 0x28, %o2 4000f958: 40 00 04 4b call 40010a84 4000f95c: b0 10 20 01 mov 1, %i0 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 4000f960: ea 24 20 d0 st %l5, [ %l0 + 0xd0 ] return true; } 4000f964: 81 c7 e0 08 ret 4000f968: 81 e8 00 00 restore /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 4000f96c: 92 10 00 11 mov %l1, %o1 4000f970: 9f c4 80 00 call %l2 4000f974: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 4000f978: 10 bf ff f5 b 4000f94c <_POSIX_signals_Check_signal+0xa0> 4000f97c: d0 05 e0 0c ld [ %l7 + 0xc ], %o0 =============================================================================== 40010080 <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 40010080: 9d e3 bf a0 save %sp, -96, %sp clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 40010084: 7f ff c7 62 call 40001e0c 40010088: 01 00 00 00 nop if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4001008c: 85 2e 20 04 sll %i0, 4, %g2 40010090: 83 2e 20 02 sll %i0, 2, %g1 40010094: 82 20 80 01 sub %g2, %g1, %g1 40010098: 05 10 00 5e sethi %hi(0x40017800), %g2 4001009c: 84 10 a3 d0 or %g2, 0x3d0, %g2 ! 40017bd0 <_POSIX_signals_Vectors> 400100a0: c4 00 80 01 ld [ %g2 + %g1 ], %g2 400100a4: 80 a0 a0 02 cmp %g2, 2 400100a8: 02 80 00 0b be 400100d4 <_POSIX_signals_Clear_process_signals+0x54> 400100ac: 05 10 00 5f sethi %hi(0x40017c00), %g2 if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 400100b0: 03 10 00 5f sethi %hi(0x40017c00), %g1 400100b4: c4 00 61 c4 ld [ %g1 + 0x1c4 ], %g2 ! 40017dc4 <_POSIX_signals_Pending> 400100b8: 86 10 20 01 mov 1, %g3 400100bc: b0 06 3f ff add %i0, -1, %i0 400100c0: b1 28 c0 18 sll %g3, %i0, %i0 400100c4: b0 28 80 18 andn %g2, %i0, %i0 400100c8: f0 20 61 c4 st %i0, [ %g1 + 0x1c4 ] } _ISR_Enable( level ); 400100cc: 7f ff c7 54 call 40001e1c 400100d0: 91 e8 00 08 restore %g0, %o0, %o0 } 400100d4: 84 10 a1 c8 or %g2, 0x1c8, %g2 ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 400100d8: c6 00 80 01 ld [ %g2 + %g1 ], %g3 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 400100dc: 82 00 40 02 add %g1, %g2, %g1 400100e0: 82 00 60 04 add %g1, 4, %g1 400100e4: 80 a0 c0 01 cmp %g3, %g1 400100e8: 02 bf ff f3 be 400100b4 <_POSIX_signals_Clear_process_signals+0x34><== ALWAYS TAKEN 400100ec: 03 10 00 5f sethi %hi(0x40017c00), %g1 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); 400100f0: 7f ff c7 4b call 40001e1c <== NOT EXECUTED 400100f4: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED =============================================================================== 40007e74 <_POSIX_signals_Get_lowest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40007e74: 82 10 20 1b mov 0x1b, %g1 ! 1b 40007e78: 86 10 20 01 mov 1, %g3 #include #include #include #include int _POSIX_signals_Get_lowest( 40007e7c: 84 00 7f ff add %g1, -1, %g2 40007e80: 85 28 c0 02 sll %g3, %g2, %g2 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 40007e84: 80 88 80 08 btst %g2, %o0 40007e88: 12 80 00 11 bne 40007ecc <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 40007e8c: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40007e90: 82 00 60 01 inc %g1 40007e94: 80 a0 60 20 cmp %g1, 0x20 40007e98: 12 bf ff fa bne 40007e80 <_POSIX_signals_Get_lowest+0xc> 40007e9c: 84 00 7f ff add %g1, -1, %g2 40007ea0: 82 10 20 01 mov 1, %g1 40007ea4: 10 80 00 05 b 40007eb8 <_POSIX_signals_Get_lowest+0x44> 40007ea8: 86 10 20 01 mov 1, %g3 */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 40007eac: 80 a0 60 1b cmp %g1, 0x1b 40007eb0: 02 80 00 07 be 40007ecc <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 40007eb4: 01 00 00 00 nop #include #include #include #include int _POSIX_signals_Get_lowest( 40007eb8: 84 00 7f ff add %g1, -1, %g2 40007ebc: 85 28 c0 02 sll %g3, %g2, %g2 #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 40007ec0: 80 88 80 08 btst %g2, %o0 40007ec4: 22 bf ff fa be,a 40007eac <_POSIX_signals_Get_lowest+0x38> 40007ec8: 82 00 60 01 inc %g1 * a return 0. This routine will NOT be called unless a signal * is pending in the set passed in. */ found_it: return signo; } 40007ecc: 81 c3 e0 08 retl 40007ed0: 90 10 00 01 mov %g1, %o0 =============================================================================== 4000cc34 <_POSIX_signals_Post_switch_extension>: */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { 4000cc34: 9d e3 bf a0 save %sp, -96, %sp POSIX_API_Control *api; int signo; ISR_Level level; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000cc38: e2 06 21 58 ld [ %i0 + 0x158 ], %l1 /* * api may be NULL in case of a thread close in progress */ if ( !api ) 4000cc3c: 80 a4 60 00 cmp %l1, 0 4000cc40: 02 80 00 34 be 4000cd10 <_POSIX_signals_Post_switch_extension+0xdc> 4000cc44: 01 00 00 00 nop * * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); 4000cc48: 7f ff d4 71 call 40001e0c 4000cc4c: 25 10 00 5f sethi %hi(0x40017c00), %l2 4000cc50: b0 10 00 08 mov %o0, %i0 4000cc54: a4 14 a1 c4 or %l2, 0x1c4, %l2 if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { 4000cc58: c6 04 80 00 ld [ %l2 ], %g3 4000cc5c: c2 04 60 d4 ld [ %l1 + 0xd4 ], %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000cc60: c4 04 60 d0 ld [ %l1 + 0xd0 ], %g2 (api->signals_pending | _POSIX_signals_Pending)) ) { 4000cc64: 82 10 c0 01 or %g3, %g1, %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000cc68: 80 a8 40 02 andncc %g1, %g2, %g0 4000cc6c: 02 80 00 27 be 4000cd08 <_POSIX_signals_Post_switch_extension+0xd4> 4000cc70: 01 00 00 00 nop (api->signals_pending | _POSIX_signals_Pending)) ) { _ISR_Enable( level ); break; } _ISR_Enable( level ); 4000cc74: 7f ff d4 6a call 40001e1c 4000cc78: a0 10 20 1b mov 0x1b, %l0 ! 1b for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); 4000cc7c: 92 10 00 10 mov %l0, %o1 4000cc80: 94 10 20 00 clr %o2 4000cc84: 40 00 0b 0a call 4000f8ac <_POSIX_signals_Check_signal> 4000cc88: 90 10 00 11 mov %l1, %o0 _POSIX_signals_Check_signal( api, signo, true ); 4000cc8c: 92 10 00 10 mov %l0, %o1 4000cc90: 90 10 00 11 mov %l1, %o0 4000cc94: 40 00 0b 06 call 4000f8ac <_POSIX_signals_Check_signal> 4000cc98: 94 10 20 01 mov 1, %o2 _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 4000cc9c: a0 04 20 01 inc %l0 4000cca0: 80 a4 20 20 cmp %l0, 0x20 4000cca4: 12 bf ff f7 bne 4000cc80 <_POSIX_signals_Post_switch_extension+0x4c> 4000cca8: 92 10 00 10 mov %l0, %o1 4000ccac: a0 10 20 01 mov 1, %l0 _POSIX_signals_Check_signal( api, signo, true ); } /* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */ for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); 4000ccb0: 92 10 00 10 mov %l0, %o1 4000ccb4: 94 10 20 00 clr %o2 4000ccb8: 40 00 0a fd call 4000f8ac <_POSIX_signals_Check_signal> 4000ccbc: 90 10 00 11 mov %l1, %o0 _POSIX_signals_Check_signal( api, signo, true ); 4000ccc0: 92 10 00 10 mov %l0, %o1 4000ccc4: 90 10 00 11 mov %l1, %o0 4000ccc8: 40 00 0a f9 call 4000f8ac <_POSIX_signals_Check_signal> 4000cccc: 94 10 20 01 mov 1, %o2 _POSIX_signals_Check_signal( api, signo, false ); _POSIX_signals_Check_signal( api, signo, true ); } /* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */ for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 4000ccd0: a0 04 20 01 inc %l0 4000ccd4: 80 a4 20 1b cmp %l0, 0x1b 4000ccd8: 12 bf ff f7 bne 4000ccb4 <_POSIX_signals_Post_switch_extension+0x80> 4000ccdc: 92 10 00 10 mov %l0, %o1 * * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); 4000cce0: 7f ff d4 4b call 40001e0c 4000cce4: 01 00 00 00 nop 4000cce8: b0 10 00 08 mov %o0, %i0 if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { 4000ccec: c6 04 80 00 ld [ %l2 ], %g3 4000ccf0: c2 04 60 d4 ld [ %l1 + 0xd4 ], %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000ccf4: c4 04 60 d0 ld [ %l1 + 0xd0 ], %g2 (api->signals_pending | _POSIX_signals_Pending)) ) { 4000ccf8: 82 10 c0 01 or %g3, %g1, %g1 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & 4000ccfc: 80 a8 40 02 andncc %g1, %g2, %g0 4000cd00: 12 bf ff dd bne 4000cc74 <_POSIX_signals_Post_switch_extension+0x40><== NEVER TAKEN 4000cd04: 01 00 00 00 nop (api->signals_pending | _POSIX_signals_Pending)) ) { _ISR_Enable( level ); 4000cd08: 7f ff d4 45 call 40001e1c 4000cd0c: 81 e8 00 00 restore 4000cd10: 81 c7 e0 08 ret 4000cd14: 81 e8 00 00 restore =============================================================================== 4002657c <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 4002657c: 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 ) ) { 40026580: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 40026584: 05 04 00 20 sethi %hi(0x10008000), %g2 40026588: 86 10 20 01 mov 1, %g3 4002658c: 9a 06 7f ff add %i1, -1, %o5 40026590: 88 08 40 02 and %g1, %g2, %g4 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 40026594: a0 10 00 18 mov %i0, %l0 POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40026598: d8 06 21 58 ld [ %i0 + 0x158 ], %o4 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 4002659c: 80 a1 00 02 cmp %g4, %g2 400265a0: 02 80 00 28 be 40026640 <_POSIX_signals_Unblock_thread+0xc4> 400265a4: 9b 28 c0 0d sll %g3, %o5, %o5 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 400265a8: c4 03 20 d0 ld [ %o4 + 0xd0 ], %g2 400265ac: 80 ab 40 02 andncc %o5, %g2, %g0 400265b0: 02 80 00 15 be 40026604 <_POSIX_signals_Unblock_thread+0x88> 400265b4: b0 10 20 00 clr %i0 400265b8: 05 04 00 00 sethi %hi(0x10000000), %g2 * it is not blocked, THEN * we need to dispatch at the end of this ISR. * + Any other combination, do nothing. */ if ( _States_Is_interruptible_by_signal( the_thread->current_state ) ) { 400265bc: 80 88 40 02 btst %g1, %g2 400265c0: 02 80 00 13 be 4002660c <_POSIX_signals_Unblock_thread+0x90> 400265c4: 80 a0 60 00 cmp %g1, 0 the_thread->Wait.return_code = EINTR; 400265c8: 84 10 20 04 mov 4, %g2 400265cc: c4 24 20 34 st %g2, [ %l0 + 0x34 ] */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 400265d0: 05 00 00 ef sethi %hi(0x3bc00), %g2 400265d4: 84 10 a2 e0 or %g2, 0x2e0, %g2 ! 3bee0 /* * In pthread_cond_wait, a thread will be blocking on a thread * queue, but is also interruptible by a POSIX signal. */ if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) ) 400265d8: 80 88 40 02 btst %g1, %g2 400265dc: 12 80 00 31 bne 400266a0 <_POSIX_signals_Unblock_thread+0x124> 400265e0: 80 88 60 08 btst 8, %g1 _Thread_queue_Extract_with_proxy( the_thread ); else if ( _States_Is_delaying(the_thread->current_state) ) { 400265e4: 02 80 00 31 be 400266a8 <_POSIX_signals_Unblock_thread+0x12c><== NEVER TAKEN 400265e8: 01 00 00 00 nop (void) _Watchdog_Remove( &the_thread->Timer ); 400265ec: 7f ff a8 76 call 400107c4 <_Watchdog_Remove> 400265f0: 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 ); 400265f4: 90 10 00 10 mov %l0, %o0 400265f8: 13 04 00 ff sethi %hi(0x1003fc00), %o1 400265fc: 7f ff a3 2c call 4000f2ac <_Thread_Clear_state> 40026600: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 40026604: 81 c7 e0 08 ret 40026608: 81 e8 00 00 restore _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 4002660c: 12 bf ff fe bne 40026604 <_POSIX_signals_Unblock_thread+0x88><== NEVER TAKEN 40026610: 03 10 00 a8 sethi %hi(0x4002a000), %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40026614: 82 10 62 28 or %g1, 0x228, %g1 ! 4002a228 <_Per_CPU_Information> 40026618: c4 00 60 08 ld [ %g1 + 8 ], %g2 4002661c: 80 a0 a0 00 cmp %g2, 0 40026620: 02 80 00 22 be 400266a8 <_POSIX_signals_Unblock_thread+0x12c> 40026624: 01 00 00 00 nop 40026628: c4 00 60 0c ld [ %g1 + 0xc ], %g2 4002662c: 80 a4 00 02 cmp %l0, %g2 40026630: 22 bf ff f5 be,a 40026604 <_POSIX_signals_Unblock_thread+0x88><== ALWAYS TAKEN 40026634: c6 28 60 18 stb %g3, [ %g1 + 0x18 ] _Thread_Dispatch_necessary = true; } } return false; } 40026638: 81 c7 e0 08 ret <== NOT EXECUTED 4002663c: 81 e8 00 00 restore <== NOT EXECUTED * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 40026640: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 40026644: 80 8b 40 01 btst %o5, %g1 40026648: 22 80 00 12 be,a 40026690 <_POSIX_signals_Unblock_thread+0x114> 4002664c: c2 03 20 d0 ld [ %o4 + 0xd0 ], %g1 the_thread->Wait.return_code = EINTR; 40026650: 82 10 20 04 mov 4, %g1 40026654: c2 24 20 34 st %g1, [ %l0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 40026658: 80 a6 a0 00 cmp %i2, 0 4002665c: 02 80 00 15 be 400266b0 <_POSIX_signals_Unblock_thread+0x134> 40026660: c2 04 20 28 ld [ %l0 + 0x28 ], %g1 the_info->si_signo = signo; the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; } else { *the_info = *info; 40026664: c4 06 80 00 ld [ %i2 ], %g2 40026668: c4 20 40 00 st %g2, [ %g1 ] 4002666c: c4 06 a0 04 ld [ %i2 + 4 ], %g2 40026670: c4 20 60 04 st %g2, [ %g1 + 4 ] 40026674: c4 06 a0 08 ld [ %i2 + 8 ], %g2 40026678: c4 20 60 08 st %g2, [ %g1 + 8 ] } _Thread_queue_Extract_with_proxy( the_thread ); 4002667c: 90 10 00 10 mov %l0, %o0 40026680: 7f ff a5 d6 call 4000fdd8 <_Thread_queue_Extract_with_proxy> 40026684: b0 10 20 01 mov 1, %i0 return true; 40026688: 81 c7 e0 08 ret 4002668c: 81 e8 00 00 restore * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 40026690: 80 ab 40 01 andncc %o5, %g1, %g0 40026694: 12 bf ff ef bne 40026650 <_POSIX_signals_Unblock_thread+0xd4> 40026698: b0 10 20 00 clr %i0 4002669c: 30 80 00 03 b,a 400266a8 <_POSIX_signals_Unblock_thread+0x12c> /* * In pthread_cond_wait, a thread will be blocking on a thread * queue, but is also interruptible by a POSIX signal. */ if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) ) _Thread_queue_Extract_with_proxy( the_thread ); 400266a0: 7f ff a5 ce call 4000fdd8 <_Thread_queue_Extract_with_proxy> 400266a4: 90 10 00 10 mov %l0, %o0 400266a8: 81 c7 e0 08 ret 400266ac: 81 e8 00 00 restore the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; the_info->si_code = SI_USER; 400266b0: 84 10 20 01 mov 1, %g2 the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; 400266b4: f2 20 40 00 st %i1, [ %g1 ] the_info->si_code = SI_USER; 400266b8: c4 20 60 04 st %g2, [ %g1 + 4 ] the_info->si_value.sival_int = 0; 400266bc: 10 bf ff f0 b 4002667c <_POSIX_signals_Unblock_thread+0x100> 400266c0: c0 20 60 08 clr [ %g1 + 8 ] =============================================================================== 4000751c <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { 4000751c: 9d e3 bf 98 save %sp, -104, %sp rtems_initialization_tasks_table *user_tasks; /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; 40007520: 03 10 00 5a sethi %hi(0x40016800), %g1 40007524: 82 10 63 00 or %g1, 0x300, %g1 ! 40016b00 40007528: e0 00 60 2c ld [ %g1 + 0x2c ], %l0 maximum = Configuration_RTEMS_API.number_of_initialization_tasks; /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) 4000752c: 80 a4 20 00 cmp %l0, 0 40007530: 02 80 00 19 be 40007594 <_RTEMS_tasks_Initialize_user_tasks_body+0x78> 40007534: e4 00 60 28 ld [ %g1 + 0x28 ], %l2 return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 40007538: 80 a4 a0 00 cmp %l2, 0 4000753c: 02 80 00 16 be 40007594 <_RTEMS_tasks_Initialize_user_tasks_body+0x78><== NEVER TAKEN 40007540: a2 10 20 00 clr %l1 40007544: a6 07 bf fc add %fp, -4, %l3 return_value = rtems_task_create( 40007548: d4 04 20 04 ld [ %l0 + 4 ], %o2 4000754c: d0 04 00 00 ld [ %l0 ], %o0 40007550: d2 04 20 08 ld [ %l0 + 8 ], %o1 40007554: d6 04 20 14 ld [ %l0 + 0x14 ], %o3 40007558: d8 04 20 0c ld [ %l0 + 0xc ], %o4 4000755c: 7f ff ff 6d call 40007310 40007560: 9a 10 00 13 mov %l3, %o5 user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) 40007564: 94 92 20 00 orcc %o0, 0, %o2 40007568: 12 80 00 0d bne 4000759c <_RTEMS_tasks_Initialize_user_tasks_body+0x80> 4000756c: d0 07 bf fc ld [ %fp + -4 ], %o0 _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( 40007570: d4 04 20 18 ld [ %l0 + 0x18 ], %o2 40007574: 40 00 00 0e call 400075ac 40007578: d2 04 20 10 ld [ %l0 + 0x10 ], %o1 id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) 4000757c: 94 92 20 00 orcc %o0, 0, %o2 40007580: 12 80 00 07 bne 4000759c <_RTEMS_tasks_Initialize_user_tasks_body+0x80> 40007584: a2 04 60 01 inc %l1 return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 40007588: 80 a4 80 11 cmp %l2, %l1 4000758c: 18 bf ff ef bgu 40007548 <_RTEMS_tasks_Initialize_user_tasks_body+0x2c><== NEVER TAKEN 40007590: a0 04 20 1c add %l0, 0x1c, %l0 40007594: 81 c7 e0 08 ret 40007598: 81 e8 00 00 restore id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); 4000759c: 90 10 20 01 mov 1, %o0 400075a0: 40 00 04 10 call 400085e0 <_Internal_error_Occurred> 400075a4: 92 10 20 01 mov 1, %o1 =============================================================================== 4000d54c <_RTEMS_tasks_Switch_extension>: /* * Per Task Variables */ tvp = executing->task_variables; 4000d54c: c2 02 21 60 ld [ %o0 + 0x160 ], %g1 while (tvp) { 4000d550: 80 a0 60 00 cmp %g1, 0 4000d554: 22 80 00 0b be,a 4000d580 <_RTEMS_tasks_Switch_extension+0x34> 4000d558: c2 02 61 60 ld [ %o1 + 0x160 ], %g1 tvp->tval = *tvp->ptr; 4000d55c: c4 00 60 04 ld [ %g1 + 4 ], %g2 *tvp->ptr = tvp->gval; 4000d560: c6 00 60 08 ld [ %g1 + 8 ], %g3 * Per Task Variables */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; 4000d564: c8 00 80 00 ld [ %g2 ], %g4 4000d568: c8 20 60 0c st %g4, [ %g1 + 0xc ] *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; 4000d56c: c2 00 40 00 ld [ %g1 ], %g1 /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { 4000d570: 80 a0 60 00 cmp %g1, 0 4000d574: 12 bf ff fa bne 4000d55c <_RTEMS_tasks_Switch_extension+0x10><== NEVER TAKEN 4000d578: c6 20 80 00 st %g3, [ %g2 ] tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; 4000d57c: c2 02 61 60 ld [ %o1 + 0x160 ], %g1 while (tvp) { 4000d580: 80 a0 60 00 cmp %g1, 0 4000d584: 02 80 00 0a be 4000d5ac <_RTEMS_tasks_Switch_extension+0x60> 4000d588: 01 00 00 00 nop tvp->gval = *tvp->ptr; 4000d58c: c4 00 60 04 ld [ %g1 + 4 ], %g2 *tvp->ptr = tvp->tval; 4000d590: c6 00 60 0c ld [ %g1 + 0xc ], %g3 tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { tvp->gval = *tvp->ptr; 4000d594: c8 00 80 00 ld [ %g2 ], %g4 4000d598: c8 20 60 08 st %g4, [ %g1 + 8 ] *tvp->ptr = tvp->tval; tvp = (rtems_task_variable_t *)tvp->next; 4000d59c: c2 00 40 00 ld [ %g1 ], %g1 *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { 4000d5a0: 80 a0 60 00 cmp %g1, 0 4000d5a4: 12 bf ff fa bne 4000d58c <_RTEMS_tasks_Switch_extension+0x40><== NEVER TAKEN 4000d5a8: c6 20 80 00 st %g3, [ %g2 ] 4000d5ac: 81 c3 e0 08 retl =============================================================================== 40008834 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 40008834: 9d e3 bf 98 save %sp, -104, %sp 40008838: 11 10 00 86 sethi %hi(0x40021800), %o0 4000883c: 92 10 00 18 mov %i0, %o1 40008840: 90 12 23 9c or %o0, 0x39c, %o0 40008844: 40 00 08 64 call 4000a9d4 <_Objects_Get> 40008848: 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 ) { 4000884c: c2 07 bf fc ld [ %fp + -4 ], %g1 40008850: 80 a0 60 00 cmp %g1, 0 40008854: 12 80 00 16 bne 400088ac <_Rate_monotonic_Timeout+0x78> <== NEVER TAKEN 40008858: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: the_thread = the_period->owner; 4000885c: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 40008860: 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); 40008864: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 40008868: 80 88 80 01 btst %g2, %g1 4000886c: 22 80 00 08 be,a 4000888c <_Rate_monotonic_Timeout+0x58> 40008870: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 40008874: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 40008878: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000887c: 80 a0 80 01 cmp %g2, %g1 40008880: 02 80 00 19 be 400088e4 <_Rate_monotonic_Timeout+0xb0> 40008884: 13 04 00 ff sethi %hi(0x1003fc00), %o1 _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { 40008888: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 4000888c: 80 a0 60 01 cmp %g1, 1 40008890: 02 80 00 09 be 400088b4 <_Rate_monotonic_Timeout+0x80> 40008894: 82 10 20 04 mov 4, %g1 _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 40008898: 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; 4000889c: 03 10 00 87 sethi %hi(0x40021c00), %g1 400088a0: c4 00 61 00 ld [ %g1 + 0x100 ], %g2 ! 40021d00 <_Thread_Dispatch_disable_level> 400088a4: 84 00 bf ff add %g2, -1, %g2 400088a8: c4 20 61 00 st %g2, [ %g1 + 0x100 ] 400088ac: 81 c7 e0 08 ret 400088b0: 81 e8 00 00 restore _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 400088b4: 82 10 20 03 mov 3, %g1 _Rate_monotonic_Initiate_statistics( the_period ); 400088b8: 90 10 00 10 mov %l0, %o0 _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 400088bc: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 400088c0: 7f ff fe 4c call 400081f0 <_Rate_monotonic_Initiate_statistics> 400088c4: 01 00 00 00 nop Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400088c8: c2 04 20 3c ld [ %l0 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400088cc: 11 10 00 87 sethi %hi(0x40021c00), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400088d0: c2 24 20 1c st %g1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400088d4: 90 12 21 e0 or %o0, 0x1e0, %o0 400088d8: 40 00 0f f8 call 4000c8b8 <_Watchdog_Insert> 400088dc: 92 04 20 10 add %l0, 0x10, %o1 400088e0: 30 bf ff ef b,a 4000889c <_Rate_monotonic_Timeout+0x68> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 400088e4: 40 00 0a 9f call 4000b360 <_Thread_Clear_state> 400088e8: 92 12 63 f8 or %o1, 0x3f8, %o1 the_thread = the_period->owner; if ( _States_Is_waiting_for_period( the_thread->current_state ) && the_thread->Wait.id == the_period->Object.id ) { _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); 400088ec: 10 bf ff f5 b 400088c0 <_Rate_monotonic_Timeout+0x8c> 400088f0: 90 10 00 10 mov %l0, %o0 =============================================================================== 4000decc <_Scheduler_priority_Block>: void _Scheduler_priority_Block( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { 4000decc: 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; 4000ded0: c2 06 60 8c ld [ %i1 + 0x8c ], %g1 4000ded4: c2 00 40 00 ld [ %g1 ], %g1 if ( _Chain_Has_only_one_node( ready ) ) { 4000ded8: c6 00 40 00 ld [ %g1 ], %g3 4000dedc: c4 00 60 08 ld [ %g1 + 8 ], %g2 4000dee0: 80 a0 c0 02 cmp %g3, %g2 4000dee4: 22 80 00 39 be,a 4000dfc8 <_Scheduler_priority_Block+0xfc> 4000dee8: c0 20 60 04 clr [ %g1 + 4 ] ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4000deec: c4 06 40 00 ld [ %i1 ], %g2 previous = the_node->previous; 4000def0: c2 06 60 04 ld [ %i1 + 4 ], %g1 next->previous = previous; 4000def4: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000def8: c4 20 40 00 st %g2, [ %g1 ] RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); 4000defc: 03 10 00 5e sethi %hi(0x40017800), %g1 4000df00: 82 10 63 78 or %g1, 0x378, %g1 ! 40017b78 <_Per_CPU_Information> { _Scheduler_priority_Ready_queue_extract(the_thread); /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) 4000df04: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000df08: 80 a6 40 02 cmp %i1, %g2 4000df0c: 02 80 00 09 be 4000df30 <_Scheduler_priority_Block+0x64> 4000df10: 05 10 00 5e sethi %hi(0x40017800), %g2 _Scheduler_priority_Schedule_body(the_scheduler); if ( _Thread_Is_executing( the_thread ) ) 4000df14: c4 00 60 0c ld [ %g1 + 0xc ], %g2 4000df18: 80 a6 40 02 cmp %i1, %g2 4000df1c: 12 80 00 03 bne 4000df28 <_Scheduler_priority_Block+0x5c> 4000df20: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 4000df24: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 4000df28: 81 c7 e0 08 ret 4000df2c: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4000df30: c4 10 a3 a0 lduh [ %g2 + 0x3a0 ], %g2 4000df34: 85 28 a0 10 sll %g2, 0x10, %g2 4000df38: 89 30 a0 10 srl %g2, 0x10, %g4 4000df3c: 80 a1 20 ff cmp %g4, 0xff 4000df40: 18 80 00 38 bgu 4000e020 <_Scheduler_priority_Block+0x154> 4000df44: c6 06 00 00 ld [ %i0 ], %g3 4000df48: 1b 10 00 58 sethi %hi(0x40016000), %o5 4000df4c: 9a 13 60 60 or %o5, 0x60, %o5 ! 40016060 <__log2table> 4000df50: c4 0b 40 04 ldub [ %o5 + %g4 ], %g2 4000df54: 84 00 a0 08 add %g2, 8, %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4000df58: 85 28 a0 10 sll %g2, 0x10, %g2 4000df5c: 19 10 00 5e sethi %hi(0x40017800), %o4 4000df60: 89 30 a0 0f srl %g2, 0xf, %g4 4000df64: 98 13 23 b0 or %o4, 0x3b0, %o4 4000df68: c8 13 00 04 lduh [ %o4 + %g4 ], %g4 4000df6c: 89 29 20 10 sll %g4, 0x10, %g4 4000df70: 99 31 20 10 srl %g4, 0x10, %o4 4000df74: 80 a3 20 ff cmp %o4, 0xff 4000df78: 38 80 00 28 bgu,a 4000e018 <_Scheduler_priority_Block+0x14c> 4000df7c: 89 31 20 18 srl %g4, 0x18, %g4 4000df80: c8 0b 40 0c ldub [ %o5 + %o4 ], %g4 4000df84: 88 01 20 08 add %g4, 8, %g4 return (_Priority_Bits_index( major ) << 4) + 4000df88: 85 30 a0 0c srl %g2, 0xc, %g2 _Priority_Bits_index( minor ); 4000df8c: 89 29 20 10 sll %g4, 0x10, %g4 4000df90: 89 31 20 10 srl %g4, 0x10, %g4 Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); return (_Priority_Bits_index( major ) << 4) + 4000df94: 88 01 00 02 add %g4, %g2, %g4 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 4000df98: 9b 29 20 02 sll %g4, 2, %o5 4000df9c: 85 29 20 04 sll %g4, 4, %g2 4000dfa0: 84 20 80 0d sub %g2, %o5, %g2 _Scheduler_priority_Block_body(the_scheduler, the_thread); } 4000dfa4: da 00 c0 02 ld [ %g3 + %g2 ], %o5 4000dfa8: 84 00 c0 02 add %g3, %g2, %g2 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000dfac: 84 00 a0 04 add %g2, 4, %g2 4000dfb0: 80 a3 40 02 cmp %o5, %g2 4000dfb4: 02 80 00 03 be 4000dfc0 <_Scheduler_priority_Block+0xf4> <== NEVER TAKEN 4000dfb8: 88 10 20 00 clr %g4 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 4000dfbc: 88 10 00 0d mov %o5, %g4 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 4000dfc0: 10 bf ff d5 b 4000df14 <_Scheduler_priority_Block+0x48> 4000dfc4: c8 20 60 10 st %g4, [ %g1 + 0x10 ] Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; tail->previous = head; 4000dfc8: c2 20 60 08 st %g1, [ %g1 + 8 ] RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 4000dfcc: 84 00 60 04 add %g1, 4, %g2 head->next = tail; 4000dfd0: c4 20 40 00 st %g2, [ %g1 ] { Chain_Control *ready = the_thread->scheduler.priority->ready_chain; if ( _Chain_Has_only_one_node( ready ) ) { _Chain_Initialize_empty( ready ); _Priority_bit_map_Remove( &the_thread->scheduler.priority->Priority_map ); 4000dfd4: 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; 4000dfd8: c6 00 60 04 ld [ %g1 + 4 ], %g3 4000dfdc: c4 10 60 0e lduh [ %g1 + 0xe ], %g2 4000dfe0: c8 10 c0 00 lduh [ %g3 ], %g4 4000dfe4: 84 09 00 02 and %g4, %g2, %g2 4000dfe8: c4 30 c0 00 sth %g2, [ %g3 ] if ( *the_priority_map->minor == 0 ) 4000dfec: 85 28 a0 10 sll %g2, 0x10, %g2 4000dff0: 80 a0 a0 00 cmp %g2, 0 4000dff4: 32 bf ff c3 bne,a 4000df00 <_Scheduler_priority_Block+0x34> 4000dff8: 03 10 00 5e sethi %hi(0x40017800), %g1 _Priority_Major_bit_map &= the_priority_map->block_major; 4000dffc: 05 10 00 5e sethi %hi(0x40017800), %g2 4000e000: c2 10 60 0c lduh [ %g1 + 0xc ], %g1 4000e004: c6 10 a3 a0 lduh [ %g2 + 0x3a0 ], %g3 4000e008: 82 08 c0 01 and %g3, %g1, %g1 4000e00c: c2 30 a3 a0 sth %g1, [ %g2 + 0x3a0 ] 4000e010: 10 bf ff bc b 4000df00 <_Scheduler_priority_Block+0x34> 4000e014: 03 10 00 5e sethi %hi(0x40017800), %g1 { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 4000e018: 10 bf ff dc b 4000df88 <_Scheduler_priority_Block+0xbc> 4000e01c: c8 0b 40 04 ldub [ %o5 + %g4 ], %g4 RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4000e020: 1b 10 00 58 sethi %hi(0x40016000), %o5 4000e024: 85 30 a0 18 srl %g2, 0x18, %g2 4000e028: 9a 13 60 60 or %o5, 0x60, %o5 4000e02c: 10 bf ff cb b 4000df58 <_Scheduler_priority_Block+0x8c> 4000e030: c4 0b 40 02 ldub [ %o5 + %g2 ], %g2 =============================================================================== 400090cc <_Scheduler_priority_Schedule>: */ void _Scheduler_priority_Schedule( Scheduler_Control *the_scheduler ) { 400090cc: 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 ); 400090d0: 03 10 00 5e sethi %hi(0x40017800), %g1 400090d4: c2 10 63 a0 lduh [ %g1 + 0x3a0 ], %g1 ! 40017ba0 <_Priority_Major_bit_map> 400090d8: 83 28 60 10 sll %g1, 0x10, %g1 400090dc: 87 30 60 10 srl %g1, 0x10, %g3 400090e0: 80 a0 e0 ff cmp %g3, 0xff 400090e4: 18 80 00 26 bgu 4000917c <_Scheduler_priority_Schedule+0xb0> 400090e8: c4 06 00 00 ld [ %i0 ], %g2 400090ec: 09 10 00 58 sethi %hi(0x40016000), %g4 400090f0: 88 11 20 60 or %g4, 0x60, %g4 ! 40016060 <__log2table> 400090f4: c2 09 00 03 ldub [ %g4 + %g3 ], %g1 400090f8: 82 00 60 08 add %g1, 8, %g1 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 400090fc: 83 28 60 10 sll %g1, 0x10, %g1 40009100: 1b 10 00 5e sethi %hi(0x40017800), %o5 40009104: 87 30 60 0f srl %g1, 0xf, %g3 40009108: 9a 13 63 b0 or %o5, 0x3b0, %o5 4000910c: c6 13 40 03 lduh [ %o5 + %g3 ], %g3 40009110: 87 28 e0 10 sll %g3, 0x10, %g3 40009114: 9b 30 e0 10 srl %g3, 0x10, %o5 40009118: 80 a3 60 ff cmp %o5, 0xff 4000911c: 38 80 00 16 bgu,a 40009174 <_Scheduler_priority_Schedule+0xa8> 40009120: 87 30 e0 18 srl %g3, 0x18, %g3 40009124: c6 09 00 0d ldub [ %g4 + %o5 ], %g3 40009128: 86 00 e0 08 add %g3, 8, %g3 return (_Priority_Bits_index( major ) << 4) + 4000912c: 83 30 60 0c srl %g1, 0xc, %g1 _Priority_Bits_index( minor ); 40009130: 87 28 e0 10 sll %g3, 0x10, %g3 40009134: 87 30 e0 10 srl %g3, 0x10, %g3 Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); return (_Priority_Bits_index( major ) << 4) + 40009138: 86 00 c0 01 add %g3, %g1, %g3 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 4000913c: 89 28 e0 02 sll %g3, 2, %g4 40009140: 83 28 e0 04 sll %g3, 4, %g1 40009144: 82 20 40 04 sub %g1, %g4, %g1 _Scheduler_priority_Schedule_body( the_scheduler ); } 40009148: c8 00 80 01 ld [ %g2 + %g1 ], %g4 4000914c: 82 00 80 01 add %g2, %g1, %g1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40009150: 82 00 60 04 add %g1, 4, %g1 40009154: 80 a1 00 01 cmp %g4, %g1 40009158: 02 80 00 03 be 40009164 <_Scheduler_priority_Schedule+0x98><== NEVER TAKEN 4000915c: 86 10 20 00 clr %g3 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 40009160: 86 10 00 04 mov %g4, %g3 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 40009164: 03 10 00 5e sethi %hi(0x40017800), %g1 40009168: c6 20 63 88 st %g3, [ %g1 + 0x388 ] ! 40017b88 <_Per_CPU_Information+0x10> 4000916c: 81 c7 e0 08 ret 40009170: 81 e8 00 00 restore { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 40009174: 10 bf ff ee b 4000912c <_Scheduler_priority_Schedule+0x60> 40009178: c6 09 00 03 ldub [ %g4 + %g3 ], %g3 RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 4000917c: 09 10 00 58 sethi %hi(0x40016000), %g4 40009180: 83 30 60 18 srl %g1, 0x18, %g1 40009184: 88 11 20 60 or %g4, 0x60, %g4 40009188: 10 bf ff dd b 400090fc <_Scheduler_priority_Schedule+0x30> 4000918c: c2 09 00 01 ldub [ %g4 + %g1 ], %g1 =============================================================================== 400081bc <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 400081bc: 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(); 400081c0: 03 10 00 86 sethi %hi(0x40021800), %g1 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 400081c4: 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(); 400081c8: d2 00 62 14 ld [ %g1 + 0x214 ], %o1 if ((!the_tod) || 400081cc: 80 a4 20 00 cmp %l0, 0 400081d0: 02 80 00 2c be 40008280 <_TOD_Validate+0xc4> <== NEVER TAKEN 400081d4: b0 10 20 00 clr %i0 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 400081d8: 11 00 03 d0 sethi %hi(0xf4000), %o0 400081dc: 40 00 4e 65 call 4001bb70 <.udiv> 400081e0: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 400081e4: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 400081e8: 80 a2 00 01 cmp %o0, %g1 400081ec: 08 80 00 25 bleu 40008280 <_TOD_Validate+0xc4> 400081f0: 01 00 00 00 nop (the_tod->ticks >= ticks_per_second) || 400081f4: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 400081f8: 80 a0 60 3b cmp %g1, 0x3b 400081fc: 18 80 00 21 bgu 40008280 <_TOD_Validate+0xc4> 40008200: 01 00 00 00 nop (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 40008204: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 40008208: 80 a0 60 3b cmp %g1, 0x3b 4000820c: 18 80 00 1d bgu 40008280 <_TOD_Validate+0xc4> 40008210: 01 00 00 00 nop (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 40008214: c2 04 20 0c ld [ %l0 + 0xc ], %g1 40008218: 80 a0 60 17 cmp %g1, 0x17 4000821c: 18 80 00 19 bgu 40008280 <_TOD_Validate+0xc4> 40008220: 01 00 00 00 nop (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 40008224: 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) || 40008228: 80 a0 60 00 cmp %g1, 0 4000822c: 02 80 00 15 be 40008280 <_TOD_Validate+0xc4> <== NEVER TAKEN 40008230: 80 a0 60 0c cmp %g1, 0xc (the_tod->month == 0) || 40008234: 18 80 00 13 bgu 40008280 <_TOD_Validate+0xc4> 40008238: 01 00 00 00 nop (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 4000823c: c4 04 00 00 ld [ %l0 ], %g2 (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || 40008240: 80 a0 a7 c3 cmp %g2, 0x7c3 40008244: 08 80 00 0f bleu 40008280 <_TOD_Validate+0xc4> 40008248: 01 00 00 00 nop (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 4000824c: c6 04 20 08 ld [ %l0 + 8 ], %g3 (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 40008250: 80 a0 e0 00 cmp %g3, 0 40008254: 02 80 00 0b be 40008280 <_TOD_Validate+0xc4> <== NEVER TAKEN 40008258: 80 88 a0 03 btst 3, %g2 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 4000825c: 32 80 00 0b bne,a 40008288 <_TOD_Validate+0xcc> 40008260: 83 28 60 02 sll %g1, 2, %g1 days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 40008264: 82 00 60 0d add %g1, 0xd, %g1 40008268: 05 10 00 81 sethi %hi(0x40020400), %g2 4000826c: 83 28 60 02 sll %g1, 2, %g1 40008270: 84 10 a1 60 or %g2, 0x160, %g2 40008274: c2 00 80 01 ld [ %g2 + %g1 ], %g1 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 40008278: 80 a0 40 03 cmp %g1, %g3 4000827c: b0 60 3f ff subx %g0, -1, %i0 if ( the_tod->day > days_in_month ) return false; return true; } 40008280: 81 c7 e0 08 ret 40008284: 81 e8 00 00 restore return false; if ( (the_tod->year % 4) == 0 ) days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 40008288: 05 10 00 81 sethi %hi(0x40020400), %g2 4000828c: 84 10 a1 60 or %g2, 0x160, %g2 ! 40020560 <_TOD_Days_per_month> 40008290: c2 00 80 01 ld [ %g2 + %g1 ], %g1 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 40008294: 80 a0 40 03 cmp %g1, %g3 40008298: b0 60 3f ff subx %g0, -1, %i0 4000829c: 81 c7 e0 08 ret 400082a0: 81 e8 00 00 restore =============================================================================== 400093d8 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 400093d8: 9d e3 bf a0 save %sp, -96, %sp */ /* * Save original state */ original_state = the_thread->current_state; 400093dc: 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 ); 400093e0: 40 00 03 ad call 4000a294 <_Thread_Set_transient> 400093e4: 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 ) 400093e8: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 400093ec: 80 a0 40 19 cmp %g1, %i1 400093f0: 02 80 00 05 be 40009404 <_Thread_Change_priority+0x2c> 400093f4: a0 10 00 18 mov %i0, %l0 _Thread_Set_priority( the_thread, new_priority ); 400093f8: 90 10 00 18 mov %i0, %o0 400093fc: 40 00 03 89 call 4000a220 <_Thread_Set_priority> 40009400: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 40009404: 7f ff e2 82 call 40001e0c 40009408: 01 00 00 00 nop 4000940c: 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; 40009410: e4 04 20 10 ld [ %l0 + 0x10 ], %l2 if ( state != STATES_TRANSIENT ) { 40009414: 80 a4 a0 04 cmp %l2, 4 40009418: 02 80 00 18 be 40009478 <_Thread_Change_priority+0xa0> 4000941c: 80 8c 60 04 btst 4, %l1 /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 40009420: 02 80 00 0b be 4000944c <_Thread_Change_priority+0x74> <== ALWAYS TAKEN 40009424: 82 0c bf fb and %l2, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); _ISR_Enable( level ); 40009428: 7f ff e2 7d call 40001e1c <== NOT EXECUTED 4000942c: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 40009430: 03 00 00 ef sethi %hi(0x3bc00), %g1 <== NOT EXECUTED 40009434: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 <== NOT EXECUTED if ( _States_Is_waiting_on_thread_queue( state ) ) { 40009438: 80 8c 80 01 btst %l2, %g1 <== NOT EXECUTED 4000943c: 32 80 00 0d bne,a 40009470 <_Thread_Change_priority+0x98><== NOT EXECUTED 40009440: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 <== NOT EXECUTED 40009444: 81 c7 e0 08 ret 40009448: 81 e8 00 00 restore */ state = the_thread->current_state; if ( state != STATES_TRANSIENT ) { /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 4000944c: c2 24 20 10 st %g1, [ %l0 + 0x10 ] _ISR_Enable( level ); 40009450: 7f ff e2 73 call 40001e1c 40009454: 90 10 00 18 mov %i0, %o0 40009458: 03 00 00 ef sethi %hi(0x3bc00), %g1 4000945c: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 40009460: 80 8c 80 01 btst %l2, %g1 40009464: 02 bf ff f8 be 40009444 <_Thread_Change_priority+0x6c> 40009468: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 4000946c: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 40009470: 40 00 03 3c call 4000a160 <_Thread_queue_Requeue> 40009474: 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 ) ) { 40009478: 12 80 00 15 bne 400094cc <_Thread_Change_priority+0xf4> <== NEVER TAKEN 4000947c: 80 8e a0 ff btst 0xff, %i2 * FIXME: hard-coded for priority scheduling. Might be ok since this * function is specific to priority scheduling? */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); if ( prepend_it ) 40009480: 02 80 00 2a be 40009528 <_Thread_Change_priority+0x150> 40009484: c0 24 20 10 clr [ %l0 + 0x10 ] RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_enqueue_first( Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); 40009488: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 4000948c: 07 10 00 5e sethi %hi(0x40017800), %g3 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 40009490: c8 00 60 04 ld [ %g1 + 4 ], %g4 40009494: da 10 60 0a lduh [ %g1 + 0xa ], %o5 40009498: d8 11 00 00 lduh [ %g4 ], %o4 _Chain_Prepend_unprotected( the_thread->scheduler.priority->ready_chain, 4000949c: c4 00 40 00 ld [ %g1 ], %g2 400094a0: 9a 13 00 0d or %o4, %o5, %o5 400094a4: da 31 00 00 sth %o5, [ %g4 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 400094a8: c8 10 60 08 lduh [ %g1 + 8 ], %g4 400094ac: da 10 e3 a0 lduh [ %g3 + 0x3a0 ], %o5 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 400094b0: c2 00 80 00 ld [ %g2 ], %g1 400094b4: 88 13 40 04 or %o5, %g4, %g4 400094b8: c8 30 e3 a0 sth %g4, [ %g3 + 0x3a0 ] Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 400094bc: c4 24 20 04 st %g2, [ %l0 + 4 ] before_node = after_node->next; after_node->next = the_node; 400094c0: e0 20 80 00 st %l0, [ %g2 ] the_node->next = before_node; 400094c4: c2 24 00 00 st %g1, [ %l0 ] before_node->previous = the_node; 400094c8: e0 20 60 04 st %l0, [ %g1 + 4 ] _Scheduler_priority_Ready_queue_enqueue_first( the_thread ); else _Scheduler_priority_Ready_queue_enqueue( the_thread ); } _ISR_Flash( level ); 400094cc: 7f ff e2 54 call 40001e1c 400094d0: 90 10 00 18 mov %i0, %o0 400094d4: 7f ff e2 4e call 40001e0c 400094d8: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( Scheduler_Control *the_scheduler ) { the_scheduler->Operations.schedule( the_scheduler ); 400094dc: 11 10 00 5d sethi %hi(0x40017400), %o0 400094e0: 90 12 22 a4 or %o0, 0x2a4, %o0 ! 400176a4 <_Scheduler> 400094e4: c2 02 20 04 ld [ %o0 + 4 ], %g1 400094e8: 9f c0 40 00 call %g1 400094ec: 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 ); 400094f0: 03 10 00 5e sethi %hi(0x40017800), %g1 400094f4: 82 10 63 78 or %g1, 0x378, %g1 ! 40017b78 <_Per_CPU_Information> 400094f8: 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() && 400094fc: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 40009500: 80 a0 80 03 cmp %g2, %g3 40009504: 02 80 00 07 be 40009520 <_Thread_Change_priority+0x148> 40009508: 01 00 00 00 nop 4000950c: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 40009510: 80 a0 a0 00 cmp %g2, 0 40009514: 02 80 00 03 be 40009520 <_Thread_Change_priority+0x148> 40009518: 84 10 20 01 mov 1, %g2 _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 4000951c: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] _ISR_Enable( level ); 40009520: 7f ff e2 3f call 40001e1c 40009524: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_enqueue( Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); 40009528: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 4000952c: 07 10 00 5e sethi %hi(0x40017800), %g3 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 40009530: c8 00 60 04 ld [ %g1 + 4 ], %g4 40009534: da 10 60 0a lduh [ %g1 + 0xa ], %o5 40009538: d8 11 00 00 lduh [ %g4 ], %o4 _Chain_Append_unprotected( the_thread->scheduler.priority->ready_chain, 4000953c: c4 00 40 00 ld [ %g1 ], %g2 40009540: 9a 13 00 0d or %o4, %o5, %o5 40009544: da 31 00 00 sth %o5, [ %g4 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 40009548: c8 10 60 08 lduh [ %g1 + 8 ], %g4 4000954c: da 10 e3 a0 lduh [ %g3 + 0x3a0 ], %o5 Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 40009550: c2 00 a0 08 ld [ %g2 + 8 ], %g1 40009554: 88 13 40 04 or %o5, %g4, %g4 40009558: c8 30 e3 a0 sth %g4, [ %g3 + 0x3a0 ] the_node->next = tail; tail->previous = the_node; 4000955c: e0 20 a0 08 st %l0, [ %g2 + 8 ] RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 40009560: 86 00 a0 04 add %g2, 4, %g3 Chain_Node *old_last = tail->previous; the_node->next = tail; 40009564: c6 24 00 00 st %g3, [ %l0 ] tail->previous = the_node; old_last->next = the_node; 40009568: e0 20 40 00 st %l0, [ %g1 ] the_node->previous = old_last; 4000956c: 10 bf ff d8 b 400094cc <_Thread_Change_priority+0xf4> 40009570: c2 24 20 04 st %g1, [ %l0 + 4 ] =============================================================================== 40009750 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 40009750: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009754: 90 10 00 18 mov %i0, %o0 40009758: 40 00 00 6c call 40009908 <_Thread_Get> 4000975c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009760: c2 07 bf fc ld [ %fp + -4 ], %g1 40009764: 80 a0 60 00 cmp %g1, 0 40009768: 12 80 00 08 bne 40009788 <_Thread_Delay_ended+0x38> <== NEVER TAKEN 4000976c: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 40009770: 7f ff ff 81 call 40009574 <_Thread_Clear_state> 40009774: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 40009778: 03 10 00 5d sethi %hi(0x40017400), %g1 4000977c: c4 00 62 20 ld [ %g1 + 0x220 ], %g2 ! 40017620 <_Thread_Dispatch_disable_level> 40009780: 84 00 bf ff add %g2, -1, %g2 40009784: c4 20 62 20 st %g2, [ %g1 + 0x220 ] 40009788: 81 c7 e0 08 ret 4000978c: 81 e8 00 00 restore =============================================================================== 40009790 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 40009790: 9d e3 bf 90 save %sp, -112, %sp Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 40009794: 25 10 00 5e sethi %hi(0x40017800), %l2 40009798: a4 14 a3 78 or %l2, 0x378, %l2 ! 40017b78 <_Per_CPU_Information> _ISR_Disable( level ); 4000979c: 7f ff e1 9c call 40001e0c 400097a0: e2 04 a0 0c ld [ %l2 + 0xc ], %l1 while ( _Thread_Dispatch_necessary == true ) { 400097a4: c2 0c a0 18 ldub [ %l2 + 0x18 ], %g1 400097a8: 80 a0 60 00 cmp %g1, 0 400097ac: 02 80 00 42 be 400098b4 <_Thread_Dispatch+0x124> 400097b0: 2d 10 00 5d sethi %hi(0x40017400), %l6 heir = _Thread_Heir; 400097b4: e0 04 a0 10 ld [ %l2 + 0x10 ], %l0 _Thread_Dispatch_disable_level = 1; 400097b8: 82 10 20 01 mov 1, %g1 400097bc: c2 25 a2 20 st %g1, [ %l6 + 0x220 ] _Thread_Dispatch_necessary = false; 400097c0: c0 2c a0 18 clrb [ %l2 + 0x18 ] /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) 400097c4: 80 a4 40 10 cmp %l1, %l0 400097c8: 02 80 00 3b be 400098b4 <_Thread_Dispatch+0x124> 400097cc: e0 24 a0 0c st %l0, [ %l2 + 0xc ] 400097d0: 27 10 00 5d sethi %hi(0x40017400), %l3 400097d4: 3b 10 00 5d sethi %hi(0x40017400), %i5 400097d8: a6 14 e2 ec or %l3, 0x2ec, %l3 400097dc: aa 07 bf f8 add %fp, -8, %l5 400097e0: a8 07 bf f0 add %fp, -16, %l4 400097e4: ba 17 62 c4 or %i5, 0x2c4, %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; 400097e8: 37 10 00 5d sethi %hi(0x40017400), %i3 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 400097ec: ae 10 00 13 mov %l3, %l7 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 400097f0: 10 80 00 2b b 4000989c <_Thread_Dispatch+0x10c> 400097f4: b8 10 20 01 mov 1, %i4 rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) heir->cpu_time_budget = _Thread_Ticks_per_timeslice; _ISR_Enable( level ); 400097f8: 7f ff e1 89 call 40001e1c 400097fc: 01 00 00 00 nop #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 40009800: 40 00 10 9a call 4000da68 <_TOD_Get_uptime> 40009804: 90 10 00 15 mov %l5, %o0 _Timestamp_Subtract( 40009808: 90 10 00 17 mov %l7, %o0 4000980c: 92 10 00 15 mov %l5, %o1 40009810: 40 00 03 5e call 4000a588 <_Timespec_Subtract> 40009814: 94 10 00 14 mov %l4, %o2 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 40009818: 92 10 00 14 mov %l4, %o1 4000981c: 40 00 03 42 call 4000a524 <_Timespec_Add_to> 40009820: 90 04 60 84 add %l1, 0x84, %o0 _Thread_Time_of_last_context_switch = uptime; 40009824: c4 07 bf f8 ld [ %fp + -8 ], %g2 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 40009828: c2 07 40 00 ld [ %i5 ], %g1 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 4000982c: c4 24 c0 00 st %g2, [ %l3 ] 40009830: c4 07 bf fc ld [ %fp + -4 ], %g2 if ( _Thread_libc_reent ) { executing->libc_reent = *_Thread_libc_reent; *_Thread_libc_reent = heir->libc_reent; } _User_extensions_Thread_switch( executing, heir ); 40009834: 90 10 00 11 mov %l1, %o0 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 40009838: c4 24 e0 04 st %g2, [ %l3 + 4 ] #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 4000983c: 80 a0 60 00 cmp %g1, 0 40009840: 02 80 00 06 be 40009858 <_Thread_Dispatch+0xc8> <== NEVER TAKEN 40009844: 92 10 00 10 mov %l0, %o1 executing->libc_reent = *_Thread_libc_reent; 40009848: c4 00 40 00 ld [ %g1 ], %g2 4000984c: c4 24 61 50 st %g2, [ %l1 + 0x150 ] *_Thread_libc_reent = heir->libc_reent; 40009850: c4 04 21 50 ld [ %l0 + 0x150 ], %g2 40009854: c4 20 40 00 st %g2, [ %g1 ] } _User_extensions_Thread_switch( executing, heir ); 40009858: 40 00 04 10 call 4000a898 <_User_extensions_Thread_switch> 4000985c: 01 00 00 00 nop if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 40009860: 90 04 60 c8 add %l1, 0xc8, %o0 40009864: 40 00 05 25 call 4000acf8 <_CPU_Context_switch> 40009868: 92 04 20 c8 add %l0, 0xc8, %o1 #endif #endif executing = _Thread_Executing; _ISR_Disable( level ); 4000986c: 7f ff e1 68 call 40001e0c 40009870: e2 04 a0 0c ld [ %l2 + 0xc ], %l1 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 40009874: c2 0c a0 18 ldub [ %l2 + 0x18 ], %g1 40009878: 80 a0 60 00 cmp %g1, 0 4000987c: 02 80 00 0e be 400098b4 <_Thread_Dispatch+0x124> 40009880: 01 00 00 00 nop heir = _Thread_Heir; 40009884: e0 04 a0 10 ld [ %l2 + 0x10 ], %l0 _Thread_Dispatch_disable_level = 1; 40009888: f8 25 a2 20 st %i4, [ %l6 + 0x220 ] _Thread_Dispatch_necessary = false; 4000988c: c0 2c a0 18 clrb [ %l2 + 0x18 ] /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) 40009890: 80 a4 00 11 cmp %l0, %l1 40009894: 02 80 00 08 be 400098b4 <_Thread_Dispatch+0x124> <== NEVER TAKEN 40009898: e0 24 a0 0c st %l0, [ %l2 + 0xc ] */ #if __RTEMS_ADA__ executing->rtems_ada_self = rtems_ada_self; rtems_ada_self = heir->rtems_ada_self; #endif if ( heir->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE ) 4000989c: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 400098a0: 80 a0 60 01 cmp %g1, 1 400098a4: 12 bf ff d5 bne 400097f8 <_Thread_Dispatch+0x68> 400098a8: c2 06 e1 84 ld [ %i3 + 0x184 ], %g1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 400098ac: 10 bf ff d3 b 400097f8 <_Thread_Dispatch+0x68> 400098b0: c2 24 20 78 st %g1, [ %l0 + 0x78 ] _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 400098b4: c0 25 a2 20 clr [ %l6 + 0x220 ] _ISR_Enable( level ); 400098b8: 7f ff e1 59 call 40001e1c 400098bc: 01 00 00 00 nop _API_extensions_Run_postswitch(); 400098c0: 7f ff f8 76 call 40007a98 <_API_extensions_Run_postswitch> 400098c4: 01 00 00 00 nop } 400098c8: 81 c7 e0 08 ret 400098cc: 81 e8 00 00 restore =============================================================================== 4000fee8 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 4000fee8: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 4000feec: 03 10 00 5e sethi %hi(0x40017800), %g1 4000fef0: e0 00 63 84 ld [ %g1 + 0x384 ], %l0 ! 40017b84 <_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(); 4000fef4: 3f 10 00 3f sethi %hi(0x4000fc00), %i7 4000fef8: be 17 e2 e8 or %i7, 0x2e8, %i7 ! 4000fee8 <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4000fefc: d0 04 20 ac ld [ %l0 + 0xac ], %o0 _ISR_Set_level(level); 4000ff00: 7f ff c7 c7 call 40001e1c 4000ff04: 91 2a 20 08 sll %o0, 8, %o0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000ff08: 03 10 00 5c sethi %hi(0x40017000), %g1 doneConstructors = 1; 4000ff0c: 84 10 20 01 mov 1, %g2 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 4000ff10: e2 08 62 a8 ldub [ %g1 + 0x2a8 ], %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 ); 4000ff14: 90 10 00 10 mov %l0, %o0 4000ff18: 7f ff e9 e0 call 4000a698 <_User_extensions_Thread_begin> 4000ff1c: c4 28 62 a8 stb %g2, [ %g1 + 0x2a8 ] /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4000ff20: 7f ff e6 6c call 400098d0 <_Thread_Enable_dispatch> 4000ff24: 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) */ { 4000ff28: 80 a4 60 00 cmp %l1, 0 4000ff2c: 02 80 00 0f be 4000ff68 <_Thread_Handler+0x80> 4000ff30: 01 00 00 00 nop INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000ff34: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000ff38: 80 a0 60 00 cmp %g1, 0 4000ff3c: 22 80 00 12 be,a 4000ff84 <_Thread_Handler+0x9c> 4000ff40: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 (*(Thread_Entry_numeric) executing->Start.entry_point)( executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { 4000ff44: 80 a0 60 01 cmp %g1, 1 4000ff48: 22 80 00 13 be,a 4000ff94 <_Thread_Handler+0xac> <== ALWAYS TAKEN 4000ff4c: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 * was placed in return_argument. This assumed that if it returned * anything (which is not supporting in all APIs), then it would be * able to fit in a (void *). */ _User_extensions_Thread_exitted( executing ); 4000ff50: 7f ff e9 e6 call 4000a6e8 <_User_extensions_Thread_exitted> 4000ff54: 90 10 00 10 mov %l0, %o0 _Internal_error_Occurred( 4000ff58: 90 10 20 00 clr %o0 4000ff5c: 92 10 20 01 mov 1, %o1 4000ff60: 7f ff e1 a0 call 400085e0 <_Internal_error_Occurred> 4000ff64: 94 10 20 05 mov 5, %o2 * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { INIT_NAME (); 4000ff68: 40 00 1a b4 call 40016a38 <_init> 4000ff6c: 01 00 00 00 nop } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000ff70: c2 04 20 94 ld [ %l0 + 0x94 ], %g1 4000ff74: 80 a0 60 00 cmp %g1, 0 4000ff78: 12 bf ff f4 bne 4000ff48 <_Thread_Handler+0x60> 4000ff7c: 80 a0 60 01 cmp %g1, 1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4000ff80: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 4000ff84: 9f c0 40 00 call %g1 4000ff88: d0 04 20 9c ld [ %l0 + 0x9c ], %o0 INIT_NAME (); } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = 4000ff8c: 10 bf ff f1 b 4000ff50 <_Thread_Handler+0x68> 4000ff90: d0 24 20 28 st %o0, [ %l0 + 0x28 ] ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 4000ff94: 9f c0 40 00 call %g1 4000ff98: d0 04 20 98 ld [ %l0 + 0x98 ], %o0 executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = 4000ff9c: 10 bf ff ed b 4000ff50 <_Thread_Handler+0x68> 4000ffa0: d0 24 20 28 st %o0, [ %l0 + 0x28 ] =============================================================================== 400099a0 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 400099a0: 9d e3 bf a0 save %sp, -96, %sp 400099a4: 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; 400099a8: c0 26 61 54 clr [ %i1 + 0x154 ] 400099ac: c0 26 61 58 clr [ %i1 + 0x158 ] extensions_area = NULL; the_thread->libc_reent = NULL; 400099b0: 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 ) { 400099b4: e0 07 a0 60 ld [ %fp + 0x60 ], %l0 400099b8: e4 00 40 00 ld [ %g1 ], %l2 if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { 400099bc: 80 a6 a0 00 cmp %i2, 0 400099c0: 02 80 00 6c be 40009b70 <_Thread_Initialize+0x1d0> 400099c4: e2 0f a0 5f ldub [ %fp + 0x5f ], %l1 stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 400099c8: c0 2e 60 b4 clrb [ %i1 + 0xb4 ] 400099cc: 90 10 00 1b mov %i3, %o0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 400099d0: 27 10 00 5d sethi %hi(0x40017400), %l3 400099d4: c2 04 e2 d0 ld [ %l3 + 0x2d0 ], %g1 ! 400176d0 <_Thread_Maximum_extensions> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 400099d8: f4 26 60 bc st %i2, [ %i1 + 0xbc ] the_stack->size = size; 400099dc: d0 26 60 b8 st %o0, [ %i1 + 0xb8 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 400099e0: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 400099e4: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 400099e8: c0 26 60 68 clr [ %i1 + 0x68 ] 400099ec: 80 a0 60 00 cmp %g1, 0 400099f0: 12 80 00 4f bne 40009b2c <_Thread_Initialize+0x18c> 400099f4: c0 26 60 6c clr [ %i1 + 0x6c ] (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; 400099f8: c0 26 61 5c clr [ %i1 + 0x15c ] * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; 400099fc: b6 10 20 00 clr %i3 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 40009a00: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 40009a04: e2 2e 60 a0 stb %l1, [ %i1 + 0xa0 ] the_thread->Start.budget_algorithm = budget_algorithm; 40009a08: e0 26 60 a4 st %l0, [ %i1 + 0xa4 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 40009a0c: 80 a4 20 02 cmp %l0, 2 40009a10: 12 80 00 05 bne 40009a24 <_Thread_Initialize+0x84> 40009a14: 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; 40009a18: 03 10 00 5d sethi %hi(0x40017400), %g1 40009a1c: c2 00 61 84 ld [ %g1 + 0x184 ], %g1 ! 40017584 <_Thread_Ticks_per_timeslice> 40009a20: c2 26 60 78 st %g1, [ %i1 + 0x78 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 40009a24: c4 07 a0 68 ld [ %fp + 0x68 ], %g2 Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return the_scheduler->Operations.scheduler_allocate( the_scheduler, the_thread ); 40009a28: 11 10 00 5d sethi %hi(0x40017400), %o0 40009a2c: 90 12 22 a4 or %o0, 0x2a4, %o0 ! 400176a4 <_Scheduler> RTEMS_INLINE_ROUTINE void* _Scheduler_Thread_scheduler_allocate( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { return 40009a30: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 40009a34: c4 26 60 ac st %g2, [ %i1 + 0xac ] the_thread->current_state = STATES_DORMANT; 40009a38: 84 10 20 01 mov 1, %g2 the_thread->Wait.queue = NULL; 40009a3c: c0 26 60 44 clr [ %i1 + 0x44 ] #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; 40009a40: c4 26 60 10 st %g2, [ %i1 + 0x10 ] the_thread->Wait.queue = NULL; the_thread->resource_count = 0; 40009a44: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 40009a48: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; 40009a4c: fa 26 60 b0 st %i5, [ %i1 + 0xb0 ] 40009a50: 9f c0 40 00 call %g1 40009a54: 92 10 00 19 mov %i1, %o1 sched =_Scheduler_Thread_scheduler_allocate( &_Scheduler, the_thread ); if ( !sched ) 40009a58: a0 92 20 00 orcc %o0, 0, %l0 40009a5c: 02 80 00 11 be 40009aa0 <_Thread_Initialize+0x100> 40009a60: 90 10 00 19 mov %i1, %o0 goto failed; _Thread_Set_priority( the_thread, priority ); 40009a64: 40 00 01 ef call 4000a220 <_Thread_Set_priority> 40009a68: 92 10 00 1d mov %i5, %o1 _Thread_Stack_Free( the_thread ); return false; } 40009a6c: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40009a70: 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 ); 40009a74: c0 26 60 84 clr [ %i1 + 0x84 ] 40009a78: c0 26 60 88 clr [ %i1 + 0x88 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40009a7c: 83 28 60 02 sll %g1, 2, %g1 40009a80: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40009a84: e4 26 60 0c st %l2, [ %i1 + 0xc ] * enabled when we get here. We want to be able to run the * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); 40009a88: 90 10 00 19 mov %i1, %o0 40009a8c: 40 00 03 3e call 4000a784 <_User_extensions_Thread_create> 40009a90: b0 10 20 01 mov 1, %i0 if ( extension_status ) 40009a94: 80 8a 20 ff btst 0xff, %o0 40009a98: 12 80 00 23 bne 40009b24 <_Thread_Initialize+0x184> 40009a9c: 01 00 00 00 nop return true; failed: if ( the_thread->libc_reent ) 40009aa0: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 40009aa4: 80 a2 20 00 cmp %o0, 0 40009aa8: 22 80 00 05 be,a 40009abc <_Thread_Initialize+0x11c> 40009aac: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 _Workspace_Free( the_thread->libc_reent ); 40009ab0: 40 00 04 7c call 4000aca0 <_Workspace_Free> 40009ab4: 01 00 00 00 nop for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 40009ab8: d0 06 61 54 ld [ %i1 + 0x154 ], %o0 40009abc: 80 a2 20 00 cmp %o0, 0 40009ac0: 22 80 00 05 be,a 40009ad4 <_Thread_Initialize+0x134> 40009ac4: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 _Workspace_Free( the_thread->API_Extensions[i] ); 40009ac8: 40 00 04 76 call 4000aca0 <_Workspace_Free> 40009acc: 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] ) 40009ad0: d0 06 61 58 ld [ %i1 + 0x158 ], %o0 40009ad4: 80 a2 20 00 cmp %o0, 0 40009ad8: 02 80 00 05 be 40009aec <_Thread_Initialize+0x14c> 40009adc: 80 a6 e0 00 cmp %i3, 0 _Workspace_Free( the_thread->API_Extensions[i] ); 40009ae0: 40 00 04 70 call 4000aca0 <_Workspace_Free> 40009ae4: 01 00 00 00 nop if ( extensions_area ) 40009ae8: 80 a6 e0 00 cmp %i3, 0 40009aec: 02 80 00 05 be 40009b00 <_Thread_Initialize+0x160> 40009af0: 80 a4 20 00 cmp %l0, 0 (void) _Workspace_Free( extensions_area ); 40009af4: 40 00 04 6b call 4000aca0 <_Workspace_Free> 40009af8: 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 ) 40009afc: 80 a4 20 00 cmp %l0, 0 40009b00: 02 80 00 05 be 40009b14 <_Thread_Initialize+0x174> 40009b04: 90 10 00 19 mov %i1, %o0 (void) _Workspace_Free( sched ); 40009b08: 40 00 04 66 call 4000aca0 <_Workspace_Free> 40009b0c: 90 10 00 10 mov %l0, %o0 _Thread_Stack_Free( the_thread ); 40009b10: 90 10 00 19 mov %i1, %o0 40009b14: 40 00 02 22 call 4000a39c <_Thread_Stack_Free> 40009b18: b0 10 20 00 clr %i0 return false; 40009b1c: 81 c7 e0 08 ret 40009b20: 81 e8 00 00 restore 40009b24: 81 c7 e0 08 ret 40009b28: 81 e8 00 00 restore /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { extensions_area = _Workspace_Allocate( 40009b2c: 82 00 60 01 inc %g1 40009b30: 40 00 04 53 call 4000ac7c <_Workspace_Allocate> 40009b34: 91 28 60 02 sll %g1, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 40009b38: b6 92 20 00 orcc %o0, 0, %i3 40009b3c: 02 80 00 1a be 40009ba4 <_Thread_Initialize+0x204> 40009b40: c6 04 e2 d0 ld [ %l3 + 0x2d0 ], %g3 goto failed; } the_thread->extensions = (void **) extensions_area; 40009b44: f6 26 61 5c st %i3, [ %i1 + 0x15c ] * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 40009b48: 84 10 20 00 clr %g2 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; 40009b4c: 82 10 20 00 clr %g1 * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) the_thread->extensions[i] = NULL; 40009b50: 85 28 a0 02 sll %g2, 2, %g2 40009b54: c0 26 c0 02 clr [ %i3 + %g2 ] * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 40009b58: 82 00 60 01 inc %g1 40009b5c: 80 a0 40 03 cmp %g1, %g3 40009b60: 08 bf ff fc bleu 40009b50 <_Thread_Initialize+0x1b0> 40009b64: 84 10 00 01 mov %g1, %g2 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 40009b68: 10 bf ff a7 b 40009a04 <_Thread_Initialize+0x64> 40009b6c: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 40009b70: 90 10 00 19 mov %i1, %o0 40009b74: 40 00 01 ef call 4000a330 <_Thread_Stack_Allocate> 40009b78: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 40009b7c: 80 a2 00 1b cmp %o0, %i3 40009b80: 0a 80 00 07 bcs 40009b9c <_Thread_Initialize+0x1fc> 40009b84: 80 a2 20 00 cmp %o0, 0 40009b88: 02 80 00 05 be 40009b9c <_Thread_Initialize+0x1fc> <== NEVER TAKEN 40009b8c: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 40009b90: f4 06 60 c0 ld [ %i1 + 0xc0 ], %i2 the_thread->Start.core_allocated_stack = true; 40009b94: 10 bf ff 8f b 400099d0 <_Thread_Initialize+0x30> 40009b98: c2 2e 60 b4 stb %g1, [ %i1 + 0xb4 ] _Thread_Stack_Free( the_thread ); return false; } 40009b9c: 81 c7 e0 08 ret 40009ba0: 91 e8 20 00 restore %g0, 0, %o0 size_t actual_stack_size = 0; void *stack = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) void *fp_area; #endif void *sched = NULL; 40009ba4: 10 bf ff bf b 40009aa0 <_Thread_Initialize+0x100> 40009ba8: a0 10 20 00 clr %l0 =============================================================================== 4000de0c <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { 4000de0c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 4000de10: 7f ff d0 44 call 40001f20 4000de14: 01 00 00 00 nop 4000de18: a0 10 00 08 mov %o0, %l0 current_state = the_thread->current_state; 4000de1c: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 if ( current_state & STATES_SUSPENDED ) { 4000de20: 80 88 60 02 btst 2, %g1 4000de24: 02 80 00 05 be 4000de38 <_Thread_Resume+0x2c> <== NEVER TAKEN 4000de28: 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 ) ) { 4000de2c: 80 a0 60 00 cmp %g1, 0 4000de30: 02 80 00 04 be 4000de40 <_Thread_Resume+0x34> 4000de34: c2 26 20 10 st %g1, [ %i0 + 0x10 ] _Scheduler_Unblock( &_Scheduler, the_thread ); } } _ISR_Enable( level ); 4000de38: 7f ff d0 3e call 40001f30 4000de3c: 91 e8 00 10 restore %g0, %l0, %o0 RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { the_scheduler->Operations.unblock( the_scheduler, the_thread ); 4000de40: 11 10 00 6e sethi %hi(0x4001b800), %o0 4000de44: 90 12 22 14 or %o0, 0x214, %o0 ! 4001ba14 <_Scheduler> 4000de48: c2 02 20 10 ld [ %o0 + 0x10 ], %g1 4000de4c: 9f c0 40 00 call %g1 4000de50: 92 10 00 18 mov %i0, %o1 4000de54: 7f ff d0 37 call 40001f30 4000de58: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 4000a470 <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 4000a470: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing; executing = _Thread_Executing; 4000a474: 03 10 00 5e sethi %hi(0x40017800), %g1 4000a478: e0 00 63 84 ld [ %g1 + 0x384 ], %l0 ! 40017b84 <_Per_CPU_Information+0xc> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 4000a47c: c2 0c 20 74 ldub [ %l0 + 0x74 ], %g1 4000a480: 80 a0 60 00 cmp %g1, 0 4000a484: 02 80 00 26 be 4000a51c <_Thread_Tickle_timeslice+0xac> 4000a488: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 4000a48c: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 4000a490: 80 a0 60 00 cmp %g1, 0 4000a494: 12 80 00 22 bne 4000a51c <_Thread_Tickle_timeslice+0xac> 4000a498: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 4000a49c: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 4000a4a0: 80 a0 60 01 cmp %g1, 1 4000a4a4: 0a 80 00 07 bcs 4000a4c0 <_Thread_Tickle_timeslice+0x50> 4000a4a8: 80 a0 60 02 cmp %g1, 2 4000a4ac: 28 80 00 10 bleu,a 4000a4ec <_Thread_Tickle_timeslice+0x7c> 4000a4b0: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 4000a4b4: 80 a0 60 03 cmp %g1, 3 4000a4b8: 22 80 00 04 be,a 4000a4c8 <_Thread_Tickle_timeslice+0x58><== ALWAYS TAKEN 4000a4bc: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 4000a4c0: 81 c7 e0 08 ret 4000a4c4: 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 ) 4000a4c8: 82 00 7f ff add %g1, -1, %g1 4000a4cc: 80 a0 60 00 cmp %g1, 0 4000a4d0: 12 bf ff fc bne 4000a4c0 <_Thread_Tickle_timeslice+0x50> 4000a4d4: c2 24 20 78 st %g1, [ %l0 + 0x78 ] (*executing->budget_callout)( executing ); 4000a4d8: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 4000a4dc: 9f c0 40 00 call %g1 4000a4e0: 90 10 00 10 mov %l0, %o0 4000a4e4: 81 c7 e0 08 ret 4000a4e8: 81 e8 00 00 restore case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: #endif if ( (int)(--executing->cpu_time_budget) <= 0 ) { 4000a4ec: 82 00 7f ff add %g1, -1, %g1 4000a4f0: 80 a0 60 00 cmp %g1, 0 4000a4f4: 14 bf ff f3 bg 4000a4c0 <_Thread_Tickle_timeslice+0x50> 4000a4f8: 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 ); 4000a4fc: 11 10 00 5d sethi %hi(0x40017400), %o0 4000a500: 90 12 22 a4 or %o0, 0x2a4, %o0 ! 400176a4 <_Scheduler> 4000a504: c2 02 20 08 ld [ %o0 + 8 ], %g1 4000a508: 9f c0 40 00 call %g1 4000a50c: 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; 4000a510: 03 10 00 5d sethi %hi(0x40017400), %g1 4000a514: c2 00 61 84 ld [ %g1 + 0x184 ], %g1 ! 40017584 <_Thread_Ticks_per_timeslice> 4000a518: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 4000a51c: 81 c7 e0 08 ret 4000a520: 81 e8 00 00 restore =============================================================================== 4000a160 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 4000a160: 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 ) 4000a164: 80 a6 20 00 cmp %i0, 0 4000a168: 02 80 00 13 be 4000a1b4 <_Thread_queue_Requeue+0x54> <== NEVER TAKEN 4000a16c: 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 ) { 4000a170: e2 06 20 34 ld [ %i0 + 0x34 ], %l1 4000a174: 80 a4 60 01 cmp %l1, 1 4000a178: 02 80 00 04 be 4000a188 <_Thread_queue_Requeue+0x28> <== ALWAYS TAKEN 4000a17c: 01 00 00 00 nop 4000a180: 81 c7 e0 08 ret <== NOT EXECUTED 4000a184: 81 e8 00 00 restore <== NOT EXECUTED Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 4000a188: 7f ff df 21 call 40001e0c 4000a18c: 01 00 00 00 nop 4000a190: a0 10 00 08 mov %o0, %l0 4000a194: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 4000a198: 03 00 00 ef sethi %hi(0x3bc00), %g1 4000a19c: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 4000a1a0: 80 88 80 01 btst %g2, %g1 4000a1a4: 12 80 00 06 bne 4000a1bc <_Thread_queue_Requeue+0x5c> <== ALWAYS TAKEN 4000a1a8: 90 10 00 18 mov %i0, %o0 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); } _ISR_Enable( level ); 4000a1ac: 7f ff df 1c call 40001e1c 4000a1b0: 90 10 00 10 mov %l0, %o0 4000a1b4: 81 c7 e0 08 ret 4000a1b8: 81 e8 00 00 restore ISR_Level level_ignored; _ISR_Disable( level ); if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 4000a1bc: 92 10 00 19 mov %i1, %o1 4000a1c0: 94 10 20 01 mov 1, %o2 4000a1c4: 40 00 0f f6 call 4000e19c <_Thread_queue_Extract_priority_helper> 4000a1c8: e2 26 20 30 st %l1, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 4000a1cc: 90 10 00 18 mov %i0, %o0 4000a1d0: 92 10 00 19 mov %i1, %o1 4000a1d4: 7f ff ff 31 call 40009e98 <_Thread_queue_Enqueue_priority> 4000a1d8: 94 07 bf fc add %fp, -4, %o2 4000a1dc: 30 bf ff f4 b,a 4000a1ac <_Thread_queue_Requeue+0x4c> =============================================================================== 4000a1e0 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 4000a1e0: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 4000a1e4: 90 10 00 18 mov %i0, %o0 4000a1e8: 7f ff fd c8 call 40009908 <_Thread_Get> 4000a1ec: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000a1f0: c2 07 bf fc ld [ %fp + -4 ], %g1 4000a1f4: 80 a0 60 00 cmp %g1, 0 4000a1f8: 12 80 00 08 bne 4000a218 <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 4000a1fc: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 4000a200: 40 00 10 22 call 4000e288 <_Thread_queue_Process_timeout> 4000a204: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 4000a208: 03 10 00 5d sethi %hi(0x40017400), %g1 4000a20c: c4 00 62 20 ld [ %g1 + 0x220 ], %g2 ! 40017620 <_Thread_Dispatch_disable_level> 4000a210: 84 00 bf ff add %g2, -1, %g2 4000a214: c4 20 62 20 st %g2, [ %g1 + 0x220 ] 4000a218: 81 c7 e0 08 ret 4000a21c: 81 e8 00 00 restore =============================================================================== 40017374 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 40017374: 9d e3 bf 88 save %sp, -120, %sp 40017378: 2f 10 01 02 sethi %hi(0x40040800), %l7 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 4001737c: ba 07 bf f4 add %fp, -12, %i5 40017380: aa 07 bf f8 add %fp, -8, %l5 40017384: a4 07 bf e8 add %fp, -24, %l2 40017388: a8 07 bf ec add %fp, -20, %l4 4001738c: 2d 10 01 01 sethi %hi(0x40040400), %l6 40017390: 39 10 01 01 sethi %hi(0x40040400), %i4 40017394: ea 27 bf f4 st %l5, [ %fp + -12 ] head->previous = NULL; 40017398: c0 27 bf f8 clr [ %fp + -8 ] tail->previous = head; 4001739c: fa 27 bf fc st %i5, [ %fp + -4 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400173a0: e8 27 bf e8 st %l4, [ %fp + -24 ] head->previous = NULL; 400173a4: c0 27 bf ec clr [ %fp + -20 ] tail->previous = head; 400173a8: e4 27 bf f0 st %l2, [ %fp + -16 ] 400173ac: ae 15 e0 10 or %l7, 0x10, %l7 400173b0: a2 06 20 30 add %i0, 0x30, %l1 400173b4: ac 15 a3 88 or %l6, 0x388, %l6 400173b8: a6 06 20 68 add %i0, 0x68, %l3 400173bc: b8 17 22 e0 or %i4, 0x2e0, %i4 400173c0: b4 06 20 08 add %i0, 8, %i2 400173c4: b6 06 20 40 add %i0, 0x40, %i3 Chain_Control *tmp; /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; 400173c8: fa 26 20 78 st %i5, [ %i0 + 0x78 ] static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 400173cc: c2 05 c0 00 ld [ %l7 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 400173d0: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 400173d4: 94 10 00 12 mov %l2, %o2 400173d8: 90 10 00 11 mov %l1, %o0 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 400173dc: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 400173e0: 40 00 12 df call 4001bf5c <_Watchdog_Adjust_to_chain> 400173e4: 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; 400173e8: 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(); 400173ec: e0 05 80 00 ld [ %l6 ], %l0 /* * Process the seconds chain. Start by checking that the Time * of Day (TOD) has not been set backwards. If it has then * we want to adjust the watchdogs->Chain to indicate this. */ if ( snapshot > last_snapshot ) { 400173f0: 80 a4 00 0a cmp %l0, %o2 400173f4: 18 80 00 43 bgu 40017500 <_Timer_server_Body+0x18c> 400173f8: 92 24 00 0a sub %l0, %o2, %o1 * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { 400173fc: 0a 80 00 39 bcs 400174e0 <_Timer_server_Body+0x16c> 40017400: 90 10 00 13 mov %l3, %o0 */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; 40017404: 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 ); 40017408: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 4001740c: 40 00 03 11 call 40018050 <_Chain_Get> 40017410: 01 00 00 00 nop if ( timer == NULL ) { 40017414: 92 92 20 00 orcc %o0, 0, %o1 40017418: 02 80 00 10 be 40017458 <_Timer_server_Body+0xe4> 4001741c: 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 ) { 40017420: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 40017424: 80 a0 60 01 cmp %g1, 1 40017428: 02 80 00 32 be 400174f0 <_Timer_server_Body+0x17c> 4001742c: 80 a0 60 03 cmp %g1, 3 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 40017430: 12 bf ff f6 bne 40017408 <_Timer_server_Body+0x94> <== NEVER TAKEN 40017434: 92 02 60 10 add %o1, 0x10, %o1 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 40017438: 40 00 12 fc call 4001c028 <_Watchdog_Insert> 4001743c: 90 10 00 13 mov %l3, %o0 } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 40017440: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 40017444: 40 00 03 03 call 40018050 <_Chain_Get> 40017448: 01 00 00 00 nop if ( timer == NULL ) { 4001744c: 92 92 20 00 orcc %o0, 0, %o1 40017450: 32 bf ff f5 bne,a 40017424 <_Timer_server_Body+0xb0> <== NEVER TAKEN 40017454: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 <== NOT EXECUTED * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 40017458: 7f ff de 63 call 4000ede4 4001745c: 01 00 00 00 nop tmp = ts->insert_chain; 40017460: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 if ( _Chain_Is_empty( insert_chain ) ) { 40017464: c2 07 bf f4 ld [ %fp + -12 ], %g1 40017468: 80 a0 40 15 cmp %g1, %l5 4001746c: 02 80 00 29 be 40017510 <_Timer_server_Body+0x19c> <== ALWAYS TAKEN 40017470: a0 10 20 01 mov 1, %l0 ts->insert_chain = NULL; do_loop = false; } _ISR_Enable( level ); 40017474: 7f ff de 60 call 4000edf4 40017478: 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 ) { 4001747c: 80 8c 20 ff btst 0xff, %l0 40017480: 12 bf ff d3 bne 400173cc <_Timer_server_Body+0x58> <== NEVER TAKEN 40017484: 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 ) ) { 40017488: 80 a0 40 14 cmp %g1, %l4 4001748c: 12 80 00 0c bne 400174bc <_Timer_server_Body+0x148> 40017490: 01 00 00 00 nop 40017494: 30 80 00 22 b,a 4001751c <_Timer_server_Body+0x1a8> Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; new_first->previous = head; 40017498: e4 20 60 04 st %l2, [ %g1 + 4 ] { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; 4001749c: c2 27 bf e8 st %g1, [ %fp + -24 ] * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; 400174a0: c0 24 20 08 clr [ %l0 + 8 ] _ISR_Enable( level ); 400174a4: 7f ff de 54 call 4000edf4 400174a8: 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 ); 400174ac: d0 04 20 20 ld [ %l0 + 0x20 ], %o0 400174b0: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 400174b4: 9f c0 40 00 call %g1 400174b8: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 400174bc: 7f ff de 4a call 4000ede4 400174c0: 01 00 00 00 nop initialized = false; } #endif return status; } 400174c4: 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)) 400174c8: 80 a4 00 14 cmp %l0, %l4 400174cc: 32 bf ff f3 bne,a 40017498 <_Timer_server_Body+0x124> 400174d0: c2 04 00 00 ld [ %l0 ], %g1 watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 400174d4: 7f ff de 48 call 4000edf4 400174d8: 01 00 00 00 nop 400174dc: 30 bf ff bb b,a 400173c8 <_Timer_server_Body+0x54> /* * The current TOD is before the last TOD which indicates that * TOD has been set backwards. */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); 400174e0: 92 10 20 01 mov 1, %o1 ! 1 400174e4: 40 00 12 6e call 4001be9c <_Watchdog_Adjust> 400174e8: 94 22 80 10 sub %o2, %l0, %o2 400174ec: 30 bf ff c6 b,a 40017404 <_Timer_server_Body+0x90> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 400174f0: 90 10 00 11 mov %l1, %o0 400174f4: 40 00 12 cd call 4001c028 <_Watchdog_Insert> 400174f8: 92 02 60 10 add %o1, 0x10, %o1 400174fc: 30 bf ff c3 b,a 40017408 <_Timer_server_Body+0x94> /* * This path is for normal forward movement and cases where the * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40017500: 90 10 00 13 mov %l3, %o0 40017504: 40 00 12 96 call 4001bf5c <_Watchdog_Adjust_to_chain> 40017508: 94 10 00 12 mov %l2, %o2 4001750c: 30 bf ff be b,a 40017404 <_Timer_server_Body+0x90> _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); tmp = ts->insert_chain; if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; 40017510: c0 26 20 78 clr [ %i0 + 0x78 ] do_loop = false; 40017514: 10 bf ff d8 b 40017474 <_Timer_server_Body+0x100> 40017518: a0 10 20 00 clr %l0 * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 4001751c: c0 2e 20 7c clrb [ %i0 + 0x7c ] 40017520: c2 07 00 00 ld [ %i4 ], %g1 40017524: 82 00 60 01 inc %g1 40017528: c2 27 00 00 st %g1, [ %i4 ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 4001752c: d0 06 00 00 ld [ %i0 ], %o0 40017530: 40 00 10 66 call 4001b6c8 <_Thread_Set_state> 40017534: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 40017538: 7f ff ff 65 call 400172cc <_Timer_server_Reset_interval_system_watchdog> 4001753c: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 40017540: 7f ff ff 78 call 40017320 <_Timer_server_Reset_tod_system_watchdog> 40017544: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 40017548: 40 00 0d d3 call 4001ac94 <_Thread_Enable_dispatch> 4001754c: 01 00 00 00 nop ts->active = true; 40017550: 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 ); 40017554: 90 10 00 1a mov %i2, %o0 _Thread_Set_state( ts->thread, STATES_DELAYING ); _Timer_server_Reset_interval_system_watchdog( ts ); _Timer_server_Reset_tod_system_watchdog( ts ); _Thread_Enable_dispatch(); ts->active = true; 40017558: 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 ); 4001755c: 40 00 13 1e call 4001c1d4 <_Watchdog_Remove> 40017560: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 40017564: 40 00 13 1c call 4001c1d4 <_Watchdog_Remove> 40017568: 90 10 00 1b mov %i3, %o0 4001756c: 30 bf ff 97 b,a 400173c8 <_Timer_server_Body+0x54> =============================================================================== 40017570 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 40017570: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 40017574: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 40017578: 80 a0 60 00 cmp %g1, 0 4001757c: 02 80 00 05 be 40017590 <_Timer_server_Schedule_operation_method+0x20> 40017580: a0 10 00 19 mov %i1, %l0 * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); 40017584: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 40017588: 40 00 02 9c call 40017ff8 <_Chain_Append> 4001758c: 81 e8 00 00 restore 40017590: 03 10 01 01 sethi %hi(0x40040400), %g1 40017594: c4 00 62 e0 ld [ %g1 + 0x2e0 ], %g2 ! 400406e0 <_Thread_Dispatch_disable_level> 40017598: 84 00 a0 01 inc %g2 4001759c: c4 20 62 e0 st %g2, [ %g1 + 0x2e0 ] * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 400175a0: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 400175a4: 80 a0 60 01 cmp %g1, 1 400175a8: 02 80 00 28 be 40017648 <_Timer_server_Schedule_operation_method+0xd8> 400175ac: 80 a0 60 03 cmp %g1, 3 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); if ( !ts->active ) { _Timer_server_Reset_interval_system_watchdog( ts ); } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 400175b0: 02 80 00 04 be 400175c0 <_Timer_server_Schedule_operation_method+0x50> 400175b4: 01 00 00 00 nop if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 400175b8: 40 00 0d b7 call 4001ac94 <_Thread_Enable_dispatch> 400175bc: 81 e8 00 00 restore } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 400175c0: 7f ff de 09 call 4000ede4 400175c4: 01 00 00 00 nop initialized = false; } #endif return status; } 400175c8: 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; 400175cc: c6 06 20 74 ld [ %i0 + 0x74 ], %g3 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 400175d0: 88 06 20 6c add %i0, 0x6c, %g4 /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 400175d4: 03 10 01 01 sethi %hi(0x40040400), %g1 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 400175d8: 80 a0 80 04 cmp %g2, %g4 400175dc: 02 80 00 0d be 40017610 <_Timer_server_Schedule_operation_method+0xa0> 400175e0: c2 00 63 88 ld [ %g1 + 0x388 ], %g1 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 400175e4: da 00 a0 10 ld [ %g2 + 0x10 ], %o5 if ( snapshot > last_snapshot ) { 400175e8: 80 a0 40 03 cmp %g1, %g3 } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 400175ec: 88 03 40 03 add %o5, %g3, %g4 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { 400175f0: 08 80 00 07 bleu 4001760c <_Timer_server_Schedule_operation_method+0x9c> 400175f4: 88 21 00 01 sub %g4, %g1, %g4 /* * We advanced in time. */ delta = snapshot - last_snapshot; 400175f8: 86 20 40 03 sub %g1, %g3, %g3 if (delta_interval > delta) { 400175fc: 80 a3 40 03 cmp %o5, %g3 40017600: 08 80 00 03 bleu 4001760c <_Timer_server_Schedule_operation_method+0x9c><== NEVER TAKEN 40017604: 88 10 20 00 clr %g4 delta_interval -= delta; 40017608: 88 23 40 03 sub %o5, %g3, %g4 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 4001760c: c8 20 a0 10 st %g4, [ %g2 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 40017610: c2 26 20 74 st %g1, [ %i0 + 0x74 ] _ISR_Enable( level ); 40017614: 7f ff dd f8 call 4000edf4 40017618: 01 00 00 00 nop _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 4001761c: 90 06 20 68 add %i0, 0x68, %o0 40017620: 40 00 12 82 call 4001c028 <_Watchdog_Insert> 40017624: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 40017628: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 4001762c: 80 a0 60 00 cmp %g1, 0 40017630: 12 bf ff e2 bne 400175b8 <_Timer_server_Schedule_operation_method+0x48> 40017634: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 40017638: 7f ff ff 3a call 40017320 <_Timer_server_Reset_tod_system_watchdog> 4001763c: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 40017640: 40 00 0d 95 call 4001ac94 <_Thread_Enable_dispatch> 40017644: 81 e8 00 00 restore if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 40017648: 7f ff dd e7 call 4000ede4 4001764c: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 40017650: 05 10 01 02 sethi %hi(0x40040800), %g2 initialized = false; } #endif return status; } 40017654: 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; 40017658: c4 00 a0 10 ld [ %g2 + 0x10 ], %g2 last_snapshot = ts->Interval_watchdogs.last_snapshot; 4001765c: c8 06 20 3c ld [ %i0 + 0x3c ], %g4 40017660: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 40017664: 80 a0 40 03 cmp %g1, %g3 40017668: 02 80 00 08 be 40017688 <_Timer_server_Schedule_operation_method+0x118> 4001766c: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 40017670: da 00 60 10 ld [ %g1 + 0x10 ], %o5 if (delta_interval > delta) { 40017674: 80 a1 00 0d cmp %g4, %o5 40017678: 1a 80 00 03 bcc 40017684 <_Timer_server_Schedule_operation_method+0x114> 4001767c: 86 10 20 00 clr %g3 delta_interval -= delta; 40017680: 86 23 40 04 sub %o5, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 40017684: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 40017688: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 4001768c: 7f ff dd da call 4000edf4 40017690: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 40017694: 90 06 20 30 add %i0, 0x30, %o0 40017698: 40 00 12 64 call 4001c028 <_Watchdog_Insert> 4001769c: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 400176a0: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 400176a4: 80 a0 60 00 cmp %g1, 0 400176a8: 12 bf ff c4 bne 400175b8 <_Timer_server_Schedule_operation_method+0x48> 400176ac: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 400176b0: 7f ff ff 07 call 400172cc <_Timer_server_Reset_interval_system_watchdog> 400176b4: 90 10 00 18 mov %i0, %o0 if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 400176b8: 40 00 0d 77 call 4001ac94 <_Thread_Enable_dispatch> 400176bc: 81 e8 00 00 restore =============================================================================== 4000a734 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 4000a734: 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 ); } } 4000a738: 23 10 00 5e sethi %hi(0x40017800), %l1 4000a73c: a2 14 60 28 or %l1, 0x28, %l1 ! 40017828 <_User_extensions_List> 4000a740: e0 04 60 08 ld [ %l1 + 8 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 4000a744: 80 a4 00 11 cmp %l0, %l1 4000a748: 02 80 00 0d be 4000a77c <_User_extensions_Fatal+0x48> <== NEVER TAKEN 4000a74c: b2 0e 60 ff and %i1, 0xff, %i1 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) 4000a750: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 4000a754: 80 a0 60 00 cmp %g1, 0 4000a758: 02 80 00 05 be 4000a76c <_User_extensions_Fatal+0x38> 4000a75c: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); 4000a760: 92 10 00 19 mov %i1, %o1 4000a764: 9f c0 40 00 call %g1 4000a768: 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 ) { 4000a76c: 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 ); 4000a770: 80 a4 00 11 cmp %l0, %l1 4000a774: 32 bf ff f8 bne,a 4000a754 <_User_extensions_Fatal+0x20> <== ALWAYS TAKEN 4000a778: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 4000a77c: 81 c7 e0 08 ret <== NOT EXECUTED 4000a780: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 4000a5e0 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 4000a5e0: 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; 4000a5e4: 07 10 00 5a sethi %hi(0x40016800), %g3 4000a5e8: 86 10 e3 38 or %g3, 0x338, %g3 ! 40016b38 initial_extensions = Configuration.User_extension_table; 4000a5ec: e6 00 e0 40 ld [ %g3 + 0x40 ], %l3 4000a5f0: 1b 10 00 5e sethi %hi(0x40017800), %o5 4000a5f4: 09 10 00 5d sethi %hi(0x40017400), %g4 4000a5f8: 84 13 60 28 or %o5, 0x28, %g2 4000a5fc: 82 11 22 24 or %g4, 0x224, %g1 4000a600: 96 00 a0 04 add %g2, 4, %o3 4000a604: 98 00 60 04 add %g1, 4, %o4 4000a608: d6 23 60 28 st %o3, [ %o5 + 0x28 ] head->previous = NULL; 4000a60c: c0 20 a0 04 clr [ %g2 + 4 ] tail->previous = head; 4000a610: c4 20 a0 08 st %g2, [ %g2 + 8 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 4000a614: d8 21 22 24 st %o4, [ %g4 + 0x224 ] head->previous = NULL; 4000a618: c0 20 60 04 clr [ %g1 + 4 ] tail->previous = head; 4000a61c: c2 20 60 08 st %g1, [ %g1 + 8 ] _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 4000a620: 80 a4 e0 00 cmp %l3, 0 4000a624: 02 80 00 1b be 4000a690 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 4000a628: e4 00 e0 3c ld [ %g3 + 0x3c ], %l2 extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) 4000a62c: 83 2c a0 02 sll %l2, 2, %g1 4000a630: a3 2c a0 04 sll %l2, 4, %l1 4000a634: a2 24 40 01 sub %l1, %g1, %l1 4000a638: a2 04 40 12 add %l1, %l2, %l1 4000a63c: a3 2c 60 02 sll %l1, 2, %l1 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( 4000a640: 40 00 01 9f call 4000acbc <_Workspace_Allocate_or_fatal_error> 4000a644: 90 10 00 11 mov %l1, %o0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 4000a648: 92 10 20 00 clr %o1 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( 4000a64c: a0 10 00 08 mov %o0, %l0 number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 4000a650: 40 00 19 46 call 40010b68 4000a654: 94 10 00 11 mov %l1, %o2 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 4000a658: 80 a4 a0 00 cmp %l2, 0 4000a65c: 02 80 00 0d be 4000a690 <_User_extensions_Handler_initialization+0xb0><== NEVER TAKEN 4000a660: a2 10 20 00 clr %l1 #include #include #include #include void _User_extensions_Handler_initialization(void) 4000a664: 93 2c 60 05 sll %l1, 5, %o1 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; 4000a668: 94 10 20 20 mov 0x20, %o2 4000a66c: 92 04 c0 09 add %l3, %o1, %o1 4000a670: 40 00 19 05 call 40010a84 4000a674: 90 04 20 14 add %l0, 0x14, %o0 _User_extensions_Add_set( extension ); 4000a678: 40 00 0f 47 call 4000e394 <_User_extensions_Add_set> 4000a67c: 90 10 00 10 mov %l0, %o0 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 4000a680: a2 04 60 01 inc %l1 4000a684: 80 a4 80 11 cmp %l2, %l1 4000a688: 18 bf ff f7 bgu 4000a664 <_User_extensions_Handler_initialization+0x84> 4000a68c: a0 04 20 34 add %l0, 0x34, %l0 4000a690: 81 c7 e0 08 ret 4000a694: 81 e8 00 00 restore =============================================================================== 4000a698 <_User_extensions_Thread_begin>: #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { 4000a698: 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 ); } } 4000a69c: 23 10 00 5e sethi %hi(0x40017800), %l1 4000a6a0: e0 04 60 28 ld [ %l1 + 0x28 ], %l0 ! 40017828 <_User_extensions_List> 4000a6a4: a2 14 60 28 or %l1, 0x28, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a6a8: a2 04 60 04 add %l1, 4, %l1 4000a6ac: 80 a4 00 11 cmp %l0, %l1 4000a6b0: 02 80 00 0c be 4000a6e0 <_User_extensions_Thread_begin+0x48><== NEVER TAKEN 4000a6b4: 01 00 00 00 nop !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_begin != NULL ) 4000a6b8: c2 04 20 28 ld [ %l0 + 0x28 ], %g1 4000a6bc: 80 a0 60 00 cmp %g1, 0 4000a6c0: 02 80 00 04 be 4000a6d0 <_User_extensions_Thread_begin+0x38> 4000a6c4: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.thread_begin)( executing ); 4000a6c8: 9f c0 40 00 call %g1 4000a6cc: 01 00 00 00 nop Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 4000a6d0: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a6d4: 80 a4 00 11 cmp %l0, %l1 4000a6d8: 32 bf ff f9 bne,a 4000a6bc <_User_extensions_Thread_begin+0x24> 4000a6dc: c2 04 20 28 ld [ %l0 + 0x28 ], %g1 4000a6e0: 81 c7 e0 08 ret 4000a6e4: 81 e8 00 00 restore =============================================================================== 4000a784 <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 4000a784: 9d e3 bf a0 save %sp, -96, %sp return false; } } return true; } 4000a788: 23 10 00 5e sethi %hi(0x40017800), %l1 4000a78c: e0 04 60 28 ld [ %l1 + 0x28 ], %l0 ! 40017828 <_User_extensions_List> #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { 4000a790: a6 10 00 18 mov %i0, %l3 return false; } } return true; } 4000a794: a2 14 60 28 or %l1, 0x28, %l1 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a798: a2 04 60 04 add %l1, 4, %l1 4000a79c: 80 a4 00 11 cmp %l0, %l1 4000a7a0: 02 80 00 13 be 4000a7ec <_User_extensions_Thread_create+0x68><== NEVER TAKEN 4000a7a4: b0 10 20 01 mov 1, %i0 the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { status = (*the_extension->Callouts.thread_create)( 4000a7a8: 25 10 00 5e sethi %hi(0x40017800), %l2 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { 4000a7ac: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 4000a7b0: 80 a0 60 00 cmp %g1, 0 4000a7b4: 02 80 00 08 be 4000a7d4 <_User_extensions_Thread_create+0x50> 4000a7b8: 84 14 a3 78 or %l2, 0x378, %g2 status = (*the_extension->Callouts.thread_create)( 4000a7bc: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 4000a7c0: 9f c0 40 00 call %g1 4000a7c4: 92 10 00 13 mov %l3, %o1 _Thread_Executing, the_thread ); if ( !status ) 4000a7c8: 80 8a 20 ff btst 0xff, %o0 4000a7cc: 22 80 00 08 be,a 4000a7ec <_User_extensions_Thread_create+0x68> 4000a7d0: b0 10 20 00 clr %i0 User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 4000a7d4: e0 04 00 00 ld [ %l0 ], %l0 { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a7d8: 80 a4 00 11 cmp %l0, %l1 4000a7dc: 32 bf ff f5 bne,a 4000a7b0 <_User_extensions_Thread_create+0x2c> 4000a7e0: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 if ( !status ) return false; } } return true; 4000a7e4: 81 c7 e0 08 ret 4000a7e8: 91 e8 20 01 restore %g0, 1, %o0 } 4000a7ec: 81 c7 e0 08 ret 4000a7f0: 81 e8 00 00 restore =============================================================================== 4000a7f4 <_User_extensions_Thread_delete>: #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { 4000a7f4: 9d e3 bf a0 save %sp, -96, %sp (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } 4000a7f8: 23 10 00 5e sethi %hi(0x40017800), %l1 4000a7fc: a2 14 60 28 or %l1, 0x28, %l1 ! 40017828 <_User_extensions_List> 4000a800: e0 04 60 08 ld [ %l1 + 8 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 4000a804: 80 a4 00 11 cmp %l0, %l1 4000a808: 02 80 00 0d be 4000a83c <_User_extensions_Thread_delete+0x48><== NEVER TAKEN 4000a80c: 25 10 00 5e sethi %hi(0x40017800), %l2 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_delete != NULL ) 4000a810: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 4000a814: 80 a0 60 00 cmp %g1, 0 4000a818: 02 80 00 05 be 4000a82c <_User_extensions_Thread_delete+0x38> 4000a81c: 84 14 a3 78 or %l2, 0x378, %g2 (*the_extension->Callouts.thread_delete)( 4000a820: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 4000a824: 9f c0 40 00 call %g1 4000a828: 92 10 00 18 mov %i0, %o1 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 4000a82c: 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 ); 4000a830: 80 a4 00 11 cmp %l0, %l1 4000a834: 32 bf ff f8 bne,a 4000a814 <_User_extensions_Thread_delete+0x20> 4000a838: c2 04 20 20 ld [ %l0 + 0x20 ], %g1 4000a83c: 81 c7 e0 08 ret 4000a840: 81 e8 00 00 restore =============================================================================== 4000a6e8 <_User_extensions_Thread_exitted>: } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { 4000a6e8: 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 ); } } 4000a6ec: 23 10 00 5e sethi %hi(0x40017800), %l1 4000a6f0: a2 14 60 28 or %l1, 0x28, %l1 ! 40017828 <_User_extensions_List> 4000a6f4: e0 04 60 08 ld [ %l1 + 8 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); 4000a6f8: 80 a4 00 11 cmp %l0, %l1 4000a6fc: 02 80 00 0c be 4000a72c <_User_extensions_Thread_exitted+0x44><== NEVER TAKEN 4000a700: 01 00 00 00 nop !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) 4000a704: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 4000a708: 80 a0 60 00 cmp %g1, 0 4000a70c: 02 80 00 04 be 4000a71c <_User_extensions_Thread_exitted+0x34> 4000a710: 90 10 00 18 mov %i0, %o0 (*the_extension->Callouts.thread_exitted)( executing ); 4000a714: 9f c0 40 00 call %g1 4000a718: 01 00 00 00 nop Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { 4000a71c: 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 ); 4000a720: 80 a4 00 11 cmp %l0, %l1 4000a724: 32 bf ff f9 bne,a 4000a708 <_User_extensions_Thread_exitted+0x20> 4000a728: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 4000a72c: 81 c7 e0 08 ret 4000a730: 81 e8 00 00 restore =============================================================================== 4000b56c <_User_extensions_Thread_restart>: #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { 4000b56c: 9d e3 bf a0 save %sp, -96, %sp (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } 4000b570: 23 10 00 82 sethi %hi(0x40020800), %l1 4000b574: e0 04 62 88 ld [ %l1 + 0x288 ], %l0 ! 40020a88 <_User_extensions_List> 4000b578: a2 14 62 88 or %l1, 0x288, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000b57c: a2 04 60 04 add %l1, 4, %l1 4000b580: 80 a4 00 11 cmp %l0, %l1 4000b584: 02 80 00 0d be 4000b5b8 <_User_extensions_Thread_restart+0x4c><== NEVER TAKEN 4000b588: 25 10 00 83 sethi %hi(0x40020c00), %l2 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_restart != NULL ) 4000b58c: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 4000b590: 80 a0 60 00 cmp %g1, 0 4000b594: 02 80 00 05 be 4000b5a8 <_User_extensions_Thread_restart+0x3c> 4000b598: 84 14 a1 d8 or %l2, 0x1d8, %g2 (*the_extension->Callouts.thread_restart)( 4000b59c: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 4000b5a0: 9f c0 40 00 call %g1 4000b5a4: 92 10 00 18 mov %i0, %o1 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 4000b5a8: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000b5ac: 80 a4 00 11 cmp %l0, %l1 4000b5b0: 32 bf ff f8 bne,a 4000b590 <_User_extensions_Thread_restart+0x24> 4000b5b4: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 4000b5b8: 81 c7 e0 08 ret 4000b5bc: 81 e8 00 00 restore =============================================================================== 4000a844 <_User_extensions_Thread_start>: #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { 4000a844: 9d e3 bf a0 save %sp, -96, %sp (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } 4000a848: 23 10 00 5e sethi %hi(0x40017800), %l1 4000a84c: e0 04 60 28 ld [ %l1 + 0x28 ], %l0 ! 40017828 <_User_extensions_List> 4000a850: a2 14 60 28 or %l1, 0x28, %l1 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a854: a2 04 60 04 add %l1, 4, %l1 4000a858: 80 a4 00 11 cmp %l0, %l1 4000a85c: 02 80 00 0d be 4000a890 <_User_extensions_Thread_start+0x4c><== NEVER TAKEN 4000a860: 25 10 00 5e sethi %hi(0x40017800), %l2 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_start != NULL ) 4000a864: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000a868: 80 a0 60 00 cmp %g1, 0 4000a86c: 02 80 00 05 be 4000a880 <_User_extensions_Thread_start+0x3c> 4000a870: 84 14 a3 78 or %l2, 0x378, %g2 (*the_extension->Callouts.thread_start)( 4000a874: d0 00 a0 0c ld [ %g2 + 0xc ], %o0 4000a878: 9f c0 40 00 call %g1 4000a87c: 92 10 00 18 mov %i0, %o1 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { 4000a880: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); 4000a884: 80 a4 00 11 cmp %l0, %l1 4000a888: 32 bf ff f8 bne,a 4000a868 <_User_extensions_Thread_start+0x24> 4000a88c: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000a890: 81 c7 e0 08 ret 4000a894: 81 e8 00 00 restore =============================================================================== 4000a898 <_User_extensions_Thread_switch>: void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { 4000a898: 9d e3 bf a0 save %sp, -96, %sp the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } 4000a89c: 23 10 00 5d sethi %hi(0x40017400), %l1 4000a8a0: e0 04 62 24 ld [ %l1 + 0x224 ], %l0 ! 40017624 <_User_extensions_Switches_list> 4000a8a4: a2 14 62 24 or %l1, 0x224, %l1 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); 4000a8a8: a2 04 60 04 add %l1, 4, %l1 4000a8ac: 80 a4 00 11 cmp %l0, %l1 4000a8b0: 02 80 00 0a be 4000a8d8 <_User_extensions_Thread_switch+0x40><== NEVER TAKEN 4000a8b4: 01 00 00 00 nop !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); 4000a8b8: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000a8bc: 90 10 00 18 mov %i0, %o0 4000a8c0: 9f c0 40 00 call %g1 4000a8c4: 92 10 00 19 mov %i1, %o1 Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { 4000a8c8: e0 04 00 00 ld [ %l0 ], %l0 ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); 4000a8cc: 80 a4 00 11 cmp %l0, %l1 4000a8d0: 32 bf ff fb bne,a 4000a8bc <_User_extensions_Thread_switch+0x24> 4000a8d4: c2 04 20 08 ld [ %l0 + 8 ], %g1 4000a8d8: 81 c7 e0 08 ret 4000a8dc: 81 e8 00 00 restore =============================================================================== 4000c948 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4000c948: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 4000c94c: 7f ff d9 0f call 40002d88 4000c950: a0 10 00 18 mov %i0, %l0 } } _ISR_Enable( level ); } 4000c954: 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 ); 4000c958: a4 06 20 04 add %i0, 4, %l2 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { 4000c95c: 80 a0 40 12 cmp %g1, %l2 4000c960: 02 80 00 1f be 4000c9dc <_Watchdog_Adjust+0x94> 4000c964: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 4000c968: 12 80 00 1f bne 4000c9e4 <_Watchdog_Adjust+0x9c> 4000c96c: 80 a6 60 01 cmp %i1, 1 case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4000c970: 80 a6 a0 00 cmp %i2, 0 4000c974: 02 80 00 1a be 4000c9dc <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000c978: 01 00 00 00 nop if ( units < _Watchdog_First( header )->delta_interval ) { 4000c97c: e2 00 60 10 ld [ %g1 + 0x10 ], %l1 4000c980: 80 a6 80 11 cmp %i2, %l1 4000c984: 1a 80 00 0b bcc 4000c9b0 <_Watchdog_Adjust+0x68> <== ALWAYS TAKEN 4000c988: a6 10 20 01 mov 1, %l3 _Watchdog_First( header )->delta_interval -= units; 4000c98c: 10 80 00 1d b 4000ca00 <_Watchdog_Adjust+0xb8> <== NOT EXECUTED 4000c990: a2 24 40 1a sub %l1, %i2, %l1 <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4000c994: b4 a6 80 11 subcc %i2, %l1, %i2 4000c998: 02 80 00 11 be 4000c9dc <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000c99c: 01 00 00 00 nop if ( units < _Watchdog_First( header )->delta_interval ) { 4000c9a0: e2 00 60 10 ld [ %g1 + 0x10 ], %l1 4000c9a4: 80 a4 40 1a cmp %l1, %i2 4000c9a8: 38 80 00 16 bgu,a 4000ca00 <_Watchdog_Adjust+0xb8> 4000c9ac: a2 24 40 1a sub %l1, %i2, %l1 _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; 4000c9b0: e6 20 60 10 st %l3, [ %g1 + 0x10 ] _ISR_Enable( level ); 4000c9b4: 7f ff d8 f9 call 40002d98 4000c9b8: 01 00 00 00 nop _Watchdog_Tickle( header ); 4000c9bc: 40 00 00 b4 call 4000cc8c <_Watchdog_Tickle> 4000c9c0: 90 10 00 10 mov %l0, %o0 _ISR_Disable( level ); 4000c9c4: 7f ff d8 f1 call 40002d88 4000c9c8: 01 00 00 00 nop } } _ISR_Enable( level ); } 4000c9cc: c4 04 00 00 ld [ %l0 ], %g2 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) 4000c9d0: 80 a4 80 02 cmp %l2, %g2 4000c9d4: 12 bf ff f0 bne 4000c994 <_Watchdog_Adjust+0x4c> 4000c9d8: 82 10 00 02 mov %g2, %g1 } break; } } _ISR_Enable( level ); 4000c9dc: 7f ff d8 ef call 40002d98 4000c9e0: 91 e8 00 08 restore %g0, %o0, %o0 * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { 4000c9e4: 12 bf ff fe bne 4000c9dc <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000c9e8: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4000c9ec: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000c9f0: b4 00 80 1a add %g2, %i2, %i2 4000c9f4: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } break; } } _ISR_Enable( level ); 4000c9f8: 7f ff d8 e8 call 40002d98 4000c9fc: 91 e8 00 08 restore %g0, %o0, %o0 break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; 4000ca00: 10 bf ff f7 b 4000c9dc <_Watchdog_Adjust+0x94> 4000ca04: e2 20 60 10 st %l1, [ %g1 + 0x10 ] =============================================================================== 4000aa8c <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 4000aa8c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 4000aa90: 7f ff dc df call 40001e0c 4000aa94: 01 00 00 00 nop previous_state = the_watchdog->state; 4000aa98: e0 06 20 08 ld [ %i0 + 8 ], %l0 switch ( previous_state ) { 4000aa9c: 80 a4 20 01 cmp %l0, 1 4000aaa0: 02 80 00 2a be 4000ab48 <_Watchdog_Remove+0xbc> 4000aaa4: 03 10 00 5d sethi %hi(0x40017400), %g1 4000aaa8: 1a 80 00 09 bcc 4000aacc <_Watchdog_Remove+0x40> 4000aaac: 80 a4 20 03 cmp %l0, 3 _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000aab0: 03 10 00 5d sethi %hi(0x40017400), %g1 4000aab4: c2 00 63 50 ld [ %g1 + 0x350 ], %g1 ! 40017750 <_Watchdog_Ticks_since_boot> 4000aab8: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 4000aabc: 7f ff dc d8 call 40001e1c 4000aac0: b0 10 00 10 mov %l0, %i0 return( previous_state ); } 4000aac4: 81 c7 e0 08 ret 4000aac8: 81 e8 00 00 restore Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; switch ( previous_state ) { 4000aacc: 18 bf ff fa bgu 4000aab4 <_Watchdog_Remove+0x28> <== NEVER TAKEN 4000aad0: 03 10 00 5d sethi %hi(0x40017400), %g1 } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } 4000aad4: c2 06 00 00 ld [ %i0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 4000aad8: c0 26 20 08 clr [ %i0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 4000aadc: c4 00 40 00 ld [ %g1 ], %g2 4000aae0: 80 a0 a0 00 cmp %g2, 0 4000aae4: 02 80 00 07 be 4000ab00 <_Watchdog_Remove+0x74> 4000aae8: 05 10 00 5d sethi %hi(0x40017400), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 4000aaec: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 4000aaf0: c4 06 20 10 ld [ %i0 + 0x10 ], %g2 4000aaf4: 84 00 c0 02 add %g3, %g2, %g2 4000aaf8: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 4000aafc: 05 10 00 5d sethi %hi(0x40017400), %g2 4000ab00: c4 00 a3 4c ld [ %g2 + 0x34c ], %g2 ! 4001774c <_Watchdog_Sync_count> 4000ab04: 80 a0 a0 00 cmp %g2, 0 4000ab08: 22 80 00 07 be,a 4000ab24 <_Watchdog_Remove+0x98> 4000ab0c: c4 06 20 04 ld [ %i0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 4000ab10: 05 10 00 5e sethi %hi(0x40017800), %g2 4000ab14: c6 00 a3 80 ld [ %g2 + 0x380 ], %g3 ! 40017b80 <_Per_CPU_Information+0x8> 4000ab18: 05 10 00 5d sethi %hi(0x40017400), %g2 4000ab1c: c6 20 a2 e4 st %g3, [ %g2 + 0x2e4 ] ! 400176e4 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4000ab20: c4 06 20 04 ld [ %i0 + 4 ], %g2 next->previous = previous; 4000ab24: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 4000ab28: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000ab2c: 03 10 00 5d sethi %hi(0x40017400), %g1 4000ab30: c2 00 63 50 ld [ %g1 + 0x350 ], %g1 ! 40017750 <_Watchdog_Ticks_since_boot> 4000ab34: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 4000ab38: 7f ff dc b9 call 40001e1c 4000ab3c: b0 10 00 10 mov %l0, %i0 return( previous_state ); } 4000ab40: 81 c7 e0 08 ret 4000ab44: 81 e8 00 00 restore _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000ab48: c2 00 63 50 ld [ %g1 + 0x350 ], %g1 /* * It is not actually on the chain so just change the state and * the Insert operation we interrupted will be aborted. */ the_watchdog->state = WATCHDOG_INACTIVE; 4000ab4c: c0 26 20 08 clr [ %i0 + 8 ] _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000ab50: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 4000ab54: 7f ff dc b2 call 40001e1c 4000ab58: b0 10 00 10 mov %l0, %i0 return( previous_state ); } 4000ab5c: 81 c7 e0 08 ret 4000ab60: 81 e8 00 00 restore =============================================================================== 4000c180 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4000c180: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4000c184: 7f ff d9 d3 call 400028d0 4000c188: 01 00 00 00 nop 4000c18c: a0 10 00 08 mov %o0, %l0 printk( "Watchdog Chain: %s %p\n", name, header ); 4000c190: 11 10 00 7f sethi %hi(0x4001fc00), %o0 4000c194: 94 10 00 19 mov %i1, %o2 4000c198: 92 10 00 18 mov %i0, %o1 4000c19c: 7f ff e4 7a call 40005384 4000c1a0: 90 12 22 28 or %o0, 0x228, %o0 printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 4000c1a4: 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 ); 4000c1a8: 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 ) ) { 4000c1ac: 80 a4 40 19 cmp %l1, %i1 4000c1b0: 02 80 00 0f be 4000c1ec <_Watchdog_Report_chain+0x6c> 4000c1b4: 11 10 00 7f sethi %hi(0x4001fc00), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4000c1b8: 92 10 00 11 mov %l1, %o1 4000c1bc: 40 00 00 0f call 4000c1f8 <_Watchdog_Report> 4000c1c0: 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 ) 4000c1c4: 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 ) ; 4000c1c8: 80 a4 40 19 cmp %l1, %i1 4000c1cc: 12 bf ff fc bne 4000c1bc <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 4000c1d0: 92 10 00 11 mov %l1, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4000c1d4: 11 10 00 7f sethi %hi(0x4001fc00), %o0 4000c1d8: 92 10 00 18 mov %i0, %o1 4000c1dc: 7f ff e4 6a call 40005384 4000c1e0: 90 12 22 40 or %o0, 0x240, %o0 } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); 4000c1e4: 7f ff d9 bf call 400028e0 4000c1e8: 91 e8 00 10 restore %g0, %l0, %o0 _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); 4000c1ec: 7f ff e4 66 call 40005384 4000c1f0: 90 12 22 50 or %o0, 0x250, %o0 4000c1f4: 30 bf ff fc b,a 4000c1e4 <_Watchdog_Report_chain+0x64> =============================================================================== 40007194 : int adjtime( struct timeval *delta, struct timeval *olddelta ) { 40007194: 9d e3 bf 98 save %sp, -104, %sp long adjustment; /* * Simple validations */ if ( !delta ) 40007198: a0 96 20 00 orcc %i0, 0, %l0 4000719c: 02 80 00 54 be 400072ec 400071a0: 03 00 03 d0 sethi %hi(0xf4000), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) 400071a4: c4 04 20 04 ld [ %l0 + 4 ], %g2 400071a8: 82 10 62 3f or %g1, 0x23f, %g1 400071ac: 80 a0 80 01 cmp %g2, %g1 400071b0: 18 80 00 4f bgu 400072ec 400071b4: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { 400071b8: 22 80 00 06 be,a 400071d0 400071bc: c2 04 00 00 ld [ %l0 ], %g1 olddelta->tv_sec = 0; olddelta->tv_usec = 0; 400071c0: c0 26 60 04 clr [ %i1 + 4 ] 400071c4: c4 04 20 04 ld [ %l0 + 4 ], %g2 if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { olddelta->tv_sec = 0; 400071c8: c0 26 40 00 clr [ %i1 ] olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); 400071cc: c2 04 00 00 ld [ %l0 ], %g1 adjustment += delta->tv_usec; /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 400071d0: 07 10 00 80 sethi %hi(0x40020000), %g3 400071d4: c8 00 e1 b4 ld [ %g3 + 0x1b4 ], %g4 ! 400201b4 olddelta->tv_sec = 0; olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); 400071d8: 9b 28 60 08 sll %g1, 8, %o5 400071dc: 87 28 60 03 sll %g1, 3, %g3 400071e0: 86 23 40 03 sub %o5, %g3, %g3 400071e4: 9b 28 e0 06 sll %g3, 6, %o5 400071e8: 86 23 40 03 sub %o5, %g3, %g3 400071ec: 82 00 c0 01 add %g3, %g1, %g1 400071f0: 83 28 60 06 sll %g1, 6, %g1 adjustment += delta->tv_usec; 400071f4: 84 00 80 01 add %g2, %g1, %g2 /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 400071f8: 80 a0 80 04 cmp %g2, %g4 400071fc: 0a 80 00 3a bcs 400072e4 40007200: b0 10 20 00 clr %i0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007204: 03 10 00 83 sethi %hi(0x40020c00), %g1 40007208: c4 00 61 d0 ld [ %g1 + 0x1d0 ], %g2 ! 40020dd0 <_Thread_Dispatch_disable_level> 4000720c: 84 00 a0 01 inc %g2 40007210: c4 20 61 d0 st %g2, [ %g1 + 0x1d0 ] * This prevents context switches while we are adjusting the TOD */ _Thread_Disable_dispatch(); _TOD_Get( &ts ); 40007214: a2 07 bf f8 add %fp, -8, %l1 40007218: 40 00 06 93 call 40008c64 <_TOD_Get> 4000721c: 90 10 00 11 mov %l1, %o0 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 40007220: c2 04 20 04 ld [ %l0 + 4 ], %g1 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 40007224: c8 07 bf f8 ld [ %fp + -8 ], %g4 40007228: c4 04 00 00 ld [ %l0 ], %g2 ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 4000722c: 87 28 60 02 sll %g1, 2, %g3 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 40007230: 84 01 00 02 add %g4, %g2, %g2 ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 40007234: 89 28 60 07 sll %g1, 7, %g4 40007238: 86 21 00 03 sub %g4, %g3, %g3 4000723c: 82 00 c0 01 add %g3, %g1, %g1 40007240: c6 07 bf fc ld [ %fp + -4 ], %g3 40007244: 83 28 60 03 sll %g1, 3, %g1 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 40007248: c4 27 bf f8 st %g2, [ %fp + -8 ] ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 4000724c: 82 00 40 03 add %g1, %g3, %g1 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 40007250: 07 0e e6 b2 sethi %hi(0x3b9ac800), %g3 40007254: 86 10 e1 ff or %g3, 0x1ff, %g3 ! 3b9ac9ff 40007258: 80 a0 40 03 cmp %g1, %g3 4000725c: 08 80 00 0a bleu 40007284 40007260: c2 27 bf fc st %g1, [ %fp + -4 ] ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 40007264: 09 31 19 4d sethi %hi(0xc4653400), %g4 40007268: 88 11 22 00 or %g4, 0x200, %g4 ! c4653600 4000726c: 82 00 40 04 add %g1, %g4, %g1 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 40007270: 80 a0 40 03 cmp %g1, %g3 40007274: 18 bf ff fe bgu 4000726c <== NEVER TAKEN 40007278: 84 00 a0 01 inc %g2 4000727c: c2 27 bf fc st %g1, [ %fp + -4 ] 40007280: c4 27 bf f8 st %g2, [ %fp + -8 ] ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 40007284: 09 31 19 4d sethi %hi(0xc4653400), %g4 40007288: 88 11 22 00 or %g4, 0x200, %g4 ! c4653600 4000728c: 80 a0 40 04 cmp %g1, %g4 40007290: 18 80 00 0a bgu 400072b8 <== NEVER TAKEN 40007294: c4 07 bf f8 ld [ %fp + -8 ], %g2 ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; 40007298: 07 0e e6 b2 sethi %hi(0x3b9ac800), %g3 4000729c: 86 10 e2 00 or %g3, 0x200, %g3 ! 3b9aca00 400072a0: 82 00 40 03 add %g1, %g3, %g1 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 400072a4: 80 a0 40 04 cmp %g1, %g4 400072a8: 08 bf ff fe bleu 400072a0 400072ac: 84 00 bf ff add %g2, -1, %g2 400072b0: c2 27 bf fc st %g1, [ %fp + -4 ] 400072b4: c4 27 bf f8 st %g2, [ %fp + -8 ] ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; } _TOD_Set( &ts ); 400072b8: 40 00 06 95 call 40008d0c <_TOD_Set> 400072bc: 90 10 00 11 mov %l1, %o0 _Thread_Enable_dispatch(); 400072c0: 40 00 0c 79 call 4000a4a4 <_Thread_Enable_dispatch> 400072c4: b0 10 20 00 clr %i0 /* set the user's output */ if ( olddelta ) 400072c8: 80 a6 60 00 cmp %i1, 0 400072cc: 02 80 00 0c be 400072fc 400072d0: 01 00 00 00 nop *olddelta = *delta; 400072d4: c2 04 00 00 ld [ %l0 ], %g1 400072d8: c2 26 40 00 st %g1, [ %i1 ] 400072dc: c2 04 20 04 ld [ %l0 + 4 ], %g1 400072e0: c2 26 60 04 st %g1, [ %i1 + 4 ] return 0; } 400072e4: 81 c7 e0 08 ret 400072e8: 81 e8 00 00 restore */ if ( !delta ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); 400072ec: 40 00 26 db call 40010e58 <__errno> 400072f0: b0 10 3f ff mov -1, %i0 400072f4: 82 10 20 16 mov 0x16, %g1 400072f8: c2 22 00 00 st %g1, [ %o0 ] 400072fc: 81 c7 e0 08 ret 40007300: 81 e8 00 00 restore =============================================================================== 40007a50 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 40007a50: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 40007a54: 21 10 00 69 sethi %hi(0x4001a400), %l0 40007a58: 40 00 04 97 call 40008cb4 40007a5c: 90 14 23 74 or %l0, 0x374, %o0 ! 4001a774 if (fcntl (fildes, F_GETFD) < 0) { 40007a60: 90 10 00 18 mov %i0, %o0 40007a64: 40 00 1e 5f call 4000f3e0 40007a68: 92 10 20 01 mov 1, %o1 40007a6c: 80 a2 20 00 cmp %o0, 0 40007a70: 06 80 00 6c bl 40007c20 40007a74: 80 a6 60 00 cmp %i1, 0 pthread_mutex_unlock(&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EBADF); } /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { 40007a78: 02 80 00 3b be 40007b64 40007a7c: 92 10 00 18 mov %i0, %o1 pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { 40007a80: e2 06 40 00 ld [ %i1 ], %l1 40007a84: 80 a4 40 18 cmp %l1, %i0 40007a88: 12 80 00 2f bne 40007b44 40007a8c: 90 14 23 74 or %l0, 0x374, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EINVAL); } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 40007a90: 92 10 00 11 mov %l1, %o1 40007a94: 11 10 00 69 sethi %hi(0x4001a400), %o0 40007a98: 94 10 20 00 clr %o2 40007a9c: 40 00 00 cc call 40007dcc 40007aa0: 90 12 23 bc or %o0, 0x3bc, %o0 if (r_chain == NULL) { 40007aa4: b0 92 20 00 orcc %o0, 0, %i0 40007aa8: 22 80 00 0f be,a 40007ae4 40007aac: a0 14 23 74 or %l0, 0x374, %l0 return AIO_ALLDONE; } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 40007ab0: a2 06 20 1c add %i0, 0x1c, %l1 40007ab4: 40 00 04 80 call 40008cb4 40007ab8: 90 10 00 11 mov %l1, %o0 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 40007abc: 92 10 00 19 mov %i1, %o1 40007ac0: 40 00 01 e5 call 40008254 40007ac4: 90 06 20 08 add %i0, 8, %o0 40007ac8: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&r_chain->mutex); 40007acc: 40 00 04 9b call 40008d38 40007ad0: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007ad4: 40 00 04 99 call 40008d38 40007ad8: 90 14 23 74 or %l0, 0x374, %o0 return result; } return AIO_ALLDONE; } 40007adc: 81 c7 e0 08 ret 40007ae0: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one (EINVAL); } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40007ae4: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 40007ae8: 82 04 20 58 add %l0, 0x58, %g1 40007aec: 80 a0 80 01 cmp %g2, %g1 40007af0: 02 80 00 0f be 40007b2c <== NEVER TAKEN 40007af4: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40007af8: 92 10 00 11 mov %l1, %o1 40007afc: 40 00 00 b4 call 40007dcc 40007b00: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40007b04: 80 a2 20 00 cmp %o0, 0 40007b08: 02 80 00 0e be 40007b40 40007b0c: 92 10 00 19 mov %i1, %o1 rtems_set_errno_and_return_minus_one (EINVAL); } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 40007b10: 40 00 01 d1 call 40008254 40007b14: 90 02 20 08 add %o0, 8, %o0 40007b18: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007b1c: 40 00 04 87 call 40008d38 40007b20: 90 10 00 10 mov %l0, %o0 return result; 40007b24: 81 c7 e0 08 ret 40007b28: 81 e8 00 00 restore } else { pthread_mutex_unlock (&aio_request_queue.mutex); 40007b2c: 90 10 00 10 mov %l0, %o0 <== NOT EXECUTED 40007b30: 40 00 04 82 call 40008d38 40007b34: b0 10 20 02 mov 2, %i0 return AIO_ALLDONE; 40007b38: 81 c7 e0 08 ret 40007b3c: 81 e8 00 00 restore r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); if (r_chain == NULL) { pthread_mutex_unlock (&aio_request_queue.mutex); 40007b40: 90 10 00 10 mov %l0, %o0 40007b44: 40 00 04 7d call 40008d38 40007b48: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one (EINVAL); 40007b4c: 40 00 2c d2 call 40012e94 <__errno> 40007b50: 01 00 00 00 nop 40007b54: 82 10 20 16 mov 0x16, %g1 ! 16 40007b58: c2 22 00 00 st %g1, [ %o0 ] 40007b5c: 81 c7 e0 08 ret 40007b60: 81 e8 00 00 restore /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { AIO_printf ("Cancel all requests\n"); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 40007b64: 11 10 00 69 sethi %hi(0x4001a400), %o0 40007b68: 94 10 20 00 clr %o2 40007b6c: 40 00 00 98 call 40007dcc 40007b70: 90 12 23 bc or %o0, 0x3bc, %o0 if (r_chain == NULL) { 40007b74: a2 92 20 00 orcc %o0, 0, %l1 40007b78: 02 80 00 0f be 40007bb4 40007b7c: b2 04 60 1c add %l1, 0x1c, %i1 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 40007b80: 40 00 04 4d call 40008cb4 40007b84: 90 10 00 19 mov %i1, %o0 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40007b88: 40 00 0b 36 call 4000a860 <_Chain_Extract> 40007b8c: 90 10 00 11 mov %l1, %o0 rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40007b90: 40 00 01 9d call 40008204 40007b94: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&r_chain->mutex); 40007b98: 40 00 04 68 call 40008d38 40007b9c: 90 10 00 19 mov %i1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007ba0: 90 14 23 74 or %l0, 0x374, %o0 40007ba4: 40 00 04 65 call 40008d38 40007ba8: b0 10 20 00 clr %i0 return AIO_CANCELED; 40007bac: 81 c7 e0 08 ret 40007bb0: 81 e8 00 00 restore pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } return AIO_ALLDONE; } 40007bb4: a0 14 23 74 or %l0, 0x374, %l0 r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { AIO_printf ("Request chain not on [WQ]\n"); if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 40007bb8: c4 04 20 54 ld [ %l0 + 0x54 ], %g2 40007bbc: 82 04 20 58 add %l0, 0x58, %g1 40007bc0: 80 a0 80 01 cmp %g2, %g1 40007bc4: 02 bf ff da be 40007b2c <== NEVER TAKEN 40007bc8: 90 04 20 54 add %l0, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40007bcc: 92 10 00 18 mov %i0, %o1 40007bd0: 40 00 00 7f call 40007dcc 40007bd4: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40007bd8: a2 92 20 00 orcc %o0, 0, %l1 40007bdc: 22 bf ff d5 be,a 40007b30 40007be0: 90 10 00 10 mov %l0, %o0 40007be4: 40 00 0b 1f call 4000a860 <_Chain_Extract> 40007be8: b2 04 60 1c add %l1, 0x1c, %i1 } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40007bec: 40 00 01 86 call 40008204 40007bf0: 90 10 00 11 mov %l1, %o0 pthread_mutex_destroy (&r_chain->mutex); 40007bf4: 40 00 03 83 call 40008a00 40007bf8: 90 10 00 19 mov %i1, %o0 pthread_cond_destroy (&r_chain->mutex); 40007bfc: 40 00 02 a1 call 40008680 40007c00: 90 10 00 19 mov %i1, %o0 free (r_chain); 40007c04: 7f ff f1 f6 call 400043dc 40007c08: 90 10 00 11 mov %l1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; 40007c0c: b0 10 20 00 clr %i0 rtems_aio_remove_fd (r_chain); pthread_mutex_destroy (&r_chain->mutex); pthread_cond_destroy (&r_chain->mutex); free (r_chain); pthread_mutex_unlock (&aio_request_queue.mutex); 40007c10: 40 00 04 4a call 40008d38 40007c14: 90 10 00 10 mov %l0, %o0 return AIO_CANCELED; 40007c18: 81 c7 e0 08 ret 40007c1c: 81 e8 00 00 restore int result; pthread_mutex_lock (&aio_request_queue.mutex); if (fcntl (fildes, F_GETFD) < 0) { pthread_mutex_unlock(&aio_request_queue.mutex); 40007c20: 40 00 04 46 call 40008d38 40007c24: 90 14 23 74 or %l0, 0x374, %o0 rtems_set_errno_and_return_minus_one (EBADF); 40007c28: 40 00 2c 9b call 40012e94 <__errno> 40007c2c: b0 10 3f ff mov -1, %i0 40007c30: 82 10 20 09 mov 9, %g1 40007c34: c2 22 00 00 st %g1, [ %o0 ] 40007c38: 81 c7 e0 08 ret 40007c3c: 81 e8 00 00 restore =============================================================================== 40007c48 : int aio_fsync( int op, struct aiocb *aiocbp ) { 40007c48: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; if (op != O_SYNC) 40007c4c: 03 00 00 08 sethi %hi(0x2000), %g1 40007c50: 80 a6 00 01 cmp %i0, %g1 40007c54: 12 80 00 14 bne 40007ca4 40007c58: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007c5c: d0 06 40 00 ld [ %i1 ], %o0 40007c60: 40 00 1d e0 call 4000f3e0 40007c64: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40007c68: 90 0a 20 03 and %o0, 3, %o0 40007c6c: 90 02 3f ff add %o0, -1, %o0 40007c70: 80 a2 20 01 cmp %o0, 1 40007c74: 18 80 00 0c bgu 40007ca4 40007c78: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007c7c: 7f ff f3 72 call 40004a44 40007c80: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007c84: 80 a2 20 00 cmp %o0, 0 40007c88: 02 80 00 06 be 40007ca0 <== NEVER TAKEN 40007c8c: 82 10 20 03 mov 3, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 40007c90: f2 22 20 14 st %i1, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_SYNC; 40007c94: c2 26 60 30 st %g1, [ %i1 + 0x30 ] return rtems_aio_enqueue (req); 40007c98: 40 00 01 8c call 400082c8 40007c9c: 91 e8 00 08 restore %g0, %o0, %o0 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40007ca0: a0 10 20 0b mov 0xb, %l0 40007ca4: 82 10 3f ff mov -1, %g1 40007ca8: e0 26 60 34 st %l0, [ %i1 + 0x34 ] 40007cac: c2 26 60 38 st %g1, [ %i1 + 0x38 ] 40007cb0: 40 00 2c 79 call 40012e94 <__errno> 40007cb4: b0 10 3f ff mov -1, %i0 40007cb8: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } 40007cbc: 81 c7 e0 08 ret 40007cc0: 81 e8 00 00 restore =============================================================================== 400084b0 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 400084b0: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 400084b4: d0 06 00 00 ld [ %i0 ], %o0 400084b8: 40 00 1b ca call 4000f3e0 400084bc: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 400084c0: 90 0a 20 03 and %o0, 3, %o0 400084c4: 80 a2 20 02 cmp %o0, 2 400084c8: 12 80 00 1b bne 40008534 400084cc: 80 a2 20 00 cmp %o0, 0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 400084d0: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 400084d4: 80 a0 60 00 cmp %g1, 0 400084d8: 12 80 00 0f bne 40008514 400084dc: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 400084e0: c2 06 20 08 ld [ %i0 + 8 ], %g1 400084e4: 80 a0 60 00 cmp %g1, 0 400084e8: 06 80 00 0c bl 40008518 400084ec: 82 10 3f ff mov -1, %g1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 400084f0: 7f ff f1 55 call 40004a44 400084f4: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 400084f8: 80 a2 20 00 cmp %o0, 0 400084fc: 02 80 00 12 be 40008544 <== NEVER TAKEN 40008500: 82 10 20 01 mov 1, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 40008504: f0 22 20 14 st %i0, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_READ; 40008508: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 4000850c: 7f ff ff 6f call 400082c8 40008510: 91 e8 00 08 restore %g0, %o0, %o0 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 40008514: 82 10 3f ff mov -1, %g1 40008518: e0 26 20 34 st %l0, [ %i0 + 0x34 ] 4000851c: c2 26 20 38 st %g1, [ %i0 + 0x38 ] 40008520: 40 00 2a 5d call 40012e94 <__errno> 40008524: b0 10 3f ff mov -1, %i0 40008528: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; return rtems_aio_enqueue (req); } 4000852c: 81 c7 e0 08 ret 40008530: 81 e8 00 00 restore { rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40008534: 02 bf ff e7 be 400084d0 <== NEVER TAKEN 40008538: a0 10 20 09 mov 9, %l0 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 4000853c: 10 bf ff f7 b 40008518 40008540: 82 10 3f ff mov -1, %g1 40008544: 10 bf ff f4 b 40008514 <== NOT EXECUTED 40008548: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED =============================================================================== 40008554 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40008554: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40008558: d0 06 00 00 ld [ %i0 ], %o0 4000855c: 40 00 1b a1 call 4000f3e0 40008560: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40008564: 90 0a 20 03 and %o0, 3, %o0 40008568: 90 02 3f ff add %o0, -1, %o0 4000856c: 80 a2 20 01 cmp %o0, 1 40008570: 18 80 00 14 bgu 400085c0 40008574: a0 10 20 09 mov 9, %l0 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 40008578: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 4000857c: 80 a0 60 00 cmp %g1, 0 40008580: 12 80 00 10 bne 400085c0 40008584: a0 10 20 16 mov 0x16, %l0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40008588: c2 06 20 08 ld [ %i0 + 8 ], %g1 4000858c: 80 a0 60 00 cmp %g1, 0 40008590: 06 80 00 0d bl 400085c4 40008594: 82 10 3f ff mov -1, %g1 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40008598: 7f ff f1 2b call 40004a44 4000859c: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 400085a0: 80 a2 20 00 cmp %o0, 0 400085a4: 02 80 00 06 be 400085bc <== NEVER TAKEN 400085a8: 82 10 20 02 mov 2, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 400085ac: f0 22 20 14 st %i0, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_WRITE; 400085b0: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 400085b4: 7f ff ff 45 call 400082c8 400085b8: 91 e8 00 08 restore %g0, %o0, %o0 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 400085bc: a0 10 20 0b mov 0xb, %l0 <== NOT EXECUTED 400085c0: 82 10 3f ff mov -1, %g1 400085c4: e0 26 20 34 st %l0, [ %i0 + 0x34 ] 400085c8: c2 26 20 38 st %g1, [ %i0 + 0x38 ] 400085cc: 40 00 2a 32 call 40012e94 <__errno> 400085d0: b0 10 3f ff mov -1, %i0 400085d4: e0 22 00 00 st %l0, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; return rtems_aio_enqueue (req); } 400085d8: 81 c7 e0 08 ret 400085dc: 81 e8 00 00 restore =============================================================================== 40007000 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 40007000: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 40007004: 80 a6 60 00 cmp %i1, 0 40007008: 02 80 00 20 be 40007088 4000700c: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40007010: 02 80 00 19 be 40007074 40007014: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 40007018: 02 80 00 12 be 40007060 <== NEVER TAKEN 4000701c: 80 a6 20 02 cmp %i0, 2 return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 40007020: 02 80 00 10 be 40007060 40007024: 80 a6 20 03 cmp %i0, 3 return 0; } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 40007028: 02 80 00 08 be 40007048 4000702c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40007030: 40 00 29 1b call 4001149c <__errno> 40007034: b0 10 3f ff mov -1, %i0 ! ffffffff 40007038: 82 10 20 16 mov 0x16, %g1 4000703c: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40007040: 81 c7 e0 08 ret 40007044: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); 40007048: 40 00 29 15 call 4001149c <__errno> 4000704c: b0 10 3f ff mov -1, %i0 40007050: 82 10 20 58 mov 0x58, %g1 40007054: c2 22 00 00 st %g1, [ %o0 ] 40007058: 81 c7 e0 08 ret 4000705c: 81 e8 00 00 restore } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { _TOD_Get_uptime_as_timespec( tp ); 40007060: 90 10 00 19 mov %i1, %o0 40007064: 40 00 08 6f call 40009220 <_TOD_Get_uptime_as_timespec> 40007068: b0 10 20 00 clr %i0 return 0; 4000706c: 81 c7 e0 08 ret 40007070: 81 e8 00 00 restore { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { _TOD_Get(tp); 40007074: 90 10 00 19 mov %i1, %o0 40007078: 40 00 08 4f call 400091b4 <_TOD_Get> 4000707c: b0 10 20 00 clr %i0 return 0; 40007080: 81 c7 e0 08 ret 40007084: 81 e8 00 00 restore clockid_t clock_id, struct timespec *tp ) { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); 40007088: 40 00 29 05 call 4001149c <__errno> 4000708c: b0 10 3f ff mov -1, %i0 40007090: 82 10 20 16 mov 0x16, %g1 40007094: c2 22 00 00 st %g1, [ %o0 ] 40007098: 81 c7 e0 08 ret 4000709c: 81 e8 00 00 restore =============================================================================== 400070a0 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 400070a0: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 400070a4: 80 a6 60 00 cmp %i1, 0 400070a8: 02 80 00 24 be 40007138 <== NEVER TAKEN 400070ac: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 400070b0: 02 80 00 0c be 400070e0 400070b4: 80 a6 20 02 cmp %i0, 2 _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 400070b8: 02 80 00 1a be 40007120 400070bc: 80 a6 20 03 cmp %i0, 3 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) 400070c0: 02 80 00 18 be 40007120 400070c4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 400070c8: 40 00 28 f5 call 4001149c <__errno> 400070cc: b0 10 3f ff mov -1, %i0 ! ffffffff 400070d0: 82 10 20 16 mov 0x16, %g1 400070d4: c2 22 00 00 st %g1, [ %o0 ] return 0; } 400070d8: 81 c7 e0 08 ret 400070dc: 81 e8 00 00 restore { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 400070e0: c4 06 40 00 ld [ %i1 ], %g2 400070e4: 03 08 76 b9 sethi %hi(0x21dae400), %g1 400070e8: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 400070ec: 80 a0 80 01 cmp %g2, %g1 400070f0: 08 80 00 12 bleu 40007138 400070f4: 03 10 00 86 sethi %hi(0x40021800), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400070f8: c4 00 61 b0 ld [ %g1 + 0x1b0 ], %g2 ! 400219b0 <_Thread_Dispatch_disable_level> 400070fc: 84 00 a0 01 inc %g2 40007100: c4 20 61 b0 st %g2, [ %g1 + 0x1b0 ] rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); 40007104: 90 10 00 19 mov %i1, %o0 40007108: 40 00 08 5e call 40009280 <_TOD_Set> 4000710c: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 40007110: 40 00 0e 42 call 4000aa18 <_Thread_Enable_dispatch> 40007114: 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; 40007118: 81 c7 e0 08 ret 4000711c: 81 e8 00 00 restore else if ( clock_id == CLOCK_PROCESS_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) rtems_set_errno_and_return_minus_one( ENOSYS ); 40007120: 40 00 28 df call 4001149c <__errno> 40007124: b0 10 3f ff mov -1, %i0 40007128: 82 10 20 58 mov 0x58, %g1 4000712c: c2 22 00 00 st %g1, [ %o0 ] 40007130: 81 c7 e0 08 ret 40007134: 81 e8 00 00 restore if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) rtems_set_errno_and_return_minus_one( EINVAL ); 40007138: 40 00 28 d9 call 4001149c <__errno> 4000713c: b0 10 3f ff mov -1, %i0 40007140: 82 10 20 16 mov 0x16, %g1 40007144: c2 22 00 00 st %g1, [ %o0 ] 40007148: 81 c7 e0 08 ret 4000714c: 81 e8 00 00 restore =============================================================================== 40026228 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 40026228: 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() ) 4002622c: 7f ff ff 20 call 40025eac 40026230: 01 00 00 00 nop 40026234: 80 a2 00 18 cmp %o0, %i0 40026238: 12 80 00 b3 bne 40026504 4002623c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); /* * Validate the signal passed. */ if ( !sig ) 40026240: 02 80 00 b7 be 4002651c 40026244: 82 06 7f ff add %i1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 40026248: 80 a0 60 1f cmp %g1, 0x1f 4002624c: 18 80 00 b4 bgu 4002651c 40026250: a5 2e 60 02 sll %i1, 2, %l2 rtems_set_errno_and_return_minus_one( EINVAL ); /* * If the signal is being ignored, then we are out of here. */ if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) 40026254: 23 10 00 a8 sethi %hi(0x4002a000), %l1 40026258: a7 2e 60 04 sll %i1, 4, %l3 4002625c: a2 14 62 80 or %l1, 0x280, %l1 40026260: 84 24 c0 12 sub %l3, %l2, %g2 40026264: 84 04 40 02 add %l1, %g2, %g2 40026268: c4 00 a0 08 ld [ %g2 + 8 ], %g2 4002626c: 80 a0 a0 01 cmp %g2, 1 40026270: 02 80 00 42 be 40026378 40026274: b0 10 20 00 clr %i0 /* * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) 40026278: 80 a6 60 04 cmp %i1, 4 4002627c: 02 80 00 41 be 40026380 40026280: 80 a6 60 08 cmp %i1, 8 40026284: 02 80 00 3f be 40026380 40026288: 80 a6 60 0b cmp %i1, 0xb 4002628c: 02 80 00 3d be 40026380 40026290: a0 10 20 01 mov 1, %l0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 40026294: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 40026298: e0 27 bf f8 st %l0, [ %fp + -8 ] if ( !value ) { 4002629c: 80 a6 a0 00 cmp %i2, 0 400262a0: 02 80 00 3e be 40026398 400262a4: a1 2c 00 01 sll %l0, %g1, %l0 siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; 400262a8: c2 06 80 00 ld [ %i2 ], %g1 400262ac: c2 27 bf fc st %g1, [ %fp + -4 ] 400262b0: 03 10 00 a7 sethi %hi(0x40029c00), %g1 400262b4: c4 00 60 d0 ld [ %g1 + 0xd0 ], %g2 ! 40029cd0 <_Thread_Dispatch_disable_level> 400262b8: 84 00 a0 01 inc %g2 400262bc: c4 20 60 d0 st %g2, [ %g1 + 0xd0 ] /* * 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; 400262c0: 03 10 00 a8 sethi %hi(0x4002a000), %g1 400262c4: d0 00 62 34 ld [ %g1 + 0x234 ], %o0 ! 4002a234 <_Per_CPU_Information+0xc> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 400262c8: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 400262cc: c2 00 60 d0 ld [ %g1 + 0xd0 ], %g1 400262d0: 80 ac 00 01 andncc %l0, %g1, %g0 400262d4: 12 80 00 1a bne 4002633c 400262d8: 09 10 00 a9 sethi %hi(0x4002a400), %g4 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 400262dc: c2 01 20 0c ld [ %g4 + 0xc ], %g1 ! 4002a40c <_POSIX_signals_Wait_queue> 400262e0: 88 11 20 0c or %g4, 0xc, %g4 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); 400262e4: 88 01 20 04 add %g4, 4, %g4 400262e8: 80 a0 40 04 cmp %g1, %g4 400262ec: 02 80 00 2d be 400263a0 400262f0: 90 10 00 01 mov %g1, %o0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 400262f4: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 400262f8: 80 8c 00 02 btst %l0, %g2 400262fc: 02 80 00 0c be 4002632c 40026300: c6 00 61 58 ld [ %g1 + 0x158 ], %g3 /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 40026304: 10 80 00 0f b 40026340 40026308: 92 10 00 19 mov %i1, %o1 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); 4002630c: 80 a0 40 04 cmp %g1, %g4 40026310: 22 80 00 25 be,a 400263a4 <== ALWAYS TAKEN 40026314: 03 10 00 a4 sethi %hi(0x40029000), %g1 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 40026318: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 ! 40029030 <== NOT EXECUTED for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4002631c: c6 00 61 58 ld [ %g1 + 0x158 ], %g3 <== NOT EXECUTED #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 40026320: 80 8c 00 02 btst %l0, %g2 <== NOT EXECUTED 40026324: 12 80 00 06 bne 4002633c <== NOT EXECUTED 40026328: 90 10 00 01 mov %g1, %o0 <== NOT EXECUTED /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 4002632c: c4 00 e0 d0 ld [ %g3 + 0xd0 ], %g2 40026330: 80 ac 00 02 andncc %l0, %g2, %g0 40026334: 22 bf ff f6 be,a 4002630c 40026338: c2 00 40 00 ld [ %g1 ], %g1 /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 4002633c: 92 10 00 19 mov %i1, %o1 40026340: 40 00 00 8f call 4002657c <_POSIX_signals_Unblock_thread> 40026344: 94 07 bf f4 add %fp, -12, %o2 40026348: 80 8a 20 ff btst 0xff, %o0 4002634c: 12 80 00 5b bne 400264b8 40026350: 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 ); 40026354: 40 00 00 80 call 40026554 <_POSIX_signals_Set_process_signals> 40026358: 90 10 00 10 mov %l0, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 4002635c: a4 24 c0 12 sub %l3, %l2, %l2 40026360: c2 04 40 12 ld [ %l1 + %l2 ], %g1 40026364: 80 a0 60 02 cmp %g1, 2 40026368: 02 80 00 58 be 400264c8 4002636c: 11 10 00 a9 sethi %hi(0x4002a400), %o0 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 40026370: 7f ff a4 a6 call 4000f608 <_Thread_Enable_dispatch> 40026374: b0 10 20 00 clr %i0 return 0; } 40026378: 81 c7 e0 08 ret 4002637c: 81 e8 00 00 restore * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) return pthread_kill( pthread_self(), sig ); 40026380: 40 00 01 0e call 400267b8 40026384: 01 00 00 00 nop 40026388: 40 00 00 cf call 400266c4 4002638c: 92 10 00 19 mov %i1, %o1 40026390: 81 c7 e0 08 ret 40026394: 91 e8 00 08 restore %g0, %o0, %o0 */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { siginfo->si_value.sival_int = 0; 40026398: 10 bf ff c6 b 400262b0 4002639c: c0 27 bf fc clr [ %fp + -4 ] * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 400263a0: 03 10 00 a4 sethi %hi(0x40029000), %g1 400263a4: c8 08 60 64 ldub [ %g1 + 0x64 ], %g4 ! 40029064 400263a8: 15 10 00 a7 sethi %hi(0x40029c00), %o2 400263ac: 88 01 20 01 inc %g4 400263b0: 94 12 a0 40 or %o2, 0x40, %o2 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 400263b4: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 400263b8: 92 02 a0 08 add %o2, 8, %o1 */ RTEMS_INLINE_ROUTINE bool _States_Is_interruptible_by_signal ( States_Control the_states ) { return (the_states & STATES_INTERRUPTIBLE_BY_SIGNAL); 400263bc: 35 04 00 00 sethi %hi(0x10000000), %i2 for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { /* * This can occur when no one is interested and an API is not configured. */ if ( !_Objects_Information_table[ the_api ] ) 400263c0: c2 02 80 00 ld [ %o2 ], %g1 400263c4: 80 a0 60 00 cmp %g1, 0 400263c8: 22 80 00 31 be,a 4002648c <== NEVER TAKEN 400263cc: 94 02 a0 04 add %o2, 4, %o2 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 400263d0: c2 00 60 04 ld [ %g1 + 4 ], %g1 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 400263d4: da 10 60 10 lduh [ %g1 + 0x10 ], %o5 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 400263d8: 80 a3 60 00 cmp %o5, 0 400263dc: 02 80 00 2b be 40026488 400263e0: d8 00 60 1c ld [ %g1 + 0x1c ], %o4 400263e4: 82 10 20 01 mov 1, %g1 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 400263e8: 85 28 60 02 sll %g1, 2, %g2 maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { the_thread = (Thread_Control *) object_table[ index ]; 400263ec: c4 03 00 02 ld [ %o4 + %g2 ], %g2 if ( !the_thread ) 400263f0: 80 a0 a0 00 cmp %g2, 0 400263f4: 22 80 00 22 be,a 4002647c 400263f8: 82 00 60 01 inc %g1 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 400263fc: c6 00 a0 14 ld [ %g2 + 0x14 ], %g3 40026400: 80 a0 c0 04 cmp %g3, %g4 40026404: 38 80 00 1e bgu,a 4002647c 40026408: 82 00 60 01 inc %g1 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 4002640c: d6 00 a1 58 ld [ %g2 + 0x158 ], %o3 40026410: d6 02 e0 d0 ld [ %o3 + 0xd0 ], %o3 40026414: 80 ac 00 0b andncc %l0, %o3, %g0 40026418: 22 80 00 19 be,a 4002647c 4002641c: 82 00 60 01 inc %g1 * * NOTE: We initialized interested_priority to PRIORITY_MAXIMUM + 1 * so we never have to worry about deferencing a NULL * interested thread. */ if ( the_thread->current_priority < interested_priority ) { 40026420: 80 a0 c0 04 cmp %g3, %g4 40026424: 2a 80 00 14 bcs,a 40026474 40026428: 88 10 00 03 mov %g3, %g4 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { 4002642c: 80 a2 20 00 cmp %o0, 0 40026430: 22 80 00 13 be,a 4002647c <== NEVER TAKEN 40026434: 82 00 60 01 inc %g1 <== NOT EXECUTED 40026438: d6 02 20 10 ld [ %o0 + 0x10 ], %o3 4002643c: 80 a2 e0 00 cmp %o3, 0 40026440: 22 80 00 0f be,a 4002647c <== NEVER TAKEN 40026444: 82 00 60 01 inc %g1 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 40026448: de 00 a0 10 ld [ %g2 + 0x10 ], %o7 4002644c: 80 a3 e0 00 cmp %o7, 0 40026450: 22 80 00 09 be,a 40026474 40026454: 88 10 00 03 mov %g3, %g4 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 40026458: 80 8a c0 1a btst %o3, %i2 4002645c: 32 80 00 08 bne,a 4002647c 40026460: 82 00 60 01 inc %g1 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 40026464: 80 8b c0 1a btst %o7, %i2 40026468: 22 80 00 05 be,a 4002647c 4002646c: 82 00 60 01 inc %g1 */ if ( interested && !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 40026470: 88 10 00 03 mov %g3, %g4 40026474: 90 10 00 02 mov %g2, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 40026478: 82 00 60 01 inc %g1 4002647c: 80 a3 40 01 cmp %o5, %g1 40026480: 1a bf ff db bcc 400263ec 40026484: 85 28 60 02 sll %g1, 2, %g2 40026488: 94 02 a0 04 add %o2, 4, %o2 * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { 4002648c: 80 a2 80 09 cmp %o2, %o1 40026490: 32 bf ff cd bne,a 400263c4 40026494: c2 02 80 00 ld [ %o2 ], %g1 } } } } if ( interested ) { 40026498: 80 a2 20 00 cmp %o0, 0 4002649c: 02 bf ff ae be 40026354 400264a0: 92 10 00 19 mov %i1, %o1 /* * Returns true if the signal was synchronously given to a thread * blocked waiting for the signal. */ if ( _POSIX_signals_Unblock_thread( the_thread, sig, siginfo ) ) { 400264a4: 40 00 00 36 call 4002657c <_POSIX_signals_Unblock_thread> 400264a8: 94 07 bf f4 add %fp, -12, %o2 400264ac: 80 8a 20 ff btst 0xff, %o0 400264b0: 02 bf ff a9 be 40026354 <== ALWAYS TAKEN 400264b4: 01 00 00 00 nop _Thread_Enable_dispatch(); 400264b8: 7f ff a4 54 call 4000f608 <_Thread_Enable_dispatch> 400264bc: b0 10 20 00 clr %i0 ! 0 return 0; 400264c0: 81 c7 e0 08 ret 400264c4: 81 e8 00 00 restore _POSIX_signals_Set_process_signals( mask ); if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 400264c8: 7f ff 9d 20 call 4000d948 <_Chain_Get> 400264cc: 90 12 20 00 mov %o0, %o0 if ( !psiginfo ) { 400264d0: 92 92 20 00 orcc %o0, 0, %o1 400264d4: 02 80 00 18 be 40026534 400264d8: c2 07 bf f4 ld [ %fp + -12 ], %g1 rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 400264dc: 11 10 00 a9 sethi %hi(0x4002a400), %o0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 400264e0: c2 22 60 08 st %g1, [ %o1 + 8 ] 400264e4: c2 07 bf f8 ld [ %fp + -8 ], %g1 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 400264e8: 90 12 20 78 or %o0, 0x78, %o0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 400264ec: c2 22 60 0c st %g1, [ %o1 + 0xc ] 400264f0: c2 07 bf fc ld [ %fp + -4 ], %g1 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 400264f4: 90 02 00 12 add %o0, %l2, %o0 400264f8: 7f ff 9c fe call 4000d8f0 <_Chain_Append> 400264fc: c2 22 60 10 st %g1, [ %o1 + 0x10 ] 40026500: 30 bf ff 9c b,a 40026370 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) rtems_set_errno_and_return_minus_one( ESRCH ); 40026504: 7f ff be 8b call 40015f30 <__errno> 40026508: b0 10 3f ff mov -1, %i0 4002650c: 82 10 20 03 mov 3, %g1 40026510: c2 22 00 00 st %g1, [ %o0 ] 40026514: 81 c7 e0 08 ret 40026518: 81 e8 00 00 restore */ if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); 4002651c: 7f ff be 85 call 40015f30 <__errno> 40026520: b0 10 3f ff mov -1, %i0 40026524: 82 10 20 16 mov 0x16, %g1 40026528: c2 22 00 00 st %g1, [ %o0 ] 4002652c: 81 c7 e0 08 ret 40026530: 81 e8 00 00 restore if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { _Thread_Enable_dispatch(); 40026534: 7f ff a4 35 call 4000f608 <_Thread_Enable_dispatch> 40026538: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EAGAIN ); 4002653c: 7f ff be 7d call 40015f30 <__errno> 40026540: 01 00 00 00 nop 40026544: 82 10 20 0b mov 0xb, %g1 ! b 40026548: c2 22 00 00 st %g1, [ %o0 ] 4002654c: 81 c7 e0 08 ret 40026550: 81 e8 00 00 restore =============================================================================== 4000c0b0 : int oflag, ... /* mode_t mode, */ /* struct mq_attr attr */ ) { 4000c0b0: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4000c0b4: 03 10 00 a7 sethi %hi(0x40029c00), %g1 4000c0b8: c4 00 60 20 ld [ %g1 + 0x20 ], %g2 ! 40029c20 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 4000c0bc: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 4000c0c0: 84 00 a0 01 inc %g2 4000c0c4: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 4000c0c8: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 4000c0cc: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 4000c0d0: c4 20 60 20 st %g2, [ %g1 + 0x20 ] POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 4000c0d4: a8 8e 62 00 andcc %i1, 0x200, %l4 4000c0d8: 12 80 00 34 bne 4000c1a8 4000c0dc: a6 10 20 00 clr %l3 RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) _Objects_Allocate( &_POSIX_Message_queue_Information_fds ); 4000c0e0: 23 10 00 a8 sethi %hi(0x4002a000), %l1 4000c0e4: 40 00 0c 79 call 4000f2c8 <_Objects_Allocate> 4000c0e8: 90 14 61 0c or %l1, 0x10c, %o0 ! 4002a10c <_POSIX_Message_queue_Information_fds> attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { 4000c0ec: a0 92 20 00 orcc %o0, 0, %l0 4000c0f0: 02 80 00 37 be 4000c1cc <== NEVER TAKEN 4000c0f4: 01 00 00 00 nop _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENFILE ); } the_mq_fd->oflag = oflag; 4000c0f8: f2 24 20 14 st %i1, [ %l0 + 0x14 ] status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); 4000c0fc: 90 10 00 18 mov %i0, %o0 4000c100: 40 00 1e 7f call 40013afc <_POSIX_Message_queue_Name_to_id> 4000c104: 92 07 bf f8 add %fp, -8, %o1 * If the name to id translation worked, then the message queue exists * and we can just return a pointer to the id. Otherwise we may * need to check to see if this is a "message queue does not exist" * or some other miscellaneous error on the name. */ if ( status ) { 4000c108: a4 92 20 00 orcc %o0, 0, %l2 4000c10c: 22 80 00 0f be,a 4000c148 4000c110: 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) ) ) { 4000c114: 80 a4 a0 02 cmp %l2, 2 4000c118: 02 80 00 40 be 4000c218 4000c11c: 80 a5 20 00 cmp %l4, 0 RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free_fd ( POSIX_Message_queue_Control_fd *the_mq_fd ) { _Objects_Free( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); 4000c120: 90 14 61 0c or %l1, 0x10c, %o0 4000c124: 40 00 0d 58 call 4000f684 <_Objects_Free> 4000c128: 92 10 00 10 mov %l0, %o1 _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 4000c12c: 40 00 10 e8 call 400104cc <_Thread_Enable_dispatch> 4000c130: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); 4000c134: 40 00 2d 82 call 4001773c <__errno> 4000c138: 01 00 00 00 nop 4000c13c: e4 22 00 00 st %l2, [ %o0 ] 4000c140: 81 c7 e0 08 ret 4000c144: 81 e8 00 00 restore } else { /* name -> ID translation succeeded */ /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 4000c148: 80 a6 6a 00 cmp %i1, 0xa00 4000c14c: 02 80 00 28 be 4000c1ec 4000c150: d2 07 bf f8 ld [ %fp + -8 ], %o1 Objects_Id id, Objects_Locations *location ) { return (POSIX_Message_queue_Control *) _Objects_Get( &_POSIX_Message_queue_Information, id, location ); 4000c154: 94 07 bf f0 add %fp, -16, %o2 4000c158: 11 10 00 a7 sethi %hi(0x40029c00), %o0 4000c15c: 40 00 0d b0 call 4000f81c <_Objects_Get> 4000c160: 90 12 23 80 or %o0, 0x380, %o0 ! 40029f80 <_POSIX_Message_queue_Information> /* * In this case we need to do an ID->pointer conversion to * check the mode. */ the_mq = _POSIX_Message_queue_Get( the_mq_id, &location ); the_mq->open_count += 1; 4000c164: c4 02 20 18 ld [ %o0 + 0x18 ], %g2 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( 4000c168: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 4000c16c: 84 00 a0 01 inc %g2 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } 4000c170: a2 14 61 0c or %l1, 0x10c, %l1 /* * In this case we need to do an ID->pointer conversion to * check the mode. */ the_mq = _POSIX_Message_queue_Get( the_mq_id, &location ); the_mq->open_count += 1; 4000c174: c4 22 20 18 st %g2, [ %o0 + 0x18 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000c178: c4 04 60 1c ld [ %l1 + 0x1c ], %g2 /* * In this case we need to do an ID->pointer conversion to * check the mode. */ the_mq = _POSIX_Message_queue_Get( the_mq_id, &location ); 4000c17c: d0 27 bf f4 st %o0, [ %fp + -12 ] the_mq->open_count += 1; the_mq_fd->Queue = the_mq; 4000c180: d0 24 20 10 st %o0, [ %l0 + 0x10 ] 4000c184: 83 28 60 02 sll %g1, 2, %g1 4000c188: e0 20 80 01 st %l0, [ %g2 + %g1 ] _Objects_Open_string( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 4000c18c: 40 00 10 d0 call 400104cc <_Thread_Enable_dispatch> 4000c190: c0 24 20 0c clr [ %l0 + 0xc ] _Thread_Enable_dispatch(); 4000c194: 40 00 10 ce call 400104cc <_Thread_Enable_dispatch> 4000c198: 01 00 00 00 nop return (mqd_t)the_mq_fd->Object.id; 4000c19c: f0 04 20 08 ld [ %l0 + 8 ], %i0 4000c1a0: 81 c7 e0 08 ret 4000c1a4: 81 e8 00 00 restore _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); 4000c1a8: 82 07 a0 54 add %fp, 0x54, %g1 4000c1ac: e6 07 a0 50 ld [ %fp + 0x50 ], %l3 4000c1b0: c2 27 bf fc st %g1, [ %fp + -4 ] RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) _Objects_Allocate( &_POSIX_Message_queue_Information_fds ); 4000c1b4: 23 10 00 a8 sethi %hi(0x4002a000), %l1 4000c1b8: 40 00 0c 44 call 4000f2c8 <_Objects_Allocate> 4000c1bc: 90 14 61 0c or %l1, 0x10c, %o0 ! 4002a10c <_POSIX_Message_queue_Information_fds> va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { 4000c1c0: a0 92 20 00 orcc %o0, 0, %l0 4000c1c4: 32 bf ff ce bne,a 4000c0fc 4000c1c8: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _Thread_Enable_dispatch(); 4000c1cc: 40 00 10 c0 call 400104cc <_Thread_Enable_dispatch> 4000c1d0: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( ENFILE ); 4000c1d4: 40 00 2d 5a call 4001773c <__errno> 4000c1d8: 01 00 00 00 nop 4000c1dc: 82 10 20 17 mov 0x17, %g1 ! 17 4000c1e0: c2 22 00 00 st %g1, [ %o0 ] 4000c1e4: 81 c7 e0 08 ret 4000c1e8: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free_fd ( POSIX_Message_queue_Control_fd *the_mq_fd ) { _Objects_Free( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); 4000c1ec: 90 14 61 0c or %l1, 0x10c, %o0 4000c1f0: 40 00 0d 25 call 4000f684 <_Objects_Free> 4000c1f4: 92 10 00 10 mov %l0, %o1 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 4000c1f8: 40 00 10 b5 call 400104cc <_Thread_Enable_dispatch> 4000c1fc: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t ); 4000c200: 40 00 2d 4f call 4001773c <__errno> 4000c204: 01 00 00 00 nop 4000c208: 82 10 20 11 mov 0x11, %g1 ! 11 4000c20c: c2 22 00 00 st %g1, [ %o0 ] 4000c210: 81 c7 e0 08 ret 4000c214: 81 e8 00 00 restore if ( status ) { /* * Unless provided a valid name that did not already exist * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { 4000c218: 02 bf ff c3 be 4000c124 4000c21c: 90 14 61 0c or %l1, 0x10c, %o0 /* * At this point, the message queue does not exist and everything has been * checked. We should go ahead and create a message queue. */ status = _POSIX_Message_queue_Create_support( 4000c220: 90 10 00 18 mov %i0, %o0 4000c224: 92 10 20 01 mov 1, %o1 4000c228: 94 10 00 13 mov %l3, %o2 4000c22c: 40 00 1d d0 call 4001396c <_POSIX_Message_queue_Create_support> 4000c230: 96 07 bf f4 add %fp, -12, %o3 ); /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { 4000c234: 80 a2 3f ff cmp %o0, -1 4000c238: 02 80 00 0d be 4000c26c 4000c23c: c6 07 bf f4 ld [ %fp + -12 ], %g3 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( 4000c240: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } 4000c244: a2 14 61 0c or %l1, 0x10c, %l1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000c248: c4 04 60 1c ld [ %l1 + 0x1c ], %g2 _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); return (mqd_t) -1; } the_mq_fd->Queue = the_mq; 4000c24c: c6 24 20 10 st %g3, [ %l0 + 0x10 ] 4000c250: 83 28 60 02 sll %g1, 2, %g1 4000c254: e0 20 80 01 st %l0, [ %g2 + %g1 ] &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 4000c258: 40 00 10 9d call 400104cc <_Thread_Enable_dispatch> 4000c25c: c0 24 20 0c clr [ %l0 + 0xc ] return (mqd_t) the_mq_fd->Object.id; 4000c260: f0 04 20 08 ld [ %l0 + 8 ], %i0 } 4000c264: 81 c7 e0 08 ret 4000c268: 81 e8 00 00 restore 4000c26c: 90 14 61 0c or %l1, 0x10c, %o0 4000c270: 92 10 00 10 mov %l0, %o1 4000c274: 40 00 0d 04 call 4000f684 <_Objects_Free> 4000c278: b0 10 3f ff mov -1, %i0 /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 4000c27c: 40 00 10 94 call 400104cc <_Thread_Enable_dispatch> 4000c280: 01 00 00 00 nop return (mqd_t) -1; 4000c284: 81 c7 e0 08 ret 4000c288: 81 e8 00 00 restore =============================================================================== 4000c7a8 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 4000c7a8: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 4000c7ac: 80 a0 60 00 cmp %g1, 0 4000c7b0: 02 80 00 09 be 4000c7d4 4000c7b4: 90 10 20 16 mov 0x16, %o0 4000c7b8: c4 00 40 00 ld [ %g1 ], %g2 4000c7bc: 80 a0 a0 00 cmp %g2, 0 4000c7c0: 02 80 00 05 be 4000c7d4 4000c7c4: 80 a2 60 04 cmp %o1, 4 return EINVAL; switch ( policy ) { 4000c7c8: 08 80 00 05 bleu 4000c7dc 4000c7cc: 84 10 20 01 mov 1, %g2 case SCHED_SPORADIC: attr->schedpolicy = policy; return 0; default: return ENOTSUP; 4000c7d0: 90 10 20 86 mov 0x86, %o0 } } 4000c7d4: 81 c3 e0 08 retl 4000c7d8: 01 00 00 00 nop ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( policy ) { 4000c7dc: 85 28 80 09 sll %g2, %o1, %g2 4000c7e0: 80 88 a0 17 btst 0x17, %g2 4000c7e4: 22 bf ff fc be,a 4000c7d4 <== NEVER TAKEN 4000c7e8: 90 10 20 86 mov 0x86, %o0 <== NOT EXECUTED case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 4000c7ec: d2 20 60 14 st %o1, [ %g1 + 0x14 ] return 0; 4000c7f0: 81 c3 e0 08 retl 4000c7f4: 90 10 20 00 clr %o0 =============================================================================== 40007594 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 40007594: 9d e3 bf 90 save %sp, -112, %sp 40007598: a0 10 00 18 mov %i0, %l0 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 4000759c: 80 a4 20 00 cmp %l0, 0 400075a0: 02 80 00 26 be 40007638 400075a4: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( count == 0 ) 400075a8: 80 a6 a0 00 cmp %i2, 0 400075ac: 02 80 00 23 be 40007638 400075b0: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 400075b4: 22 80 00 27 be,a 40007650 400075b8: b2 07 bf f0 add %fp, -16, %i1 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 400075bc: c2 06 40 00 ld [ %i1 ], %g1 400075c0: 80 a0 60 00 cmp %g1, 0 400075c4: 02 80 00 1d be 40007638 400075c8: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 400075cc: c2 06 60 04 ld [ %i1 + 4 ], %g1 400075d0: 80 a0 60 00 cmp %g1, 0 400075d4: 12 80 00 19 bne 40007638 <== NEVER TAKEN 400075d8: 03 10 00 63 sethi %hi(0x40018c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400075dc: c4 00 63 80 ld [ %g1 + 0x380 ], %g2 ! 40018f80 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 400075e0: c0 27 bf f8 clr [ %fp + -8 ] 400075e4: 84 00 a0 01 inc %g2 the_attributes.maximum_count = count; 400075e8: f4 27 bf fc st %i2, [ %fp + -4 ] 400075ec: c4 20 63 80 st %g2, [ %g1 + 0x380 ] * 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 ); 400075f0: 25 10 00 64 sethi %hi(0x40019000), %l2 400075f4: 40 00 08 ee call 400099ac <_Objects_Allocate> 400075f8: 90 14 a3 60 or %l2, 0x360, %o0 ! 40019360 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 400075fc: a2 92 20 00 orcc %o0, 0, %l1 40007600: 02 80 00 10 be 40007640 40007604: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 40007608: 40 00 06 30 call 40008ec8 <_CORE_barrier_Initialize> 4000760c: 92 07 bf f8 add %fp, -8, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007610: 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; } 40007614: a4 14 a3 60 or %l2, 0x360, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007618: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 4000761c: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007620: 85 28 a0 02 sll %g2, 2, %g2 40007624: 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; 40007628: c0 24 60 0c clr [ %l1 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 4000762c: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 40007630: 40 00 0d 42 call 4000ab38 <_Thread_Enable_dispatch> 40007634: b0 10 20 00 clr %i0 return 0; } 40007638: 81 c7 e0 08 ret 4000763c: 81 e8 00 00 restore _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); 40007640: 40 00 0d 3e call 4000ab38 <_Thread_Enable_dispatch> 40007644: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40007648: 81 c7 e0 08 ret 4000764c: 81 e8 00 00 restore * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 40007650: 7f ff ff 9a call 400074b8 40007654: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40007658: 10 bf ff da b 400075c0 4000765c: c2 06 40 00 ld [ %i1 ], %g1 =============================================================================== 40006e14 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 40006e14: 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 ) 40006e18: 80 a6 20 00 cmp %i0, 0 40006e1c: 02 80 00 15 be 40006e70 40006e20: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40006e24: 03 10 00 65 sethi %hi(0x40019400), %g1 40006e28: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 ! 40019430 <_Thread_Dispatch_disable_level> 40006e2c: 84 00 a0 01 inc %g2 40006e30: c4 20 60 30 st %g2, [ %g1 + 0x30 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 40006e34: 40 00 12 9b call 4000b8a0 <_Workspace_Allocate> 40006e38: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 40006e3c: 80 a2 20 00 cmp %o0, 0 40006e40: 02 80 00 0a be 40006e68 <== NEVER TAKEN 40006e44: 01 00 00 00 nop thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40006e48: 03 10 00 66 sethi %hi(0x40019800), %g1 40006e4c: c2 00 61 94 ld [ %g1 + 0x194 ], %g1 ! 40019994 <_Per_CPU_Information+0xc> handler_stack = &thread_support->Cancellation_Handlers; handler->routine = routine; handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); 40006e50: 92 10 00 08 mov %o0, %o1 handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); if ( handler ) { thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; 40006e54: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 handler->routine = routine; 40006e58: f0 22 20 08 st %i0, [ %o0 + 8 ] handler->arg = arg; 40006e5c: f2 22 20 0c st %i1, [ %o0 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 40006e60: 40 00 06 61 call 400087e4 <_Chain_Append> 40006e64: 90 00 60 e4 add %g1, 0xe4, %o0 } _Thread_Enable_dispatch(); 40006e68: 40 00 0d 75 call 4000a43c <_Thread_Enable_dispatch> 40006e6c: 81 e8 00 00 restore 40006e70: 81 c7 e0 08 ret 40006e74: 81 e8 00 00 restore =============================================================================== 40007de4 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 40007de4: 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; 40007de8: 80 a6 60 00 cmp %i1, 0 40007dec: 02 80 00 26 be 40007e84 40007df0: a2 10 00 18 mov %i0, %l1 else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 40007df4: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007df8: 80 a0 60 01 cmp %g1, 1 40007dfc: 02 80 00 20 be 40007e7c <== NEVER TAKEN 40007e00: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !the_attr->is_initialized ) 40007e04: c2 06 40 00 ld [ %i1 ], %g1 40007e08: 80 a0 60 00 cmp %g1, 0 40007e0c: 02 80 00 1c be 40007e7c 40007e10: 03 10 00 68 sethi %hi(0x4001a000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007e14: c4 00 61 40 ld [ %g1 + 0x140 ], %g2 ! 4001a140 <_Thread_Dispatch_disable_level> 40007e18: 84 00 a0 01 inc %g2 40007e1c: c4 20 61 40 st %g2, [ %g1 + 0x140 ] RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 40007e20: 25 10 00 69 sethi %hi(0x4001a400), %l2 40007e24: 40 00 0a 63 call 4000a7b0 <_Objects_Allocate> 40007e28: 90 14 a1 b8 or %l2, 0x1b8, %o0 ! 4001a5b8 <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 40007e2c: a0 92 20 00 orcc %o0, 0, %l0 40007e30: 02 80 00 18 be 40007e90 40007e34: 90 04 20 18 add %l0, 0x18, %o0 _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40007e38: c2 06 60 04 ld [ %i1 + 4 ], %g1 the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40007e3c: 92 10 20 00 clr %o1 40007e40: 15 04 00 02 sethi %hi(0x10000800), %o2 40007e44: 96 10 20 74 mov 0x74, %o3 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40007e48: c2 24 20 10 st %g1, [ %l0 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40007e4c: 40 00 10 e9 call 4000c1f0 <_Thread_queue_Initialize> 40007e50: c0 24 20 14 clr [ %l0 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007e54: c4 14 20 0a lduh [ %l0 + 0xa ], %g2 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 40007e58: a4 14 a1 b8 or %l2, 0x1b8, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007e5c: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007e60: c2 04 20 08 ld [ %l0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007e64: 85 28 a0 02 sll %g2, 2, %g2 40007e68: e0 20 c0 02 st %l0, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 40007e6c: c0 24 20 0c clr [ %l0 + 0xc ] &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 40007e70: c2 24 40 00 st %g1, [ %l1 ] _Thread_Enable_dispatch(); 40007e74: 40 00 0e b2 call 4000b93c <_Thread_Enable_dispatch> 40007e78: b0 10 20 00 clr %i0 return 0; } 40007e7c: 81 c7 e0 08 ret 40007e80: 81 e8 00 00 restore { POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; else the_attr = &_POSIX_Condition_variables_Default_attributes; 40007e84: 33 10 00 62 sethi %hi(0x40018800), %i1 40007e88: 10 bf ff db b 40007df4 40007e8c: b2 16 63 1c or %i1, 0x31c, %i1 ! 40018b1c <_POSIX_Condition_variables_Default_attributes> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { _Thread_Enable_dispatch(); 40007e90: 40 00 0e ab call 4000b93c <_Thread_Enable_dispatch> 40007e94: b0 10 20 0c mov 0xc, %i0 return ENOMEM; 40007e98: 81 c7 e0 08 ret 40007e9c: 81 e8 00 00 restore =============================================================================== 40007c44 : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 40007c44: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 40007c48: 80 a0 60 00 cmp %g1, 0 40007c4c: 02 80 00 08 be 40007c6c 40007c50: 90 10 20 16 mov 0x16, %o0 40007c54: c4 00 40 00 ld [ %g1 ], %g2 40007c58: 80 a0 a0 00 cmp %g2, 0 40007c5c: 02 80 00 04 be 40007c6c <== NEVER TAKEN 40007c60: 01 00 00 00 nop return EINVAL; attr->is_initialized = false; 40007c64: c0 20 40 00 clr [ %g1 ] return 0; 40007c68: 90 10 20 00 clr %o0 } 40007c6c: 81 c3 e0 08 retl =============================================================================== 400072dc : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 400072dc: 9d e3 bf 58 save %sp, -168, %sp 400072e0: a0 10 00 18 mov %i0, %l0 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 400072e4: 80 a6 a0 00 cmp %i2, 0 400072e8: 02 80 00 63 be 40007474 400072ec: b0 10 20 0e mov 0xe, %i0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 400072f0: 80 a6 60 00 cmp %i1, 0 400072f4: 22 80 00 62 be,a 4000747c 400072f8: 33 10 00 7c sethi %hi(0x4001f000), %i1 if ( !the_attr->is_initialized ) 400072fc: c2 06 40 00 ld [ %i1 ], %g1 40007300: 80 a0 60 00 cmp %g1, 0 40007304: 02 80 00 5c be 40007474 40007308: 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) ) 4000730c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007310: 80 a0 60 00 cmp %g1, 0 40007314: 02 80 00 07 be 40007330 40007318: 03 10 00 7f sethi %hi(0x4001fc00), %g1 4000731c: c4 06 60 08 ld [ %i1 + 8 ], %g2 40007320: c2 00 62 54 ld [ %g1 + 0x254 ], %g1 40007324: 80 a0 80 01 cmp %g2, %g1 40007328: 0a 80 00 8d bcs 4000755c 4000732c: 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 ) { 40007330: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 40007334: 80 a0 60 01 cmp %g1, 1 40007338: 02 80 00 53 be 40007484 4000733c: 80 a0 60 02 cmp %g1, 2 40007340: 12 80 00 4d bne 40007474 40007344: b0 10 20 16 mov 0x16, %i0 schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 40007348: d6 06 60 18 ld [ %i1 + 0x18 ], %o3 4000734c: d8 06 60 1c ld [ %i1 + 0x1c ], %o4 40007350: da 06 60 20 ld [ %i1 + 0x20 ], %o5 40007354: c8 06 60 24 ld [ %i1 + 0x24 ], %g4 40007358: c6 06 60 28 ld [ %i1 + 0x28 ], %g3 4000735c: c4 06 60 2c ld [ %i1 + 0x2c ], %g2 40007360: c2 06 60 30 ld [ %i1 + 0x30 ], %g1 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 40007364: e2 06 60 14 ld [ %i1 + 0x14 ], %l1 schedparam = the_attr->schedparam; 40007368: d6 27 bf dc st %o3, [ %fp + -36 ] 4000736c: d8 27 bf e0 st %o4, [ %fp + -32 ] 40007370: da 27 bf e4 st %o5, [ %fp + -28 ] 40007374: c8 27 bf e8 st %g4, [ %fp + -24 ] 40007378: c6 27 bf ec st %g3, [ %fp + -20 ] 4000737c: c4 27 bf f0 st %g2, [ %fp + -16 ] 40007380: c2 27 bf f4 st %g1, [ %fp + -12 ] /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 40007384: c2 06 60 0c ld [ %i1 + 0xc ], %g1 40007388: 80 a0 60 00 cmp %g1, 0 4000738c: 12 80 00 3a bne 40007474 40007390: b0 10 20 86 mov 0x86, %i0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 40007394: d0 07 bf dc ld [ %fp + -36 ], %o0 40007398: 40 00 1c 00 call 4000e398 <_POSIX_Priority_Is_valid> 4000739c: b0 10 20 16 mov 0x16, %i0 400073a0: 80 8a 20 ff btst 0xff, %o0 400073a4: 02 80 00 34 be 40007474 <== NEVER TAKEN 400073a8: 03 10 00 7f sethi %hi(0x4001fc00), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 400073ac: e8 07 bf dc ld [ %fp + -36 ], %l4 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 400073b0: 90 10 00 11 mov %l1, %o0 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 400073b4: ea 08 62 58 ldub [ %g1 + 0x258 ], %l5 400073b8: 92 07 bf dc add %fp, -36, %o1 400073bc: 94 07 bf fc add %fp, -4, %o2 400073c0: 40 00 1c 03 call 4000e3cc <_POSIX_Thread_Translate_sched_param> 400073c4: 96 07 bf f8 add %fp, -8, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 400073c8: b0 92 20 00 orcc %o0, 0, %i0 400073cc: 12 80 00 2a bne 40007474 400073d0: 27 10 00 82 sethi %hi(0x40020800), %l3 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 400073d4: d0 04 e1 e0 ld [ %l3 + 0x1e0 ], %o0 ! 400209e0 <_RTEMS_Allocator_Mutex> 400073d8: 40 00 06 79 call 40008dbc <_API_Mutex_Lock> 400073dc: 2d 10 00 82 sethi %hi(0x40020800), %l6 * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 400073e0: 40 00 09 4c call 40009910 <_Objects_Allocate> 400073e4: 90 15 a3 80 or %l6, 0x380, %o0 ! 40020b80 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 400073e8: a4 92 20 00 orcc %o0, 0, %l2 400073ec: 02 80 00 1f be 40007468 400073f0: 05 10 00 7f sethi %hi(0x4001fc00), %g2 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 400073f4: c2 06 60 08 ld [ %i1 + 8 ], %g1 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 400073f8: d6 00 a2 54 ld [ %g2 + 0x254 ], %o3 400073fc: 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( 40007400: 80 a2 c0 01 cmp %o3, %g1 40007404: 1a 80 00 03 bcc 40007410 40007408: d4 06 60 04 ld [ %i1 + 4 ], %o2 4000740c: 96 10 00 01 mov %g1, %o3 40007410: c2 07 bf fc ld [ %fp + -4 ], %g1 40007414: c0 27 bf d4 clr [ %fp + -44 ] 40007418: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 4000741c: 82 10 20 01 mov 1, %g1 40007420: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007424: c2 07 bf f8 ld [ %fp + -8 ], %g1 40007428: 9a 0d 60 ff and %l5, 0xff, %o5 4000742c: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40007430: 82 07 bf d4 add %fp, -44, %g1 40007434: c0 23 a0 68 clr [ %sp + 0x68 ] 40007438: 90 15 a3 80 or %l6, 0x380, %o0 4000743c: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 40007440: 92 10 00 12 mov %l2, %o1 40007444: 98 10 20 00 clr %o4 40007448: 40 00 0d c9 call 4000ab6c <_Thread_Initialize> 4000744c: 9a 23 40 14 sub %o5, %l4, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 40007450: 80 8a 20 ff btst 0xff, %o0 40007454: 12 80 00 1f bne 400074d0 40007458: 11 10 00 82 sethi %hi(0x40020800), %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 4000745c: 92 10 00 12 mov %l2, %o1 40007460: 40 00 0a 1b call 40009ccc <_Objects_Free> 40007464: 90 12 23 80 or %o0, 0x380, %o0 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 40007468: d0 04 e1 e0 ld [ %l3 + 0x1e0 ], %o0 4000746c: 40 00 06 6a call 40008e14 <_API_Mutex_Unlock> 40007470: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40007474: 81 c7 e0 08 ret 40007478: 81 e8 00 00 restore int rc; if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 4000747c: 10 bf ff a0 b 400072fc 40007480: b2 16 61 04 or %i1, 0x104, %i1 * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40007484: 03 10 00 83 sethi %hi(0x40020c00), %g1 40007488: c2 00 62 84 ld [ %g1 + 0x284 ], %g1 ! 40020e84 <_Per_CPU_Information+0xc> 4000748c: c2 00 61 58 ld [ %g1 + 0x158 ], %g1 schedpolicy = api->schedpolicy; schedparam = api->schedparam; 40007490: d4 00 60 88 ld [ %g1 + 0x88 ], %o2 40007494: d6 00 60 8c ld [ %g1 + 0x8c ], %o3 40007498: d8 00 60 90 ld [ %g1 + 0x90 ], %o4 4000749c: da 00 60 94 ld [ %g1 + 0x94 ], %o5 400074a0: c8 00 60 98 ld [ %g1 + 0x98 ], %g4 400074a4: c6 00 60 9c ld [ %g1 + 0x9c ], %g3 400074a8: c4 00 60 a0 ld [ %g1 + 0xa0 ], %g2 * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; schedpolicy = api->schedpolicy; 400074ac: e2 00 60 84 ld [ %g1 + 0x84 ], %l1 schedparam = api->schedparam; 400074b0: d4 27 bf dc st %o2, [ %fp + -36 ] 400074b4: d6 27 bf e0 st %o3, [ %fp + -32 ] 400074b8: d8 27 bf e4 st %o4, [ %fp + -28 ] 400074bc: da 27 bf e8 st %o5, [ %fp + -24 ] 400074c0: c8 27 bf ec st %g4, [ %fp + -20 ] 400074c4: c6 27 bf f0 st %g3, [ %fp + -16 ] break; 400074c8: 10 bf ff af b 40007384 400074cc: c4 27 bf f4 st %g2, [ %fp + -12 ] } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 400074d0: e8 04 a1 58 ld [ %l2 + 0x158 ], %l4 api->Attributes = *the_attr; 400074d4: 92 10 00 19 mov %i1, %o1 400074d8: 94 10 20 40 mov 0x40, %o2 400074dc: 40 00 29 1d call 40011950 400074e0: 90 10 00 14 mov %l4, %o0 api->detachstate = the_attr->detachstate; 400074e4: c2 06 60 3c ld [ %i1 + 0x3c ], %g1 api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 400074e8: 90 10 00 12 mov %l2, %o0 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; 400074ec: c2 25 20 40 st %g1, [ %l4 + 0x40 ] api->schedpolicy = schedpolicy; api->schedparam = schedparam; 400074f0: c2 07 bf dc ld [ %fp + -36 ], %g1 */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; 400074f4: e2 25 20 84 st %l1, [ %l4 + 0x84 ] api->schedparam = schedparam; 400074f8: c2 25 20 88 st %g1, [ %l4 + 0x88 ] 400074fc: c2 07 bf e0 ld [ %fp + -32 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40007500: 92 10 20 01 mov 1, %o1 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40007504: c2 25 20 8c st %g1, [ %l4 + 0x8c ] 40007508: c2 07 bf e4 ld [ %fp + -28 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 4000750c: 94 10 00 1a mov %i2, %o2 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40007510: c2 25 20 90 st %g1, [ %l4 + 0x90 ] 40007514: c2 07 bf e8 ld [ %fp + -24 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40007518: 96 10 00 1b mov %i3, %o3 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 4000751c: c2 25 20 94 st %g1, [ %l4 + 0x94 ] 40007520: c2 07 bf ec ld [ %fp + -20 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40007524: 98 10 20 00 clr %o4 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40007528: c2 25 20 98 st %g1, [ %l4 + 0x98 ] 4000752c: c2 07 bf f0 ld [ %fp + -16 ], %g1 40007530: c2 25 20 9c st %g1, [ %l4 + 0x9c ] 40007534: c2 07 bf f4 ld [ %fp + -12 ], %g1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40007538: 40 00 10 2e call 4000b5f0 <_Thread_Start> 4000753c: c2 25 20 a0 st %g1, [ %l4 + 0xa0 ] _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 40007540: 80 a4 60 04 cmp %l1, 4 40007544: 02 80 00 08 be 40007564 40007548: 01 00 00 00 nop } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 4000754c: c2 04 a0 08 ld [ %l2 + 8 ], %g1 _RTEMS_Unlock_allocator(); 40007550: d0 04 e1 e0 ld [ %l3 + 0x1e0 ], %o0 40007554: 40 00 06 30 call 40008e14 <_API_Mutex_Unlock> 40007558: c2 24 00 00 st %g1, [ %l0 ] return 0; 4000755c: 81 c7 e0 08 ret 40007560: 81 e8 00 00 restore return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { _Watchdog_Insert_ticks( 40007564: 40 00 10 a7 call 4000b800 <_Timespec_To_ticks> 40007568: 90 05 20 90 add %l4, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000756c: 92 05 20 a8 add %l4, 0xa8, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40007570: d0 25 20 b4 st %o0, [ %l4 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007574: 11 10 00 82 sethi %hi(0x40020800), %o0 40007578: 40 00 11 90 call 4000bbb8 <_Watchdog_Insert> 4000757c: 90 12 22 00 or %o0, 0x200, %o0 ! 40020a00 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 40007580: 10 bf ff f4 b 40007550 40007584: c2 04 a0 08 ld [ %l2 + 8 ], %g1 =============================================================================== 400092e8 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 400092e8: 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 ); 400092ec: 90 10 00 19 mov %i1, %o0 400092f0: 40 00 00 39 call 400093d4 <_POSIX_Absolute_timeout_to_ticks> 400092f4: 92 07 bf fc add %fp, -4, %o1 400092f8: a0 10 00 08 mov %o0, %l0 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 400092fc: 80 a4 20 03 cmp %l0, 3 40009300: 02 80 00 10 be 40009340 40009304: 90 10 00 18 mov %i0, %o0 do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 40009308: d4 07 bf fc ld [ %fp + -4 ], %o2 4000930c: 7f ff ff bd call 40009200 <_POSIX_Mutex_Lock_support> 40009310: 92 10 20 00 clr %o1 * This service only gives us the option to block. We used a polling * attempt to lock if the abstime was not in the future. If we did * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { 40009314: 80 a2 20 10 cmp %o0, 0x10 40009318: 02 80 00 04 be 40009328 <== ALWAYS TAKEN 4000931c: 80 a4 20 00 cmp %l0, 0 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } 40009320: 81 c7 e0 08 ret 40009324: 91 e8 00 08 restore %g0, %o0, %o0 * attempt to lock if the abstime was not in the future. If we did * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40009328: 02 80 00 0b be 40009354 <== NEVER TAKEN 4000932c: a0 04 3f ff add %l0, -1, %l0 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40009330: 80 a4 20 01 cmp %l0, 1 40009334: 28 bf ff fb bleu,a 40009320 <== ALWAYS TAKEN 40009338: 90 10 20 74 mov 0x74, %o0 4000933c: 30 bf ff f9 b,a 40009320 <== NOT EXECUTED */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 40009340: d4 07 bf fc ld [ %fp + -4 ], %o2 40009344: 7f ff ff af call 40009200 <_POSIX_Mutex_Lock_support> 40009348: 92 10 20 01 mov 1, %o1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } 4000934c: 81 c7 e0 08 ret 40009350: 91 e8 00 08 restore %g0, %o0, %o0 * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) return EINVAL; 40009354: 10 bf ff f3 b 40009320 <== NOT EXECUTED 40009358: 90 10 20 16 mov 0x16, %o0 <== NOT EXECUTED =============================================================================== 40006cf0 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 40006cf0: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40006cf4: 80 a0 60 00 cmp %g1, 0 40006cf8: 02 80 00 0b be 40006d24 40006cfc: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40006d00: c4 00 40 00 ld [ %g1 ], %g2 40006d04: 80 a0 a0 00 cmp %g2, 0 40006d08: 02 80 00 07 be 40006d24 40006d0c: 80 a2 60 00 cmp %o1, 0 return EINVAL; if ( !type ) 40006d10: 02 80 00 05 be 40006d24 <== NEVER TAKEN 40006d14: 01 00 00 00 nop return EINVAL; *type = attr->type; 40006d18: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 40006d1c: 90 10 20 00 clr %o0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 40006d20: c2 22 40 00 st %g1, [ %o1 ] return 0; } 40006d24: 81 c3 e0 08 retl =============================================================================== 40008eb0 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 40008eb0: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40008eb4: 80 a0 60 00 cmp %g1, 0 40008eb8: 02 80 00 08 be 40008ed8 40008ebc: 90 10 20 16 mov 0x16, %o0 40008ec0: c4 00 40 00 ld [ %g1 ], %g2 40008ec4: 80 a0 a0 00 cmp %g2, 0 40008ec8: 02 80 00 04 be 40008ed8 40008ecc: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40008ed0: 28 80 00 04 bleu,a 40008ee0 <== ALWAYS TAKEN 40008ed4: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; default: return EINVAL; } } 40008ed8: 81 c3 e0 08 retl 40008edc: 01 00 00 00 nop 40008ee0: 81 c3 e0 08 retl 40008ee4: 90 10 20 00 clr %o0 ! 0 =============================================================================== 40006d80 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 40006d80: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40006d84: 80 a0 60 00 cmp %g1, 0 40006d88: 02 80 00 08 be 40006da8 40006d8c: 90 10 20 16 mov 0x16, %o0 40006d90: c4 00 40 00 ld [ %g1 ], %g2 40006d94: 80 a0 a0 00 cmp %g2, 0 40006d98: 02 80 00 04 be 40006da8 <== NEVER TAKEN 40006d9c: 80 a2 60 03 cmp %o1, 3 return EINVAL; switch ( type ) { 40006da0: 28 80 00 04 bleu,a 40006db0 40006da4: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; default: return EINVAL; } } 40006da8: 81 c3 e0 08 retl 40006dac: 01 00 00 00 nop 40006db0: 81 c3 e0 08 retl 40006db4: 90 10 20 00 clr %o0 ! 0 =============================================================================== 400079c4 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 400079c4: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 400079c8: 80 a6 60 00 cmp %i1, 0 400079cc: 02 80 00 0b be 400079f8 400079d0: a0 10 00 18 mov %i0, %l0 400079d4: 80 a6 20 00 cmp %i0, 0 400079d8: 02 80 00 08 be 400079f8 400079dc: 01 00 00 00 nop return EINVAL; if ( !once_control->init_executed ) { 400079e0: c2 06 20 04 ld [ %i0 + 4 ], %g1 400079e4: 80 a0 60 00 cmp %g1, 0 400079e8: 02 80 00 06 be 40007a00 400079ec: b0 10 20 00 clr %i0 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 400079f0: 81 c7 e0 08 ret 400079f4: 81 e8 00 00 restore 400079f8: 81 c7 e0 08 ret 400079fc: 91 e8 20 16 restore %g0, 0x16, %o0 if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 40007a00: a2 07 bf fc add %fp, -4, %l1 40007a04: 90 10 21 00 mov 0x100, %o0 40007a08: 92 10 21 00 mov 0x100, %o1 40007a0c: 40 00 03 1c call 4000867c 40007a10: 94 10 00 11 mov %l1, %o2 if ( !once_control->init_executed ) { 40007a14: c2 04 20 04 ld [ %l0 + 4 ], %g1 40007a18: 80 a0 60 00 cmp %g1, 0 40007a1c: 02 80 00 09 be 40007a40 <== ALWAYS TAKEN 40007a20: 82 10 20 01 mov 1, %g1 once_control->is_initialized = true; once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 40007a24: d0 07 bf fc ld [ %fp + -4 ], %o0 40007a28: 92 10 21 00 mov 0x100, %o1 40007a2c: 94 10 00 11 mov %l1, %o2 40007a30: 40 00 03 13 call 4000867c 40007a34: b0 10 20 00 clr %i0 40007a38: 81 c7 e0 08 ret 40007a3c: 81 e8 00 00 restore if ( !once_control->init_executed ) { rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); if ( !once_control->init_executed ) { once_control->is_initialized = true; 40007a40: c2 24 00 00 st %g1, [ %l0 ] once_control->init_executed = true; (*init_routine)(); 40007a44: 9f c6 40 00 call %i1 40007a48: c2 24 20 04 st %g1, [ %l0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 40007a4c: 10 bf ff f7 b 40007a28 40007a50: d0 07 bf fc ld [ %fp + -4 ], %o0 =============================================================================== 400081ac : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 400081ac: 9d e3 bf 90 save %sp, -112, %sp 400081b0: a0 10 00 18 mov %i0, %l0 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 400081b4: 80 a4 20 00 cmp %l0, 0 400081b8: 02 80 00 23 be 40008244 400081bc: b0 10 20 16 mov 0x16, %i0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 400081c0: 80 a6 60 00 cmp %i1, 0 400081c4: 22 80 00 26 be,a 4000825c 400081c8: b2 07 bf f4 add %fp, -12, %i1 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 400081cc: c2 06 40 00 ld [ %i1 ], %g1 400081d0: 80 a0 60 00 cmp %g1, 0 400081d4: 02 80 00 1c be 40008244 <== NEVER TAKEN 400081d8: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 400081dc: c2 06 60 04 ld [ %i1 + 4 ], %g1 400081e0: 80 a0 60 00 cmp %g1, 0 400081e4: 12 80 00 18 bne 40008244 <== NEVER TAKEN 400081e8: 03 10 00 6d sethi %hi(0x4001b400), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 400081ec: c4 00 61 b0 ld [ %g1 + 0x1b0 ], %g2 ! 4001b5b0 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 400081f0: c0 27 bf fc clr [ %fp + -4 ] 400081f4: 84 00 a0 01 inc %g2 400081f8: c4 20 61 b0 st %g2, [ %g1 + 0x1b0 ] * 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 ); 400081fc: 25 10 00 6d sethi %hi(0x4001b400), %l2 40008200: 40 00 0a 7a call 4000abe8 <_Objects_Allocate> 40008204: 90 14 a3 d0 or %l2, 0x3d0, %o0 ! 4001b7d0 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 40008208: a2 92 20 00 orcc %o0, 0, %l1 4000820c: 02 80 00 10 be 4000824c 40008210: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 40008214: 40 00 08 0e call 4000a24c <_CORE_RWLock_Initialize> 40008218: 92 07 bf fc add %fp, -4, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 4000821c: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 40008220: a4 14 a3 d0 or %l2, 0x3d0, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40008224: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40008228: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000822c: 85 28 a0 02 sll %g2, 2, %g2 40008230: 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; 40008234: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 40008238: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 4000823c: 40 00 0e ce call 4000bd74 <_Thread_Enable_dispatch> 40008240: b0 10 20 00 clr %i0 return 0; } 40008244: 81 c7 e0 08 ret 40008248: 81 e8 00 00 restore _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { _Thread_Enable_dispatch(); 4000824c: 40 00 0e ca call 4000bd74 <_Thread_Enable_dispatch> 40008250: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 40008254: 81 c7 e0 08 ret 40008258: 81 e8 00 00 restore * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 4000825c: 40 00 02 7c call 40008c4c 40008260: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40008264: 10 bf ff db b 400081d0 40008268: c2 06 40 00 ld [ %i1 ], %g1 =============================================================================== 400082dc : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 400082dc: 9d e3 bf 98 save %sp, -104, %sp Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 400082e0: 80 a6 20 00 cmp %i0, 0 400082e4: 02 80 00 24 be 40008374 400082e8: a0 10 20 16 mov 0x16, %l0 * * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); 400082ec: 92 07 bf f8 add %fp, -8, %o1 400082f0: 40 00 1c 60 call 4000f470 <_POSIX_Absolute_timeout_to_ticks> 400082f4: 90 10 00 19 mov %i1, %o0 400082f8: d2 06 00 00 ld [ %i0 ], %o1 400082fc: a2 10 00 08 mov %o0, %l1 40008300: 94 07 bf fc add %fp, -4, %o2 40008304: 11 10 00 6d sethi %hi(0x4001b400), %o0 40008308: 40 00 0b 8d call 4000b13c <_Objects_Get> 4000830c: 90 12 23 d0 or %o0, 0x3d0, %o0 ! 4001b7d0 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40008310: c2 07 bf fc ld [ %fp + -4 ], %g1 40008314: 80 a0 60 00 cmp %g1, 0 40008318: 12 80 00 17 bne 40008374 4000831c: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 40008320: 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, 40008324: 82 1c 60 03 xor %l1, 3, %g1 40008328: 90 02 20 10 add %o0, 0x10, %o0 4000832c: 80 a0 00 01 cmp %g0, %g1 40008330: 98 10 20 00 clr %o4 40008334: a4 60 3f ff subx %g0, -1, %l2 40008338: 40 00 07 d0 call 4000a278 <_CORE_RWLock_Obtain_for_reading> 4000833c: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40008340: 40 00 0e 8d call 4000bd74 <_Thread_Enable_dispatch> 40008344: 01 00 00 00 nop if ( !do_wait ) { 40008348: 80 a4 a0 00 cmp %l2, 0 4000834c: 12 80 00 12 bne 40008394 40008350: 03 10 00 6e sethi %hi(0x4001b800), %g1 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 40008354: c2 00 63 14 ld [ %g1 + 0x314 ], %g1 ! 4001bb14 <_Per_CPU_Information+0xc> 40008358: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000835c: 80 a2 20 02 cmp %o0, 2 40008360: 02 80 00 07 be 4000837c 40008364: 80 a4 60 00 cmp %l1, 0 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 40008368: 40 00 00 3f call 40008464 <_POSIX_RWLock_Translate_core_RWLock_return_code> 4000836c: 01 00 00 00 nop 40008370: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40008374: 81 c7 e0 08 ret 40008378: 91 e8 00 10 restore %g0, %l0, %o0 ); _Thread_Enable_dispatch(); if ( !do_wait ) { if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 4000837c: 02 bf ff fe be 40008374 <== NEVER TAKEN 40008380: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40008384: 80 a4 60 01 cmp %l1, 1 40008388: 18 bf ff f8 bgu 40008368 <== NEVER TAKEN 4000838c: a0 10 20 74 mov 0x74, %l0 40008390: 30 bf ff f9 b,a 40008374 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait ) { 40008394: c2 00 63 14 ld [ %g1 + 0x314 ], %g1 40008398: 10 bf ff f4 b 40008368 4000839c: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 =============================================================================== 400083a0 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 400083a0: 9d e3 bf 98 save %sp, -104, %sp Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 400083a4: 80 a6 20 00 cmp %i0, 0 400083a8: 02 80 00 24 be 40008438 400083ac: a0 10 20 16 mov 0x16, %l0 * * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); 400083b0: 92 07 bf f8 add %fp, -8, %o1 400083b4: 40 00 1c 2f call 4000f470 <_POSIX_Absolute_timeout_to_ticks> 400083b8: 90 10 00 19 mov %i1, %o0 400083bc: d2 06 00 00 ld [ %i0 ], %o1 400083c0: a2 10 00 08 mov %o0, %l1 400083c4: 94 07 bf fc add %fp, -4, %o2 400083c8: 11 10 00 6d sethi %hi(0x4001b400), %o0 400083cc: 40 00 0b 5c call 4000b13c <_Objects_Get> 400083d0: 90 12 23 d0 or %o0, 0x3d0, %o0 ! 4001b7d0 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 400083d4: c2 07 bf fc ld [ %fp + -4 ], %g1 400083d8: 80 a0 60 00 cmp %g1, 0 400083dc: 12 80 00 17 bne 40008438 400083e0: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 400083e4: 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, 400083e8: 82 1c 60 03 xor %l1, 3, %g1 400083ec: 90 02 20 10 add %o0, 0x10, %o0 400083f0: 80 a0 00 01 cmp %g0, %g1 400083f4: 98 10 20 00 clr %o4 400083f8: a4 60 3f ff subx %g0, -1, %l2 400083fc: 40 00 07 d5 call 4000a350 <_CORE_RWLock_Obtain_for_writing> 40008400: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40008404: 40 00 0e 5c call 4000bd74 <_Thread_Enable_dispatch> 40008408: 01 00 00 00 nop if ( !do_wait && 4000840c: 80 a4 a0 00 cmp %l2, 0 40008410: 12 80 00 12 bne 40008458 40008414: 03 10 00 6e sethi %hi(0x4001b800), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 40008418: c2 00 63 14 ld [ %g1 + 0x314 ], %g1 ! 4001bb14 <_Per_CPU_Information+0xc> 4000841c: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 40008420: 80 a2 20 02 cmp %o0, 2 40008424: 02 80 00 07 be 40008440 40008428: 80 a4 60 00 cmp %l1, 0 if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( 4000842c: 40 00 00 0e call 40008464 <_POSIX_RWLock_Translate_core_RWLock_return_code> 40008430: 01 00 00 00 nop 40008434: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 40008438: 81 c7 e0 08 ret 4000843c: 91 e8 00 10 restore %g0, %l0, %o0 ); _Thread_Enable_dispatch(); if ( !do_wait && (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40008440: 02 bf ff fe be 40008438 <== NEVER TAKEN 40008444: a2 04 7f ff add %l1, -1, %l1 return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40008448: 80 a4 60 01 cmp %l1, 1 4000844c: 18 bf ff f8 bgu 4000842c <== NEVER TAKEN 40008450: a0 10 20 74 mov 0x74, %l0 40008454: 30 bf ff f9 b,a 40008438 ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 40008458: c2 00 63 14 ld [ %g1 + 0x314 ], %g1 4000845c: 10 bf ff f4 b 4000842c 40008460: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 =============================================================================== 40008c74 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 40008c74: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40008c78: 80 a0 60 00 cmp %g1, 0 40008c7c: 02 80 00 08 be 40008c9c 40008c80: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40008c84: c4 00 40 00 ld [ %g1 ], %g2 40008c88: 80 a0 a0 00 cmp %g2, 0 40008c8c: 02 80 00 04 be 40008c9c 40008c90: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 40008c94: 28 80 00 04 bleu,a 40008ca4 <== ALWAYS TAKEN 40008c98: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; default: return EINVAL; } } 40008c9c: 81 c3 e0 08 retl 40008ca0: 01 00 00 00 nop 40008ca4: 81 c3 e0 08 retl 40008ca8: 90 10 20 00 clr %o0 ! 0 =============================================================================== 40009c18 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 40009c18: 9d e3 bf 90 save %sp, -112, %sp 40009c1c: a0 10 00 18 mov %i0, %l0 int rc; /* * Check all the parameters */ if ( !param ) 40009c20: 80 a6 a0 00 cmp %i2, 0 40009c24: 02 80 00 3b be 40009d10 40009c28: b0 10 20 16 mov 0x16, %i0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 40009c2c: 90 10 00 19 mov %i1, %o0 40009c30: 92 10 00 1a mov %i2, %o1 40009c34: 94 07 bf fc add %fp, -4, %o2 40009c38: 40 00 1a 54 call 40010588 <_POSIX_Thread_Translate_sched_param> 40009c3c: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 40009c40: b0 92 20 00 orcc %o0, 0, %i0 40009c44: 12 80 00 33 bne 40009d10 40009c48: 92 10 00 10 mov %l0, %o1 40009c4c: 11 10 00 73 sethi %hi(0x4001cc00), %o0 40009c50: 94 07 bf f4 add %fp, -12, %o2 40009c54: 40 00 08 c2 call 4000bf5c <_Objects_Get> 40009c58: 90 12 23 60 or %o0, 0x360, %o0 /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 40009c5c: c2 07 bf f4 ld [ %fp + -12 ], %g1 40009c60: 80 a0 60 00 cmp %g1, 0 40009c64: 12 80 00 2d bne 40009d18 40009c68: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40009c6c: e0 02 21 58 ld [ %o0 + 0x158 ], %l0 if ( api->schedpolicy == SCHED_SPORADIC ) 40009c70: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 40009c74: 80 a0 60 04 cmp %g1, 4 40009c78: 02 80 00 33 be 40009d44 40009c7c: 01 00 00 00 nop (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; 40009c80: f2 24 20 84 st %i1, [ %l0 + 0x84 ] api->schedparam = *param; 40009c84: c2 06 80 00 ld [ %i2 ], %g1 the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40009c88: 80 a6 60 00 cmp %i1, 0 if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; 40009c8c: c2 24 20 88 st %g1, [ %l0 + 0x88 ] 40009c90: c4 06 a0 04 ld [ %i2 + 4 ], %g2 40009c94: c4 24 20 8c st %g2, [ %l0 + 0x8c ] 40009c98: c4 06 a0 08 ld [ %i2 + 8 ], %g2 40009c9c: c4 24 20 90 st %g2, [ %l0 + 0x90 ] 40009ca0: c4 06 a0 0c ld [ %i2 + 0xc ], %g2 40009ca4: c4 24 20 94 st %g2, [ %l0 + 0x94 ] 40009ca8: c4 06 a0 10 ld [ %i2 + 0x10 ], %g2 40009cac: c4 24 20 98 st %g2, [ %l0 + 0x98 ] 40009cb0: c4 06 a0 14 ld [ %i2 + 0x14 ], %g2 40009cb4: c4 24 20 9c st %g2, [ %l0 + 0x9c ] 40009cb8: c4 06 a0 18 ld [ %i2 + 0x18 ], %g2 40009cbc: c4 24 20 a0 st %g2, [ %l0 + 0xa0 ] the_thread->budget_algorithm = budget_algorithm; 40009cc0: c4 07 bf fc ld [ %fp + -4 ], %g2 40009cc4: c4 24 60 7c st %g2, [ %l1 + 0x7c ] the_thread->budget_callout = budget_callout; 40009cc8: c4 07 bf f8 ld [ %fp + -8 ], %g2 switch ( api->schedpolicy ) { 40009ccc: 06 80 00 0f bl 40009d08 <== NEVER TAKEN 40009cd0: c4 24 60 80 st %g2, [ %l1 + 0x80 ] 40009cd4: 80 a6 60 02 cmp %i1, 2 40009cd8: 14 80 00 12 bg 40009d20 40009cdc: 80 a6 60 04 cmp %i1, 4 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 40009ce0: 05 10 00 73 sethi %hi(0x4001cc00), %g2 40009ce4: 07 10 00 70 sethi %hi(0x4001c000), %g3 40009ce8: c4 00 a0 64 ld [ %g2 + 0x64 ], %g2 40009cec: d2 08 e1 d8 ldub [ %g3 + 0x1d8 ], %o1 40009cf0: c4 24 60 78 st %g2, [ %l1 + 0x78 ] 40009cf4: 92 22 40 01 sub %o1, %g1, %o1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40009cf8: 90 10 00 11 mov %l1, %o0 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; the_thread->real_priority = 40009cfc: d2 24 60 18 st %o1, [ %l1 + 0x18 ] _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40009d00: 40 00 0a 67 call 4000c69c <_Thread_Change_priority> 40009d04: 94 10 20 01 mov 1, %o2 _Watchdog_Remove( &api->Sporadic_timer ); _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); break; } _Thread_Enable_dispatch(); 40009d08: 40 00 0b a3 call 4000cb94 <_Thread_Enable_dispatch> 40009d0c: 01 00 00 00 nop return 0; 40009d10: 81 c7 e0 08 ret 40009d14: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return ESRCH; } 40009d18: 81 c7 e0 08 ret 40009d1c: 91 e8 20 03 restore %g0, 3, %o0 api->schedpolicy = policy; api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40009d20: 12 bf ff fa bne 40009d08 <== NEVER TAKEN 40009d24: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 40009d28: c2 24 20 a4 st %g1, [ %l0 + 0xa4 ] _Watchdog_Remove( &api->Sporadic_timer ); 40009d2c: 40 00 10 8a call 4000df54 <_Watchdog_Remove> 40009d30: 90 04 20 a8 add %l0, 0xa8, %o0 _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 40009d34: 90 10 20 00 clr %o0 40009d38: 7f ff ff 6a call 40009ae0 <_POSIX_Threads_Sporadic_budget_TSR> 40009d3c: 92 10 00 11 mov %l1, %o1 break; 40009d40: 30 bf ff f2 b,a 40009d08 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); 40009d44: 40 00 10 84 call 4000df54 <_Watchdog_Remove> 40009d48: 90 04 20 a8 add %l0, 0xa8, %o0 api->schedpolicy = policy; 40009d4c: 10 bf ff ce b 40009c84 40009d50: f2 24 20 84 st %i1, [ %l0 + 0x84 ] =============================================================================== 40007668 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 40007668: 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() ) 4000766c: 21 10 00 66 sethi %hi(0x40019800), %l0 40007670: a0 14 21 88 or %l0, 0x188, %l0 ! 40019988 <_Per_CPU_Information> 40007674: c2 04 20 08 ld [ %l0 + 8 ], %g1 40007678: 80 a0 60 00 cmp %g1, 0 4000767c: 12 80 00 15 bne 400076d0 <== NEVER TAKEN 40007680: 01 00 00 00 nop 40007684: 03 10 00 65 sethi %hi(0x40019400), %g1 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40007688: c4 04 20 0c ld [ %l0 + 0xc ], %g2 4000768c: c6 00 60 30 ld [ %g1 + 0x30 ], %g3 40007690: c4 00 a1 58 ld [ %g2 + 0x158 ], %g2 40007694: 86 00 e0 01 inc %g3 40007698: c6 20 60 30 st %g3, [ %g1 + 0x30 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000769c: c2 00 a0 d8 ld [ %g2 + 0xd8 ], %g1 400076a0: 80 a0 60 00 cmp %g1, 0 400076a4: 12 80 00 0d bne 400076d8 <== NEVER TAKEN 400076a8: 01 00 00 00 nop 400076ac: c2 00 a0 e0 ld [ %g2 + 0xe0 ], %g1 400076b0: 80 a0 60 00 cmp %g1, 0 400076b4: 02 80 00 09 be 400076d8 400076b8: 01 00 00 00 nop thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 400076bc: 40 00 0b 60 call 4000a43c <_Thread_Enable_dispatch> 400076c0: b2 10 3f ff mov -1, %i1 ! ffffffff if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 400076c4: f0 04 20 0c ld [ %l0 + 0xc ], %i0 400076c8: 40 00 1a 1b call 4000df34 <_POSIX_Thread_Exit> 400076cc: 81 e8 00 00 restore 400076d0: 81 c7 e0 08 ret <== NOT EXECUTED 400076d4: 81 e8 00 00 restore <== NOT EXECUTED _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 400076d8: 40 00 0b 59 call 4000a43c <_Thread_Enable_dispatch> 400076dc: 81 e8 00 00 restore =============================================================================== 400082c8 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 400082c8: 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); 400082cc: 21 10 00 69 sethi %hi(0x4001a400), %l0 400082d0: 40 00 02 79 call 40008cb4 400082d4: 90 14 23 74 or %l0, 0x374, %o0 ! 4001a774 if (result != 0) { 400082d8: a2 92 20 00 orcc %o0, 0, %l1 400082dc: 12 80 00 31 bne 400083a0 <== NEVER TAKEN 400082e0: 90 10 00 18 mov %i0, %o0 return result; } /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); 400082e4: 40 00 04 bc call 400095d4 400082e8: a4 14 23 74 or %l0, 0x374, %l2 400082ec: 92 07 bf f8 add %fp, -8, %o1 400082f0: 40 00 03 a2 call 40009178 400082f4: 94 07 bf dc add %fp, -36, %o2 req->caller_thread = pthread_self (); 400082f8: 40 00 04 b7 call 400095d4 400082fc: 01 00 00 00 nop req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40008300: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 req->policy = policy; 40008304: c6 07 bf f8 ld [ %fp + -8 ], %g3 /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40008308: c4 00 60 18 ld [ %g1 + 0x18 ], %g2 req->policy = policy; 4000830c: c6 26 20 08 st %g3, [ %i0 + 8 ] /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40008310: c6 07 bf dc ld [ %fp + -36 ], %g3 /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); 40008314: d0 26 20 10 st %o0, [ %i0 + 0x10 ] req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40008318: 84 20 c0 02 sub %g3, %g2, %g2 4000831c: c4 26 20 0c st %g2, [ %i0 + 0xc ] req->policy = policy; req->aiocbp->error_code = EINPROGRESS; req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 40008320: c4 04 a0 68 ld [ %l2 + 0x68 ], %g2 pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; req->policy = policy; req->aiocbp->error_code = EINPROGRESS; 40008324: 86 10 20 77 mov 0x77, %g3 req->aiocbp->return_value = 0; 40008328: c0 20 60 38 clr [ %g1 + 0x38 ] if ((aio_request_queue.idle_threads == 0) && 4000832c: 80 a0 a0 00 cmp %g2, 0 40008330: 12 80 00 06 bne 40008348 <== NEVER TAKEN 40008334: c6 20 60 34 st %g3, [ %g1 + 0x34 ] 40008338: c4 04 a0 64 ld [ %l2 + 0x64 ], %g2 4000833c: 80 a0 a0 04 cmp %g2, 4 40008340: 24 80 00 1c ble,a 400083b0 40008344: d2 00 40 00 ld [ %g1 ], %o1 else { /* the maximum number of threads has been already created even though some of them might be idle. The request belongs to one of the active fd chain */ r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40008348: d2 00 40 00 ld [ %g1 ], %o1 4000834c: 94 10 20 00 clr %o2 40008350: 11 10 00 69 sethi %hi(0x4001a400), %o0 40008354: 7f ff fe 9e call 40007dcc 40008358: 90 12 23 bc or %o0, 0x3bc, %o0 ! 4001a7bc req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 4000835c: a6 92 20 00 orcc %o0, 0, %l3 40008360: 22 80 00 32 be,a 40008428 40008364: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 { pthread_mutex_lock (&r_chain->mutex); 40008368: a4 04 e0 1c add %l3, 0x1c, %l2 4000836c: 40 00 02 52 call 40008cb4 40008370: 90 10 00 12 mov %l2, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 40008374: 90 04 e0 08 add %l3, 8, %o0 40008378: 7f ff ff 84 call 40008188 4000837c: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 40008380: 40 00 01 25 call 40008814 40008384: 90 04 e0 20 add %l3, 0x20, %o0 pthread_mutex_unlock (&r_chain->mutex); 40008388: 40 00 02 6c call 40008d38 4000838c: 90 10 00 12 mov %l2, %o0 if (aio_request_queue.idle_threads > 0) pthread_cond_signal (&aio_request_queue.new_req); } } pthread_mutex_unlock (&aio_request_queue.mutex); 40008390: 40 00 02 6a call 40008d38 40008394: 90 14 23 74 or %l0, 0x374, %o0 return 0; } 40008398: 81 c7 e0 08 ret 4000839c: 91 e8 00 11 restore %g0, %l1, %o0 /* The queue should be initialized */ AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED); result = pthread_mutex_lock (&aio_request_queue.mutex); if (result != 0) { free (req); 400083a0: 7f ff f0 0f call 400043dc <== NOT EXECUTED 400083a4: b0 10 00 11 mov %l1, %i0 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); return 0; } 400083a8: 81 c7 e0 08 ret <== NOT EXECUTED 400083ac: 81 e8 00 00 restore <== NOT EXECUTED if ((aio_request_queue.idle_threads == 0) && aio_request_queue.active_threads < AIO_MAX_THREADS) /* we still have empty places on the active_threads chain */ { chain = &aio_request_queue.work_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 400083b0: 90 04 a0 48 add %l2, 0x48, %o0 400083b4: 7f ff fe 86 call 40007dcc 400083b8: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 400083bc: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 400083c0: 80 a0 60 01 cmp %g1, 1 400083c4: 12 bf ff e9 bne 40008368 400083c8: a6 10 00 08 mov %o0, %l3 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); 400083cc: 90 02 20 08 add %o0, 8, %o0 400083d0: 40 00 09 41 call 4000a8d4 <_Chain_Insert> 400083d4: 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); 400083d8: 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; 400083dc: c0 24 e0 18 clr [ %l3 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 400083e0: 40 00 01 db call 40008b4c 400083e4: 90 04 e0 1c add %l3, 0x1c, %o0 pthread_cond_init (&r_chain->cond, NULL); 400083e8: 92 10 20 00 clr %o1 400083ec: 40 00 00 db call 40008758 400083f0: 90 04 e0 20 add %l3, 0x20, %o0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 400083f4: 90 07 bf fc add %fp, -4, %o0 400083f8: 92 04 a0 08 add %l2, 8, %o1 400083fc: 96 10 00 13 mov %l3, %o3 40008400: 15 10 00 1f sethi %hi(0x40007c00), %o2 40008404: 40 00 02 b2 call 40008ecc 40008408: 94 12 a3 10 or %o2, 0x310, %o2 ! 40007f10 rtems_aio_handle, (void *) r_chain); if (result != 0) { 4000840c: 82 92 20 00 orcc %o0, 0, %g1 40008410: 12 80 00 25 bne 400084a4 <== NEVER TAKEN 40008414: 90 10 00 12 mov %l2, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); return result; } ++aio_request_queue.active_threads; 40008418: c2 04 a0 64 ld [ %l2 + 0x64 ], %g1 4000841c: 82 00 60 01 inc %g1 40008420: 10 bf ff dc b 40008390 40008424: c2 24 a0 64 st %g1, [ %l2 + 0x64 ] } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 40008428: 11 10 00 69 sethi %hi(0x4001a400), %o0 4000842c: d2 00 40 00 ld [ %g1 ], %o1 40008430: 90 12 23 c8 or %o0, 0x3c8, %o0 40008434: 7f ff fe 66 call 40007dcc 40008438: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 4000843c: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 40008440: 80 a0 60 01 cmp %g1, 1 40008444: 02 80 00 0c be 40008474 40008448: a6 10 00 08 mov %o0, %l3 r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); pthread_cond_init (&r_chain->cond, NULL); } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); 4000844c: 90 02 20 08 add %o0, 8, %o0 40008450: 7f ff ff 4e call 40008188 40008454: 92 10 00 18 mov %i0, %o1 if (aio_request_queue.idle_threads > 0) 40008458: c2 04 a0 68 ld [ %l2 + 0x68 ], %g1 4000845c: 80 a0 60 00 cmp %g1, 0 40008460: 04 bf ff cc ble 40008390 <== ALWAYS TAKEN 40008464: 01 00 00 00 nop pthread_cond_signal (&aio_request_queue.new_req); 40008468: 40 00 00 eb call 40008814 <== NOT EXECUTED 4000846c: 90 04 a0 04 add %l2, 4, %o0 <== NOT EXECUTED 40008470: 30 bf ff c8 b,a 40008390 <== NOT EXECUTED 40008474: 92 10 00 18 mov %i0, %o1 40008478: 40 00 09 17 call 4000a8d4 <_Chain_Insert> 4000847c: 90 02 20 08 add %o0, 8, %o0 /* 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); 40008480: 90 04 e0 1c add %l3, 0x1c, %o0 if (r_chain->new_fd == 1) { /* If this is a new fd chain we signal the idle threads that might be waiting for requests */ AIO_printf (" New chain on waiting queue \n "); rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; 40008484: c0 24 e0 18 clr [ %l3 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40008488: 40 00 01 b1 call 40008b4c 4000848c: 92 10 20 00 clr %o1 pthread_cond_init (&r_chain->cond, NULL); 40008490: 90 04 e0 20 add %l3, 0x20, %o0 40008494: 40 00 00 b1 call 40008758 40008498: 92 10 20 00 clr %o1 } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); if (aio_request_queue.idle_threads > 0) 4000849c: 10 bf ff f0 b 4000845c 400084a0: c2 04 a0 68 ld [ %l2 + 0x68 ], %g1 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, rtems_aio_handle, (void *) r_chain); if (result != 0) { pthread_mutex_unlock (&aio_request_queue.mutex); 400084a4: 40 00 02 25 call 40008d38 <== NOT EXECUTED 400084a8: a2 10 00 01 mov %g1, %l1 <== NOT EXECUTED return result; 400084ac: 30 bf ff bb b,a 40008398 <== NOT EXECUTED =============================================================================== 40007f10 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 40007f10: 9d e3 bf 78 save %sp, -136, %sp struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 40007f14: 29 10 00 69 sethi %hi(0x4001a400), %l4 40007f18: a2 06 20 1c add %i0, 0x1c, %l1 40007f1c: a8 15 23 74 or %l4, 0x374, %l4 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 40007f20: ac 07 bf f4 add %fp, -12, %l6 timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40007f24: ae 10 00 14 mov %l4, %l7 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)) { 40007f28: ba 05 20 58 add %l4, 0x58, %i5 --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40007f2c: b8 05 20 04 add %l4, 4, %i4 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); 40007f30: a6 07 bf fc add %fp, -4, %l3 40007f34: a4 07 bf d8 add %fp, -40, %l2 default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 40007f38: aa 10 3f ff mov -1, %l5 /* 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); 40007f3c: 40 00 03 5e call 40008cb4 40007f40: 90 10 00 11 mov %l1, %o0 if (result != 0) 40007f44: 80 a2 20 00 cmp %o0, 0 40007f48: 12 80 00 2a bne 40007ff0 <== NEVER TAKEN 40007f4c: 01 00 00 00 nop } } AIO_printf ("Thread finished\n"); return NULL; } 40007f50: e0 06 20 08 ld [ %i0 + 8 ], %l0 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40007f54: 82 06 20 0c add %i0, 0xc, %g1 /* 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)) { 40007f58: 80 a4 00 01 cmp %l0, %g1 40007f5c: 02 80 00 40 be 4000805c 40007f60: 01 00 00 00 nop node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 40007f64: 40 00 05 9c call 400095d4 40007f68: 01 00 00 00 nop 40007f6c: 92 10 00 13 mov %l3, %o1 40007f70: 40 00 04 82 call 40009178 40007f74: 94 10 00 12 mov %l2, %o2 param.sched_priority = req->priority; 40007f78: c2 04 20 0c ld [ %l0 + 0xc ], %g1 pthread_setschedparam (pthread_self(), req->policy, ¶m); 40007f7c: 40 00 05 96 call 400095d4 40007f80: c2 27 bf d8 st %g1, [ %fp + -40 ] 40007f84: d2 04 20 08 ld [ %l0 + 8 ], %o1 40007f88: 40 00 05 97 call 400095e4 40007f8c: 94 10 00 12 mov %l2, %o2 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40007f90: 40 00 0a 34 call 4000a860 <_Chain_Extract> 40007f94: 90 10 00 10 mov %l0, %o0 rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 40007f98: 40 00 03 68 call 40008d38 40007f9c: 90 10 00 11 mov %l1, %o0 switch (req->aiocbp->aio_lio_opcode) { 40007fa0: f6 04 20 14 ld [ %l0 + 0x14 ], %i3 40007fa4: c2 06 e0 30 ld [ %i3 + 0x30 ], %g1 40007fa8: 80 a0 60 02 cmp %g1, 2 40007fac: 22 80 00 24 be,a 4000803c 40007fb0: c4 1e e0 08 ldd [ %i3 + 8 ], %g2 40007fb4: 80 a0 60 03 cmp %g1, 3 40007fb8: 02 80 00 1d be 4000802c <== NEVER TAKEN 40007fbc: 01 00 00 00 nop 40007fc0: 80 a0 60 01 cmp %g1, 1 40007fc4: 22 80 00 0d be,a 40007ff8 <== ALWAYS TAKEN 40007fc8: c4 1e e0 08 ldd [ %i3 + 8 ], %g2 default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; 40007fcc: 40 00 2b b2 call 40012e94 <__errno> <== NOT EXECUTED 40007fd0: ea 26 e0 38 st %l5, [ %i3 + 0x38 ] <== NOT EXECUTED 40007fd4: c2 02 00 00 ld [ %o0 ], %g1 <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); 40007fd8: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED 40007fdc: 40 00 03 36 call 40008cb4 <== NOT EXECUTED 40007fe0: c2 26 e0 34 st %g1, [ %i3 + 0x34 ] <== NOT EXECUTED if (result != 0) 40007fe4: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40007fe8: 22 bf ff db be,a 40007f54 <== NOT EXECUTED 40007fec: e0 06 20 08 ld [ %i0 + 8 ], %l0 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } 40007ff0: 81 c7 e0 08 ret 40007ff4: 91 e8 20 00 restore %g0, 0, %o0 pthread_mutex_unlock (&r_chain->mutex); switch (req->aiocbp->aio_lio_opcode) { case LIO_READ: AIO_printf ("read\n"); result = pread (req->aiocbp->aio_fildes, 40007ff8: d0 06 c0 00 ld [ %i3 ], %o0 40007ffc: d2 06 e0 10 ld [ %i3 + 0x10 ], %o1 40008000: d4 06 e0 14 ld [ %i3 + 0x14 ], %o2 40008004: 96 10 00 02 mov %g2, %o3 40008008: 40 00 2e d7 call 40013b64 4000800c: 98 10 00 03 mov %g3, %o4 break; default: result = -1; } if (result == -1) { 40008010: 80 a2 3f ff cmp %o0, -1 40008014: 22 bf ff ee be,a 40007fcc <== NEVER TAKEN 40008018: f6 04 20 14 ld [ %l0 + 0x14 ], %i3 <== NOT EXECUTED req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; 4000801c: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 40008020: d0 20 60 38 st %o0, [ %g1 + 0x38 ] req->aiocbp->error_code = 0; 40008024: 10 bf ff c6 b 40007f3c 40008028: c0 20 60 34 clr [ %g1 + 0x34 ] req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); 4000802c: 40 00 1d 71 call 4000f5f0 <== NOT EXECUTED 40008030: d0 06 c0 00 ld [ %i3 ], %o0 <== NOT EXECUTED break; 40008034: 10 bf ff f8 b 40008014 <== NOT EXECUTED 40008038: 80 a2 3f ff cmp %o0, -1 <== NOT EXECUTED req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, 4000803c: d0 06 c0 00 ld [ %i3 ], %o0 40008040: d2 06 e0 10 ld [ %i3 + 0x10 ], %o1 40008044: d4 06 e0 14 ld [ %i3 + 0x14 ], %o2 40008048: 96 10 00 02 mov %g2, %o3 4000804c: 40 00 2f 02 call 40013c54 40008050: 98 10 00 03 mov %g3, %o4 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 40008054: 10 bf ff f0 b 40008014 40008058: 80 a2 3f ff cmp %o0, -1 struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); 4000805c: 40 00 03 37 call 40008d38 40008060: 90 10 00 11 mov %l1, %o0 pthread_mutex_lock (&aio_request_queue.mutex); 40008064: 40 00 03 14 call 40008cb4 40008068: 90 10 00 14 mov %l4, %o0 if (rtems_chain_is_empty (chain)) 4000806c: c2 06 20 08 ld [ %i0 + 8 ], %g1 40008070: 80 a4 00 01 cmp %l0, %g1 40008074: 02 80 00 05 be 40008088 <== ALWAYS TAKEN 40008078: 92 10 00 16 mov %l6, %o1 } } /* 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); 4000807c: 40 00 03 2f call 40008d38 40008080: 90 10 00 14 mov %l4, %o0 40008084: 30 bf ff ae b,a 40007f3c pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 40008088: 40 00 01 56 call 400085e0 4000808c: 90 10 20 01 mov 1, %o0 timeout.tv_sec += 3; 40008090: c2 07 bf f4 ld [ %fp + -12 ], %g1 timeout.tv_nsec = 0; 40008094: c0 27 bf f8 clr [ %fp + -8 ] pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40008098: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 4000809c: a0 06 20 20 add %i0, 0x20, %l0 pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 400080a0: c2 27 bf f4 st %g1, [ %fp + -12 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 400080a4: 90 10 00 10 mov %l0, %o0 400080a8: 92 10 00 17 mov %l7, %o1 400080ac: 40 00 01 fb call 40008898 400080b0: 94 10 00 16 mov %l6, %o2 &aio_request_queue.mutex, &timeout); /* If no requests were added to the chain we delete the fd chain from the queue and start working with idle fd chains */ if (result == ETIMEDOUT) { 400080b4: 80 a2 20 74 cmp %o0, 0x74 400080b8: 12 bf ff f1 bne 4000807c <== NEVER TAKEN 400080bc: 01 00 00 00 nop 400080c0: 40 00 09 e8 call 4000a860 <_Chain_Extract> 400080c4: 90 10 00 18 mov %i0, %o0 rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 400080c8: 40 00 02 4e call 40008a00 400080cc: 90 10 00 11 mov %l1, %o0 pthread_cond_destroy (&r_chain->cond); 400080d0: 40 00 01 6c call 40008680 400080d4: 90 10 00 10 mov %l0, %o0 free (r_chain); 400080d8: 7f ff f0 c1 call 400043dc 400080dc: 90 10 00 18 mov %i0, %o0 } } AIO_printf ("Thread finished\n"); return NULL; } 400080e0: f0 05 20 54 ld [ %l4 + 0x54 ], %i0 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)) { 400080e4: 80 a6 00 1d cmp %i0, %i5 400080e8: 22 80 00 0e be,a 40008120 400080ec: c4 05 20 68 ld [ %l4 + 0x68 ], %g2 } } /* Otherwise move this chain to the working chain and start the loop all over again */ AIO_printf ("Work on idle\n"); --aio_request_queue.idle_threads; 400080f0: c4 05 e0 68 ld [ %l7 + 0x68 ], %g2 ++aio_request_queue.active_threads; 400080f4: c2 05 e0 64 ld [ %l7 + 0x64 ], %g1 } } /* Otherwise move this chain to the working chain and start the loop all over again */ AIO_printf ("Work on idle\n"); --aio_request_queue.idle_threads; 400080f8: 84 00 bf ff add %g2, -1, %g2 ++aio_request_queue.active_threads; 400080fc: 82 00 60 01 inc %g1 40008100: 90 10 00 18 mov %i0, %o0 } } /* Otherwise move this chain to the working chain and start the loop all over again */ AIO_printf ("Work on idle\n"); --aio_request_queue.idle_threads; 40008104: c4 25 e0 68 st %g2, [ %l7 + 0x68 ] 40008108: 40 00 09 d6 call 4000a860 <_Chain_Extract> 4000810c: c2 25 e0 64 st %g1, [ %l7 + 0x64 ] node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = (rtems_aio_request_chain *) node; rtems_aio_move_to_work (r_chain); 40008110: 90 10 00 18 mov %i0, %o0 40008114: 7f ff ff 60 call 40007e94 40008118: a2 06 20 1c add %i0, 0x1c, %l1 4000811c: 30 bf ff d8 b,a 4000807c signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; 40008120: c2 05 20 64 ld [ %l4 + 0x64 ], %g1 /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; 40008124: 84 00 a0 01 inc %g2 --aio_request_queue.active_threads; 40008128: 82 00 7f ff add %g1, -1, %g1 clock_gettime (CLOCK_REALTIME, &timeout); 4000812c: 92 10 00 16 mov %l6, %o1 /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; 40008130: c4 25 20 68 st %g2, [ %l4 + 0x68 ] --aio_request_queue.active_threads; 40008134: c2 25 20 64 st %g1, [ %l4 + 0x64 ] clock_gettime (CLOCK_REALTIME, &timeout); 40008138: 40 00 01 2a call 400085e0 4000813c: 90 10 20 01 mov 1, %o0 timeout.tv_sec += 3; 40008140: c2 07 bf f4 ld [ %fp + -12 ], %g1 timeout.tv_nsec = 0; 40008144: c0 27 bf f8 clr [ %fp + -8 ] AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40008148: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 4000814c: 90 10 00 1c mov %i4, %o0 AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 40008150: c2 27 bf f4 st %g1, [ %fp + -12 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 40008154: 92 10 00 14 mov %l4, %o1 40008158: 40 00 01 d0 call 40008898 4000815c: 94 10 00 16 mov %l6, %o2 &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { 40008160: 80 a2 20 74 cmp %o0, 0x74 40008164: 22 80 00 04 be,a 40008174 <== ALWAYS TAKEN 40008168: c2 05 20 68 ld [ %l4 + 0x68 ], %g1 4000816c: 10 bf ff e1 b 400080f0 <== NOT EXECUTED 40008170: f0 05 20 54 ld [ %l4 + 0x54 ], %i0 <== NOT EXECUTED AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; pthread_mutex_unlock (&aio_request_queue.mutex); 40008174: 90 10 00 14 mov %l4, %o0 /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; 40008178: 82 00 7f ff add %g1, -1, %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 4000817c: 40 00 02 ef call 40008d38 40008180: c2 25 20 68 st %g1, [ %l4 + 0x68 ] return NULL; 40008184: 30 bf ff 9b b,a 40007ff0 =============================================================================== 40007cc4 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 40007cc4: 9d e3 bf a0 save %sp, -96, %sp int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 40007cc8: 21 10 00 69 sethi %hi(0x4001a400), %l0 40007ccc: 40 00 04 66 call 40008e64 40007cd0: 90 14 23 7c or %l0, 0x37c, %o0 ! 4001a77c if (result != 0) 40007cd4: b0 92 20 00 orcc %o0, 0, %i0 40007cd8: 12 80 00 23 bne 40007d64 <== NEVER TAKEN 40007cdc: 90 14 23 7c or %l0, 0x37c, %o0 return result; result = 40007ce0: 40 00 04 6d call 40008e94 40007ce4: 92 10 20 00 clr %o1 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 40007ce8: 80 a2 20 00 cmp %o0, 0 40007cec: 12 80 00 20 bne 40007d6c <== NEVER TAKEN 40007cf0: 23 10 00 69 sethi %hi(0x4001a400), %l1 pthread_attr_destroy (&aio_request_queue.attr); result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 40007cf4: 92 10 20 00 clr %o1 40007cf8: 40 00 03 95 call 40008b4c 40007cfc: 90 14 63 74 or %l1, 0x374, %o0 if (result != 0) 40007d00: 80 a2 20 00 cmp %o0, 0 40007d04: 12 80 00 23 bne 40007d90 <== NEVER TAKEN 40007d08: 92 10 20 00 clr %o1 pthread_attr_destroy (&aio_request_queue.attr); result = pthread_cond_init (&aio_request_queue.new_req, NULL); 40007d0c: 11 10 00 69 sethi %hi(0x4001a400), %o0 40007d10: 40 00 02 92 call 40008758 40007d14: 90 12 23 78 or %o0, 0x378, %o0 ! 4001a778 if (result != 0) { 40007d18: b0 92 20 00 orcc %o0, 0, %i0 40007d1c: 12 80 00 26 bne 40007db4 <== NEVER TAKEN 40007d20: 01 00 00 00 nop ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007d24: a2 14 63 74 or %l1, 0x374, %l1 head->previous = NULL; tail->previous = head; 40007d28: 82 04 60 54 add %l1, 0x54, %g1 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007d2c: 88 04 60 4c add %l1, 0x4c, %g4 head->previous = NULL; tail->previous = head; 40007d30: 86 04 60 48 add %l1, 0x48, %g3 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007d34: 84 04 60 58 add %l1, 0x58, %g2 head->previous = NULL; tail->previous = head; 40007d38: c2 24 60 5c st %g1, [ %l1 + 0x5c ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007d3c: c8 24 60 48 st %g4, [ %l1 + 0x48 ] head->previous = NULL; 40007d40: c0 24 60 4c clr [ %l1 + 0x4c ] tail->previous = head; 40007d44: c6 24 60 50 st %g3, [ %l1 + 0x50 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007d48: c4 24 60 54 st %g2, [ %l1 + 0x54 ] head->previous = NULL; 40007d4c: c0 24 60 58 clr [ %l1 + 0x58 ] } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; 40007d50: c0 24 60 64 clr [ %l1 + 0x64 ] aio_request_queue.idle_threads = 0; 40007d54: c0 24 60 68 clr [ %l1 + 0x68 ] aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 40007d58: 03 00 00 2c sethi %hi(0xb000), %g1 40007d5c: 82 10 60 0b or %g1, 0xb, %g1 ! b00b 40007d60: c2 24 60 60 st %g1, [ %l1 + 0x60 ] return result; } 40007d64: 81 c7 e0 08 ret 40007d68: 81 e8 00 00 restore result = pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) pthread_attr_destroy (&aio_request_queue.attr); 40007d6c: 40 00 04 32 call 40008e34 <== NOT EXECUTED 40007d70: 90 14 23 7c or %l0, 0x37c, %o0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 40007d74: 23 10 00 69 sethi %hi(0x4001a400), %l1 <== NOT EXECUTED 40007d78: 92 10 20 00 clr %o1 <== NOT EXECUTED 40007d7c: 40 00 03 74 call 40008b4c <== NOT EXECUTED 40007d80: 90 14 63 74 or %l1, 0x374, %o0 <== NOT EXECUTED if (result != 0) 40007d84: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40007d88: 02 bf ff e1 be 40007d0c <== NOT EXECUTED 40007d8c: 92 10 20 00 clr %o1 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40007d90: 40 00 04 29 call 40008e34 <== NOT EXECUTED 40007d94: 90 14 23 7c or %l0, 0x37c, %o0 <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 40007d98: 92 10 20 00 clr %o1 <== NOT EXECUTED 40007d9c: 11 10 00 69 sethi %hi(0x4001a400), %o0 <== NOT EXECUTED 40007da0: 40 00 02 6e call 40008758 <== NOT EXECUTED 40007da4: 90 12 23 78 or %o0, 0x378, %o0 ! 4001a778 <== NOT EXECUTED if (result != 0) { 40007da8: b0 92 20 00 orcc %o0, 0, %i0 <== NOT EXECUTED 40007dac: 22 bf ff df be,a 40007d28 <== NOT EXECUTED 40007db0: a2 14 63 74 or %l1, 0x374, %l1 <== NOT EXECUTED pthread_mutex_destroy (&aio_request_queue.mutex); 40007db4: 40 00 03 13 call 40008a00 <== NOT EXECUTED 40007db8: 90 14 63 74 or %l1, 0x374, %o0 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40007dbc: 40 00 04 1e call 40008e34 <== NOT EXECUTED 40007dc0: 90 14 23 7c or %l0, 0x37c, %o0 <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007dc4: 10 bf ff d9 b 40007d28 <== NOT EXECUTED 40007dc8: a2 14 63 74 or %l1, 0x374, %l1 <== NOT EXECUTED =============================================================================== 40008188 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 40008188: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 4000818c: c4 06 00 00 ld [ %i0 ], %g2 40008190: 82 06 20 04 add %i0, 4, %g1 rtems_chain_node *node; AIO_printf ("FD exists \n"); node = rtems_chain_first (chain); if (rtems_chain_is_empty (chain)) { 40008194: 80 a0 80 01 cmp %g2, %g1 40008198: 02 80 00 16 be 400081f0 <== NEVER TAKEN 4000819c: 86 10 00 19 mov %i1, %g3 rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && 400081a0: 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; 400081a4: c8 00 a0 14 ld [ %g2 + 0x14 ], %g4 while (req->aiocbp->aio_reqprio > prio && 400081a8: d8 03 60 18 ld [ %o5 + 0x18 ], %o4 400081ac: da 01 20 18 ld [ %g4 + 0x18 ], %o5 400081b0: 80 a3 40 0c cmp %o5, %o4 400081b4: 06 80 00 07 bl 400081d0 <== NEVER TAKEN 400081b8: 88 10 00 02 mov %g2, %g4 RTEMS_INLINE_ROUTINE void rtems_chain_insert( rtems_chain_node *after_node, rtems_chain_node *the_node ) { _Chain_Insert( after_node, the_node ); 400081bc: 10 80 00 0c b 400081ec 400081c0: f0 01 20 04 ld [ %g4 + 4 ], %i0 400081c4: 80 a1 00 01 cmp %g4, %g1 <== NOT EXECUTED 400081c8: 02 80 00 0c be 400081f8 <== NOT EXECUTED 400081cc: 88 10 00 01 mov %g1, %g4 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } 400081d0: c8 00 80 00 ld [ %g2 ], %g4 <== NOT EXECUTED int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && !rtems_chain_is_tail (chain, node)) { node = rtems_chain_next (node); prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 400081d4: da 01 20 14 ld [ %g4 + 0x14 ], %o5 <== NOT EXECUTED rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && 400081d8: da 03 60 18 ld [ %o5 + 0x18 ], %o5 <== NOT EXECUTED 400081dc: 80 a3 40 0c cmp %o5, %o4 <== NOT EXECUTED 400081e0: 06 bf ff f9 bl 400081c4 <== NOT EXECUTED 400081e4: 84 10 00 04 mov %g4, %g2 <== NOT EXECUTED 400081e8: f0 01 20 04 ld [ %g4 + 4 ], %i0 <== NOT EXECUTED 400081ec: b2 10 00 03 mov %g3, %i1 400081f0: 40 00 09 b9 call 4000a8d4 <_Chain_Insert> 400081f4: 81 e8 00 00 restore 400081f8: b2 10 00 03 mov %g3, %i1 <== NOT EXECUTED 400081fc: 10 bf ff fd b 400081f0 <== NOT EXECUTED 40008200: f0 01 20 04 ld [ %g4 + 4 ], %i0 <== NOT EXECUTED =============================================================================== 40007e94 : * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { 40007e94: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 40007e98: 05 10 00 69 sethi %hi(0x4001a400), %g2 40007e9c: 84 10 a3 74 or %g2, 0x374, %g2 ! 4001a774 40007ea0: c2 00 a0 48 ld [ %g2 + 0x48 ], %g1 rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 40007ea4: da 06 20 14 ld [ %i0 + 0x14 ], %o5 40007ea8: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { 40007eac: b2 10 00 18 mov %i0, %i1 rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 40007eb0: 80 a1 00 0d cmp %g4, %o5 40007eb4: 16 80 00 10 bge 40007ef4 <== NEVER TAKEN 40007eb8: 86 10 00 01 mov %g1, %g3 40007ebc: 84 00 a0 4c add %g2, 0x4c, %g2 40007ec0: 80 a0 40 02 cmp %g1, %g2 40007ec4: 32 80 00 08 bne,a 40007ee4 <== ALWAYS TAKEN 40007ec8: c6 00 40 00 ld [ %g1 ], %g3 40007ecc: 10 80 00 0b b 40007ef8 <== NOT EXECUTED 40007ed0: f0 00 e0 04 ld [ %g3 + 4 ], %i0 <== NOT EXECUTED 40007ed4: 80 a0 c0 02 cmp %g3, %g2 40007ed8: 02 80 00 0a be 40007f00 <== NEVER TAKEN 40007edc: 86 10 00 02 mov %g2, %g3 } } AIO_printf ("Thread finished\n"); return NULL; } 40007ee0: c6 00 40 00 ld [ %g1 ], %g3 rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 40007ee4: c8 00 e0 14 ld [ %g3 + 0x14 ], %g4 40007ee8: 80 a1 00 0d cmp %g4, %o5 40007eec: 06 bf ff fa bl 40007ed4 40007ef0: 82 10 00 03 mov %g3, %g1 40007ef4: f0 00 e0 04 ld [ %g3 + 4 ], %i0 40007ef8: 40 00 0a 77 call 4000a8d4 <_Chain_Insert> 40007efc: 81 e8 00 00 restore 40007f00: f0 00 e0 04 ld [ %g3 + 4 ], %i0 <== NOT EXECUTED 40007f04: 40 00 0a 74 call 4000a8d4 <_Chain_Insert> <== NOT EXECUTED 40007f08: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40008204 : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { 40008204: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 40008208: e0 06 20 08 ld [ %i0 + 8 ], %l0 while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; 4000820c: a6 10 20 8c mov 0x8c, %l3 RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Tail(the_chain)); 40008210: b0 06 20 0c add %i0, 0xc, %i0 rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 40008214: 80 a4 00 18 cmp %l0, %i0 40008218: 02 80 00 0d be 4000824c <== NEVER TAKEN 4000821c: a4 10 3f ff mov -1, %l2 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40008220: 40 00 09 90 call 4000a860 <_Chain_Extract> 40008224: 90 10 00 10 mov %l0, %o0 { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; 40008228: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 } } AIO_printf ("Thread finished\n"); return NULL; } 4000822c: e2 04 00 00 ld [ %l0 ], %l1 rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); 40008230: 90 10 00 10 mov %l0, %o0 while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; 40008234: e6 20 60 34 st %l3, [ %g1 + 0x34 ] req->aiocbp->return_value = -1; free (req); 40008238: 7f ff f0 69 call 400043dc 4000823c: e4 20 60 38 st %l2, [ %g1 + 0x38 ] rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) 40008240: 80 a4 40 18 cmp %l1, %i0 40008244: 12 bf ff f7 bne 40008220 40008248: a0 10 00 11 mov %l1, %l0 4000824c: 81 c7 e0 08 ret 40008250: 81 e8 00 00 restore =============================================================================== 40008254 : * 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) { 40008254: 9d e3 bf a0 save %sp, -96, %sp } } AIO_printf ("Thread finished\n"); return NULL; } 40008258: c4 06 00 00 ld [ %i0 ], %g2 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000825c: 82 06 20 04 add %i0, 4, %g1 * AIO_CANCELED - if request was canceled */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { if (rtems_chain_is_empty (chain)) 40008260: 80 a0 80 01 cmp %g2, %g1 40008264: 12 80 00 07 bne 40008280 40008268: b0 10 20 02 mov 2, %i0 4000826c: 30 80 00 15 b,a 400082c0 } } AIO_printf ("Thread finished\n"); return NULL; } 40008270: c4 00 80 00 ld [ %g2 ], %g2 <== NOT EXECUTED rtems_chain_node *node = rtems_chain_first (chain); rtems_aio_request *current; current = (rtems_aio_request *) node; while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) { 40008274: 80 a0 80 01 cmp %g2, %g1 <== NOT EXECUTED 40008278: 02 80 00 10 be 400082b8 <== NOT EXECUTED 4000827c: b0 10 20 01 mov 1, %i0 <== NOT EXECUTED 40008280: c6 00 a0 14 ld [ %g2 + 0x14 ], %g3 40008284: 80 a0 c0 19 cmp %g3, %i1 40008288: 12 bf ff fa bne 40008270 <== NEVER TAKEN 4000828c: a0 10 00 02 mov %g2, %l0 40008290: 40 00 09 74 call 4000a860 <_Chain_Extract> 40008294: 90 10 00 02 mov %g2, %o0 if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 40008298: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 4000829c: 84 10 20 8c mov 0x8c, %g2 400082a0: c4 20 60 34 st %g2, [ %g1 + 0x34 ] current->aiocbp->return_value = -1; 400082a4: 84 10 3f ff mov -1, %g2 free (current); 400082a8: 90 10 00 10 mov %l0, %o0 return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; current->aiocbp->return_value = -1; 400082ac: c4 20 60 38 st %g2, [ %g1 + 0x38 ] free (current); 400082b0: 7f ff f0 4b call 400043dc 400082b4: b0 10 20 00 clr %i0 } return AIO_CANCELED; 400082b8: 81 c7 e0 08 ret 400082bc: 81 e8 00 00 restore } 400082c0: 81 c7 e0 08 ret 400082c4: 81 e8 00 00 restore =============================================================================== 40010308 : rtems_name name, rtems_attribute attribute_set, uint32_t maximum_waiters, rtems_id *id ) { 40010308: 9d e3 bf 98 save %sp, -104, %sp 4001030c: a0 10 00 18 mov %i0, %l0 Barrier_Control *the_barrier; CORE_barrier_Attributes the_attributes; if ( !rtems_is_name_valid( name ) ) 40010310: 80 a4 20 00 cmp %l0, 0 40010314: 02 80 00 23 be 400103a0 40010318: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !id ) 4001031c: 80 a6 e0 00 cmp %i3, 0 40010320: 02 80 00 20 be 400103a0 40010324: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; /* Initialize core barrier attributes */ if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { 40010328: 80 8e 60 10 btst 0x10, %i1 4001032c: 02 80 00 1f be 400103a8 40010330: 80 a6 a0 00 cmp %i2, 0 the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 40010334: c0 27 bf f8 clr [ %fp + -8 ] if ( maximum_waiters == 0 ) 40010338: 02 80 00 1a be 400103a0 4001033c: b0 10 20 0a mov 0xa, %i0 40010340: 03 10 00 93 sethi %hi(0x40024c00), %g1 40010344: c4 00 62 50 ld [ %g1 + 0x250 ], %g2 ! 40024e50 <_Thread_Dispatch_disable_level> return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; the_attributes.maximum_count = maximum_waiters; 40010348: f4 27 bf fc st %i2, [ %fp + -4 ] 4001034c: 84 00 a0 01 inc %g2 40010350: c4 20 62 50 st %g2, [ %g1 + 0x250 ] * This function allocates a barrier control block from * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE Barrier_Control *_Barrier_Allocate( void ) { return (Barrier_Control *) _Objects_Allocate( &_Barrier_Information ); 40010354: 25 10 00 95 sethi %hi(0x40025400), %l2 40010358: 7f ff e9 b4 call 4000aa28 <_Objects_Allocate> 4001035c: 90 14 a3 a0 or %l2, 0x3a0, %o0 ! 400257a0 <_Barrier_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { 40010360: a2 92 20 00 orcc %o0, 0, %l1 40010364: 02 80 00 1e be 400103dc <== NEVER TAKEN 40010368: 90 04 60 14 add %l1, 0x14, %o0 return RTEMS_TOO_MANY; } the_barrier->attribute_set = attribute_set; _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 4001036c: 92 07 bf f8 add %fp, -8, %o1 40010370: 40 00 02 43 call 40010c7c <_CORE_barrier_Initialize> 40010374: f2 24 60 10 st %i1, [ %l1 + 0x10 ] 40010378: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *id = the_barrier->Object.id; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 4001037c: a4 14 a3 a0 or %l2, 0x3a0, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40010380: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40010384: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40010388: 85 28 a0 02 sll %g2, 2, %g2 4001038c: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40010390: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Barrier_Information, &the_barrier->Object, (Objects_Name) name ); *id = the_barrier->Object.id; 40010394: c2 26 c0 00 st %g1, [ %i3 ] _Thread_Enable_dispatch(); 40010398: 7f ff ee 13 call 4000bbe4 <_Thread_Enable_dispatch> 4001039c: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; } 400103a0: 81 c7 e0 08 ret 400103a4: 81 e8 00 00 restore if ( _Attributes_Is_barrier_automatic( attribute_set ) ) { the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; if ( maximum_waiters == 0 ) return RTEMS_INVALID_NUMBER; } else the_attributes.discipline = CORE_BARRIER_MANUAL_RELEASE; 400103a8: 82 10 20 01 mov 1, %g1 400103ac: c2 27 bf f8 st %g1, [ %fp + -8 ] 400103b0: 03 10 00 93 sethi %hi(0x40024c00), %g1 400103b4: c4 00 62 50 ld [ %g1 + 0x250 ], %g2 ! 40024e50 <_Thread_Dispatch_disable_level> the_attributes.maximum_count = maximum_waiters; 400103b8: f4 27 bf fc st %i2, [ %fp + -4 ] 400103bc: 84 00 a0 01 inc %g2 400103c0: c4 20 62 50 st %g2, [ %g1 + 0x250 ] 400103c4: 25 10 00 95 sethi %hi(0x40025400), %l2 400103c8: 7f ff e9 98 call 4000aa28 <_Objects_Allocate> 400103cc: 90 14 a3 a0 or %l2, 0x3a0, %o0 ! 400257a0 <_Barrier_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _Barrier_Allocate(); if ( !the_barrier ) { 400103d0: a2 92 20 00 orcc %o0, 0, %l1 400103d4: 12 bf ff e6 bne 4001036c 400103d8: 90 04 60 14 add %l1, 0x14, %o0 _Thread_Enable_dispatch(); 400103dc: 7f ff ee 02 call 4000bbe4 <_Thread_Enable_dispatch> 400103e0: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 400103e4: 81 c7 e0 08 ret 400103e8: 81 e8 00 00 restore =============================================================================== 40007dc0 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 40007dc0: 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 ); 40007dc4: 90 10 00 18 mov %i0, %o0 40007dc8: 40 00 01 82 call 400083d0 <_Chain_Append_with_empty_check> 40007dcc: 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 ) { 40007dd0: 80 8a 20 ff btst 0xff, %o0 40007dd4: 12 80 00 04 bne 40007de4 <== ALWAYS TAKEN 40007dd8: b0 10 20 00 clr %i0 sc = rtems_event_send( task, events ); } return sc; } 40007ddc: 81 c7 e0 08 ret <== NOT EXECUTED 40007de0: 81 e8 00 00 restore <== NOT EXECUTED { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { sc = rtems_event_send( task, events ); 40007de4: b0 10 00 1a mov %i2, %i0 40007de8: 7f ff fd 61 call 4000736c 40007dec: 93 e8 00 1b restore %g0, %i3, %o1 =============================================================================== 40007e28 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 40007e28: 9d e3 bf 98 save %sp, -104, %sp 40007e2c: 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( 40007e30: a4 07 bf fc add %fp, -4, %l2 */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); 40007e34: 40 00 01 a6 call 400084cc <_Chain_Get> 40007e38: 90 10 00 10 mov %l0, %o0 40007e3c: 92 10 20 00 clr %o1 40007e40: a2 10 00 08 mov %o0, %l1 40007e44: 94 10 00 1a mov %i2, %o2 40007e48: 90 10 00 19 mov %i1, %o0 rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 40007e4c: 80 a4 60 00 cmp %l1, 0 40007e50: 12 80 00 0a bne 40007e78 40007e54: 96 10 00 12 mov %l2, %o3 ) { rtems_event_set out; sc = rtems_event_receive( 40007e58: 7f ff fc e2 call 400071e0 40007e5c: 01 00 00 00 nop ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 40007e60: 80 a2 20 00 cmp %o0, 0 40007e64: 02 bf ff f4 be 40007e34 <== NEVER TAKEN 40007e68: b0 10 00 08 mov %o0, %i0 timeout, &out ); } *node_ptr = node; 40007e6c: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 40007e70: 81 c7 e0 08 ret 40007e74: 81 e8 00 00 restore rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 40007e78: 90 10 20 00 clr %o0 timeout, &out ); } *node_ptr = node; 40007e7c: e2 26 c0 00 st %l1, [ %i3 ] return sc; } 40007e80: 81 c7 e0 08 ret 40007e84: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40007e88 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 40007e88: 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 ); 40007e8c: 90 10 00 18 mov %i0, %o0 40007e90: 40 00 01 ad call 40008544 <_Chain_Prepend_with_empty_check> 40007e94: 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) { 40007e98: 80 8a 20 ff btst 0xff, %o0 40007e9c: 12 80 00 04 bne 40007eac <== ALWAYS TAKEN 40007ea0: b0 10 20 00 clr %i0 sc = rtems_event_send( task, events ); } return sc; } 40007ea4: 81 c7 e0 08 ret 40007ea8: 81 e8 00 00 restore { rtems_status_code sc = RTEMS_SUCCESSFUL; bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { sc = rtems_event_send( task, events ); 40007eac: b0 10 00 1a mov %i2, %i0 40007eb0: 7f ff fd 2f call 4000736c 40007eb4: 93 e8 00 1b restore %g0, %i3, %o1 =============================================================================== 40008d4c : rtems_status_code rtems_io_register_driver( rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { 40008d4c: 9d e3 bf a0 save %sp, -96, %sp rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) 40008d50: 03 10 00 70 sethi %hi(0x4001c000), %g1 40008d54: c4 00 62 a0 ld [ %g1 + 0x2a0 ], %g2 ! 4001c2a0 <_Per_CPU_Information+0x8> rtems_status_code rtems_io_register_driver( rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { 40008d58: 86 10 00 19 mov %i1, %g3 rtems_device_major_number major_limit = _IO_Number_of_drivers; 40008d5c: 03 10 00 71 sethi %hi(0x4001c400), %g1 if ( rtems_interrupt_is_in_progress() ) 40008d60: 80 a0 a0 00 cmp %g2, 0 40008d64: 12 80 00 42 bne 40008e6c 40008d68: c8 00 62 d4 ld [ %g1 + 0x2d4 ], %g4 return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) 40008d6c: 80 a6 a0 00 cmp %i2, 0 40008d70: 02 80 00 50 be 40008eb0 40008d74: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) 40008d78: 80 a6 60 00 cmp %i1, 0 40008d7c: 02 80 00 4d be 40008eb0 40008d80: c8 26 80 00 st %g4, [ %i2 ] static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40008d84: c4 06 40 00 ld [ %i1 ], %g2 40008d88: 80 a0 a0 00 cmp %g2, 0 40008d8c: 22 80 00 46 be,a 40008ea4 40008d90: c4 06 60 04 ld [ %i1 + 4 ], %g2 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) 40008d94: 80 a1 00 18 cmp %g4, %i0 40008d98: 08 80 00 33 bleu 40008e64 40008d9c: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40008da0: 05 10 00 6f sethi %hi(0x4001bc00), %g2 40008da4: c8 00 a1 40 ld [ %g2 + 0x140 ], %g4 ! 4001bd40 <_Thread_Dispatch_disable_level> 40008da8: 88 01 20 01 inc %g4 40008dac: c8 20 a1 40 st %g4, [ %g2 + 0x140 ] return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { 40008db0: 80 a6 20 00 cmp %i0, 0 40008db4: 12 80 00 30 bne 40008e74 40008db8: 1b 10 00 71 sethi %hi(0x4001c400), %o5 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; 40008dbc: c8 00 62 d4 ld [ %g1 + 0x2d4 ], %g4 rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { 40008dc0: 80 a1 20 00 cmp %g4, 0 40008dc4: 22 80 00 3d be,a 40008eb8 <== NEVER TAKEN 40008dc8: c0 26 80 00 clr [ %i2 ] <== NOT EXECUTED 40008dcc: 10 80 00 05 b 40008de0 40008dd0: c2 03 62 d8 ld [ %o5 + 0x2d8 ], %g1 40008dd4: 80 a1 00 18 cmp %g4, %i0 40008dd8: 08 80 00 0a bleu 40008e00 40008ddc: 82 00 60 18 add %g1, 0x18, %g1 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40008de0: c4 00 40 00 ld [ %g1 ], %g2 40008de4: 80 a0 a0 00 cmp %g2, 0 40008de8: 32 bf ff fb bne,a 40008dd4 40008dec: b0 06 20 01 inc %i0 40008df0: c4 00 60 04 ld [ %g1 + 4 ], %g2 40008df4: 80 a0 a0 00 cmp %g2, 0 40008df8: 32 bf ff f7 bne,a 40008dd4 40008dfc: b0 06 20 01 inc %i0 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) 40008e00: 80 a1 00 18 cmp %g4, %i0 40008e04: 02 80 00 2d be 40008eb8 40008e08: f0 26 80 00 st %i0, [ %i2 ] 40008e0c: 83 2e 20 03 sll %i0, 3, %g1 40008e10: 85 2e 20 05 sll %i0, 5, %g2 40008e14: 84 20 80 01 sub %g2, %g1, %g2 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40008e18: c8 03 62 d8 ld [ %o5 + 0x2d8 ], %g4 40008e1c: da 00 c0 00 ld [ %g3 ], %o5 40008e20: 82 01 00 02 add %g4, %g2, %g1 40008e24: da 21 00 02 st %o5, [ %g4 + %g2 ] 40008e28: c4 00 e0 04 ld [ %g3 + 4 ], %g2 _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 40008e2c: b2 10 20 00 clr %i1 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40008e30: c4 20 60 04 st %g2, [ %g1 + 4 ] 40008e34: c4 00 e0 08 ld [ %g3 + 8 ], %g2 _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 40008e38: b4 10 20 00 clr %i2 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40008e3c: c4 20 60 08 st %g2, [ %g1 + 8 ] 40008e40: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 40008e44: c4 20 60 0c st %g2, [ %g1 + 0xc ] 40008e48: c4 00 e0 10 ld [ %g3 + 0x10 ], %g2 40008e4c: c4 20 60 10 st %g2, [ %g1 + 0x10 ] 40008e50: c4 00 e0 14 ld [ %g3 + 0x14 ], %g2 _Thread_Enable_dispatch(); 40008e54: 40 00 08 17 call 4000aeb0 <_Thread_Enable_dispatch> 40008e58: c4 20 60 14 st %g2, [ %g1 + 0x14 ] return rtems_io_initialize( major, 0, NULL ); 40008e5c: 40 00 24 7c call 4001204c 40008e60: 81 e8 00 00 restore } 40008e64: 81 c7 e0 08 ret 40008e68: 91 e8 20 0a restore %g0, 0xa, %o0 ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; 40008e6c: 81 c7 e0 08 ret 40008e70: 91 e8 20 12 restore %g0, 0x12, %o0 _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 40008e74: c2 03 62 d8 ld [ %o5 + 0x2d8 ], %g1 40008e78: 89 2e 20 05 sll %i0, 5, %g4 40008e7c: 85 2e 20 03 sll %i0, 3, %g2 40008e80: 84 21 00 02 sub %g4, %g2, %g2 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40008e84: c8 00 40 02 ld [ %g1 + %g2 ], %g4 40008e88: 80 a1 20 00 cmp %g4, 0 40008e8c: 02 80 00 0f be 40008ec8 40008e90: 82 00 40 02 add %g1, %g2, %g1 major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); 40008e94: 40 00 08 07 call 4000aeb0 <_Thread_Enable_dispatch> 40008e98: b0 10 20 0c mov 0xc, %i0 return RTEMS_RESOURCE_IN_USE; 40008e9c: 81 c7 e0 08 ret 40008ea0: 81 e8 00 00 restore static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40008ea4: 80 a0 a0 00 cmp %g2, 0 40008ea8: 32 bf ff bc bne,a 40008d98 40008eac: 80 a1 00 18 cmp %g4, %i0 if ( driver_table == NULL ) return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; 40008eb0: 81 c7 e0 08 ret 40008eb4: 91 e8 20 09 restore %g0, 9, %o0 if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); 40008eb8: 40 00 07 fe call 4000aeb0 <_Thread_Enable_dispatch> 40008ebc: b0 10 20 05 mov 5, %i0 return sc; 40008ec0: 81 c7 e0 08 ret 40008ec4: 81 e8 00 00 restore static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40008ec8: c2 00 60 04 ld [ %g1 + 4 ], %g1 40008ecc: 80 a0 60 00 cmp %g1, 0 40008ed0: 12 bf ff f1 bne 40008e94 40008ed4: 01 00 00 00 nop if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; 40008ed8: 10 bf ff d0 b 40008e18 40008edc: f0 26 80 00 st %i0, [ %i2 ] =============================================================================== 4000a2b0 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 4000a2b0: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 4000a2b4: 80 a6 20 00 cmp %i0, 0 4000a2b8: 02 80 00 20 be 4000a338 <== NEVER TAKEN 4000a2bc: 25 10 00 a8 sethi %hi(0x4002a000), %l2 4000a2c0: a4 14 a2 5c or %l2, 0x25c, %l2 ! 4002a25c <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 4000a2c4: a6 04 a0 0c add %l2, 0xc, %l3 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; 4000a2c8: c2 04 80 00 ld [ %l2 ], %g1 4000a2cc: e2 00 60 04 ld [ %g1 + 4 ], %l1 if ( !information ) 4000a2d0: 80 a4 60 00 cmp %l1, 0 4000a2d4: 22 80 00 16 be,a 4000a32c 4000a2d8: a4 04 a0 04 add %l2, 4, %l2 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 4000a2dc: c2 14 60 10 lduh [ %l1 + 0x10 ], %g1 4000a2e0: 84 90 60 00 orcc %g1, 0, %g2 4000a2e4: 22 80 00 12 be,a 4000a32c 4000a2e8: a4 04 a0 04 add %l2, 4, %l2 4000a2ec: a0 10 20 01 mov 1, %l0 the_thread = (Thread_Control *)information->local_table[ i ]; 4000a2f0: c6 04 60 1c ld [ %l1 + 0x1c ], %g3 4000a2f4: 83 2c 20 02 sll %l0, 2, %g1 4000a2f8: c2 00 c0 01 ld [ %g3 + %g1 ], %g1 if ( !the_thread ) 4000a2fc: 90 90 60 00 orcc %g1, 0, %o0 4000a300: 02 80 00 05 be 4000a314 <== NEVER TAKEN 4000a304: a0 04 20 01 inc %l0 continue; (*routine)(the_thread); 4000a308: 9f c6 00 00 call %i0 4000a30c: 01 00 00 00 nop 4000a310: c4 14 60 10 lduh [ %l1 + 0x10 ], %g2 information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 4000a314: 83 28 a0 10 sll %g2, 0x10, %g1 4000a318: 83 30 60 10 srl %g1, 0x10, %g1 4000a31c: 80 a0 40 10 cmp %g1, %l0 4000a320: 3a bf ff f5 bcc,a 4000a2f4 4000a324: c6 04 60 1c ld [ %l1 + 0x1c ], %g3 4000a328: a4 04 a0 04 add %l2, 4, %l2 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 4000a32c: 80 a4 80 13 cmp %l2, %l3 4000a330: 32 bf ff e7 bne,a 4000a2cc 4000a334: c2 04 80 00 ld [ %l2 ], %g1 4000a338: 81 c7 e0 08 ret 4000a33c: 81 e8 00 00 restore =============================================================================== 40008dc8 : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { 40008dc8: 9d e3 bf a0 save %sp, -96, %sp 40008dcc: 90 10 00 18 mov %i0, %o0 int i; /* * Validate parameters and look up information structure. */ if ( !info ) 40008dd0: 80 a6 a0 00 cmp %i2, 0 40008dd4: 02 80 00 21 be 40008e58 40008dd8: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 40008ddc: 93 2e 60 10 sll %i1, 0x10, %o1 if ( !obj_info ) return RTEMS_INVALID_NUMBER; 40008de0: b0 10 20 0a mov 0xa, %i0 * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 40008de4: 40 00 07 96 call 4000ac3c <_Objects_Get_information> 40008de8: 93 32 60 10 srl %o1, 0x10, %o1 if ( !obj_info ) 40008dec: 80 a2 20 00 cmp %o0, 0 40008df0: 02 80 00 1a be 40008e58 40008df4: 01 00 00 00 nop /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; 40008df8: c4 02 20 0c ld [ %o0 + 0xc ], %g2 info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; 40008dfc: c8 12 20 10 lduh [ %o0 + 0x10 ], %g4 return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; 40008e00: c6 02 20 08 ld [ %o0 + 8 ], %g3 info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; 40008e04: c2 0a 20 12 ldub [ %o0 + 0x12 ], %g1 /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; 40008e08: c4 26 a0 04 st %g2, [ %i2 + 4 ] return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; 40008e0c: c6 26 80 00 st %g3, [ %i2 ] info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; 40008e10: c2 2e a0 0c stb %g1, [ %i2 + 0xc ] info->maximum = obj_info->maximum; 40008e14: c8 26 a0 08 st %g4, [ %i2 + 8 ] for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 40008e18: 80 a1 20 00 cmp %g4, 0 40008e1c: 02 80 00 0d be 40008e50 <== NEVER TAKEN 40008e20: 84 10 20 00 clr %g2 40008e24: da 02 20 1c ld [ %o0 + 0x1c ], %o5 40008e28: 86 10 20 01 mov 1, %g3 40008e2c: 82 10 20 01 mov 1, %g1 if ( !obj_info->local_table[i] ) 40008e30: 87 28 e0 02 sll %g3, 2, %g3 40008e34: c6 03 40 03 ld [ %o5 + %g3 ], %g3 info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 40008e38: 82 00 60 01 inc %g1 if ( !obj_info->local_table[i] ) unallocated++; 40008e3c: 80 a0 00 03 cmp %g0, %g3 40008e40: 84 60 bf ff subx %g2, -1, %g2 info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 40008e44: 80 a1 00 01 cmp %g4, %g1 40008e48: 1a bf ff fa bcc 40008e30 40008e4c: 86 10 00 01 mov %g1, %g3 if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; 40008e50: c4 26 a0 10 st %g2, [ %i2 + 0x10 ] return RTEMS_SUCCESSFUL; 40008e54: b0 10 20 00 clr %i0 } 40008e58: 81 c7 e0 08 ret 40008e5c: 81 e8 00 00 restore =============================================================================== 40014c40 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 40014c40: 9d e3 bf a0 save %sp, -96, %sp 40014c44: a0 10 00 18 mov %i0, %l0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 40014c48: 80 a4 20 00 cmp %l0, 0 40014c4c: 02 80 00 34 be 40014d1c 40014c50: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !starting_address ) 40014c54: 80 a6 60 00 cmp %i1, 0 40014c58: 02 80 00 31 be 40014d1c 40014c5c: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !id ) 40014c60: 80 a7 60 00 cmp %i5, 0 40014c64: 02 80 00 2e be 40014d1c <== NEVER TAKEN 40014c68: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 40014c6c: 02 80 00 2e be 40014d24 40014c70: 80 a6 a0 00 cmp %i2, 0 40014c74: 02 80 00 2c be 40014d24 40014c78: 80 a6 80 1b cmp %i2, %i3 40014c7c: 0a 80 00 28 bcs 40014d1c 40014c80: b0 10 20 08 mov 8, %i0 40014c84: 80 8e e0 07 btst 7, %i3 40014c88: 12 80 00 25 bne 40014d1c 40014c8c: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 40014c90: 12 80 00 23 bne 40014d1c 40014c94: b0 10 20 09 mov 9, %i0 40014c98: 03 10 01 01 sethi %hi(0x40040400), %g1 40014c9c: c4 00 62 e0 ld [ %g1 + 0x2e0 ], %g2 ! 400406e0 <_Thread_Dispatch_disable_level> 40014ca0: 84 00 a0 01 inc %g2 40014ca4: c4 20 62 e0 st %g2, [ %g1 + 0x2e0 ] * 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 ); 40014ca8: 25 10 01 01 sethi %hi(0x40040400), %l2 40014cac: 40 00 13 59 call 40019a10 <_Objects_Allocate> 40014cb0: 90 14 a0 f4 or %l2, 0xf4, %o0 ! 400404f4 <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 40014cb4: a2 92 20 00 orcc %o0, 0, %l1 40014cb8: 02 80 00 1d be 40014d2c 40014cbc: 92 10 00 1b mov %i3, %o1 #endif the_partition->starting_address = starting_address; the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; 40014cc0: f8 24 60 1c st %i4, [ %l1 + 0x1c ] _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 40014cc4: f2 24 60 10 st %i1, [ %l1 + 0x10 ] the_partition->length = length; 40014cc8: f4 24 60 14 st %i2, [ %l1 + 0x14 ] the_partition->buffer_size = buffer_size; 40014ccc: f6 24 60 18 st %i3, [ %l1 + 0x18 ] the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; 40014cd0: c0 24 60 20 clr [ %l1 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 40014cd4: 40 00 68 6b call 4002ee80 <.udiv> 40014cd8: 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, 40014cdc: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 40014ce0: 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, 40014ce4: 96 10 00 1b mov %i3, %o3 40014ce8: b8 04 60 24 add %l1, 0x24, %i4 40014cec: 40 00 0c ec call 4001809c <_Chain_Initialize> 40014cf0: 90 10 00 1c mov %i4, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40014cf4: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40014cf8: a4 14 a0 f4 or %l2, 0xf4, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40014cfc: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 40014d00: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40014d04: 85 28 a0 02 sll %g2, 2, %g2 40014d08: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 40014d0c: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 40014d10: c2 27 40 00 st %g1, [ %i5 ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 40014d14: 40 00 17 e0 call 4001ac94 <_Thread_Enable_dispatch> 40014d18: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40014d1c: 81 c7 e0 08 ret 40014d20: 81 e8 00 00 restore } 40014d24: 81 c7 e0 08 ret 40014d28: 91 e8 20 08 restore %g0, 8, %o0 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); 40014d2c: 40 00 17 da call 4001ac94 <_Thread_Enable_dispatch> 40014d30: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 40014d34: 81 c7 e0 08 ret 40014d38: 81 e8 00 00 restore =============================================================================== 40008360 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 40008360: 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 ); 40008364: 11 10 00 86 sethi %hi(0x40021800), %o0 40008368: 92 10 00 18 mov %i0, %o1 4000836c: 90 12 23 9c or %o0, 0x39c, %o0 40008370: 40 00 09 99 call 4000a9d4 <_Objects_Get> 40008374: 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 ) { 40008378: c2 07 bf fc ld [ %fp + -4 ], %g1 4000837c: 80 a0 60 00 cmp %g1, 0 40008380: 02 80 00 04 be 40008390 40008384: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40008388: 81 c7 e0 08 ret 4000838c: 91 e8 20 04 restore %g0, 4, %o0 the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 40008390: c4 02 20 40 ld [ %o0 + 0x40 ], %g2 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 40008394: 23 10 00 88 sethi %hi(0x40022000), %l1 40008398: a2 14 62 58 or %l1, 0x258, %l1 ! 40022258 <_Per_CPU_Information> 4000839c: c2 04 60 0c ld [ %l1 + 0xc ], %g1 400083a0: 80 a0 80 01 cmp %g2, %g1 400083a4: 02 80 00 06 be 400083bc 400083a8: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 400083ac: 40 00 0c c4 call 4000b6bc <_Thread_Enable_dispatch> 400083b0: b0 10 20 17 mov 0x17, %i0 return RTEMS_NOT_OWNER_OF_RESOURCE; 400083b4: 81 c7 e0 08 ret 400083b8: 81 e8 00 00 restore } if ( length == RTEMS_PERIOD_STATUS ) { 400083bc: 12 80 00 0f bne 400083f8 400083c0: 01 00 00 00 nop switch ( the_period->state ) { 400083c4: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 400083c8: 80 a0 60 04 cmp %g1, 4 400083cc: 08 80 00 06 bleu 400083e4 <== ALWAYS TAKEN 400083d0: b0 10 20 00 clr %i0 the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 400083d4: 40 00 0c ba call 4000b6bc <_Thread_Enable_dispatch> 400083d8: 01 00 00 00 nop return RTEMS_TIMEOUT; 400083dc: 81 c7 e0 08 ret 400083e0: 81 e8 00 00 restore _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { switch ( the_period->state ) { 400083e4: 83 28 60 02 sll %g1, 2, %g1 400083e8: 05 10 00 7e sethi %hi(0x4001f800), %g2 400083ec: 84 10 a3 ac or %g2, 0x3ac, %g2 ! 4001fbac 400083f0: 10 bf ff f9 b 400083d4 400083f4: f0 00 80 01 ld [ %g2 + %g1 ], %i0 } _Thread_Enable_dispatch(); return( return_value ); } _ISR_Disable( level ); 400083f8: 7f ff ea 2d call 40002cac 400083fc: 01 00 00 00 nop 40008400: a6 10 00 08 mov %o0, %l3 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 40008404: e4 04 20 38 ld [ %l0 + 0x38 ], %l2 40008408: 80 a4 a0 00 cmp %l2, 0 4000840c: 02 80 00 14 be 4000845c 40008410: 80 a4 a0 02 cmp %l2, 2 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 40008414: 02 80 00 29 be 400084b8 40008418: 80 a4 a0 04 cmp %l2, 4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 4000841c: 12 bf ff e6 bne 400083b4 <== NEVER TAKEN 40008420: b0 10 20 04 mov 4, %i0 /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 40008424: 7f ff ff 8f call 40008260 <_Rate_monotonic_Update_statistics> 40008428: 90 10 00 10 mov %l0, %o0 _ISR_Enable( level ); 4000842c: 7f ff ea 24 call 40002cbc 40008430: 90 10 00 13 mov %l3, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 40008434: 82 10 20 02 mov 2, %g1 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40008438: 92 04 20 10 add %l0, 0x10, %o1 4000843c: 11 10 00 87 sethi %hi(0x40021c00), %o0 the_period->next_length = length; 40008440: f2 24 20 3c st %i1, [ %l0 + 0x3c ] 40008444: 90 12 21 e0 or %o0, 0x1e0, %o0 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; 40008448: c2 24 20 38 st %g1, [ %l0 + 0x38 ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000844c: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40008450: 40 00 11 1a call 4000c8b8 <_Watchdog_Insert> 40008454: b0 10 20 06 mov 6, %i0 40008458: 30 bf ff df b,a 400083d4 return( return_value ); } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { _ISR_Enable( level ); 4000845c: 7f ff ea 18 call 40002cbc 40008460: 01 00 00 00 nop /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 40008464: 7f ff ff 63 call 400081f0 <_Rate_monotonic_Initiate_statistics> 40008468: 90 10 00 10 mov %l0, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 4000846c: 82 10 20 02 mov 2, %g1 40008470: 92 04 20 10 add %l0, 0x10, %o1 40008474: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 40008478: 11 10 00 87 sethi %hi(0x40021c00), %o0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 4000847c: 03 10 00 22 sethi %hi(0x40008800), %g1 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40008480: 90 12 21 e0 or %o0, 0x1e0, %o0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40008484: 82 10 60 34 or %g1, 0x34, %g1 the_watchdog->id = id; 40008488: f0 24 20 30 st %i0, [ %l0 + 0x30 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 4000848c: c2 24 20 2c st %g1, [ %l0 + 0x2c ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40008490: c0 24 20 18 clr [ %l0 + 0x18 ] the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 40008494: c0 24 20 34 clr [ %l0 + 0x34 ] _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 40008498: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000849c: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400084a0: 40 00 11 06 call 4000c8b8 <_Watchdog_Insert> 400084a4: b0 10 20 00 clr %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 400084a8: 40 00 0c 85 call 4000b6bc <_Thread_Enable_dispatch> 400084ac: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 400084b0: 81 c7 e0 08 ret 400084b4: 81 e8 00 00 restore if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 400084b8: 7f ff ff 6a call 40008260 <_Rate_monotonic_Update_statistics> 400084bc: 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; 400084c0: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 400084c4: 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; 400084c8: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 400084cc: 7f ff e9 fc call 40002cbc 400084d0: 90 10 00 13 mov %l3, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 400084d4: c2 04 60 0c ld [ %l1 + 0xc ], %g1 400084d8: c4 04 20 08 ld [ %l0 + 8 ], %g2 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 400084dc: 90 10 00 01 mov %g1, %o0 400084e0: 13 00 00 10 sethi %hi(0x4000), %o1 400084e4: 40 00 0e d3 call 4000c030 <_Thread_Set_state> 400084e8: c4 20 60 20 st %g2, [ %g1 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 400084ec: 7f ff e9 f0 call 40002cac 400084f0: 01 00 00 00 nop local_state = the_period->state; 400084f4: e6 04 20 38 ld [ %l0 + 0x38 ], %l3 the_period->state = RATE_MONOTONIC_ACTIVE; 400084f8: e4 24 20 38 st %l2, [ %l0 + 0x38 ] _ISR_Enable( level ); 400084fc: 7f ff e9 f0 call 40002cbc 40008500: 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 ) 40008504: 80 a4 e0 03 cmp %l3, 3 40008508: 22 80 00 06 be,a 40008520 4000850c: d0 04 60 0c ld [ %l1 + 0xc ], %o0 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); 40008510: 40 00 0c 6b call 4000b6bc <_Thread_Enable_dispatch> 40008514: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40008518: 81 c7 e0 08 ret 4000851c: 81 e8 00 00 restore /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40008520: 40 00 0b 90 call 4000b360 <_Thread_Clear_state> 40008524: 13 00 00 10 sethi %hi(0x4000), %o1 40008528: 30 bf ff fa b,a 40008510 =============================================================================== 4000852c : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 4000852c: 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 ) 40008530: 80 a6 60 00 cmp %i1, 0 40008534: 02 80 00 4c be 40008664 <== NEVER TAKEN 40008538: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 4000853c: 13 10 00 7e sethi %hi(0x4001f800), %o1 40008540: 9f c6 40 00 call %i1 40008544: 92 12 63 c0 or %o1, 0x3c0, %o1 ! 4001fbc0 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 40008548: 90 10 00 18 mov %i0, %o0 4000854c: 13 10 00 7e sethi %hi(0x4001f800), %o1 40008550: 9f c6 40 00 call %i1 40008554: 92 12 63 e0 or %o1, 0x3e0, %o1 ! 4001fbe0 (*print)( context, "--- Wall times are in seconds ---\n" ); 40008558: 90 10 00 18 mov %i0, %o0 4000855c: 13 10 00 7f sethi %hi(0x4001fc00), %o1 40008560: 9f c6 40 00 call %i1 40008564: 92 12 60 08 or %o1, 8, %o1 ! 4001fc08 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 40008568: 90 10 00 18 mov %i0, %o0 4000856c: 13 10 00 7f sethi %hi(0x4001fc00), %o1 40008570: 9f c6 40 00 call %i1 40008574: 92 12 60 30 or %o1, 0x30, %o1 ! 4001fc30 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 40008578: 90 10 00 18 mov %i0, %o0 4000857c: 13 10 00 7f sethi %hi(0x4001fc00), %o1 40008580: 9f c6 40 00 call %i1 40008584: 92 12 60 80 or %o1, 0x80, %o1 ! 4001fc80 /* * 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 ; 40008588: 23 10 00 86 sethi %hi(0x40021800), %l1 4000858c: a2 14 63 9c or %l1, 0x39c, %l1 ! 40021b9c <_Rate_monotonic_Information> 40008590: e0 04 60 08 ld [ %l1 + 8 ], %l0 40008594: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40008598: 80 a4 00 01 cmp %l0, %g1 4000859c: 18 80 00 32 bgu 40008664 <== NEVER TAKEN 400085a0: 2f 10 00 7f sethi %hi(0x4001fc00), %l7 struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); (*print)( context, 400085a4: 39 10 00 7f sethi %hi(0x4001fc00), %i4 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 400085a8: 2b 10 00 7b sethi %hi(0x4001ec00), %l5 400085ac: a4 07 bf a0 add %fp, -96, %l2 #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 400085b0: ba 07 bf d8 add %fp, -40, %i5 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 400085b4: a6 07 bf f8 add %fp, -8, %l3 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 400085b8: ae 15 e0 d0 or %l7, 0xd0, %l7 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; 400085bc: ac 07 bf b8 add %fp, -72, %l6 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 400085c0: a8 07 bf f0 add %fp, -16, %l4 (*print)( context, 400085c4: b8 17 20 e8 or %i4, 0xe8, %i4 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; 400085c8: b4 07 bf d0 add %fp, -48, %i2 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 400085cc: 10 80 00 06 b 400085e4 400085d0: aa 15 62 a8 or %l5, 0x2a8, %l5 * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 400085d4: 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 ; 400085d8: 80 a0 40 10 cmp %g1, %l0 400085dc: 0a 80 00 22 bcs 40008664 400085e0: 01 00 00 00 nop id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 400085e4: 90 10 00 10 mov %l0, %o0 400085e8: 40 00 1b cd call 4000f51c 400085ec: 92 10 00 12 mov %l2, %o1 if ( status != RTEMS_SUCCESSFUL ) 400085f0: 80 a2 20 00 cmp %o0, 0 400085f4: 32 bf ff f8 bne,a 400085d4 400085f8: c2 04 60 0c ld [ %l1 + 0xc ], %g1 #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 400085fc: 92 10 00 1d mov %i5, %o1 40008600: 40 00 1b f6 call 4000f5d8 40008604: 90 10 00 10 mov %l0, %o0 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 40008608: d0 07 bf d8 ld [ %fp + -40 ], %o0 4000860c: 94 10 00 13 mov %l3, %o2 40008610: 40 00 00 b9 call 400088f4 40008614: 92 10 20 05 mov 5, %o1 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40008618: d8 1f bf a0 ldd [ %fp + -96 ], %o4 4000861c: 92 10 00 17 mov %l7, %o1 40008620: 94 10 00 10 mov %l0, %o2 40008624: 90 10 00 18 mov %i0, %o0 40008628: 9f c6 40 00 call %i1 4000862c: 96 10 00 13 mov %l3, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 40008630: c2 07 bf a0 ld [ %fp + -96 ], %g1 struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 40008634: 94 10 00 14 mov %l4, %o2 40008638: 90 10 00 16 mov %l6, %o0 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 4000863c: 80 a0 60 00 cmp %g1, 0 40008640: 12 80 00 0b bne 4000866c 40008644: 92 10 00 15 mov %l5, %o1 (*print)( context, "\n" ); 40008648: 9f c6 40 00 call %i1 4000864c: 90 10 00 18 mov %i0, %o0 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 40008650: c2 04 60 0c ld [ %l1 + 0xc ], %g1 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 40008654: 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 ; 40008658: 80 a0 40 10 cmp %g1, %l0 4000865c: 1a bf ff e3 bcc 400085e8 <== ALWAYS TAKEN 40008660: 90 10 00 10 mov %l0, %o0 40008664: 81 c7 e0 08 ret 40008668: 81 e8 00 00 restore struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 4000866c: 40 00 0f 57 call 4000c3c8 <_Timespec_Divide_by_integer> 40008670: 92 10 00 01 mov %g1, %o1 (*print)( context, 40008674: d0 07 bf ac ld [ %fp + -84 ], %o0 40008678: 40 00 4b 98 call 4001b4d8 <.div> 4000867c: 92 10 23 e8 mov 0x3e8, %o1 40008680: 96 10 00 08 mov %o0, %o3 40008684: d0 07 bf b4 ld [ %fp + -76 ], %o0 40008688: d6 27 bf 9c st %o3, [ %fp + -100 ] 4000868c: 40 00 4b 93 call 4001b4d8 <.div> 40008690: 92 10 23 e8 mov 0x3e8, %o1 40008694: c2 07 bf f0 ld [ %fp + -16 ], %g1 40008698: b6 10 00 08 mov %o0, %i3 4000869c: d0 07 bf f4 ld [ %fp + -12 ], %o0 400086a0: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 400086a4: 40 00 4b 8d call 4001b4d8 <.div> 400086a8: 92 10 23 e8 mov 0x3e8, %o1 400086ac: d8 07 bf b0 ld [ %fp + -80 ], %o4 400086b0: d6 07 bf 9c ld [ %fp + -100 ], %o3 400086b4: d4 07 bf a8 ld [ %fp + -88 ], %o2 400086b8: 9a 10 00 1b mov %i3, %o5 400086bc: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 400086c0: 92 10 00 1c mov %i4, %o1 400086c4: 9f c6 40 00 call %i1 400086c8: 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); 400086cc: d2 07 bf a0 ld [ %fp + -96 ], %o1 400086d0: 94 10 00 14 mov %l4, %o2 400086d4: 40 00 0f 3d call 4000c3c8 <_Timespec_Divide_by_integer> 400086d8: 90 10 00 1a mov %i2, %o0 (*print)( context, 400086dc: d0 07 bf c4 ld [ %fp + -60 ], %o0 400086e0: 40 00 4b 7e call 4001b4d8 <.div> 400086e4: 92 10 23 e8 mov 0x3e8, %o1 400086e8: 96 10 00 08 mov %o0, %o3 400086ec: d0 07 bf cc ld [ %fp + -52 ], %o0 400086f0: d6 27 bf 9c st %o3, [ %fp + -100 ] 400086f4: 40 00 4b 79 call 4001b4d8 <.div> 400086f8: 92 10 23 e8 mov 0x3e8, %o1 400086fc: c2 07 bf f0 ld [ %fp + -16 ], %g1 40008700: b6 10 00 08 mov %o0, %i3 40008704: d0 07 bf f4 ld [ %fp + -12 ], %o0 40008708: 92 10 23 e8 mov 0x3e8, %o1 4000870c: 40 00 4b 73 call 4001b4d8 <.div> 40008710: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40008714: d4 07 bf c0 ld [ %fp + -64 ], %o2 40008718: d6 07 bf 9c ld [ %fp + -100 ], %o3 4000871c: d8 07 bf c8 ld [ %fp + -56 ], %o4 40008720: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40008724: 13 10 00 7f sethi %hi(0x4001fc00), %o1 40008728: 90 10 00 18 mov %i0, %o0 4000872c: 92 12 61 08 or %o1, 0x108, %o1 40008730: 9f c6 40 00 call %i1 40008734: 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 ; 40008738: 10 bf ff a7 b 400085d4 4000873c: c2 04 60 0c ld [ %l1 + 0xc ], %g1 =============================================================================== 4000875c : /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { 4000875c: 9d e3 bf a0 save %sp, -96, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40008760: 03 10 00 87 sethi %hi(0x40021c00), %g1 40008764: c4 00 61 00 ld [ %g1 + 0x100 ], %g2 ! 40021d00 <_Thread_Dispatch_disable_level> 40008768: 84 00 a0 01 inc %g2 4000876c: c4 20 61 00 st %g2, [ %g1 + 0x100 ] /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 40008770: 23 10 00 86 sethi %hi(0x40021800), %l1 40008774: a2 14 63 9c or %l1, 0x39c, %l1 ! 40021b9c <_Rate_monotonic_Information> 40008778: e0 04 60 08 ld [ %l1 + 8 ], %l0 4000877c: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40008780: 80 a4 00 01 cmp %l0, %g1 40008784: 18 80 00 09 bgu 400087a8 <== NEVER TAKEN 40008788: 01 00 00 00 nop id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); 4000878c: 40 00 00 0a call 400087b4 40008790: 90 10 00 10 mov %l0, %o0 /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 40008794: c2 04 60 0c ld [ %l1 + 0xc ], %g1 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 40008798: a0 04 20 01 inc %l0 /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 4000879c: 80 a0 40 10 cmp %g1, %l0 400087a0: 1a bf ff fb bcc 4000878c 400087a4: 01 00 00 00 nop } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); 400087a8: 40 00 0b c5 call 4000b6bc <_Thread_Enable_dispatch> 400087ac: 81 e8 00 00 restore =============================================================================== 40016260 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 40016260: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 40016264: 80 a6 60 00 cmp %i1, 0 40016268: 12 80 00 04 bne 40016278 4001626c: 82 10 20 0a mov 0xa, %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40016270: 81 c7 e0 08 ret 40016274: 91 e8 00 01 restore %g0, %g1, %o0 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 40016278: 90 10 00 18 mov %i0, %o0 4001627c: 40 00 12 94 call 4001accc <_Thread_Get> 40016280: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40016284: c2 07 bf fc ld [ %fp + -4 ], %g1 40016288: 80 a0 60 00 cmp %g1, 0 4001628c: 02 80 00 05 be 400162a0 40016290: a2 10 00 08 mov %o0, %l1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 40016294: 82 10 20 04 mov 4, %g1 } 40016298: 81 c7 e0 08 ret 4001629c: 91 e8 00 01 restore %g0, %g1, %o0 the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 400162a0: e0 02 21 54 ld [ %o0 + 0x154 ], %l0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 400162a4: c2 04 20 0c ld [ %l0 + 0xc ], %g1 400162a8: 80 a0 60 00 cmp %g1, 0 400162ac: 02 80 00 25 be 40016340 400162b0: 01 00 00 00 nop if ( asr->is_enabled ) { 400162b4: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 400162b8: 80 a0 60 00 cmp %g1, 0 400162bc: 02 80 00 15 be 40016310 400162c0: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 400162c4: 7f ff e2 c8 call 4000ede4 400162c8: 01 00 00 00 nop *signal_set |= signals; 400162cc: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 400162d0: b2 10 40 19 or %g1, %i1, %i1 400162d4: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _ISR_Enable( _level ); 400162d8: 7f ff e2 c7 call 4000edf4 400162dc: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 400162e0: 03 10 01 03 sethi %hi(0x40040c00), %g1 400162e4: 82 10 60 40 or %g1, 0x40, %g1 ! 40040c40 <_Per_CPU_Information> 400162e8: c4 00 60 08 ld [ %g1 + 8 ], %g2 400162ec: 80 a0 a0 00 cmp %g2, 0 400162f0: 02 80 00 0f be 4001632c 400162f4: 01 00 00 00 nop 400162f8: c4 00 60 0c ld [ %g1 + 0xc ], %g2 400162fc: 80 a4 40 02 cmp %l1, %g2 40016300: 12 80 00 0b bne 4001632c <== NEVER TAKEN 40016304: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; 40016308: c4 28 60 18 stb %g2, [ %g1 + 0x18 ] 4001630c: 30 80 00 08 b,a 4001632c rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 40016310: 7f ff e2 b5 call 4000ede4 40016314: 01 00 00 00 nop *signal_set |= signals; 40016318: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4001631c: b2 10 40 19 or %g1, %i1, %i1 40016320: f2 24 20 18 st %i1, [ %l0 + 0x18 ] _ISR_Enable( _level ); 40016324: 7f ff e2 b4 call 4000edf4 40016328: 01 00 00 00 nop } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 4001632c: 40 00 12 5a call 4001ac94 <_Thread_Enable_dispatch> 40016330: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40016334: 82 10 20 00 clr %g1 ! 0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40016338: 81 c7 e0 08 ret 4001633c: 91 e8 00 01 restore %g0, %g1, %o0 _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 40016340: 40 00 12 55 call 4001ac94 <_Thread_Enable_dispatch> 40016344: 01 00 00 00 nop return RTEMS_NOT_DEFINED; 40016348: 10 bf ff ca b 40016270 4001634c: 82 10 20 0b mov 0xb, %g1 ! b =============================================================================== 4000fb3c : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4000fb3c: 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 ) 4000fb40: 80 a6 a0 00 cmp %i2, 0 4000fb44: 02 80 00 43 be 4000fc50 4000fb48: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4000fb4c: 27 10 00 5e sethi %hi(0x40017800), %l3 4000fb50: a6 14 e3 78 or %l3, 0x378, %l3 ! 40017b78 <_Per_CPU_Information> 4000fb54: e0 04 e0 0c ld [ %l3 + 0xc ], %l0 api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000fb58: c4 0c 20 74 ldub [ %l0 + 0x74 ], %g2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000fb5c: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000fb60: 80 a0 00 02 cmp %g0, %g2 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 4000fb64: e2 04 21 54 ld [ %l0 + 0x154 ], %l1 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 4000fb68: a4 60 3f ff subx %g0, -1, %l2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4000fb6c: 80 a0 60 00 cmp %g1, 0 4000fb70: 12 80 00 3a bne 4000fc58 4000fb74: a5 2c a0 08 sll %l2, 8, %l2 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000fb78: c2 0c 60 08 ldub [ %l1 + 8 ], %g1 4000fb7c: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000fb80: 7f ff ed 62 call 4000b108 <_CPU_ISR_Get_level> 4000fb84: a8 60 3f ff subx %g0, -1, %l4 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000fb88: a9 2d 20 0a sll %l4, 0xa, %l4 4000fb8c: a8 15 00 08 or %l4, %o0, %l4 old_mode |= _ISR_Get_level(); 4000fb90: a4 15 00 12 or %l4, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000fb94: 80 8e 61 00 btst 0x100, %i1 4000fb98: 02 80 00 06 be 4000fbb0 4000fb9c: 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; 4000fba0: 82 0e 21 00 and %i0, 0x100, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 4000fba4: 80 a0 00 01 cmp %g0, %g1 4000fba8: 82 60 3f ff subx %g0, -1, %g1 4000fbac: c2 2c 20 74 stb %g1, [ %l0 + 0x74 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 4000fbb0: 80 8e 62 00 btst 0x200, %i1 4000fbb4: 02 80 00 0b be 4000fbe0 4000fbb8: 80 8e 60 0f btst 0xf, %i1 if ( _Modes_Is_timeslice(mode_set) ) { 4000fbbc: 80 8e 22 00 btst 0x200, %i0 4000fbc0: 22 80 00 07 be,a 4000fbdc 4000fbc4: c0 24 20 7c clr [ %l0 + 0x7c ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4000fbc8: 03 10 00 5d sethi %hi(0x40017400), %g1 4000fbcc: c2 00 61 84 ld [ %g1 + 0x184 ], %g1 ! 40017584 <_Thread_Ticks_per_timeslice> 4000fbd0: c2 24 20 78 st %g1, [ %l0 + 0x78 ] if ( mask & RTEMS_PREEMPT_MASK ) executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000fbd4: 82 10 20 01 mov 1, %g1 4000fbd8: c2 24 20 7c st %g1, [ %l0 + 0x7c ] } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 4000fbdc: 80 8e 60 0f btst 0xf, %i1 4000fbe0: 12 80 00 3d bne 4000fcd4 4000fbe4: 01 00 00 00 nop * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 4000fbe8: 80 8e 64 00 btst 0x400, %i1 4000fbec: 02 80 00 14 be 4000fc3c 4000fbf0: 86 10 20 00 clr %g3 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 4000fbf4: c4 0c 60 08 ldub [ %l1 + 8 ], %g2 */ RTEMS_INLINE_ROUTINE bool _Modes_Is_asr_disabled ( Modes_Control mode_set ) { return (mode_set & RTEMS_ASR_MASK) == RTEMS_NO_ASR; 4000fbf8: 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( 4000fbfc: 80 a0 00 18 cmp %g0, %i0 4000fc00: 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 ) { 4000fc04: 80 a0 80 01 cmp %g2, %g1 4000fc08: 22 80 00 0e be,a 4000fc40 4000fc0c: 03 10 00 5d sethi %hi(0x40017400), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 4000fc10: 7f ff c8 7f call 40001e0c 4000fc14: c2 2c 60 08 stb %g1, [ %l1 + 8 ] _signals = information->signals_pending; 4000fc18: c4 04 60 18 ld [ %l1 + 0x18 ], %g2 information->signals_pending = information->signals_posted; 4000fc1c: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 information->signals_posted = _signals; 4000fc20: c4 24 60 14 st %g2, [ %l1 + 0x14 ] rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; 4000fc24: c2 24 60 18 st %g1, [ %l1 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 4000fc28: 7f ff c8 7d call 40001e1c 4000fc2c: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 4000fc30: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 4000fc34: 80 a0 00 01 cmp %g0, %g1 4000fc38: 86 40 20 00 addx %g0, 0, %g3 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4000fc3c: 03 10 00 5d sethi %hi(0x40017400), %g1 4000fc40: c4 00 63 98 ld [ %g1 + 0x398 ], %g2 ! 40017798 <_System_state_Current> 4000fc44: 80 a0 a0 03 cmp %g2, 3 4000fc48: 02 80 00 11 be 4000fc8c <== ALWAYS TAKEN 4000fc4c: 82 10 20 00 clr %g1 if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; } 4000fc50: 81 c7 e0 08 ret 4000fc54: 91 e8 00 01 restore %g0, %g1, %o0 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000fc58: c2 0c 60 08 ldub [ %l1 + 8 ], %g1 old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 4000fc5c: a4 14 a2 00 or %l2, 0x200, %l2 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000fc60: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4000fc64: 7f ff ed 29 call 4000b108 <_CPU_ISR_Get_level> 4000fc68: a8 60 3f ff subx %g0, -1, %l4 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 4000fc6c: a9 2d 20 0a sll %l4, 0xa, %l4 4000fc70: a8 15 00 08 or %l4, %o0, %l4 old_mode |= _ISR_Get_level(); 4000fc74: a4 15 00 12 or %l4, %l2, %l2 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 4000fc78: 80 8e 61 00 btst 0x100, %i1 4000fc7c: 02 bf ff cd be 4000fbb0 4000fc80: 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; 4000fc84: 10 bf ff c8 b 4000fba4 4000fc88: 82 0e 21 00 and %i0, 0x100, %g1 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || 4000fc8c: 80 88 e0 ff btst 0xff, %g3 4000fc90: 12 80 00 0a bne 4000fcb8 4000fc94: c4 04 e0 0c ld [ %l3 + 0xc ], %g2 4000fc98: c6 04 e0 10 ld [ %l3 + 0x10 ], %g3 4000fc9c: 80 a0 80 03 cmp %g2, %g3 4000fca0: 02 bf ff ec be 4000fc50 4000fca4: 01 00 00 00 nop (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 4000fca8: c4 08 a0 74 ldub [ %g2 + 0x74 ], %g2 4000fcac: 80 a0 a0 00 cmp %g2, 0 4000fcb0: 02 bf ff e8 be 4000fc50 <== NEVER TAKEN 4000fcb4: 01 00 00 00 nop _Thread_Dispatch_necessary = true; 4000fcb8: 82 10 20 01 mov 1, %g1 ! 1 4000fcbc: c2 2c e0 18 stb %g1, [ %l3 + 0x18 ] } } if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 4000fcc0: 7f ff e6 b4 call 40009790 <_Thread_Dispatch> 4000fcc4: 01 00 00 00 nop } return RTEMS_SUCCESSFUL; 4000fcc8: 82 10 20 00 clr %g1 ! 0 } 4000fccc: 81 c7 e0 08 ret 4000fcd0: 91 e8 00 01 restore %g0, %g1, %o0 */ RTEMS_INLINE_ROUTINE ISR_Level _Modes_Get_interrupt_level ( Modes_Control mode_set ) { return ( mode_set & RTEMS_INTERRUPT_MASK ); 4000fcd4: 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 ) ); 4000fcd8: 7f ff c8 51 call 40001e1c 4000fcdc: 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 ) { 4000fce0: 10 bf ff c3 b 4000fbec 4000fce4: 80 8e 64 00 btst 0x400, %i1 =============================================================================== 4000bff0 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4000bff0: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4000bff4: 80 a6 60 00 cmp %i1, 0 4000bff8: 02 80 00 07 be 4000c014 4000bffc: 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 ) ); 4000c000: 03 10 00 6d sethi %hi(0x4001b400), %g1 4000c004: c2 08 62 c4 ldub [ %g1 + 0x2c4 ], %g1 ! 4001b6c4 */ RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && 4000c008: 80 a6 40 01 cmp %i1, %g1 4000c00c: 18 80 00 1c bgu 4000c07c 4000c010: b0 10 20 13 mov 0x13, %i0 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4000c014: 80 a6 a0 00 cmp %i2, 0 4000c018: 02 80 00 19 be 4000c07c 4000c01c: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4000c020: 40 00 09 69 call 4000e5c4 <_Thread_Get> 4000c024: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000c028: c2 07 bf fc ld [ %fp + -4 ], %g1 4000c02c: 80 a0 60 00 cmp %g1, 0 4000c030: 12 80 00 13 bne 4000c07c 4000c034: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4000c038: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4000c03c: 80 a6 60 00 cmp %i1, 0 4000c040: 02 80 00 0d be 4000c074 4000c044: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 4000c048: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4000c04c: 80 a0 60 00 cmp %g1, 0 4000c050: 02 80 00 06 be 4000c068 4000c054: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 4000c058: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000c05c: 80 a6 40 01 cmp %i1, %g1 4000c060: 1a 80 00 05 bcc 4000c074 <== ALWAYS TAKEN 4000c064: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4000c068: 92 10 00 19 mov %i1, %o1 4000c06c: 40 00 08 0a call 4000e094 <_Thread_Change_priority> 4000c070: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 4000c074: 40 00 09 46 call 4000e58c <_Thread_Enable_dispatch> 4000c078: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 4000c07c: 81 c7 e0 08 ret 4000c080: 81 e8 00 00 restore =============================================================================== 400083a4 : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { 400083a4: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) 400083a8: 80 a6 60 00 cmp %i1, 0 400083ac: 02 80 00 1e be 40008424 400083b0: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); 400083b4: 90 10 00 18 mov %i0, %o0 400083b8: 40 00 08 f1 call 4000a77c <_Thread_Get> 400083bc: 92 07 bf fc add %fp, -4, %o1 switch (location) { 400083c0: c2 07 bf fc ld [ %fp + -4 ], %g1 400083c4: 80 a0 60 00 cmp %g1, 0 400083c8: 12 80 00 19 bne 4000842c 400083cc: 82 10 20 04 mov 4, %g1 case OBJECTS_LOCAL: tvp = the_thread->task_variables; 400083d0: c2 02 21 60 ld [ %o0 + 0x160 ], %g1 while (tvp) { 400083d4: 80 a0 60 00 cmp %g1, 0 400083d8: 02 80 00 10 be 40008418 400083dc: 01 00 00 00 nop if (tvp->ptr == ptr) { 400083e0: c4 00 60 04 ld [ %g1 + 4 ], %g2 400083e4: 80 a0 80 19 cmp %g2, %i1 400083e8: 32 80 00 09 bne,a 4000840c 400083ec: d2 00 40 00 ld [ %g1 ], %o1 if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 400083f0: 10 80 00 19 b 40008454 400083f4: c4 00 40 00 ld [ %g1 ], %g2 switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { 400083f8: 80 a0 80 19 cmp %g2, %i1 400083fc: 22 80 00 0e be,a 40008434 40008400: c4 02 40 00 ld [ %o1 ], %g2 40008404: 82 10 00 09 mov %o1, %g1 _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; 40008408: d2 00 40 00 ld [ %g1 ], %o1 the_thread = _Thread_Get (tid, &location); switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { 4000840c: 80 a2 60 00 cmp %o1, 0 40008410: 32 bf ff fa bne,a 400083f8 <== ALWAYS TAKEN 40008414: c4 02 60 04 ld [ %o1 + 4 ], %g2 return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 40008418: 40 00 08 cb call 4000a744 <_Thread_Enable_dispatch> 4000841c: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; 40008420: 82 10 20 09 mov 9, %g1 ! 9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40008424: 81 c7 e0 08 ret 40008428: 91 e8 00 01 restore %g0, %g1, %o0 4000842c: 81 c7 e0 08 ret 40008430: 91 e8 00 01 restore %g0, %g1, %o0 case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; 40008434: c4 20 40 00 st %g2, [ %g1 ] else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); 40008438: 40 00 00 2e call 400084f0 <_RTEMS_Tasks_Invoke_task_variable_dtor> 4000843c: 01 00 00 00 nop _Thread_Enable_dispatch(); 40008440: 40 00 08 c1 call 4000a744 <_Thread_Enable_dispatch> 40008444: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40008448: 82 10 20 00 clr %g1 ! 0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4000844c: 81 c7 e0 08 ret 40008450: 91 e8 00 01 restore %g0, %g1, %o0 while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 40008454: 92 10 00 01 mov %g1, %o1 40008458: 10 bf ff f8 b 40008438 4000845c: c4 22 21 60 st %g2, [ %o0 + 0x160 ] =============================================================================== 40008460 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { 40008460: 9d e3 bf 98 save %sp, -104, %sp 40008464: 90 10 00 18 mov %i0, %o0 Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) 40008468: 80 a6 60 00 cmp %i1, 0 4000846c: 02 80 00 1b be 400084d8 40008470: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !result ) 40008474: 80 a6 a0 00 cmp %i2, 0 40008478: 02 80 00 1c be 400084e8 4000847c: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); 40008480: 40 00 08 bf call 4000a77c <_Thread_Get> 40008484: 92 07 bf fc add %fp, -4, %o1 switch (location) { 40008488: c2 07 bf fc ld [ %fp + -4 ], %g1 4000848c: 80 a0 60 00 cmp %g1, 0 40008490: 12 80 00 12 bne 400084d8 40008494: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; 40008498: c2 02 21 60 ld [ %o0 + 0x160 ], %g1 while (tvp) { 4000849c: 80 a0 60 00 cmp %g1, 0 400084a0: 32 80 00 07 bne,a 400084bc 400084a4: c4 00 60 04 ld [ %g1 + 4 ], %g2 400084a8: 30 80 00 0e b,a 400084e0 400084ac: 80 a0 60 00 cmp %g1, 0 400084b0: 02 80 00 0c be 400084e0 <== NEVER TAKEN 400084b4: 01 00 00 00 nop if (tvp->ptr == ptr) { 400084b8: c4 00 60 04 ld [ %g1 + 4 ], %g2 400084bc: 80 a0 80 19 cmp %g2, %i1 400084c0: 32 bf ff fb bne,a 400084ac 400084c4: c2 00 40 00 ld [ %g1 ], %g1 /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; 400084c8: c2 00 60 0c ld [ %g1 + 0xc ], %g1 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 400084cc: b0 10 20 00 clr %i0 /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; _Thread_Enable_dispatch(); 400084d0: 40 00 08 9d call 4000a744 <_Thread_Enable_dispatch> 400084d4: c2 26 80 00 st %g1, [ %i2 ] return RTEMS_SUCCESSFUL; 400084d8: 81 c7 e0 08 ret 400084dc: 81 e8 00 00 restore } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 400084e0: 40 00 08 99 call 4000a744 <_Thread_Enable_dispatch> 400084e4: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; 400084e8: 81 c7 e0 08 ret 400084ec: 81 e8 00 00 restore =============================================================================== 40016cc0 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 40016cc0: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 40016cc4: 11 10 01 04 sethi %hi(0x40041000), %o0 40016cc8: 92 10 00 18 mov %i0, %o1 40016ccc: 90 12 20 74 or %o0, 0x74, %o0 40016cd0: 40 00 0c b7 call 40019fac <_Objects_Get> 40016cd4: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40016cd8: c2 07 bf fc ld [ %fp + -4 ], %g1 40016cdc: 80 a0 60 00 cmp %g1, 0 40016ce0: 22 80 00 04 be,a 40016cf0 40016ce4: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40016ce8: 81 c7 e0 08 ret 40016cec: 91 e8 20 04 restore %g0, 4, %o0 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 40016cf0: 80 a0 60 04 cmp %g1, 4 40016cf4: 02 80 00 04 be 40016d04 <== NEVER TAKEN 40016cf8: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 40016cfc: 40 00 15 36 call 4001c1d4 <_Watchdog_Remove> 40016d00: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 40016d04: 40 00 0f e4 call 4001ac94 <_Thread_Enable_dispatch> 40016d08: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 40016d0c: 81 c7 e0 08 ret 40016d10: 81 e8 00 00 restore =============================================================================== 400171d8 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 400171d8: 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; 400171dc: 03 10 01 04 sethi %hi(0x40041000), %g1 400171e0: e0 00 60 b4 ld [ %g1 + 0xb4 ], %l0 ! 400410b4 <_Timer_server> rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 400171e4: a2 10 00 18 mov %i0, %l1 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) 400171e8: 80 a4 20 00 cmp %l0, 0 400171ec: 02 80 00 10 be 4001722c 400171f0: b0 10 20 0e mov 0xe, %i0 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 400171f4: 03 10 01 01 sethi %hi(0x40040400), %g1 400171f8: c2 08 62 f0 ldub [ %g1 + 0x2f0 ], %g1 ! 400406f0 <_TOD_Is_set> 400171fc: 80 a0 60 00 cmp %g1, 0 40017200: 02 80 00 0b be 4001722c <== NEVER TAKEN 40017204: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; if ( !routine ) 40017208: 80 a6 a0 00 cmp %i2, 0 4001720c: 02 80 00 08 be 4001722c 40017210: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 40017214: 90 10 00 19 mov %i1, %o0 40017218: 7f ff f3 b2 call 400140e0 <_TOD_Validate> 4001721c: b0 10 20 14 mov 0x14, %i0 40017220: 80 8a 20 ff btst 0xff, %o0 40017224: 12 80 00 04 bne 40017234 40017228: 01 00 00 00 nop case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4001722c: 81 c7 e0 08 ret 40017230: 81 e8 00 00 restore return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 40017234: 7f ff f3 75 call 40014008 <_TOD_To_seconds> 40017238: 90 10 00 19 mov %i1, %o0 if ( seconds <= _TOD_Seconds_since_epoch() ) 4001723c: 25 10 01 01 sethi %hi(0x40040400), %l2 40017240: c2 04 a3 88 ld [ %l2 + 0x388 ], %g1 ! 40040788 <_TOD_Now> 40017244: 80 a2 00 01 cmp %o0, %g1 40017248: 08 bf ff f9 bleu 4001722c 4001724c: b2 10 00 08 mov %o0, %i1 40017250: 92 10 00 11 mov %l1, %o1 40017254: 11 10 01 04 sethi %hi(0x40041000), %o0 40017258: 94 07 bf fc add %fp, -4, %o2 4001725c: 40 00 0b 54 call 40019fac <_Objects_Get> 40017260: 90 12 20 74 or %o0, 0x74, %o0 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40017264: c2 07 bf fc ld [ %fp + -4 ], %g1 40017268: 80 a0 60 00 cmp %g1, 0 4001726c: 12 80 00 16 bne 400172c4 40017270: b0 10 00 08 mov %o0, %i0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 40017274: 40 00 13 d8 call 4001c1d4 <_Watchdog_Remove> 40017278: 90 02 20 10 add %o0, 0x10, %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 4001727c: c4 04 a3 88 ld [ %l2 + 0x388 ], %g2 (*timer_server->schedule_operation)( timer_server, the_timer ); 40017280: c2 04 20 04 ld [ %l0 + 4 ], %g1 40017284: 92 10 00 18 mov %i0, %o1 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 40017288: b2 26 40 02 sub %i1, %g2, %i1 (*timer_server->schedule_operation)( timer_server, the_timer ); 4001728c: 90 10 00 10 mov %l0, %o0 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 40017290: 84 10 20 03 mov 3, %g2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40017294: f4 26 20 2c st %i2, [ %i0 + 0x2c ] 40017298: c4 26 20 38 st %g2, [ %i0 + 0x38 ] the_watchdog->id = id; 4001729c: e2 26 20 30 st %l1, [ %i0 + 0x30 ] the_watchdog->user_data = user_data; 400172a0: f6 26 20 34 st %i3, [ %i0 + 0x34 ] _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 400172a4: f2 26 20 1c st %i1, [ %i0 + 0x1c ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 400172a8: c0 26 20 18 clr [ %i0 + 0x18 ] (*timer_server->schedule_operation)( timer_server, the_timer ); 400172ac: 9f c0 40 00 call %g1 400172b0: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 400172b4: 40 00 0e 78 call 4001ac94 <_Thread_Enable_dispatch> 400172b8: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 400172bc: 81 c7 e0 08 ret 400172c0: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400172c4: 81 c7 e0 08 ret 400172c8: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 40007a64 : #include int sched_get_priority_max( int policy ) { 40007a64: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 40007a68: 80 a6 20 04 cmp %i0, 4 40007a6c: 08 80 00 08 bleu 40007a8c 40007a70: 82 10 20 01 mov 1, %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40007a74: 40 00 25 5d call 40010fe8 <__errno> 40007a78: b0 10 3f ff mov -1, %i0 40007a7c: 82 10 20 16 mov 0x16, %g1 40007a80: c2 22 00 00 st %g1, [ %o0 ] 40007a84: 81 c7 e0 08 ret 40007a88: 81 e8 00 00 restore int sched_get_priority_max( int policy ) { switch ( policy ) { 40007a8c: b1 28 40 18 sll %g1, %i0, %i0 40007a90: 80 8e 20 17 btst 0x17, %i0 40007a94: 02 bf ff f8 be 40007a74 <== NEVER TAKEN 40007a98: 03 10 00 7f sethi %hi(0x4001fc00), %g1 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 40007a9c: f0 08 62 58 ldub [ %g1 + 0x258 ], %i0 ! 4001fe58 } 40007aa0: 81 c7 e0 08 ret 40007aa4: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 40007aa8 : #include int sched_get_priority_min( int policy ) { 40007aa8: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 40007aac: 80 a6 20 04 cmp %i0, 4 40007ab0: 08 80 00 09 bleu 40007ad4 40007ab4: 84 10 20 01 mov 1, %g2 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40007ab8: 40 00 25 4c call 40010fe8 <__errno> 40007abc: 01 00 00 00 nop 40007ac0: 82 10 3f ff mov -1, %g1 ! ffffffff 40007ac4: 84 10 20 16 mov 0x16, %g2 40007ac8: c4 22 00 00 st %g2, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40007acc: 81 c7 e0 08 ret 40007ad0: 91 e8 00 01 restore %g0, %g1, %o0 int sched_get_priority_min( int policy ) { switch ( policy ) { 40007ad4: b1 28 80 18 sll %g2, %i0, %i0 40007ad8: 80 8e 20 17 btst 0x17, %i0 40007adc: 02 bf ff f7 be 40007ab8 <== NEVER TAKEN 40007ae0: 82 10 20 01 mov 1, %g1 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40007ae4: 81 c7 e0 08 ret 40007ae8: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 40007aec : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 40007aec: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 40007af0: 80 a6 20 00 cmp %i0, 0 40007af4: 12 80 00 0a bne 40007b1c <== ALWAYS TAKEN 40007af8: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); if ( !interval ) 40007afc: 02 80 00 13 be 40007b48 40007b00: 03 10 00 82 sethi %hi(0x40020800), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 40007b04: d0 00 60 84 ld [ %g1 + 0x84 ], %o0 ! 40020884 <_Thread_Ticks_per_timeslice> 40007b08: 92 10 00 19 mov %i1, %o1 40007b0c: 40 00 0f 12 call 4000b754 <_Timespec_From_ticks> 40007b10: b0 10 20 00 clr %i0 return 0; } 40007b14: 81 c7 e0 08 ret 40007b18: 81 e8 00 00 restore { /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 40007b1c: 7f ff f1 49 call 40004040 40007b20: 01 00 00 00 nop 40007b24: 80 a2 00 18 cmp %o0, %i0 40007b28: 02 bf ff f5 be 40007afc 40007b2c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 40007b30: 40 00 25 2e call 40010fe8 <__errno> 40007b34: b0 10 3f ff mov -1, %i0 40007b38: 82 10 20 03 mov 3, %g1 40007b3c: c2 22 00 00 st %g1, [ %o0 ] 40007b40: 81 c7 e0 08 ret 40007b44: 81 e8 00 00 restore if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); 40007b48: 40 00 25 28 call 40010fe8 <__errno> 40007b4c: b0 10 3f ff mov -1, %i0 40007b50: 82 10 20 16 mov 0x16, %g1 40007b54: c2 22 00 00 st %g1, [ %o0 ] 40007b58: 81 c7 e0 08 ret 40007b5c: 81 e8 00 00 restore =============================================================================== 4000a380 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 4000a380: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 4000a384: 03 10 00 96 sethi %hi(0x40025800), %g1 4000a388: c4 00 61 00 ld [ %g1 + 0x100 ], %g2 ! 40025900 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 4000a38c: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 4000a390: 84 00 a0 01 inc %g2 4000a394: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 4000a398: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 4000a39c: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 4000a3a0: c4 20 61 00 st %g2, [ %g1 + 0x100 ] POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 4000a3a4: a2 8e 62 00 andcc %i1, 0x200, %l1 4000a3a8: 12 80 00 25 bne 4000a43c 4000a3ac: a0 10 20 00 clr %l0 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 4000a3b0: 90 10 00 18 mov %i0, %o0 4000a3b4: 40 00 1c 07 call 400113d0 <_POSIX_Semaphore_Name_to_id> 4000a3b8: 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 ) { 4000a3bc: a4 92 20 00 orcc %o0, 0, %l2 4000a3c0: 22 80 00 0e be,a 4000a3f8 4000a3c4: 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) ) ) { 4000a3c8: 80 a4 a0 02 cmp %l2, 2 4000a3cc: 12 80 00 04 bne 4000a3dc <== NEVER TAKEN 4000a3d0: 80 a4 60 00 cmp %l1, 0 4000a3d4: 12 80 00 1e bne 4000a44c 4000a3d8: 94 10 00 10 mov %l0, %o2 _Thread_Enable_dispatch(); 4000a3dc: 40 00 0c 1f call 4000d458 <_Thread_Enable_dispatch> 4000a3e0: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 4000a3e4: 40 00 28 b4 call 400146b4 <__errno> 4000a3e8: 01 00 00 00 nop 4000a3ec: e4 22 00 00 st %l2, [ %o0 ] 4000a3f0: 81 c7 e0 08 ret 4000a3f4: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 4000a3f8: 80 a6 6a 00 cmp %i1, 0xa00 4000a3fc: 02 80 00 20 be 4000a47c 4000a400: d2 07 bf f8 ld [ %fp + -8 ], %o1 4000a404: 94 07 bf f0 add %fp, -16, %o2 4000a408: 11 10 00 96 sethi %hi(0x40025800), %o0 4000a40c: 40 00 08 e7 call 4000c7a8 <_Objects_Get> 4000a410: 90 12 23 e0 or %o0, 0x3e0, %o0 ! 40025be0 <_POSIX_Semaphore_Information> _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 4000a414: 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 ); 4000a418: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 4000a41c: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 4000a420: 40 00 0c 0e call 4000d458 <_Thread_Enable_dispatch> 4000a424: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 4000a428: 40 00 0c 0c call 4000d458 <_Thread_Enable_dispatch> 4000a42c: 01 00 00 00 nop return_id: #if defined(RTEMS_USE_16_BIT_OBJECT) the_semaphore->Semaphore_id = the_semaphore->Object.id; id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; 4000a430: f0 07 bf f4 ld [ %fp + -12 ], %i0 #endif return id; } 4000a434: 81 c7 e0 08 ret 4000a438: 91 ee 20 08 restore %i0, 8, %o0 _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 4000a43c: 82 07 a0 54 add %fp, 0x54, %g1 4000a440: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 4000a444: 10 bf ff db b 4000a3b0 4000a448: c2 27 bf fc st %g1, [ %fp + -4 ] /* * At this point, the semaphore does not exist and everything has been * checked. We should go ahead and create a semaphore. */ status =_POSIX_Semaphore_Create_support( 4000a44c: 92 10 20 00 clr %o1 4000a450: 96 07 bf f4 add %fp, -12, %o3 4000a454: 40 00 1b 83 call 40011260 <_POSIX_Semaphore_Create_support> 4000a458: 90 10 00 18 mov %i0, %o0 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 4000a45c: 40 00 0b ff call 4000d458 <_Thread_Enable_dispatch> 4000a460: a0 10 00 08 mov %o0, %l0 if ( status == -1 ) 4000a464: 80 a4 3f ff cmp %l0, -1 4000a468: 02 bf ff e2 be 4000a3f0 4000a46c: 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; 4000a470: f0 07 bf f4 ld [ %fp + -12 ], %i0 4000a474: 81 c7 e0 08 ret 4000a478: 91 ee 20 08 restore %i0, 8, %o0 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); 4000a47c: 40 00 0b f7 call 4000d458 <_Thread_Enable_dispatch> 4000a480: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 4000a484: 40 00 28 8c call 400146b4 <__errno> 4000a488: 01 00 00 00 nop 4000a48c: 82 10 20 11 mov 0x11, %g1 ! 11 4000a490: c2 22 00 00 st %g1, [ %o0 ] 4000a494: 81 c7 e0 08 ret 4000a498: 81 e8 00 00 restore =============================================================================== 4000a4f8 : int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { 4000a4f8: 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 ); 4000a4fc: 90 10 00 19 mov %i1, %o0 4000a500: 40 00 18 9d call 40010774 <_POSIX_Absolute_timeout_to_ticks> 4000a504: 92 07 bf fc add %fp, -4, %o1 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 4000a508: 80 a2 20 03 cmp %o0, 3 4000a50c: 02 80 00 07 be 4000a528 <== ALWAYS TAKEN 4000a510: d4 07 bf fc ld [ %fp + -4 ], %o2 do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 4000a514: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED 4000a518: 40 00 1b d0 call 40011458 <_POSIX_Semaphore_Wait_support> <== NOT EXECUTED 4000a51c: 92 10 20 00 clr %o1 <== NOT EXECUTED lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } 4000a520: 81 c7 e0 08 ret <== NOT EXECUTED 4000a524: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 4000a528: 90 10 00 18 mov %i0, %o0 4000a52c: 40 00 1b cb call 40011458 <_POSIX_Semaphore_Wait_support> 4000a530: 92 10 20 01 mov 1, %o1 lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } 4000a534: 81 c7 e0 08 ret 4000a538: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 400079ec : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 400079ec: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 400079f0: 80 a6 a0 00 cmp %i2, 0 400079f4: 02 80 00 0d be 40007a28 400079f8: 87 2e 20 02 sll %i0, 2, %g3 *oact = _POSIX_signals_Vectors[ sig ]; 400079fc: 05 10 00 87 sethi %hi(0x40021c00), %g2 40007a00: 83 2e 20 04 sll %i0, 4, %g1 40007a04: 84 10 a3 60 or %g2, 0x360, %g2 40007a08: 82 20 40 03 sub %g1, %g3, %g1 40007a0c: c6 00 80 01 ld [ %g2 + %g1 ], %g3 40007a10: 82 00 80 01 add %g2, %g1, %g1 40007a14: c6 26 80 00 st %g3, [ %i2 ] 40007a18: c4 00 60 04 ld [ %g1 + 4 ], %g2 40007a1c: c4 26 a0 04 st %g2, [ %i2 + 4 ] 40007a20: c2 00 60 08 ld [ %g1 + 8 ], %g1 40007a24: c2 26 a0 08 st %g1, [ %i2 + 8 ] if ( !sig ) 40007a28: 80 a6 20 00 cmp %i0, 0 40007a2c: 02 80 00 33 be 40007af8 40007a30: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 40007a34: 82 06 3f ff add %i0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 40007a38: 80 a0 60 1f cmp %g1, 0x1f 40007a3c: 18 80 00 2f bgu 40007af8 40007a40: 80 a6 20 09 cmp %i0, 9 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 40007a44: 02 80 00 2d be 40007af8 40007a48: 80 a6 60 00 cmp %i1, 0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 40007a4c: 02 80 00 1a be 40007ab4 <== NEVER TAKEN 40007a50: 82 10 20 00 clr %g1 /* * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); 40007a54: 7f ff ea 78 call 40002434 40007a58: 01 00 00 00 nop 40007a5c: b4 10 00 08 mov %o0, %i2 if ( act->sa_handler == SIG_DFL ) { 40007a60: c2 06 60 08 ld [ %i1 + 8 ], %g1 40007a64: 80 a0 60 00 cmp %g1, 0 40007a68: 02 80 00 15 be 40007abc 40007a6c: 83 2e 20 02 sll %i0, 2, %g1 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); 40007a70: 40 00 19 8b call 4000e09c <_POSIX_signals_Clear_process_signals> 40007a74: 90 10 00 18 mov %i0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 40007a78: c4 06 40 00 ld [ %i1 ], %g2 40007a7c: 87 2e 20 02 sll %i0, 2, %g3 40007a80: 03 10 00 87 sethi %hi(0x40021c00), %g1 40007a84: b1 2e 20 04 sll %i0, 4, %i0 40007a88: 82 10 63 60 or %g1, 0x360, %g1 40007a8c: b0 26 00 03 sub %i0, %g3, %i0 40007a90: c4 20 40 18 st %g2, [ %g1 + %i0 ] 40007a94: c4 06 60 04 ld [ %i1 + 4 ], %g2 40007a98: b0 00 40 18 add %g1, %i0, %i0 40007a9c: c4 26 20 04 st %g2, [ %i0 + 4 ] 40007aa0: c2 06 60 08 ld [ %i1 + 8 ], %g1 40007aa4: c2 26 20 08 st %g1, [ %i0 + 8 ] } _ISR_Enable( level ); 40007aa8: 7f ff ea 67 call 40002444 40007aac: 90 10 00 1a mov %i2, %o0 * now (signals not posted when SIG_IGN). * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; 40007ab0: 82 10 20 00 clr %g1 } 40007ab4: 81 c7 e0 08 ret 40007ab8: 91 e8 00 01 restore %g0, %g1, %o0 * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 40007abc: b1 2e 20 04 sll %i0, 4, %i0 40007ac0: b0 26 00 01 sub %i0, %g1, %i0 40007ac4: 03 10 00 81 sethi %hi(0x40020400), %g1 40007ac8: 82 10 60 08 or %g1, 8, %g1 ! 40020408 <_POSIX_signals_Default_vectors> 40007acc: c8 00 40 18 ld [ %g1 + %i0 ], %g4 40007ad0: 82 00 40 18 add %g1, %i0, %g1 40007ad4: c6 00 60 04 ld [ %g1 + 4 ], %g3 40007ad8: c4 00 60 08 ld [ %g1 + 8 ], %g2 40007adc: 03 10 00 87 sethi %hi(0x40021c00), %g1 40007ae0: 82 10 63 60 or %g1, 0x360, %g1 ! 40021f60 <_POSIX_signals_Vectors> 40007ae4: c8 20 40 18 st %g4, [ %g1 + %i0 ] 40007ae8: b0 00 40 18 add %g1, %i0, %i0 40007aec: c6 26 20 04 st %g3, [ %i0 + 4 ] 40007af0: 10 bf ff ee b 40007aa8 40007af4: c4 26 20 08 st %g2, [ %i0 + 8 ] * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) rtems_set_errno_and_return_minus_one( EINVAL ); 40007af8: 40 00 26 69 call 4001149c <__errno> 40007afc: 01 00 00 00 nop 40007b00: 84 10 20 16 mov 0x16, %g2 ! 16 40007b04: 82 10 3f ff mov -1, %g1 40007b08: 10 bf ff eb b 40007ab4 40007b0c: c4 22 00 00 st %g2, [ %o0 ] =============================================================================== 40007ed4 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 40007ed4: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 40007ed8: a0 96 20 00 orcc %i0, 0, %l0 40007edc: 02 80 00 83 be 400080e8 40007ee0: 80 a6 a0 00 cmp %i2, 0 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 40007ee4: 02 80 00 5b be 40008050 40007ee8: 80 a6 60 00 cmp %i1, 0 if ( !_Timespec_Is_valid( timeout ) ) 40007eec: 40 00 0f 3b call 4000bbd8 <_Timespec_Is_valid> 40007ef0: 90 10 00 1a mov %i2, %o0 40007ef4: 80 8a 20 ff btst 0xff, %o0 40007ef8: 02 80 00 7c be 400080e8 40007efc: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 40007f00: 40 00 0f 5d call 4000bc74 <_Timespec_To_ticks> 40007f04: 90 10 00 1a mov %i2, %o0 if ( !interval ) 40007f08: b4 92 20 00 orcc %o0, 0, %i2 40007f0c: 02 80 00 77 be 400080e8 <== NEVER TAKEN 40007f10: 80 a6 60 00 cmp %i1, 0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40007f14: 02 80 00 52 be 4000805c <== NEVER TAKEN 40007f18: 23 10 00 89 sethi %hi(0x40022400), %l1 the_thread = _Thread_Executing; 40007f1c: 23 10 00 89 sethi %hi(0x40022400), %l1 40007f20: a2 14 63 68 or %l1, 0x368, %l1 ! 40022768 <_Per_CPU_Information> 40007f24: f0 04 60 0c ld [ %l1 + 0xc ], %i0 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40007f28: 7f ff ea 1d call 4000279c 40007f2c: e6 06 21 58 ld [ %i0 + 0x158 ], %l3 40007f30: a4 10 00 08 mov %o0, %l2 if ( *set & api->signals_pending ) { 40007f34: c2 04 00 00 ld [ %l0 ], %g1 40007f38: c4 04 e0 d4 ld [ %l3 + 0xd4 ], %g2 40007f3c: 80 88 40 02 btst %g1, %g2 40007f40: 12 80 00 52 bne 40008088 40007f44: 01 00 00 00 nop return the_info->si_signo; } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 40007f48: 05 10 00 8a sethi %hi(0x40022800), %g2 40007f4c: c4 00 a1 b4 ld [ %g2 + 0x1b4 ], %g2 ! 400229b4 <_POSIX_signals_Pending> 40007f50: 80 88 40 02 btst %g1, %g2 40007f54: 12 80 00 2e bne 4000800c 40007f58: 03 10 00 88 sethi %hi(0x40022000), %g1 40007f5c: c4 00 62 10 ld [ %g1 + 0x210 ], %g2 ! 40022210 <_Thread_Dispatch_disable_level> the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; return signo; } the_info->si_signo = -1; 40007f60: 86 10 3f ff mov -1, %g3 40007f64: c6 26 40 00 st %g3, [ %i1 ] 40007f68: 84 00 a0 01 inc %g2 40007f6c: c4 20 62 10 st %g2, [ %g1 + 0x210 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 40007f70: 82 10 20 04 mov 4, %g1 40007f74: c2 26 20 34 st %g1, [ %i0 + 0x34 ] the_thread->Wait.option = *set; 40007f78: c2 04 00 00 ld [ %l0 ], %g1 the_thread->Wait.return_argument = the_info; 40007f7c: f2 26 20 28 st %i1, [ %i0 + 0x28 ] the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; 40007f80: c2 26 20 30 st %g1, [ %i0 + 0x30 ] RTEMS_INLINE_ROUTINE void _Thread_queue_Enter_critical_section ( Thread_queue_Control *the_thread_queue ) { the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 40007f84: a4 10 20 01 mov 1, %l2 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 40007f88: 29 10 00 8a sethi %hi(0x40022800), %l4 40007f8c: a8 15 21 4c or %l4, 0x14c, %l4 ! 4002294c <_POSIX_signals_Wait_queue> 40007f90: e8 26 20 44 st %l4, [ %i0 + 0x44 ] 40007f94: e4 25 20 30 st %l2, [ %l4 + 0x30 ] the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; the_thread->Wait.return_argument = the_info; _Thread_queue_Enter_critical_section( &_POSIX_signals_Wait_queue ); _ISR_Enable( level ); 40007f98: 7f ff ea 05 call 400027ac 40007f9c: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 40007fa0: 90 10 00 14 mov %l4, %o0 40007fa4: 92 10 00 1a mov %i2, %o1 40007fa8: 15 10 00 2e sethi %hi(0x4000b800), %o2 40007fac: 40 00 0d 25 call 4000b440 <_Thread_queue_Enqueue_with_handler> 40007fb0: 94 12 a0 30 or %o2, 0x30, %o2 ! 4000b830 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 40007fb4: 40 00 0b db call 4000af20 <_Thread_Enable_dispatch> 40007fb8: 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 ); 40007fbc: d2 06 40 00 ld [ %i1 ], %o1 40007fc0: 90 10 00 13 mov %l3, %o0 40007fc4: 94 10 00 19 mov %i1, %o2 40007fc8: 96 10 20 00 clr %o3 40007fcc: 40 00 1a 4b call 4000e8f8 <_POSIX_signals_Clear_signals> 40007fd0: 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) 40007fd4: c2 04 60 0c ld [ %l1 + 0xc ], %g1 40007fd8: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007fdc: 80 a0 60 04 cmp %g1, 4 40007fe0: 12 80 00 3b bne 400080cc 40007fe4: 01 00 00 00 nop || !(*set & signo_to_mask( the_info->si_signo )) ) { 40007fe8: f0 06 40 00 ld [ %i1 ], %i0 40007fec: c2 04 00 00 ld [ %l0 ], %g1 40007ff0: 84 06 3f ff add %i0, -1, %g2 40007ff4: a5 2c 80 02 sll %l2, %g2, %l2 40007ff8: 80 8c 80 01 btst %l2, %g1 40007ffc: 02 80 00 34 be 400080cc 40008000: 01 00 00 00 nop errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } 40008004: 81 c7 e0 08 ret 40008008: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 4000800c: 7f ff ff 9a call 40007e74 <_POSIX_signals_Get_lowest> 40008010: 90 10 00 02 mov %g2, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40008014: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40008018: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 4000801c: 96 10 20 01 mov 1, %o3 40008020: 90 10 00 13 mov %l3, %o0 40008024: 92 10 00 18 mov %i0, %o1 40008028: 40 00 1a 34 call 4000e8f8 <_POSIX_signals_Clear_signals> 4000802c: 98 10 20 00 clr %o4 _ISR_Enable( level ); 40008030: 7f ff e9 df call 400027ac 40008034: 90 10 00 12 mov %l2, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 40008038: 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; 4000803c: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 40008040: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 40008044: c0 26 60 08 clr [ %i1 + 8 ] return signo; 40008048: 81 c7 e0 08 ret 4000804c: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40008050: 12 bf ff b3 bne 40007f1c 40008054: b4 10 20 00 clr %i2 the_thread = _Thread_Executing; 40008058: 23 10 00 89 sethi %hi(0x40022400), %l1 4000805c: a2 14 63 68 or %l1, 0x368, %l1 ! 40022768 <_Per_CPU_Information> 40008060: f0 04 60 0c ld [ %l1 + 0xc ], %i0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40008064: b2 07 bf f4 add %fp, -12, %i1 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40008068: 7f ff e9 cd call 4000279c 4000806c: e6 06 21 58 ld [ %i0 + 0x158 ], %l3 40008070: a4 10 00 08 mov %o0, %l2 if ( *set & api->signals_pending ) { 40008074: c2 04 00 00 ld [ %l0 ], %g1 40008078: c4 04 e0 d4 ld [ %l3 + 0xd4 ], %g2 4000807c: 80 88 40 02 btst %g1, %g2 40008080: 22 bf ff b3 be,a 40007f4c 40008084: 05 10 00 8a sethi %hi(0x40022800), %g2 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 40008088: 7f ff ff 7b call 40007e74 <_POSIX_signals_Get_lowest> 4000808c: 90 10 00 02 mov %g2, %o0 _POSIX_signals_Clear_signals( 40008090: 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 ); 40008094: 92 10 00 08 mov %o0, %o1 40008098: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 4000809c: 96 10 20 00 clr %o3 400080a0: 90 10 00 13 mov %l3, %o0 400080a4: 40 00 1a 15 call 4000e8f8 <_POSIX_signals_Clear_signals> 400080a8: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 400080ac: 7f ff e9 c0 call 400027ac 400080b0: 90 10 00 12 mov %l2, %o0 the_info->si_code = SI_USER; 400080b4: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 400080b8: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 400080bc: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 400080c0: f0 06 40 00 ld [ %i1 ], %i0 400080c4: 81 c7 e0 08 ret 400080c8: 81 e8 00 00 restore * was not in our set. */ if ( (_Thread_Executing->Wait.return_code != EINTR) || !(*set & signo_to_mask( the_info->si_signo )) ) { errno = _Thread_Executing->Wait.return_code; 400080cc: 40 00 26 d7 call 40011c28 <__errno> 400080d0: b0 10 3f ff mov -1, %i0 400080d4: c2 04 60 0c ld [ %l1 + 0xc ], %g1 400080d8: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 400080dc: c2 22 00 00 st %g1, [ %o0 ] return -1; } return the_info->si_signo; } 400080e0: 81 c7 e0 08 ret 400080e4: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); 400080e8: 40 00 26 d0 call 40011c28 <__errno> 400080ec: b0 10 3f ff mov -1, %i0 400080f0: 82 10 20 16 mov 0x16, %g1 400080f4: c2 22 00 00 st %g1, [ %o0 ] 400080f8: 81 c7 e0 08 ret 400080fc: 81 e8 00 00 restore =============================================================================== 40009ebc : int sigwait( const sigset_t *set, int *sig ) { 40009ebc: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 40009ec0: 92 10 20 00 clr %o1 40009ec4: 90 10 00 18 mov %i0, %o0 40009ec8: 7f ff ff 6d call 40009c7c 40009ecc: 94 10 20 00 clr %o2 if ( status != -1 ) { 40009ed0: 80 a2 3f ff cmp %o0, -1 40009ed4: 02 80 00 07 be 40009ef0 40009ed8: 80 a6 60 00 cmp %i1, 0 if ( sig ) 40009edc: 02 80 00 03 be 40009ee8 <== NEVER TAKEN 40009ee0: b0 10 20 00 clr %i0 *sig = status; 40009ee4: d0 26 40 00 st %o0, [ %i1 ] 40009ee8: 81 c7 e0 08 ret 40009eec: 81 e8 00 00 restore return 0; } return errno; 40009ef0: 40 00 25 b7 call 400135cc <__errno> 40009ef4: 01 00 00 00 nop 40009ef8: f0 02 00 00 ld [ %o0 ], %i0 } 40009efc: 81 c7 e0 08 ret 40009f00: 81 e8 00 00 restore =============================================================================== 40006c70 : */ long sysconf( int name ) { 40006c70: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 40006c74: 80 a6 20 02 cmp %i0, 2 40006c78: 02 80 00 0e be 40006cb0 40006c7c: 80 a6 20 04 cmp %i0, 4 return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 40006c80: 02 80 00 14 be 40006cd0 40006c84: 80 a6 20 33 cmp %i0, 0x33 return rtems_libio_number_iops; if ( name == _SC_GETPW_R_SIZE_MAX ) 40006c88: 02 80 00 08 be 40006ca8 40006c8c: 82 10 24 00 mov 0x400, %g1 return 1024; if ( name == _SC_PAGESIZE ) 40006c90: 80 a6 20 08 cmp %i0, 8 40006c94: 02 80 00 05 be 40006ca8 40006c98: 82 00 6c 00 add %g1, 0xc00, %g1 return PAGE_SIZE; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 40006c9c: 80 a6 22 03 cmp %i0, 0x203 40006ca0: 12 80 00 10 bne 40006ce0 <== ALWAYS TAKEN 40006ca4: 82 10 20 00 clr %g1 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); } 40006ca8: 81 c7 e0 08 ret 40006cac: 91 e8 00 01 restore %g0, %g1, %o0 int name ) { if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); 40006cb0: 03 10 00 5f sethi %hi(0x40017c00), %g1 long sysconf( int name ) { if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / 40006cb4: d2 00 63 08 ld [ %g1 + 0x308 ], %o1 ! 40017f08 40006cb8: 11 00 03 d0 sethi %hi(0xf4000), %o0 40006cbc: 40 00 36 3b call 400145a8 <.udiv> 40006cc0: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 40006cc4: 82 10 00 08 mov %o0, %g1 if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); } 40006cc8: 81 c7 e0 08 ret 40006ccc: 91 e8 00 01 restore %g0, %g1, %o0 if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) return rtems_libio_number_iops; 40006cd0: 03 10 00 5f sethi %hi(0x40017c00), %g1 40006cd4: c2 00 62 24 ld [ %g1 + 0x224 ], %g1 ! 40017e24 if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); } 40006cd8: 81 c7 e0 08 ret 40006cdc: 91 e8 00 01 restore %g0, %g1, %o0 #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40006ce0: 40 00 26 96 call 40010738 <__errno> 40006ce4: 01 00 00 00 nop 40006ce8: 84 10 20 16 mov 0x16, %g2 ! 16 40006cec: 82 10 3f ff mov -1, %g1 40006cf0: 10 bf ff ee b 40006ca8 40006cf4: c4 22 00 00 st %g2, [ %o0 ] =============================================================================== 40007018 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 40007018: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 4000701c: 80 a6 20 01 cmp %i0, 1 40007020: 12 80 00 3d bne 40007114 40007024: 80 a6 a0 00 cmp %i2, 0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 40007028: 02 80 00 3b be 40007114 4000702c: 80 a6 60 00 cmp %i1, 0 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 40007030: 02 80 00 0e be 40007068 40007034: 03 10 00 82 sethi %hi(0x40020800), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 40007038: c2 06 40 00 ld [ %i1 ], %g1 4000703c: 82 00 7f ff add %g1, -1, %g1 40007040: 80 a0 60 01 cmp %g1, 1 40007044: 18 80 00 34 bgu 40007114 <== NEVER TAKEN 40007048: 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 ) 4000704c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007050: 80 a0 60 00 cmp %g1, 0 40007054: 02 80 00 30 be 40007114 <== NEVER TAKEN 40007058: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 4000705c: 80 a0 60 1f cmp %g1, 0x1f 40007060: 18 80 00 2d bgu 40007114 <== NEVER TAKEN 40007064: 03 10 00 82 sethi %hi(0x40020800), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 40007068: c4 00 60 40 ld [ %g1 + 0x40 ], %g2 ! 40020840 <_Thread_Dispatch_disable_level> 4000706c: 84 00 a0 01 inc %g2 40007070: c4 20 60 40 st %g2, [ %g1 + 0x40 ] * 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 ); 40007074: 21 10 00 82 sethi %hi(0x40020800), %l0 40007078: 40 00 08 6b call 40009224 <_Objects_Allocate> 4000707c: 90 14 23 60 or %l0, 0x360, %o0 ! 40020b60 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 40007080: 80 a2 20 00 cmp %o0, 0 40007084: 02 80 00 2a be 4000712c 40007088: 82 10 20 02 mov 2, %g1 rtems_set_errno_and_return_minus_one( EAGAIN ); } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 4000708c: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 40007090: 03 10 00 83 sethi %hi(0x40020c00), %g1 40007094: c2 00 61 a4 ld [ %g1 + 0x1a4 ], %g1 ! 40020da4 <_Per_CPU_Information+0xc> if ( evp != NULL ) { 40007098: 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; 4000709c: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 400070a0: 02 80 00 08 be 400070c0 400070a4: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 400070a8: c6 06 40 00 ld [ %i1 ], %g3 ptimer->inf.sigev_signo = evp->sigev_signo; 400070ac: c4 06 60 04 ld [ %i1 + 4 ], %g2 ptimer->inf.sigev_value = evp->sigev_value; 400070b0: c2 06 60 08 ld [ %i1 + 8 ], %g1 ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; if ( evp != NULL ) { ptimer->inf.sigev_notify = evp->sigev_notify; 400070b4: c6 22 20 40 st %g3, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 400070b8: c4 22 20 44 st %g2, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 400070bc: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400070c0: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; _Thread_Enable_dispatch(); return 0; } 400070c4: a0 14 23 60 or %l0, 0x360, %l0 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400070c8: c6 04 20 1c ld [ %l0 + 0x1c ], %g3 ptimer->inf.sigev_notify = evp->sigev_notify; ptimer->inf.sigev_signo = evp->sigev_signo; ptimer->inf.sigev_value = evp->sigev_value; } ptimer->overrun = 0; 400070cc: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 400070d0: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 400070d4: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 400070d8: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 400070dc: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 400070e0: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 400070e4: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 400070e8: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 400070ec: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400070f0: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400070f4: 85 28 a0 02 sll %g2, 2, %g2 400070f8: 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; 400070fc: 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; 40007100: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 40007104: 40 00 0c ab call 4000a3b0 <_Thread_Enable_dispatch> 40007108: b0 10 20 00 clr %i0 return 0; } 4000710c: 81 c7 e0 08 ret 40007110: 81 e8 00 00 restore if ( !evp->sigev_signo ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) rtems_set_errno_and_return_minus_one( EINVAL ); 40007114: 40 00 27 c1 call 40011018 <__errno> 40007118: b0 10 3f ff mov -1, %i0 4000711c: 82 10 20 16 mov 0x16, %g1 40007120: c2 22 00 00 st %g1, [ %o0 ] 40007124: 81 c7 e0 08 ret 40007128: 81 e8 00 00 restore /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { _Thread_Enable_dispatch(); 4000712c: 40 00 0c a1 call 4000a3b0 <_Thread_Enable_dispatch> 40007130: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EAGAIN ); 40007134: 40 00 27 b9 call 40011018 <__errno> 40007138: 01 00 00 00 nop 4000713c: 82 10 20 0b mov 0xb, %g1 ! b 40007140: c2 22 00 00 st %g1, [ %o0 ] 40007144: 81 c7 e0 08 ret 40007148: 81 e8 00 00 restore =============================================================================== 4000714c : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 4000714c: 9d e3 bf 80 save %sp, -128, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 40007150: 80 a6 a0 00 cmp %i2, 0 40007154: 02 80 00 8a be 4000737c <== NEVER TAKEN 40007158: 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) ) ) { 4000715c: 40 00 0f d5 call 4000b0b0 <_Timespec_Is_valid> 40007160: 90 06 a0 08 add %i2, 8, %o0 40007164: 80 8a 20 ff btst 0xff, %o0 40007168: 02 80 00 85 be 4000737c 4000716c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 40007170: 40 00 0f d0 call 4000b0b0 <_Timespec_Is_valid> 40007174: 90 10 00 1a mov %i2, %o0 40007178: 80 8a 20 ff btst 0xff, %o0 4000717c: 02 80 00 80 be 4000737c <== NEVER TAKEN 40007180: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40007184: 12 80 00 7c bne 40007374 40007188: 80 a6 60 04 cmp %i1, 4 rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 4000718c: c8 06 80 00 ld [ %i2 ], %g4 40007190: c6 06 a0 04 ld [ %i2 + 4 ], %g3 40007194: c4 06 a0 08 ld [ %i2 + 8 ], %g2 40007198: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 4000719c: c8 27 bf e4 st %g4, [ %fp + -28 ] 400071a0: c6 27 bf e8 st %g3, [ %fp + -24 ] 400071a4: c4 27 bf ec st %g2, [ %fp + -20 ] /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 400071a8: 80 a6 60 04 cmp %i1, 4 400071ac: 02 80 00 3b be 40007298 400071b0: c2 27 bf f0 st %g1, [ %fp + -16 ] timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) _Objects_Get( &_POSIX_Timer_Information, (Objects_Id) id, location ); 400071b4: 92 10 00 18 mov %i0, %o1 400071b8: 11 10 00 82 sethi %hi(0x40020800), %o0 400071bc: 94 07 bf fc add %fp, -4, %o2 400071c0: 40 00 09 6e call 40009778 <_Objects_Get> 400071c4: 90 12 23 60 or %o0, 0x360, %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 ) { 400071c8: c2 07 bf fc ld [ %fp + -4 ], %g1 400071cc: 80 a0 60 00 cmp %g1, 0 400071d0: 12 80 00 48 bne 400072f0 <== NEVER TAKEN 400071d4: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: /* First, it verifies if the timer must be stopped */ if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) { 400071d8: c2 07 bf ec ld [ %fp + -20 ], %g1 400071dc: 80 a0 60 00 cmp %g1, 0 400071e0: 12 80 00 05 bne 400071f4 400071e4: c2 07 bf f0 ld [ %fp + -16 ], %g1 400071e8: 80 a0 60 00 cmp %g1, 0 400071ec: 02 80 00 47 be 40007308 400071f0: 01 00 00 00 nop _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); 400071f4: 40 00 0f d6 call 4000b14c <_Timespec_To_ticks> 400071f8: 90 10 00 1a mov %i2, %o0 400071fc: d0 24 20 64 st %o0, [ %l0 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 40007200: 40 00 0f d3 call 4000b14c <_Timespec_To_ticks> 40007204: 90 07 bf ec add %fp, -20, %o0 activated = _POSIX_Timer_Insert_helper( 40007208: d4 04 20 08 ld [ %l0 + 8 ], %o2 return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); initial_period = _Timespec_To_ticks( &normalize.it_value ); 4000720c: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 40007210: 98 10 00 10 mov %l0, %o4 40007214: 90 04 20 10 add %l0, 0x10, %o0 40007218: 17 10 00 1c sethi %hi(0x40007000), %o3 4000721c: 40 00 1b b8 call 4000e0fc <_POSIX_Timer_Insert_helper> 40007220: 96 12 e3 94 or %o3, 0x394, %o3 ! 40007394 <_POSIX_Timer_TSR> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 40007224: 80 8a 20 ff btst 0xff, %o0 40007228: 02 80 00 18 be 40007288 4000722c: 80 a6 e0 00 cmp %i3, 0 /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 40007230: 02 80 00 0b be 4000725c 40007234: c2 07 bf e4 ld [ %fp + -28 ], %g1 *ovalue = ptimer->timer_data; 40007238: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 4000723c: c2 26 c0 00 st %g1, [ %i3 ] 40007240: c2 04 20 58 ld [ %l0 + 0x58 ], %g1 40007244: c2 26 e0 04 st %g1, [ %i3 + 4 ] 40007248: c2 04 20 5c ld [ %l0 + 0x5c ], %g1 4000724c: c2 26 e0 08 st %g1, [ %i3 + 8 ] 40007250: c2 04 20 60 ld [ %l0 + 0x60 ], %g1 40007254: c2 26 e0 0c st %g1, [ %i3 + 0xc ] ptimer->timer_data = normalize; 40007258: c2 07 bf e4 ld [ %fp + -28 ], %g1 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; _TOD_Get( &ptimer->time ); 4000725c: 90 04 20 6c add %l0, 0x6c, %o0 * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) *ovalue = ptimer->timer_data; ptimer->timer_data = normalize; 40007260: c2 24 20 54 st %g1, [ %l0 + 0x54 ] 40007264: c2 07 bf e8 ld [ %fp + -24 ], %g1 40007268: c2 24 20 58 st %g1, [ %l0 + 0x58 ] 4000726c: c2 07 bf ec ld [ %fp + -20 ], %g1 40007270: c2 24 20 5c st %g1, [ %l0 + 0x5c ] 40007274: c2 07 bf f0 ld [ %fp + -16 ], %g1 40007278: c2 24 20 60 st %g1, [ %l0 + 0x60 ] /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 4000727c: 82 10 20 03 mov 3, %g1 _TOD_Get( &ptimer->time ); 40007280: 40 00 06 65 call 40008c14 <_TOD_Get> 40007284: c2 2c 20 3c stb %g1, [ %l0 + 0x3c ] _Thread_Enable_dispatch(); 40007288: 40 00 0c 4a call 4000a3b0 <_Thread_Enable_dispatch> 4000728c: b0 10 20 00 clr %i0 return 0; 40007290: 81 c7 e0 08 ret 40007294: 81 e8 00 00 restore normalize = *value; /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); 40007298: a0 07 bf f4 add %fp, -12, %l0 4000729c: 40 00 06 5e call 40008c14 <_TOD_Get> 400072a0: 90 10 00 10 mov %l0, %o0 /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 400072a4: b2 07 bf ec add %fp, -20, %i1 400072a8: 90 10 00 10 mov %l0, %o0 400072ac: 40 00 0f 6f call 4000b068 <_Timespec_Greater_than> 400072b0: 92 10 00 19 mov %i1, %o1 400072b4: 80 8a 20 ff btst 0xff, %o0 400072b8: 12 80 00 31 bne 4000737c 400072bc: 90 10 00 10 mov %l0, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 400072c0: 92 10 00 19 mov %i1, %o1 400072c4: 40 00 0f 8c call 4000b0f4 <_Timespec_Subtract> 400072c8: 94 10 00 19 mov %i1, %o2 400072cc: 92 10 00 18 mov %i0, %o1 400072d0: 11 10 00 82 sethi %hi(0x40020800), %o0 400072d4: 94 07 bf fc add %fp, -4, %o2 400072d8: 40 00 09 28 call 40009778 <_Objects_Get> 400072dc: 90 12 23 60 or %o0, 0x360, %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 ) { 400072e0: c2 07 bf fc ld [ %fp + -4 ], %g1 400072e4: 80 a0 60 00 cmp %g1, 0 400072e8: 02 bf ff bc be 400071d8 400072ec: a0 10 00 08 mov %o0, %l0 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 400072f0: 40 00 27 4a call 40011018 <__errno> 400072f4: b0 10 3f ff mov -1, %i0 400072f8: 82 10 20 16 mov 0x16, %g1 400072fc: c2 22 00 00 st %g1, [ %o0 ] } 40007300: 81 c7 e0 08 ret 40007304: 81 e8 00 00 restore case OBJECTS_LOCAL: /* First, it verifies if the timer must be stopped */ if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) { /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 40007308: 40 00 10 da call 4000b670 <_Watchdog_Remove> 4000730c: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 40007310: 80 a6 e0 00 cmp %i3, 0 40007314: 02 80 00 0b be 40007340 40007318: c2 07 bf e4 ld [ %fp + -28 ], %g1 *ovalue = ptimer->timer_data; 4000731c: c2 04 20 54 ld [ %l0 + 0x54 ], %g1 40007320: c2 26 c0 00 st %g1, [ %i3 ] 40007324: c2 04 20 58 ld [ %l0 + 0x58 ], %g1 40007328: c2 26 e0 04 st %g1, [ %i3 + 4 ] 4000732c: c2 04 20 5c ld [ %l0 + 0x5c ], %g1 40007330: c2 26 e0 08 st %g1, [ %i3 + 8 ] 40007334: c2 04 20 60 ld [ %l0 + 0x60 ], %g1 40007338: c2 26 e0 0c st %g1, [ %i3 + 0xc ] /* The new data are set */ ptimer->timer_data = normalize; 4000733c: c2 07 bf e4 ld [ %fp + -28 ], %g1 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; /* Returns with success */ _Thread_Enable_dispatch(); return 0; 40007340: b0 10 20 00 clr %i0 (void) _Watchdog_Remove( &ptimer->Timer ); /* The old data of the timer are returned */ if ( ovalue ) *ovalue = ptimer->timer_data; /* The new data are set */ ptimer->timer_data = normalize; 40007344: c2 24 20 54 st %g1, [ %l0 + 0x54 ] 40007348: c2 07 bf e8 ld [ %fp + -24 ], %g1 4000734c: c2 24 20 58 st %g1, [ %l0 + 0x58 ] 40007350: c2 07 bf ec ld [ %fp + -20 ], %g1 40007354: c2 24 20 5c st %g1, [ %l0 + 0x5c ] 40007358: c2 07 bf f0 ld [ %fp + -16 ], %g1 4000735c: c2 24 20 60 st %g1, [ %l0 + 0x60 ] /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 40007360: 82 10 20 04 mov 4, %g1 /* Returns with success */ _Thread_Enable_dispatch(); 40007364: 40 00 0c 13 call 4000a3b0 <_Thread_Enable_dispatch> 40007368: c2 2c 20 3c stb %g1, [ %l0 + 0x3c ] return 0; 4000736c: 81 c7 e0 08 ret 40007370: 81 e8 00 00 restore } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40007374: 22 bf ff 87 be,a 40007190 40007378: c8 06 80 00 ld [ %i2 ], %g4 if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) rtems_set_errno_and_return_minus_one( EINVAL ); 4000737c: 40 00 27 27 call 40011018 <__errno> 40007380: b0 10 3f ff mov -1, %i0 40007384: 82 10 20 16 mov 0x16, %g1 40007388: c2 22 00 00 st %g1, [ %o0 ] 4000738c: 81 c7 e0 08 ret 40007390: 81 e8 00 00 restore =============================================================================== 40006f5c : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 40006f5c: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 40006f60: 21 10 00 68 sethi %hi(0x4001a000), %l0 40006f64: a0 14 22 48 or %l0, 0x248, %l0 ! 4001a248 <_POSIX_signals_Ualarm_timer> 40006f68: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 40006f6c: 80 a0 60 00 cmp %g1, 0 40006f70: 02 80 00 25 be 40007004 40006f74: a2 10 00 18 mov %i0, %l1 _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 40006f78: 40 00 10 90 call 4000b1b8 <_Watchdog_Remove> 40006f7c: 90 10 00 10 mov %l0, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 40006f80: 90 02 3f fe add %o0, -2, %o0 40006f84: 80 a2 20 01 cmp %o0, 1 40006f88: 08 80 00 27 bleu 40007024 <== ALWAYS TAKEN 40006f8c: b0 10 20 00 clr %i0 /* * If useconds is non-zero, then the caller wants to schedule * the alarm repeatedly at that interval. If the interval is * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { 40006f90: 80 a4 60 00 cmp %l1, 0 40006f94: 02 80 00 1a be 40006ffc 40006f98: 25 00 03 d0 sethi %hi(0xf4000), %l2 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40006f9c: 90 10 00 11 mov %l1, %o0 40006fa0: 40 00 3a a4 call 40015a30 <.udiv> 40006fa4: 92 14 a2 40 or %l2, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006fa8: 92 14 a2 40 or %l2, 0x240, %o1 * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40006fac: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006fb0: 40 00 3b 4c call 40015ce0 <.urem> 40006fb4: 90 10 00 11 mov %l1, %o0 40006fb8: 87 2a 20 07 sll %o0, 7, %g3 40006fbc: 82 10 00 08 mov %o0, %g1 40006fc0: 85 2a 20 02 sll %o0, 2, %g2 40006fc4: 84 20 c0 02 sub %g3, %g2, %g2 40006fc8: 82 00 80 01 add %g2, %g1, %g1 40006fcc: 83 28 60 03 sll %g1, 3, %g1 ticks = _Timespec_To_ticks( &tp ); 40006fd0: a2 07 bf f8 add %fp, -8, %l1 */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006fd4: c2 27 bf fc st %g1, [ %fp + -4 ] ticks = _Timespec_To_ticks( &tp ); 40006fd8: 40 00 0e ff call 4000abd4 <_Timespec_To_ticks> 40006fdc: 90 10 00 11 mov %l1, %o0 if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 40006fe0: 40 00 0e fd call 4000abd4 <_Timespec_To_ticks> 40006fe4: 90 10 00 11 mov %l1, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006fe8: 92 10 00 10 mov %l0, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006fec: d0 24 20 0c st %o0, [ %l0 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006ff0: 11 10 00 66 sethi %hi(0x40019800), %o0 40006ff4: 40 00 10 06 call 4000b00c <_Watchdog_Insert> 40006ff8: 90 12 22 00 or %o0, 0x200, %o0 ! 40019a00 <_Watchdog_Ticks_chain> } return remaining; } 40006ffc: 81 c7 e0 08 ret 40007000: 81 e8 00 00 restore Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40007004: 03 10 00 1b sethi %hi(0x40006c00), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40007008: c0 24 20 08 clr [ %l0 + 8 ] the_watchdog->routine = routine; 4000700c: 82 10 63 2c or %g1, 0x32c, %g1 the_watchdog->id = id; 40007010: c0 24 20 20 clr [ %l0 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40007014: c2 24 20 1c st %g1, [ %l0 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 40007018: c0 24 20 24 clr [ %l0 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 4000701c: 10 bf ff dd b 40006f90 40007020: 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); 40007024: c4 04 20 0c ld [ %l0 + 0xc ], %g2 40007028: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 4000702c: d0 04 20 14 ld [ %l0 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40007030: 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); 40007034: 90 02 00 02 add %o0, %g2, %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40007038: 40 00 0e bc call 4000ab28 <_Timespec_From_ticks> 4000703c: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40007040: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 40007044: 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; 40007048: 85 28 60 03 sll %g1, 3, %g2 4000704c: 87 28 60 08 sll %g1, 8, %g3 40007050: 84 20 c0 02 sub %g3, %g2, %g2 remaining += tp.tv_nsec / 1000; 40007054: 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; 40007058: b1 28 a0 06 sll %g2, 6, %i0 4000705c: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 40007060: 40 00 3a 76 call 40015a38 <.div> 40007064: 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; 40007068: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 4000706c: 10 bf ff c9 b 40006f90 40007070: b0 02 00 18 add %o0, %i0, %i0