=============================================================================== 40007d78 <_API_extensions_Add_post_switch>: */ RTEMS_INLINE_ROUTINE bool _Chain_Is_node_off_chain( const Chain_Node *node ) { return (node->next == NULL) && (node->previous == NULL); 40007d78: c2 02 00 00 ld [ %o0 ], %g1 40007d7c: 80 a0 60 00 cmp %g1, 0 40007d80: 22 80 00 04 be,a 40007d90 <_API_extensions_Add_post_switch+0x18> 40007d84: c2 02 20 04 ld [ %o0 + 4 ], %g1 40007d88: 81 c3 e0 08 retl 40007d8c: 01 00 00 00 nop 40007d90: 80 a0 60 00 cmp %g1, 0 40007d94: 12 bf ff fd bne 40007d88 <_API_extensions_Add_post_switch+0x10><== NEVER TAKEN 40007d98: 03 10 00 7b sethi %hi(0x4001ec00), %g1 Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 40007d9c: 82 10 63 30 or %g1, 0x330, %g1 ! 4001ef30 <_API_extensions_Post_switch_list> 40007da0: c4 00 60 08 ld [ %g1 + 8 ], %g2 the_node->next = tail; 40007da4: 86 00 60 04 add %g1, 4, %g3 tail->previous = the_node; 40007da8: d0 20 60 08 st %o0, [ %g1 + 8 ] ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; 40007dac: c6 22 00 00 st %g3, [ %o0 ] tail->previous = the_node; old_last->next = the_node; 40007db0: d0 20 80 00 st %o0, [ %g2 ] the_node->previous = old_last; 40007db4: 81 c3 e0 08 retl 40007db8: c4 22 20 04 st %g2, [ %o0 + 4 ] =============================================================================== 40007dbc <_API_extensions_Run_postdriver>: } } #endif void _API_extensions_Run_postdriver( void ) { 40007dbc: 9d e3 bf a0 save %sp, -96, %sp */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; 40007dc0: 39 10 00 7c sethi %hi(0x4001f000), %i4 40007dc4: fa 07 20 78 ld [ %i4 + 0x78 ], %i5 ! 4001f078 <_API_extensions_List> 40007dc8: b8 17 20 78 or %i4, 0x78, %i4 Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40007dcc: b8 07 20 04 add %i4, 4, %i4 40007dd0: 80 a7 40 1c cmp %i5, %i4 40007dd4: 02 80 00 09 be 40007df8 <_API_extensions_Run_postdriver+0x3c><== NEVER TAKEN 40007dd8: 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)(); 40007ddc: c2 07 60 08 ld [ %i5 + 8 ], %g1 40007de0: 9f c0 40 00 call %g1 40007de4: 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 ) { 40007de8: fa 07 40 00 ld [ %i5 ], %i5 void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); 40007dec: 80 a7 40 1c cmp %i5, %i4 40007df0: 32 bf ff fc bne,a 40007de0 <_API_extensions_Run_postdriver+0x24> 40007df4: c2 07 60 08 ld [ %i5 + 8 ], %g1 40007df8: 81 c7 e0 08 ret 40007dfc: 81 e8 00 00 restore =============================================================================== 4000a12c <_CORE_RWLock_Release>: #include CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 4000a12c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 4000a130: 03 10 00 6b sethi %hi(0x4001ac00), %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 ); 4000a134: 7f ff e4 c6 call 4000344c 4000a138: fa 00 61 00 ld [ %g1 + 0x100 ], %i5 ! 4001ad00 <_Per_CPU_Information+0x10> 4000a13c: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 4000a140: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 4000a144: 80 a0 60 00 cmp %g1, 0 4000a148: 02 80 00 2b be 4000a1f4 <_CORE_RWLock_Release+0xc8> 4000a14c: 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 ) { 4000a150: 22 80 00 22 be,a 4000a1d8 <_CORE_RWLock_Release+0xac> 4000a154: 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; 4000a158: c0 27 60 34 clr [ %i5 + 0x34 ] /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; 4000a15c: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 4000a160: 7f ff e4 bf call 4000345c 4000a164: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 4000a168: 40 00 07 e0 call 4000c0e8 <_Thread_queue_Dequeue> 4000a16c: 90 10 00 18 mov %i0, %o0 if ( next ) { 4000a170: 80 a2 20 00 cmp %o0, 0 4000a174: 22 80 00 24 be,a 4000a204 <_CORE_RWLock_Release+0xd8> 4000a178: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 4000a17c: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 4000a180: 80 a0 60 01 cmp %g1, 1 4000a184: 02 80 00 22 be 4000a20c <_CORE_RWLock_Release+0xe0> 4000a188: 84 10 20 01 mov 1, %g2 } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 4000a18c: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 4000a190: 82 00 60 01 inc %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 4000a194: c4 26 20 44 st %g2, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 4000a198: 10 80 00 09 b 4000a1bc <_CORE_RWLock_Release+0x90> 4000a19c: 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 || 4000a1a0: 80 a0 60 01 cmp %g1, 1 4000a1a4: 02 80 00 0b be 4000a1d0 <_CORE_RWLock_Release+0xa4> <== NEVER TAKEN 4000a1a8: 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; 4000a1ac: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 4000a1b0: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 4000a1b4: 40 00 08 dd call 4000c528 <_Thread_queue_Extract> 4000a1b8: 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 ); 4000a1bc: 40 00 09 2c call 4000c66c <_Thread_queue_First> 4000a1c0: 90 10 00 18 mov %i0, %o0 if ( !next || 4000a1c4: 92 92 20 00 orcc %o0, 0, %o1 4000a1c8: 32 bf ff f6 bne,a 4000a1a0 <_CORE_RWLock_Release+0x74> 4000a1cc: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 4000a1d0: 81 c7 e0 08 ret 4000a1d4: 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; 4000a1d8: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 4000a1dc: 80 a0 60 00 cmp %g1, 0 4000a1e0: 02 bf ff de be 4000a158 <_CORE_RWLock_Release+0x2c> 4000a1e4: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 4000a1e8: 7f ff e4 9d call 4000345c 4000a1ec: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 4000a1f0: 30 80 00 05 b,a 4000a204 <_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 ); 4000a1f4: 7f ff e4 9a call 4000345c 4000a1f8: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 4000a1fc: 82 10 20 02 mov 2, %g1 4000a200: c2 27 60 34 st %g1, [ %i5 + 0x34 ] } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 4000a204: 81 c7 e0 08 ret 4000a208: 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; 4000a20c: 82 10 20 02 mov 2, %g1 4000a210: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 4000a214: 81 c7 e0 08 ret 4000a218: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000a21c <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 4000a21c: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 4000a220: 90 10 00 18 mov %i0, %o0 4000a224: 40 00 06 e4 call 4000bdb4 <_Thread_Get> 4000a228: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000a22c: c2 07 bf fc ld [ %fp + -4 ], %g1 4000a230: 80 a0 60 00 cmp %g1, 0 4000a234: 12 80 00 08 bne 4000a254 <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 4000a238: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 4000a23c: 40 00 09 4d call 4000c770 <_Thread_queue_Process_timeout> 4000a240: 01 00 00 00 nop * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 4000a244: 03 10 00 69 sethi %hi(0x4001a400), %g1 4000a248: c4 00 63 e0 ld [ %g1 + 0x3e0 ], %g2 ! 4001a7e0 <_Thread_Dispatch_disable_level> --level; 4000a24c: 84 00 bf ff add %g2, -1, %g2 _Thread_Dispatch_disable_level = level; 4000a250: c4 20 63 e0 st %g2, [ %g1 + 0x3e0 ] 4000a254: 81 c7 e0 08 ret 4000a258: 81 e8 00 00 restore =============================================================================== 4000811c <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 4000811c: 9d e3 bf a0 save %sp, -96, %sp * This routine returns true if thread dispatch indicates * that we are in a critical section. */ RTEMS_INLINE_ROUTINE bool _Thread_Dispatch_in_critical_section(void) { if ( _Thread_Dispatch_disable_level == 0 ) 40008120: 3b 10 00 7b sethi %hi(0x4001ec00), %i5 40008124: c2 07 62 c0 ld [ %i5 + 0x2c0 ], %g1 ! 4001eec0 <_Thread_Dispatch_disable_level> 40008128: 80 a0 60 00 cmp %g1, 0 4000812c: 02 80 00 1f be 400081a8 <_CORE_mutex_Seize+0x8c> 40008130: f8 27 a0 54 st %i4, [ %fp + 0x54 ] _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 40008134: 80 a6 a0 00 cmp %i2, 0 40008138: 02 80 00 2c be 400081e8 <_CORE_mutex_Seize+0xcc> 4000813c: 90 10 00 18 mov %i0, %o0 40008140: 03 10 00 7c sethi %hi(0x4001f000), %g1 40008144: c2 00 63 c8 ld [ %g1 + 0x3c8 ], %g1 ! 4001f3c8 <_System_state_Current> 40008148: 80 a0 60 01 cmp %g1, 1 4000814c: 38 80 00 2e bgu,a 40008204 <_CORE_mutex_Seize+0xe8> 40008150: 90 10 20 00 clr %o0 40008154: 40 00 14 6a call 4000d2fc <_CORE_mutex_Seize_interrupt_trylock> 40008158: 92 07 a0 54 add %fp, 0x54, %o1 4000815c: 80 a2 20 00 cmp %o0, 0 40008160: 02 80 00 27 be 400081fc <_CORE_mutex_Seize+0xe0> <== ALWAYS TAKEN 40008164: 01 00 00 00 nop * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40008168: c4 07 62 c0 ld [ %i5 + 0x2c0 ], %g2 4000816c: 03 10 00 7c sethi %hi(0x4001f000), %g1 40008170: c2 00 63 e0 ld [ %g1 + 0x3e0 ], %g1 ! 4001f3e0 <_Per_CPU_Information+0x10> 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; 40008174: 86 10 20 01 mov 1, %g3 40008178: c6 26 20 30 st %g3, [ %i0 + 0x30 ] 4000817c: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 40008180: f2 20 60 20 st %i1, [ %g1 + 0x20 ] ++level; 40008184: 82 00 a0 01 add %g2, 1, %g1 _Thread_Dispatch_disable_level = level; 40008188: c2 27 62 c0 st %g1, [ %i5 + 0x2c0 ] 4000818c: 7f ff e7 ca call 400020b4 40008190: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 40008194: 90 10 00 18 mov %i0, %o0 40008198: 7f ff ff ba call 40008080 <_CORE_mutex_Seize_interrupt_blocking> 4000819c: 92 10 00 1b mov %i3, %o1 400081a0: 81 c7 e0 08 ret 400081a4: 81 e8 00 00 restore 400081a8: 90 10 00 18 mov %i0, %o0 400081ac: 40 00 14 54 call 4000d2fc <_CORE_mutex_Seize_interrupt_trylock> 400081b0: 92 07 a0 54 add %fp, 0x54, %o1 400081b4: 80 a2 20 00 cmp %o0, 0 400081b8: 02 bf ff fa be 400081a0 <_CORE_mutex_Seize+0x84> 400081bc: 80 a6 a0 00 cmp %i2, 0 400081c0: 12 bf ff ea bne 40008168 <_CORE_mutex_Seize+0x4c> 400081c4: 01 00 00 00 nop 400081c8: 7f ff e7 bb call 400020b4 400081cc: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 400081d0: 03 10 00 7c sethi %hi(0x4001f000), %g1 400081d4: c2 00 63 e0 ld [ %g1 + 0x3e0 ], %g1 ! 4001f3e0 <_Per_CPU_Information+0x10> 400081d8: 84 10 20 01 mov 1, %g2 400081dc: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 400081e0: 81 c7 e0 08 ret 400081e4: 81 e8 00 00 restore 400081e8: 40 00 14 45 call 4000d2fc <_CORE_mutex_Seize_interrupt_trylock> 400081ec: 92 07 a0 54 add %fp, 0x54, %o1 400081f0: 80 a2 20 00 cmp %o0, 0 400081f4: 12 bf ff f5 bne 400081c8 <_CORE_mutex_Seize+0xac> <== NEVER TAKEN 400081f8: 01 00 00 00 nop 400081fc: 81 c7 e0 08 ret 40008200: 81 e8 00 00 restore 40008204: 92 10 20 00 clr %o1 40008208: 40 00 01 c1 call 4000890c <_Internal_error_Occurred> 4000820c: 94 10 20 12 mov 0x12, %o2 =============================================================================== 4000838c <_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 ) { 4000838c: 9d e3 bf a0 save %sp, -96, %sp 40008390: ba 10 00 18 mov %i0, %i5 Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 40008394: b0 10 20 00 clr %i0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 40008398: 40 00 07 a5 call 4000a22c <_Thread_queue_Dequeue> 4000839c: 90 10 00 1d mov %i5, %o0 400083a0: 80 a2 20 00 cmp %o0, 0 400083a4: 02 80 00 04 be 400083b4 <_CORE_semaphore_Surrender+0x28> 400083a8: 01 00 00 00 nop status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } 400083ac: 81 c7 e0 08 ret 400083b0: 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 ); 400083b4: 7f ff e7 3c call 400020a4 400083b8: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 400083bc: c2 07 60 48 ld [ %i5 + 0x48 ], %g1 400083c0: c4 07 60 40 ld [ %i5 + 0x40 ], %g2 400083c4: 80 a0 40 02 cmp %g1, %g2 400083c8: 1a 80 00 05 bcc 400083dc <_CORE_semaphore_Surrender+0x50> <== NEVER TAKEN 400083cc: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 400083d0: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 400083d4: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 400083d8: c2 27 60 48 st %g1, [ %i5 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 400083dc: 7f ff e7 36 call 400020b4 400083e0: 01 00 00 00 nop } return status; } 400083e4: 81 c7 e0 08 ret 400083e8: 81 e8 00 00 restore =============================================================================== 40007f4c <_Chain_Initialize>: Chain_Control *the_chain, void *starting_address, size_t number_nodes, size_t node_size ) { 40007f4c: 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; 40007f50: 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 ); 40007f54: ba 06 20 04 add %i0, 4, %i5 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 40007f58: 80 a6 a0 00 cmp %i2, 0 40007f5c: 02 80 00 13 be 40007fa8 <_Chain_Initialize+0x5c> <== NEVER TAKEN 40007f60: 92 06 bf ff add %i2, -1, %o1 40007f64: 86 10 00 09 mov %o1, %g3 40007f68: 82 10 00 19 mov %i1, %g1 40007f6c: 84 10 00 18 mov %i0, %g2 current->next = next; 40007f70: c2 20 80 00 st %g1, [ %g2 ] next->previous = current; 40007f74: c4 20 60 04 st %g2, [ %g1 + 4 ] Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { 40007f78: 86 00 ff ff add %g3, -1, %g3 40007f7c: 84 10 00 01 mov %g1, %g2 40007f80: 80 a0 ff ff cmp %g3, -1 40007f84: 12 bf ff fb bne 40007f70 <_Chain_Initialize+0x24> 40007f88: 82 00 40 1b add %g1, %i3, %g1 #include #include #include #include void _Chain_Initialize( 40007f8c: 40 00 42 00 call 4001878c <.umul> 40007f90: 90 10 00 1b mov %i3, %o0 40007f94: 90 06 40 08 add %i1, %o0, %o0 current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; 40007f98: fa 22 00 00 st %i5, [ %o0 ] tail->previous = current; 40007f9c: d0 26 20 08 st %o0, [ %i0 + 8 ] 40007fa0: 81 c7 e0 08 ret 40007fa4: 81 e8 00 00 restore ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; 40007fa8: 10 bf ff fc b 40007f98 <_Chain_Initialize+0x4c> <== NOT EXECUTED 40007fac: 90 10 00 18 mov %i0, %o0 <== NOT EXECUTED =============================================================================== 40006ef8 <_Event_Surrender>: rtems_event_set event_in, Event_Control *event, Thread_blocking_operation_States *sync_state, States_Control wait_state ) { 40006ef8: 9d e3 bf a0 save %sp, -96, %sp rtems_event_set seized_events; rtems_option option_set; option_set = the_thread->Wait.option; _ISR_Disable( level ); 40006efc: 7f ff ec 6a call 400020a4 40006f00: fa 06 20 30 ld [ %i0 + 0x30 ], %i5 RTEMS_INLINE_ROUTINE void _Event_sets_Post( rtems_event_set the_new_events, rtems_event_set *the_event_set ) { *the_event_set |= the_new_events; 40006f04: c2 06 80 00 ld [ %i2 ], %g1 40006f08: b2 16 40 01 or %i1, %g1, %i1 40006f0c: f2 26 80 00 st %i1, [ %i2 ] _Event_sets_Post( event_in, &event->pending_events ); pending_events = event->pending_events; event_condition = the_thread->Wait.count; 40006f10: 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 ) ) { 40006f14: 84 8e 40 01 andcc %i1, %g1, %g2 40006f18: 02 80 00 35 be 40006fec <_Event_Surrender+0xf4> 40006f1c: 07 10 00 7c sethi %hi(0x4001f000), %g3 /* * 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() && 40006f20: 86 10 e3 d0 or %g3, 0x3d0, %g3 ! 4001f3d0 <_Per_CPU_Information> 40006f24: c8 00 e0 08 ld [ %g3 + 8 ], %g4 40006f28: 80 a1 20 00 cmp %g4, 0 40006f2c: 32 80 00 1c bne,a 40006f9c <_Event_Surrender+0xa4> 40006f30: c6 00 e0 10 ld [ %g3 + 0x10 ], %g3 RTEMS_INLINE_ROUTINE bool _States_Are_set ( States_Control the_states, States_Control mask ) { return ( (the_states & mask) != STATES_READY); 40006f34: c6 06 20 10 ld [ %i0 + 0x10 ], %g3 } /* * Otherwise, this is a normal send to another thread */ if ( _States_Are_set( the_thread->current_state, wait_state ) ) { 40006f38: 80 8f 00 03 btst %i4, %g3 40006f3c: 02 80 00 2c be 40006fec <_Event_Surrender+0xf4> 40006f40: 80 a0 40 02 cmp %g1, %g2 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 40006f44: 02 80 00 04 be 40006f54 <_Event_Surrender+0x5c> 40006f48: 80 8f 60 02 btst 2, %i5 40006f4c: 02 80 00 28 be 40006fec <_Event_Surrender+0xf4> <== NEVER TAKEN 40006f50: 01 00 00 00 nop event->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006f54: 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) ); 40006f58: b2 2e 40 02 andn %i1, %g2, %i1 /* * Otherwise, this is a normal send to another thread */ if ( _States_Are_set( the_thread->current_state, wait_state ) ) { if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { event->pending_events = _Event_sets_Clear( 40006f5c: f2 26 80 00 st %i1, [ %i2 ] pending_events, seized_events ); the_thread->Wait.count = 0; 40006f60: c0 26 20 24 clr [ %i0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006f64: c4 20 40 00 st %g2, [ %g1 ] _ISR_Flash( level ); 40006f68: 7f ff ec 53 call 400020b4 40006f6c: 01 00 00 00 nop 40006f70: 7f ff ec 4d call 400020a4 40006f74: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 40006f78: c2 06 20 50 ld [ %i0 + 0x50 ], %g1 40006f7c: 80 a0 60 02 cmp %g1, 2 40006f80: 02 80 00 1d be 40006ff4 <_Event_Surrender+0xfc> 40006f84: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 40006f88: 7f ff ec 4b call 400020b4 40006f8c: 33 04 01 ff sethi %hi(0x1007fc00), %i1 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40006f90: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1007fff8 40006f94: 40 00 0a e0 call 40009b14 <_Thread_Clear_state> 40006f98: 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() && 40006f9c: 80 a6 00 03 cmp %i0, %g3 40006fa0: 32 bf ff e6 bne,a 40006f38 <_Event_Surrender+0x40> 40006fa4: c6 06 20 10 ld [ %i0 + 0x10 ], %g3 _Thread_Is_executing( the_thread ) && ((*sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 40006fa8: c6 06 c0 00 ld [ %i3 ], %g3 40006fac: 86 00 ff ff add %g3, -1, %g3 /* * 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 ) && 40006fb0: 80 a0 e0 01 cmp %g3, 1 40006fb4: 38 bf ff e1 bgu,a 40006f38 <_Event_Surrender+0x40> 40006fb8: c6 06 20 10 ld [ %i0 + 0x10 ], %g3 ((*sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (*sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { 40006fbc: 80 a0 40 02 cmp %g1, %g2 40006fc0: 02 80 00 04 be 40006fd0 <_Event_Surrender+0xd8> 40006fc4: 80 8f 60 02 btst 2, %i5 40006fc8: 02 80 00 09 be 40006fec <_Event_Surrender+0xf4> <== NEVER TAKEN 40006fcc: 01 00 00 00 nop event->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006fd0: c2 06 20 28 ld [ %i0 + 0x28 ], %g1 40006fd4: b2 2e 40 02 andn %i1, %g2, %i1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((*sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (*sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { event->pending_events = _Event_sets_Clear( 40006fd8: f2 26 80 00 st %i1, [ %i2 ] pending_events, seized_events ); the_thread->Wait.count = 0; 40006fdc: c0 26 20 24 clr [ %i0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 40006fe0: c4 20 40 00 st %g2, [ %g1 ] *sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 40006fe4: 82 10 20 03 mov 3, %g1 40006fe8: c2 26 c0 00 st %g1, [ %i3 ] _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 40006fec: 7f ff ec 32 call 400020b4 40006ff0: 91 e8 00 08 restore %g0, %o0, %o0 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 40006ff4: 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 ); 40006ff8: 7f ff ec 2f call 400020b4 40006ffc: 33 04 01 ff sethi %hi(0x1007fc00), %i1 (void) _Watchdog_Remove( &the_thread->Timer ); 40007000: 40 00 0f 4d call 4000ad34 <_Watchdog_Remove> 40007004: 90 06 20 48 add %i0, 0x48, %o0 40007008: b2 16 63 f8 or %i1, 0x3f8, %i1 4000700c: 40 00 0a c2 call 40009b14 <_Thread_Clear_state> 40007010: 81 e8 00 00 restore =============================================================================== 40007014 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *arg ) { 40007014: 9d e3 bf 98 save %sp, -104, %sp ISR_Level level; Thread_blocking_operation_States *sync_state; sync_state = arg; the_thread = _Thread_Get( id, &location ); 40007018: 90 10 00 18 mov %i0, %o0 4000701c: 40 00 0b b7 call 40009ef8 <_Thread_Get> 40007020: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40007024: c2 07 bf fc ld [ %fp + -4 ], %g1 40007028: 80 a0 60 00 cmp %g1, 0 4000702c: 12 80 00 15 bne 40007080 <_Event_Timeout+0x6c> <== NEVER TAKEN 40007030: ba 10 00 08 mov %o0, %i5 * * 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 ); 40007034: 7f ff ec 1c call 400020a4 40007038: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 4000703c: 03 10 00 7c sethi %hi(0x4001f000), %g1 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 40007040: c2 00 63 e0 ld [ %g1 + 0x3e0 ], %g1 ! 4001f3e0 <_Per_CPU_Information+0x10> 40007044: 80 a7 40 01 cmp %i5, %g1 40007048: 02 80 00 10 be 40007088 <_Event_Timeout+0x74> 4000704c: c0 27 60 24 clr [ %i5 + 0x24 ] if ( *sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) *sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; 40007050: 82 10 20 06 mov 6, %g1 40007054: c2 27 60 34 st %g1, [ %i5 + 0x34 ] _ISR_Enable( level ); 40007058: 7f ff ec 17 call 400020b4 4000705c: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40007060: 90 10 00 1d mov %i5, %o0 40007064: 13 04 01 ff sethi %hi(0x1007fc00), %o1 40007068: 40 00 0a ab call 40009b14 <_Thread_Clear_state> 4000706c: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1007fff8 * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40007070: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40007074: c4 00 62 c0 ld [ %g1 + 0x2c0 ], %g2 ! 4001eec0 <_Thread_Dispatch_disable_level> --level; 40007078: 84 00 bf ff add %g2, -1, %g2 _Thread_Dispatch_disable_level = level; 4000707c: c4 20 62 c0 st %g2, [ %g1 + 0x2c0 ] 40007080: 81 c7 e0 08 ret 40007084: 81 e8 00 00 restore } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( *sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 40007088: c2 06 40 00 ld [ %i1 ], %g1 4000708c: 80 a0 60 01 cmp %g1, 1 40007090: 12 bf ff f1 bne 40007054 <_Event_Timeout+0x40> 40007094: 82 10 20 06 mov 6, %g1 *sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 40007098: 82 10 20 02 mov 2, %g1 4000709c: 10 bf ff ed b 40007050 <_Event_Timeout+0x3c> 400070a0: c2 26 40 00 st %g1, [ %i1 ] =============================================================================== 4000d45c <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 4000d45c: 9d e3 bf 98 save %sp, -104, %sp Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE 4000d460: a2 06 60 04 add %i1, 4, %l1 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 4000d464: a0 10 00 18 mov %i0, %l0 Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { 4000d468: 80 a6 40 11 cmp %i1, %l1 4000d46c: 18 80 00 85 bgu 4000d680 <_Heap_Allocate_aligned_with_boundary+0x224> 4000d470: ea 06 20 10 ld [ %i0 + 0x10 ], %l5 /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { 4000d474: 80 a6 e0 00 cmp %i3, 0 4000d478: 12 80 00 7c bne 4000d668 <_Heap_Allocate_aligned_with_boundary+0x20c> 4000d47c: 80 a6 40 1b cmp %i1, %i3 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 4000d480: fa 04 20 08 ld [ %l0 + 8 ], %i5 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000d484: 80 a4 00 1d cmp %l0, %i5 4000d488: 02 80 00 18 be 4000d4e8 <_Heap_Allocate_aligned_with_boundary+0x8c> 4000d48c: b8 10 20 00 clr %i4 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; 4000d490: ac 10 20 04 mov 4, %l6 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 4000d494: ae 05 60 07 add %l5, 7, %l7 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; 4000d498: ac 25 80 19 sub %l6, %i1, %l6 4000d49c: 10 80 00 0b b 4000d4c8 <_Heap_Allocate_aligned_with_boundary+0x6c> 4000d4a0: ec 27 bf fc st %l6, [ %fp + -4 ] * 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 ) { if ( alignment == 0 ) { 4000d4a4: 12 80 00 18 bne 4000d504 <_Heap_Allocate_aligned_with_boundary+0xa8> 4000d4a8: b0 07 60 08 add %i5, 8, %i0 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { 4000d4ac: 80 a6 20 00 cmp %i0, 0 4000d4b0: 12 80 00 4d bne 4000d5e4 <_Heap_Allocate_aligned_with_boundary+0x188><== ALWAYS TAKEN 4000d4b4: b8 07 20 01 inc %i4 break; } block = block->next; 4000d4b8: fa 07 60 08 ld [ %i5 + 8 ], %i5 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000d4bc: 80 a4 00 1d cmp %l0, %i5 4000d4c0: 22 80 00 0b be,a 4000d4ec <_Heap_Allocate_aligned_with_boundary+0x90> 4000d4c4: c2 04 20 44 ld [ %l0 + 0x44 ], %g1 /* * 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 ) { 4000d4c8: c2 07 60 04 ld [ %i5 + 4 ], %g1 4000d4cc: 80 a4 40 01 cmp %l1, %g1 4000d4d0: 0a bf ff f5 bcs 4000d4a4 <_Heap_Allocate_aligned_with_boundary+0x48> 4000d4d4: 80 a6 a0 00 cmp %i2, 0 if ( alloc_begin != 0 ) { break; } block = block->next; 4000d4d8: fa 07 60 08 ld [ %i5 + 8 ], %i5 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { 4000d4dc: 80 a4 00 1d cmp %l0, %i5 4000d4e0: 12 bf ff fa bne 4000d4c8 <_Heap_Allocate_aligned_with_boundary+0x6c> 4000d4e4: b8 07 20 01 inc %i4 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { 4000d4e8: c2 04 20 44 ld [ %l0 + 0x44 ], %g1 4000d4ec: 80 a0 40 1c cmp %g1, %i4 4000d4f0: 1a 80 00 03 bcc 4000d4fc <_Heap_Allocate_aligned_with_boundary+0xa0> 4000d4f4: b0 10 20 00 clr %i0 stats->max_search = search_count; 4000d4f8: f8 24 20 44 st %i4, [ %l0 + 0x44 ] } return (void *) alloc_begin; 4000d4fc: 81 c7 e0 08 ret 4000d500: 81 e8 00 00 restore uintptr_t alignment, uintptr_t boundary ) { uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; 4000d504: e8 04 20 14 ld [ %l0 + 0x14 ], %l4 - 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; 4000d508: a4 08 7f fe and %g1, -2, %l2 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; 4000d50c: c2 07 bf fc ld [ %fp + -4 ], %g1 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; 4000d510: 84 25 c0 14 sub %l7, %l4, %g2 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; 4000d514: a4 07 40 12 add %i5, %l2, %l2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000d518: 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; 4000d51c: b0 00 40 12 add %g1, %l2, %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 4000d520: a4 00 80 12 add %g2, %l2, %l2 4000d524: 40 00 2d 80 call 40018b24 <.urem> 4000d528: 90 10 00 18 mov %i0, %o0 4000d52c: 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 ) { 4000d530: 80 a4 80 18 cmp %l2, %i0 4000d534: 1a 80 00 06 bcc 4000d54c <_Heap_Allocate_aligned_with_boundary+0xf0> 4000d538: a6 07 60 08 add %i5, 8, %l3 4000d53c: 90 10 00 12 mov %l2, %o0 4000d540: 40 00 2d 79 call 40018b24 <.urem> 4000d544: 92 10 00 1a mov %i2, %o1 4000d548: b0 24 80 08 sub %l2, %o0, %i0 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { 4000d54c: 80 a6 e0 00 cmp %i3, 0 4000d550: 02 80 00 37 be 4000d62c <_Heap_Allocate_aligned_with_boundary+0x1d0> 4000d554: 80 a4 c0 18 cmp %l3, %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; 4000d558: 86 06 00 19 add %i0, %i1, %g3 4000d55c: 92 10 00 1b mov %i3, %o1 4000d560: 90 10 00 03 mov %g3, %o0 4000d564: 40 00 2d 70 call 40018b24 <.urem> 4000d568: c6 27 bf f8 st %g3, [ %fp + -8 ] 4000d56c: c6 07 bf f8 ld [ %fp + -8 ], %g3 4000d570: 90 20 c0 08 sub %g3, %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 ) { 4000d574: 80 a6 00 08 cmp %i0, %o0 4000d578: 1a 80 00 2c bcc 4000d628 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000d57c: a4 04 c0 19 add %l3, %i1, %l2 4000d580: 80 a2 00 03 cmp %o0, %g3 4000d584: 2a 80 00 12 bcs,a 4000d5cc <_Heap_Allocate_aligned_with_boundary+0x170> 4000d588: 80 a4 80 08 cmp %l2, %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 ) { 4000d58c: 10 80 00 28 b 4000d62c <_Heap_Allocate_aligned_with_boundary+0x1d0> 4000d590: 80 a4 c0 18 cmp %l3, %i0 4000d594: 92 10 00 1a mov %i2, %o1 4000d598: 40 00 2d 63 call 40018b24 <.urem> 4000d59c: 90 10 00 18 mov %i0, %o0 4000d5a0: 92 10 00 1b mov %i3, %o1 4000d5a4: b0 26 00 08 sub %i0, %o0, %i0 if ( boundary_line < boundary_floor ) { return 0; } alloc_begin = boundary_line - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; 4000d5a8: ac 06 00 19 add %i0, %i1, %l6 4000d5ac: 40 00 2d 5e call 40018b24 <.urem> 4000d5b0: 90 10 00 16 mov %l6, %o0 4000d5b4: 90 25 80 08 sub %l6, %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 ) { 4000d5b8: 80 a2 00 16 cmp %o0, %l6 4000d5bc: 1a 80 00 1b bcc 4000d628 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000d5c0: 80 a6 00 08 cmp %i0, %o0 4000d5c4: 1a 80 00 19 bcc 4000d628 <_Heap_Allocate_aligned_with_boundary+0x1cc> 4000d5c8: 80 a4 80 08 cmp %l2, %o0 if ( boundary_line < boundary_floor ) { 4000d5cc: 08 bf ff f2 bleu 4000d594 <_Heap_Allocate_aligned_with_boundary+0x138> 4000d5d0: b0 22 00 19 sub %o0, %i1, %i0 return 0; 4000d5d4: b0 10 20 00 clr %i0 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { 4000d5d8: 80 a6 20 00 cmp %i0, 0 4000d5dc: 02 bf ff b7 be 4000d4b8 <_Heap_Allocate_aligned_with_boundary+0x5c><== ALWAYS TAKEN 4000d5e0: b8 07 20 01 inc %i4 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4000d5e4: c6 04 20 48 ld [ %l0 + 0x48 ], %g3 stats->searches += search_count; 4000d5e8: c4 04 20 4c ld [ %l0 + 0x4c ], %g2 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4000d5ec: 86 00 e0 01 inc %g3 stats->searches += search_count; 4000d5f0: 84 00 80 1c add %g2, %i4, %g2 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; 4000d5f4: c6 24 20 48 st %g3, [ %l0 + 0x48 ] stats->searches += search_count; 4000d5f8: c4 24 20 4c st %g2, [ %l0 + 0x4c ] block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 4000d5fc: 90 10 00 10 mov %l0, %o0 4000d600: 92 10 00 1d mov %i5, %o1 4000d604: 94 10 00 18 mov %i0, %o2 4000d608: 7f ff ec 75 call 400087dc <_Heap_Block_allocate> 4000d60c: 96 10 00 19 mov %i1, %o3 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { 4000d610: c2 04 20 44 ld [ %l0 + 0x44 ], %g1 4000d614: 80 a0 40 1c cmp %g1, %i4 4000d618: 2a bf ff b9 bcs,a 4000d4fc <_Heap_Allocate_aligned_with_boundary+0xa0> 4000d61c: f8 24 20 44 st %i4, [ %l0 + 0x44 ] stats->max_search = search_count; } return (void *) alloc_begin; } 4000d620: 81 c7 e0 08 ret 4000d624: 81 e8 00 00 restore 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 ) { 4000d628: 80 a4 c0 18 cmp %l3, %i0 4000d62c: 18 bf ff ea bgu 4000d5d4 <_Heap_Allocate_aligned_with_boundary+0x178> 4000d630: 82 10 3f f8 mov -8, %g1 4000d634: 90 10 00 18 mov %i0, %o0 4000d638: a4 20 40 1d sub %g1, %i5, %l2 4000d63c: 92 10 00 15 mov %l5, %o1 4000d640: 40 00 2d 39 call 40018b24 <.urem> 4000d644: a4 04 80 18 add %l2, %i0, %l2 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 ) { 4000d648: 90 a4 80 08 subcc %l2, %o0, %o0 4000d64c: 02 bf ff 99 be 4000d4b0 <_Heap_Allocate_aligned_with_boundary+0x54> 4000d650: 80 a6 20 00 cmp %i0, 0 4000d654: 80 a2 00 14 cmp %o0, %l4 4000d658: 1a bf ff 96 bcc 4000d4b0 <_Heap_Allocate_aligned_with_boundary+0x54> 4000d65c: 80 a6 20 00 cmp %i0, 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 ) { if ( boundary_line < boundary_floor ) { return 0; 4000d660: 10 bf ff de b 4000d5d8 <_Heap_Allocate_aligned_with_boundary+0x17c> 4000d664: b0 10 20 00 clr %i0 /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { 4000d668: 18 80 00 06 bgu 4000d680 <_Heap_Allocate_aligned_with_boundary+0x224> 4000d66c: 80 a6 a0 00 cmp %i2, 0 return NULL; } if ( alignment == 0 ) { 4000d670: 22 bf ff 84 be,a 4000d480 <_Heap_Allocate_aligned_with_boundary+0x24> 4000d674: b4 10 00 15 mov %l5, %i2 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 4000d678: 10 bf ff 83 b 4000d484 <_Heap_Allocate_aligned_with_boundary+0x28> 4000d67c: fa 04 20 08 ld [ %l0 + 8 ], %i5 uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { /* Integer overflow occured */ return NULL; 4000d680: 81 c7 e0 08 ret 4000d684: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000d29c <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t unused __attribute__((unused)) ) { 4000d29c: 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; 4000d2a0: c0 27 bf f8 clr [ %fp + -8 ] Heap_Block *extend_last_block = NULL; 4000d2a4: c0 27 bf fc clr [ %fp + -4 ] Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t unused __attribute__((unused)) ) { 4000d2a8: b8 10 00 18 mov %i0, %i4 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 4000d2ac: e2 06 20 20 ld [ %i0 + 0x20 ], %l1 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; 4000d2b0: a0 06 40 1a add %i1, %i2, %l0 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; 4000d2b4: e4 06 20 10 ld [ %i0 + 0x10 ], %l2 uintptr_t const min_block_size = heap->min_block_size; 4000d2b8: d6 06 20 14 ld [ %i0 + 0x14 ], %o3 uintptr_t const free_size = stats->free_size; uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { 4000d2bc: 80 a6 40 10 cmp %i1, %l0 4000d2c0: 08 80 00 04 bleu 4000d2d0 <_Heap_Extend+0x34> 4000d2c4: f0 06 20 30 ld [ %i0 + 0x30 ], %i0 return 0; 4000d2c8: 81 c7 e0 08 ret 4000d2cc: 91 e8 20 00 restore %g0, 0, %o0 } extend_area_ok = _Heap_Get_first_and_last_block( 4000d2d0: 90 10 00 19 mov %i1, %o0 4000d2d4: 92 10 00 1a mov %i2, %o1 4000d2d8: 94 10 00 12 mov %l2, %o2 4000d2dc: 98 07 bf f8 add %fp, -8, %o4 4000d2e0: 7f ff ec 06 call 400082f8 <_Heap_Get_first_and_last_block> 4000d2e4: 9a 07 bf fc add %fp, -4, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 4000d2e8: 80 8a 20 ff btst 0xff, %o0 4000d2ec: 02 bf ff f7 be 4000d2c8 <_Heap_Extend+0x2c> 4000d2f0: ba 10 00 11 mov %l1, %i5 4000d2f4: aa 10 20 00 clr %l5 4000d2f8: ac 10 20 00 clr %l6 4000d2fc: a6 10 20 00 clr %l3 4000d300: 10 80 00 10 b 4000d340 <_Heap_Extend+0xa4> 4000d304: a8 10 20 00 clr %l4 return 0; } if ( extend_area_end == sub_area_begin ) { merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 4000d308: 2a 80 00 02 bcs,a 4000d310 <_Heap_Extend+0x74> 4000d30c: ac 10 00 1d mov %i5, %l6 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 4000d310: 80 a6 c0 19 cmp %i3, %i1 4000d314: 22 80 00 1e be,a 4000d38c <_Heap_Extend+0xf0> 4000d318: e0 27 40 00 st %l0, [ %i5 ] start_block->prev_size = extend_area_end; merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 4000d31c: 80 a6 40 1b cmp %i1, %i3 4000d320: 38 80 00 02 bgu,a 4000d328 <_Heap_Extend+0x8c> 4000d324: aa 10 00 08 mov %o0, %l5 - 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; 4000d328: fa 02 20 04 ld [ %o0 + 4 ], %i5 4000d32c: ba 0f 7f fe and %i5, -2, %i5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000d330: ba 02 00 1d add %o0, %i5, %i5 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 4000d334: 80 a4 40 1d cmp %l1, %i5 4000d338: 22 80 00 1c be,a 4000d3a8 <_Heap_Extend+0x10c> 4000d33c: c2 07 20 18 ld [ %i4 + 0x18 ], %g1 return 0; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 4000d340: 80 a7 40 11 cmp %i5, %l1 4000d344: 22 80 00 03 be,a 4000d350 <_Heap_Extend+0xb4> 4000d348: f4 07 20 18 ld [ %i4 + 0x18 ], %i2 4000d34c: b4 10 00 1d mov %i5, %i2 uintptr_t const sub_area_end = start_block->prev_size; 4000d350: f6 07 40 00 ld [ %i5 ], %i3 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000d354: 92 10 00 12 mov %l2, %o1 4000d358: 40 00 17 1b call 40012fc4 <.urem> 4000d35c: 90 10 00 1b mov %i3, %o0 4000d360: 82 06 ff f8 add %i3, -8, %g1 Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 4000d364: 80 a6 80 10 cmp %i2, %l0 4000d368: 0a 80 00 64 bcs 4000d4f8 <_Heap_Extend+0x25c> 4000d36c: 90 20 40 08 sub %g1, %o0, %o0 sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return 0; } if ( extend_area_end == sub_area_begin ) { 4000d370: 80 a6 80 10 cmp %i2, %l0 4000d374: 12 bf ff e5 bne 4000d308 <_Heap_Extend+0x6c> 4000d378: 80 a4 00 1b cmp %l0, %i3 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 ) { 4000d37c: 80 a6 c0 19 cmp %i3, %i1 4000d380: 12 bf ff e7 bne 4000d31c <_Heap_Extend+0x80> <== ALWAYS TAKEN 4000d384: a8 10 00 1d mov %i5, %l4 start_block->prev_size = extend_area_end; 4000d388: e0 27 40 00 st %l0, [ %i5 ] <== NOT EXECUTED - 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; 4000d38c: fa 02 20 04 ld [ %o0 + 4 ], %i5 4000d390: ba 0f 7f fe and %i5, -2, %i5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000d394: ba 02 00 1d add %o0, %i5, %i5 } 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 ); 4000d398: 80 a4 40 1d cmp %l1, %i5 4000d39c: 12 bf ff e9 bne 4000d340 <_Heap_Extend+0xa4> <== NEVER TAKEN 4000d3a0: a6 10 00 08 mov %o0, %l3 if ( extend_area_begin < heap->area_begin ) { 4000d3a4: c2 07 20 18 ld [ %i4 + 0x18 ], %g1 4000d3a8: 80 a6 40 01 cmp %i1, %g1 4000d3ac: 3a 80 00 4e bcc,a 4000d4e4 <_Heap_Extend+0x248> 4000d3b0: c2 07 20 1c ld [ %i4 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 4000d3b4: f2 27 20 18 st %i1, [ %i4 + 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; 4000d3b8: c2 07 bf f8 ld [ %fp + -8 ], %g1 4000d3bc: c4 07 bf fc ld [ %fp + -4 ], %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 ) { 4000d3c0: c8 07 20 20 ld [ %i4 + 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 = 4000d3c4: 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; 4000d3c8: e0 20 40 00 st %l0, [ %g1 ] extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 4000d3cc: ba 10 e0 01 or %g3, 1, %i5 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 = 4000d3d0: fa 20 60 04 st %i5, [ %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; 4000d3d4: 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 ) { 4000d3d8: 80 a1 00 01 cmp %g4, %g1 4000d3dc: 08 80 00 3c bleu 4000d4cc <_Heap_Extend+0x230> 4000d3e0: c0 20 a0 04 clr [ %g2 + 4 ] heap->first_block = extend_first_block; 4000d3e4: c2 27 20 20 st %g1, [ %i4 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000d3e8: 80 a5 20 00 cmp %l4, 0 4000d3ec: 02 80 00 47 be 4000d508 <_Heap_Extend+0x26c> 4000d3f0: 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; 4000d3f4: fa 07 20 10 ld [ %i4 + 0x10 ], %i5 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; 4000d3f8: 92 10 00 1d mov %i5, %o1 4000d3fc: 40 00 16 f2 call 40012fc4 <.urem> 4000d400: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 4000d404: 80 a2 20 00 cmp %o0, 0 4000d408: 02 80 00 04 be 4000d418 <_Heap_Extend+0x17c> 4000d40c: c4 05 00 00 ld [ %l4 ], %g2 return value - remainder + alignment; 4000d410: b2 06 40 1d add %i1, %i5, %i1 4000d414: b2 26 40 08 sub %i1, %o0, %i1 uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = 4000d418: 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; 4000d41c: 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 = 4000d420: 84 25 00 01 sub %l4, %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; 4000d424: 84 10 a0 01 or %g2, 1, %g2 _Heap_Free_block( heap, new_first_block ); 4000d428: 90 10 00 1c mov %i4, %o0 4000d42c: 92 10 00 01 mov %g1, %o1 4000d430: 7f ff ff 85 call 4000d244 <_Heap_Free_block> 4000d434: c4 26 7f fc st %g2, [ %i1 + -4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 4000d438: 80 a4 e0 00 cmp %l3, 0 4000d43c: 02 80 00 3a be 4000d524 <_Heap_Extend+0x288> 4000d440: a0 04 3f f8 add %l0, -8, %l0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000d444: d2 07 20 10 ld [ %i4 + 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( 4000d448: a0 24 00 13 sub %l0, %l3, %l0 4000d44c: 40 00 16 de call 40012fc4 <.urem> 4000d450: 90 10 00 10 mov %l0, %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) 4000d454: c2 04 e0 04 ld [ %l3 + 4 ], %g1 4000d458: a0 24 00 08 sub %l0, %o0, %l0 4000d45c: 82 20 40 10 sub %g1, %l0, %g1 | HEAP_PREV_BLOCK_USED; 4000d460: 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 = 4000d464: 84 04 00 13 add %l0, %l3, %g2 4000d468: 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; 4000d46c: c2 04 e0 04 ld [ %l3 + 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 ); 4000d470: 90 10 00 1c mov %i4, %o0 4000d474: 82 08 60 01 and %g1, 1, %g1 4000d478: 92 10 00 13 mov %l3, %o1 block->size_and_flag = size | flag; 4000d47c: a0 14 00 01 or %l0, %g1, %l0 4000d480: 7f ff ff 71 call 4000d244 <_Heap_Free_block> 4000d484: e0 24 e0 04 st %l0, [ %l3 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d488: 80 a4 e0 00 cmp %l3, 0 4000d48c: 02 80 00 33 be 4000d558 <_Heap_Extend+0x2bc> 4000d490: 80 a5 20 00 cmp %l4, 0 */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( heap->last_block, (uintptr_t) heap->first_block - (uintptr_t) heap->last_block 4000d494: c2 07 20 24 ld [ %i4 + 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( 4000d498: fa 07 20 20 ld [ %i4 + 0x20 ], %i5 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; 4000d49c: 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; 4000d4a0: c4 07 20 2c ld [ %i4 + 0x2c ], %g2 _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 4000d4a4: c6 07 20 30 ld [ %i4 + 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( 4000d4a8: ba 27 40 01 sub %i5, %g1, %i5 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; 4000d4ac: 88 09 20 01 and %g4, 1, %g4 block->size_and_flag = size | flag; 4000d4b0: 88 17 40 04 or %i5, %g4, %g4 4000d4b4: c8 20 60 04 st %g4, [ %g1 + 4 ] 4000d4b8: b0 20 c0 18 sub %g3, %i0, %i0 /* Statistics */ stats->size += extended_size; 4000d4bc: 82 00 80 18 add %g2, %i0, %g1 4000d4c0: c2 27 20 2c st %g1, [ %i4 + 0x2c ] return extended_size; } 4000d4c4: 81 c7 e0 08 ret 4000d4c8: 81 e8 00 00 restore 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 ) { 4000d4cc: c2 07 20 24 ld [ %i4 + 0x24 ], %g1 4000d4d0: 80 a0 40 02 cmp %g1, %g2 4000d4d4: 2a bf ff c5 bcs,a 4000d3e8 <_Heap_Extend+0x14c> 4000d4d8: c4 27 20 24 st %g2, [ %i4 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 4000d4dc: 10 bf ff c4 b 4000d3ec <_Heap_Extend+0x150> 4000d4e0: 80 a5 20 00 cmp %l4, 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 ) { 4000d4e4: 80 a4 00 01 cmp %l0, %g1 4000d4e8: 38 bf ff b4 bgu,a 4000d3b8 <_Heap_Extend+0x11c> 4000d4ec: e0 27 20 1c st %l0, [ %i4 + 0x1c ] heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 4000d4f0: 10 bf ff b3 b 4000d3bc <_Heap_Extend+0x120> 4000d4f4: c2 07 bf f8 ld [ %fp + -8 ], %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 ( 4000d4f8: 80 a6 40 1b cmp %i1, %i3 4000d4fc: 1a bf ff 9e bcc 4000d374 <_Heap_Extend+0xd8> 4000d500: 80 a6 80 10 cmp %i2, %l0 4000d504: 30 bf ff 71 b,a 4000d2c8 <_Heap_Extend+0x2c> 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 ) { 4000d508: 80 a5 a0 00 cmp %l6, 0 4000d50c: 02 bf ff cc be 4000d43c <_Heap_Extend+0x1a0> 4000d510: 80 a4 e0 00 cmp %l3, 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; 4000d514: ac 25 80 02 sub %l6, %g2, %l6 4000d518: ac 15 a0 01 or %l6, 1, %l6 ) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = 4000d51c: 10 bf ff c8 b 4000d43c <_Heap_Extend+0x1a0> 4000d520: ec 20 a0 04 st %l6, [ %g2 + 4 ] ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { 4000d524: 80 a5 60 00 cmp %l5, 0 4000d528: 02 bf ff d8 be 4000d488 <_Heap_Extend+0x1ec> 4000d52c: c4 07 bf f8 ld [ %fp + -8 ], %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; 4000d530: c6 05 60 04 ld [ %l5 + 4 ], %g3 _Heap_Link_above( 4000d534: c2 07 bf fc ld [ %fp + -4 ], %g1 4000d538: 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 ); 4000d53c: 84 20 80 15 sub %g2, %l5, %g2 block->size_and_flag = size | flag; 4000d540: 84 10 80 03 or %g2, %g3, %g2 4000d544: c4 25 60 04 st %g2, [ %l5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 4000d548: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000d54c: 84 10 a0 01 or %g2, 1, %g2 4000d550: 10 bf ff ce b 4000d488 <_Heap_Extend+0x1ec> 4000d554: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 4000d558: 32 bf ff d0 bne,a 4000d498 <_Heap_Extend+0x1fc> 4000d55c: c2 07 20 24 ld [ %i4 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 4000d560: d2 07 bf f8 ld [ %fp + -8 ], %o1 4000d564: 7f ff ff 38 call 4000d244 <_Heap_Free_block> 4000d568: 90 10 00 1c mov %i4, %o0 */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( heap->last_block, (uintptr_t) heap->first_block - (uintptr_t) heap->last_block 4000d56c: 10 bf ff cb b 4000d498 <_Heap_Extend+0x1fc> 4000d570: c2 07 20 24 ld [ %i4 + 0x24 ], %g1 =============================================================================== 4000d688 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 4000d688: 9d e3 bf a0 save %sp, -96, %sp /* * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { 4000d68c: 80 a6 60 00 cmp %i1, 0 4000d690: 02 80 00 3c be 4000d780 <_Heap_Free+0xf8> 4000d694: 82 10 20 01 mov 1, %g1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000d698: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 4000d69c: 40 00 2d 22 call 40018b24 <.urem> 4000d6a0: 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 4000d6a4: c4 06 20 20 ld [ %i0 + 0x20 ], %g2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000d6a8: ba 06 7f f8 add %i1, -8, %i5 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4000d6ac: 90 27 40 08 sub %i5, %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; 4000d6b0: 80 a2 00 02 cmp %o0, %g2 4000d6b4: 0a 80 00 30 bcs 4000d774 <_Heap_Free+0xec> 4000d6b8: 82 10 20 00 clr %g1 4000d6bc: c8 06 20 24 ld [ %i0 + 0x24 ], %g4 4000d6c0: 80 a2 00 04 cmp %o0, %g4 4000d6c4: 38 80 00 2d bgu,a 4000d778 <_Heap_Free+0xf0> <== NEVER TAKEN 4000d6c8: b0 08 60 ff and %g1, 0xff, %i0 <== NOT EXECUTED - 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; 4000d6cc: f6 02 20 04 ld [ %o0 + 4 ], %i3 4000d6d0: ba 0e ff fe and %i3, -2, %i5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000d6d4: 86 02 00 1d add %o0, %i5, %g3 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 4000d6d8: 80 a0 80 03 cmp %g2, %g3 4000d6dc: 38 80 00 27 bgu,a 4000d778 <_Heap_Free+0xf0> <== NEVER TAKEN 4000d6e0: b0 08 60 ff and %g1, 0xff, %i0 <== NOT EXECUTED 4000d6e4: 80 a1 00 03 cmp %g4, %g3 4000d6e8: 2a 80 00 24 bcs,a 4000d778 <_Heap_Free+0xf0> <== NEVER TAKEN 4000d6ec: b0 08 60 ff and %g1, 0xff, %i0 <== NOT EXECUTED 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; 4000d6f0: f8 00 e0 04 ld [ %g3 + 4 ], %i4 return false; } _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_prev_used( next_block ) ) { 4000d6f4: 80 8f 20 01 btst 1, %i4 4000d6f8: 02 80 00 1f be 4000d774 <_Heap_Free+0xec> <== NEVER TAKEN 4000d6fc: 80 a1 00 03 cmp %g4, %g3 return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 4000d700: 02 80 00 23 be 4000d78c <_Heap_Free+0x104> 4000d704: b8 0f 3f fe and %i4, -2, %i4 4000d708: 82 00 c0 1c add %g3, %i4, %g1 4000d70c: c2 00 60 04 ld [ %g1 + 4 ], %g1 4000d710: 80 88 60 01 btst 1, %g1 4000d714: 12 80 00 1f bne 4000d790 <_Heap_Free+0x108> 4000d718: 80 8e e0 01 btst 1, %i3 if ( !_Heap_Is_prev_used( block ) ) { 4000d71c: 02 80 00 20 be 4000d79c <_Heap_Free+0x114> 4000d720: b2 10 20 01 mov 1, %i1 RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace( Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; 4000d724: c4 00 e0 08 ld [ %g3 + 8 ], %g2 Heap_Block *prev = old_block->prev; 4000d728: c2 00 e0 0c ld [ %g3 + 0xc ], %g1 new_block->next = next; 4000d72c: c4 22 20 08 st %g2, [ %o0 + 8 ] new_block->prev = prev; 4000d730: 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; 4000d734: b8 07 00 1d add %i4, %i5, %i4 next->prev = new_block; 4000d738: d0 20 a0 0c st %o0, [ %g2 + 0xc ] prev->next = new_block; 4000d73c: d0 20 60 08 st %o0, [ %g1 + 8 ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000d740: 84 17 20 01 or %i4, 1, %g2 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 4000d744: f8 22 00 1c st %i4, [ %o0 + %i4 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000d748: c4 22 20 04 st %g2, [ %o0 + 4 ] } } /* Statistics */ --stats->used_blocks; ++stats->frees; 4000d74c: c2 06 20 50 ld [ %i0 + 0x50 ], %g1 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000d750: c4 06 20 40 ld [ %i0 + 0x40 ], %g2 ++stats->frees; stats->free_size += block_size; 4000d754: c6 06 20 30 ld [ %i0 + 0x30 ], %g3 } } /* Statistics */ --stats->used_blocks; ++stats->frees; 4000d758: 82 00 60 01 inc %g1 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000d75c: 84 00 bf ff add %g2, -1, %g2 ++stats->frees; stats->free_size += block_size; 4000d760: ba 00 c0 1d add %g3, %i5, %i5 } } /* Statistics */ --stats->used_blocks; ++stats->frees; 4000d764: c2 26 20 50 st %g1, [ %i0 + 0x50 ] stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 4000d768: c4 26 20 40 st %g2, [ %i0 + 0x40 ] ++stats->frees; stats->free_size += block_size; 4000d76c: fa 26 20 30 st %i5, [ %i0 + 0x30 ] return( true ); 4000d770: 82 10 20 01 mov 1, %g1 4000d774: b0 08 60 ff and %g1, 0xff, %i0 4000d778: 81 c7 e0 08 ret 4000d77c: 81 e8 00 00 restore 4000d780: b0 08 60 ff and %g1, 0xff, %i0 4000d784: 81 c7 e0 08 ret 4000d788: 81 e8 00 00 restore 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 ) ) { 4000d78c: 80 8e e0 01 btst 1, %i3 4000d790: 32 80 00 1e bne,a 4000d808 <_Heap_Free+0x180> 4000d794: c4 06 20 08 ld [ %i0 + 8 ], %g2 if ( !_Heap_Protection_determine_block_free( heap, block ) ) { return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 4000d798: b2 10 20 00 clr %i1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { uintptr_t const prev_size = block->prev_size; 4000d79c: f4 02 00 00 ld [ %o0 ], %i2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 4000d7a0: b6 22 00 1a sub %o0, %i2, %i3 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; 4000d7a4: 80 a0 80 1b cmp %g2, %i3 4000d7a8: 18 bf ff f3 bgu 4000d774 <_Heap_Free+0xec> <== NEVER TAKEN 4000d7ac: 82 10 20 00 clr %g1 4000d7b0: 80 a1 00 1b cmp %g4, %i3 4000d7b4: 2a bf ff f1 bcs,a 4000d778 <_Heap_Free+0xf0> <== NEVER TAKEN 4000d7b8: b0 08 60 ff and %g1, 0xff, %i0 <== NOT EXECUTED 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; 4000d7bc: c4 06 e0 04 ld [ %i3 + 4 ], %g2 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) ) { 4000d7c0: 80 88 a0 01 btst 1, %g2 4000d7c4: 02 bf ff ec be 4000d774 <_Heap_Free+0xec> <== NEVER TAKEN 4000d7c8: 80 8e 60 ff btst 0xff, %i1 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 4000d7cc: 22 80 00 21 be,a 4000d850 <_Heap_Free+0x1c8> 4000d7d0: b4 07 40 1a add %i5, %i2, %i2 return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 4000d7d4: c2 00 e0 08 ld [ %g3 + 8 ], %g1 Heap_Block *prev = block->prev; 4000d7d8: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 4000d7dc: c6 06 20 38 ld [ %i0 + 0x38 ], %g3 prev->next = next; 4000d7e0: c2 20 a0 08 st %g1, [ %g2 + 8 ] next->prev = prev; 4000d7e4: c4 20 60 0c st %g2, [ %g1 + 0xc ] 4000d7e8: 82 00 ff ff add %g3, -1, %g1 4000d7ec: c2 26 20 38 st %g1, [ %i0 + 0x38 ] _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; 4000d7f0: b8 07 40 1c add %i5, %i4, %i4 4000d7f4: b4 07 00 1a add %i4, %i2, %i2 _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 4000d7f8: 82 16 a0 01 or %i2, 1, %g1 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 4000d7fc: f4 26 c0 1a st %i2, [ %i3 + %i2 ] 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; 4000d800: 10 bf ff d3 b 4000d74c <_Heap_Free+0xc4> 4000d804: c2 26 e0 04 st %g1, [ %i3 + 4 ] 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; 4000d808: 82 17 60 01 or %i5, 1, %g1 4000d80c: c2 22 20 04 st %g1, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000d810: c8 00 e0 04 ld [ %g3 + 4 ], %g4 ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 4000d814: f0 22 20 0c st %i0, [ %o0 + 0xc ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 4000d818: c2 06 20 38 ld [ %i0 + 0x38 ], %g1 Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 4000d81c: c4 22 20 08 st %g2, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 4000d820: d0 20 a0 0c st %o0, [ %g2 + 0xc ] } 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; 4000d824: 84 09 3f fe and %g4, -2, %g2 next_block->prev_size = block_size; 4000d828: fa 22 00 1d st %i5, [ %o0 + %i5 ] } 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; 4000d82c: c4 20 e0 04 st %g2, [ %g3 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { 4000d830: c4 06 20 3c ld [ %i0 + 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; 4000d834: 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; 4000d838: d0 26 20 08 st %o0, [ %i0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 4000d83c: 80 a0 40 02 cmp %g1, %g2 4000d840: 08 bf ff c3 bleu 4000d74c <_Heap_Free+0xc4> 4000d844: c2 26 20 38 st %g1, [ %i0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 4000d848: 10 bf ff c1 b 4000d74c <_Heap_Free+0xc4> 4000d84c: c2 26 20 3c st %g1, [ %i0 + 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; 4000d850: 82 16 a0 01 or %i2, 1, %g1 4000d854: c2 26 e0 04 st %g1, [ %i3 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 4000d858: c2 00 e0 04 ld [ %g3 + 4 ], %g1 next_block->prev_size = size; 4000d85c: f4 22 00 1d st %i2, [ %o0 + %i5 ] _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; 4000d860: 82 08 7f fe and %g1, -2, %g1 4000d864: 10 bf ff ba b 4000d74c <_Heap_Free+0xc4> 4000d868: c2 20 e0 04 st %g1, [ %g3 + 4 ] =============================================================================== 40013354 <_Heap_Get_free_information>: return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 40013354: c2 02 20 08 ld [ %o0 + 8 ], %g1 ) { Heap_Block *the_block; Heap_Block *const tail = _Heap_Free_list_tail(the_heap); info->number = 0; 40013358: c0 22 40 00 clr [ %o1 ] info->largest = 0; 4001335c: c0 22 60 04 clr [ %o1 + 4 ] info->total = 0; 40013360: c0 22 60 08 clr [ %o1 + 8 ] for(the_block = _Heap_Free_list_first(the_heap); 40013364: 88 10 20 01 mov 1, %g4 40013368: 9a 10 20 00 clr %o5 4001336c: 80 a2 00 01 cmp %o0, %g1 40013370: 12 80 00 04 bne 40013380 <_Heap_Get_free_information+0x2c><== ALWAYS TAKEN 40013374: 86 10 20 00 clr %g3 40013378: 30 80 00 10 b,a 400133b8 <_Heap_Get_free_information+0x64><== NOT EXECUTED 4001337c: 88 10 00 0c mov %o4, %g4 - 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; 40013380: c4 00 60 04 ld [ %g1 + 4 ], %g2 40013384: 98 01 20 01 add %g4, 1, %o4 40013388: 84 08 bf fe and %g2, -2, %g2 /* As we always coalesce free blocks, prev block must have been used. */ _HAssert(_Heap_Is_prev_used(the_block)); info->number++; info->total += the_size; if ( info->largest < the_size ) 4001338c: 80 a0 80 0d cmp %g2, %o5 40013390: 08 80 00 03 bleu 4001339c <_Heap_Get_free_information+0x48> 40013394: 86 00 c0 02 add %g3, %g2, %g3 info->largest = the_size; 40013398: c4 22 60 04 st %g2, [ %o1 + 4 ] info->largest = 0; info->total = 0; for(the_block = _Heap_Free_list_first(the_heap); the_block != tail; the_block = the_block->next) 4001339c: c2 00 60 08 ld [ %g1 + 8 ], %g1 info->number = 0; info->largest = 0; info->total = 0; for(the_block = _Heap_Free_list_first(the_heap); 400133a0: 80 a2 00 01 cmp %o0, %g1 400133a4: 32 bf ff f6 bne,a 4001337c <_Heap_Get_free_information+0x28> 400133a8: da 02 60 04 ld [ %o1 + 4 ], %o5 400133ac: c8 22 40 00 st %g4, [ %o1 ] 400133b0: 81 c3 e0 08 retl 400133b4: c6 22 60 08 st %g3, [ %o1 + 8 ] 400133b8: 81 c3 e0 08 retl <== NOT EXECUTED =============================================================================== 4000a3f8 <_Heap_Greedy_allocate>: Heap_Block *_Heap_Greedy_allocate( Heap_Control *heap, const uintptr_t *block_sizes, size_t block_count ) { 4000a3f8: 9d e3 bf a0 save %sp, -96, %sp Heap_Block *allocated_blocks = NULL; Heap_Block *blocks = NULL; Heap_Block *current; size_t i; for (i = 0; i < block_count; ++i) { 4000a3fc: 80 a6 a0 00 cmp %i2, 0 4000a400: 02 80 00 35 be 4000a4d4 <_Heap_Greedy_allocate+0xdc> 4000a404: b8 10 00 18 mov %i0, %i4 4000a408: ba 10 20 00 clr %i5 4000a40c: b6 10 20 00 clr %i3 #include "config.h" #endif #include Heap_Block *_Heap_Greedy_allocate( 4000a410: 83 2f 60 02 sll %i5, 2, %g1 * @brief See _Heap_Allocate_aligned_with_boundary() with alignment and * boundary equals zero. */ RTEMS_INLINE_ROUTINE void *_Heap_Allocate( Heap_Control *heap, uintptr_t size ) { return _Heap_Allocate_aligned_with_boundary( heap, size, 0, 0 ); 4000a414: d2 06 40 01 ld [ %i1 + %g1 ], %o1 4000a418: 94 10 20 00 clr %o2 4000a41c: 96 10 20 00 clr %o3 4000a420: 40 00 1f 3e call 40012118 <_Heap_Allocate_aligned_with_boundary> 4000a424: 90 10 00 1c mov %i4, %o0 size_t i; for (i = 0; i < block_count; ++i) { void *next = _Heap_Allocate( heap, block_sizes [i] ); if ( next != NULL ) { 4000a428: 82 92 20 00 orcc %o0, 0, %g1 4000a42c: 22 80 00 09 be,a 4000a450 <_Heap_Greedy_allocate+0x58> <== NEVER TAKEN 4000a430: ba 07 60 01 inc %i5 <== NOT EXECUTED RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4000a434: d2 07 20 10 ld [ %i4 + 0x10 ], %o1 4000a438: 40 00 36 a8 call 40017ed8 <.urem> 4000a43c: b0 00 7f f8 add %g1, -8, %i0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 4000a440: 90 26 00 08 sub %i0, %o0, %o0 Heap_Block *next_block = _Heap_Block_of_alloc_area( (uintptr_t) next, heap->page_size ); next_block->next = allocated_blocks; 4000a444: f6 22 20 08 st %i3, [ %o0 + 8 ] 4000a448: b6 10 00 08 mov %o0, %i3 Heap_Block *allocated_blocks = NULL; Heap_Block *blocks = NULL; Heap_Block *current; size_t i; for (i = 0; i < block_count; ++i) { 4000a44c: ba 07 60 01 inc %i5 4000a450: 80 a7 40 1a cmp %i5, %i2 4000a454: 12 bf ff f0 bne 4000a414 <_Heap_Greedy_allocate+0x1c> 4000a458: 83 2f 60 02 sll %i5, 2, %g1 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 4000a45c: fa 07 20 08 ld [ %i4 + 8 ], %i5 next_block->next = allocated_blocks; allocated_blocks = next_block; } } while ( (current = _Heap_Free_list_first( heap )) != free_list_tail ) { 4000a460: 80 a7 00 1d cmp %i4, %i5 4000a464: 02 80 00 17 be 4000a4c0 <_Heap_Greedy_allocate+0xc8> <== NEVER TAKEN 4000a468: b0 10 20 00 clr %i0 4000a46c: 10 80 00 03 b 4000a478 <_Heap_Greedy_allocate+0x80> 4000a470: b4 10 20 00 clr %i2 4000a474: 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; 4000a478: d6 07 60 04 ld [ %i5 + 4 ], %o3 _Heap_Block_allocate( 4000a47c: 92 10 00 1d mov %i5, %o1 4000a480: 96 0a ff fe and %o3, -2, %o3 4000a484: 94 07 60 08 add %i5, 8, %o2 4000a488: 90 10 00 1c mov %i4, %o0 4000a48c: 40 00 00 e0 call 4000a80c <_Heap_Block_allocate> 4000a490: 96 02 ff f8 add %o3, -8, %o3 current, _Heap_Alloc_area_of_block( current ), _Heap_Block_size( current ) - HEAP_BLOCK_HEADER_SIZE ); current->next = blocks; 4000a494: f4 27 60 08 st %i2, [ %i5 + 8 ] return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 4000a498: c2 07 20 08 ld [ %i4 + 8 ], %g1 next_block->next = allocated_blocks; allocated_blocks = next_block; } } while ( (current = _Heap_Free_list_first( heap )) != free_list_tail ) { 4000a49c: 80 a7 00 01 cmp %i4, %g1 4000a4a0: 12 bf ff f5 bne 4000a474 <_Heap_Greedy_allocate+0x7c> 4000a4a4: b4 10 00 1d mov %i5, %i2 4000a4a8: 10 80 00 06 b 4000a4c0 <_Heap_Greedy_allocate+0xc8> 4000a4ac: b0 10 00 1d mov %i5, %i0 } while ( allocated_blocks != NULL ) { current = allocated_blocks; allocated_blocks = allocated_blocks->next; _Heap_Free( heap, (void *) _Heap_Alloc_area_of_block( current ) ); 4000a4b0: 92 06 e0 08 add %i3, 8, %o1 4000a4b4: 90 10 00 1c mov %i4, %o0 4000a4b8: 40 00 1f a3 call 40012344 <_Heap_Free> 4000a4bc: b6 10 00 1a mov %i2, %i3 current->next = blocks; blocks = current; } while ( allocated_blocks != NULL ) { 4000a4c0: 80 a6 e0 00 cmp %i3, 0 4000a4c4: 32 bf ff fb bne,a 4000a4b0 <_Heap_Greedy_allocate+0xb8> 4000a4c8: f4 06 e0 08 ld [ %i3 + 8 ], %i2 allocated_blocks = allocated_blocks->next; _Heap_Free( heap, (void *) _Heap_Alloc_area_of_block( current ) ); } return blocks; } 4000a4cc: 81 c7 e0 08 ret 4000a4d0: 81 e8 00 00 restore const uintptr_t *block_sizes, size_t block_count ) { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); Heap_Block *allocated_blocks = NULL; 4000a4d4: 10 bf ff e2 b 4000a45c <_Heap_Greedy_allocate+0x64> 4000a4d8: b6 10 20 00 clr %i3 =============================================================================== 4000a4dc <_Heap_Greedy_free>: void _Heap_Greedy_free( Heap_Control *heap, Heap_Block *blocks ) { 4000a4dc: 9d e3 bf a0 save %sp, -96, %sp while ( blocks != NULL ) { 4000a4e0: 80 a6 60 00 cmp %i1, 0 4000a4e4: 02 80 00 09 be 4000a508 <_Heap_Greedy_free+0x2c> <== NEVER TAKEN 4000a4e8: 01 00 00 00 nop Heap_Block *current = blocks; blocks = blocks->next; 4000a4ec: fa 06 60 08 ld [ %i1 + 8 ], %i5 _Heap_Free( heap, (void *) _Heap_Alloc_area_of_block( current ) ); 4000a4f0: 92 06 60 08 add %i1, 8, %o1 4000a4f4: 40 00 1f 94 call 40012344 <_Heap_Free> 4000a4f8: 90 10 00 18 mov %i0, %o0 void _Heap_Greedy_free( Heap_Control *heap, Heap_Block *blocks ) { while ( blocks != NULL ) { 4000a4fc: b2 97 60 00 orcc %i5, 0, %i1 4000a500: 32 bf ff fc bne,a 4000a4f0 <_Heap_Greedy_free+0x14> 4000a504: fa 06 60 08 ld [ %i1 + 8 ], %i5 4000a508: 81 c7 e0 08 ret 4000a50c: 81 e8 00 00 restore =============================================================================== 40013420 <_Heap_Iterate>: void _Heap_Iterate( Heap_Control *heap, Heap_Block_visitor visitor, void *visitor_arg ) { 40013420: 9d e3 bf a0 save %sp, -96, %sp <== NOT EXECUTED Heap_Block *current = heap->first_block; 40013424: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 <== NOT EXECUTED Heap_Block *end = heap->last_block; 40013428: f8 06 20 24 ld [ %i0 + 0x24 ], %i4 <== NOT EXECUTED bool stop = false; while ( !stop && current != end ) { 4001342c: 80 a0 40 1c cmp %g1, %i4 <== NOT EXECUTED 40013430: 32 80 00 08 bne,a 40013450 <_Heap_Iterate+0x30> <== NOT EXECUTED 40013434: d2 00 60 04 ld [ %g1 + 4 ], %o1 <== NOT EXECUTED 40013438: 30 80 00 10 b,a 40013478 <_Heap_Iterate+0x58> <== NOT EXECUTED 4001343c: 90 1a 20 01 xor %o0, 1, %o0 <== NOT EXECUTED 40013440: 80 8a 20 ff btst 0xff, %o0 <== NOT EXECUTED 40013444: 02 80 00 0d be 40013478 <_Heap_Iterate+0x58> <== NOT EXECUTED 40013448: 01 00 00 00 nop <== NOT EXECUTED 4001344c: d2 00 60 04 ld [ %g1 + 4 ], %o1 <== NOT EXECUTED uintptr_t size = _Heap_Block_size( current ); Heap_Block *next = _Heap_Block_at( current, size ); bool used = _Heap_Is_prev_used( next ); stop = (*visitor)( current, size, used, visitor_arg ); 40013450: 90 10 00 01 mov %g1, %o0 <== NOT EXECUTED 40013454: 92 0a 7f fe and %o1, -2, %o1 <== NOT EXECUTED RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 40013458: ba 00 40 09 add %g1, %o1, %i5 <== NOT EXECUTED 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; 4001345c: d4 07 60 04 ld [ %i5 + 4 ], %o2 <== NOT EXECUTED 40013460: 96 10 00 1a mov %i2, %o3 <== NOT EXECUTED 40013464: 9f c6 40 00 call %i1 <== NOT EXECUTED 40013468: 94 0a a0 01 and %o2, 1, %o2 <== NOT EXECUTED { Heap_Block *current = heap->first_block; Heap_Block *end = heap->last_block; bool stop = false; while ( !stop && current != end ) { 4001346c: 80 a7 00 1d cmp %i4, %i5 <== NOT EXECUTED 40013470: 12 bf ff f3 bne 4001343c <_Heap_Iterate+0x1c> <== NOT EXECUTED 40013474: 82 10 00 1d mov %i5, %g1 <== NOT EXECUTED 40013478: 81 c7 e0 08 ret <== NOT EXECUTED 4001347c: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 4001c10c <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 4001c10c: 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); 4001c110: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 4001c114: 7f ff f2 84 call 40018b24 <.urem> 4001c118: 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 4001c11c: c2 06 20 20 ld [ %i0 + 0x20 ], %g1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 4001c120: 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); 4001c124: 90 20 80 08 sub %g2, %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; 4001c128: 80 a2 00 01 cmp %o0, %g1 4001c12c: 0a 80 00 16 bcs 4001c184 <_Heap_Size_of_alloc_area+0x78> 4001c130: 84 10 20 00 clr %g2 4001c134: c6 06 20 24 ld [ %i0 + 0x24 ], %g3 4001c138: 80 a2 00 03 cmp %o0, %g3 4001c13c: 18 80 00 13 bgu 4001c188 <_Heap_Size_of_alloc_area+0x7c> <== NEVER TAKEN 4001c140: b0 08 a0 ff and %g2, 0xff, %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; 4001c144: c8 02 20 04 ld [ %o0 + 4 ], %g4 4001c148: 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); 4001c14c: 90 02 00 04 add %o0, %g4, %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; 4001c150: 80 a0 40 08 cmp %g1, %o0 4001c154: 18 80 00 0d bgu 4001c188 <_Heap_Size_of_alloc_area+0x7c> <== NEVER TAKEN 4001c158: 01 00 00 00 nop 4001c15c: 80 a0 c0 08 cmp %g3, %o0 4001c160: 0a 80 00 0a bcs 4001c188 <_Heap_Size_of_alloc_area+0x7c> <== NEVER TAKEN 4001c164: 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; 4001c168: c2 02 20 04 ld [ %o0 + 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 ) 4001c16c: 80 88 60 01 btst 1, %g1 4001c170: 02 80 00 06 be 4001c188 <_Heap_Size_of_alloc_area+0x7c> <== NEVER TAKEN 4001c174: 90 22 00 19 sub %o0, %i1, %o0 return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; return true; 4001c178: 84 10 20 01 mov 1, %g2 || !_Heap_Is_prev_used( next_block ) ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; 4001c17c: 90 02 20 04 add %o0, 4, %o0 4001c180: d0 26 80 00 st %o0, [ %i2 ] 4001c184: b0 08 a0 ff and %g2, 0xff, %i0 4001c188: 81 c7 e0 08 ret 4001c18c: 81 e8 00 00 restore =============================================================================== 40009274 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 40009274: 9d e3 bf 80 save %sp, -128, %sp uintptr_t const page_size = heap->page_size; 40009278: f6 06 20 10 ld [ %i0 + 0x10 ], %i3 uintptr_t const min_block_size = heap->min_block_size; 4000927c: e0 06 20 14 ld [ %i0 + 0x14 ], %l0 Heap_Block *const first_block = heap->first_block; 40009280: f8 06 20 20 ld [ %i0 + 0x20 ], %i4 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; 40009284: 80 a6 a0 00 cmp %i2, 0 40009288: 02 80 00 0c be 400092b8 <_Heap_Walk+0x44> 4000928c: e2 06 20 24 ld [ %i0 + 0x24 ], %l1 if ( !_System_state_Is_up( _System_state_Get() ) ) { 40009290: 03 10 00 65 sethi %hi(0x40019400), %g1 40009294: c4 00 60 b8 ld [ %g1 + 0xb8 ], %g2 ! 400194b8 <_System_state_Current> 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; 40009298: 07 10 00 24 sethi %hi(0x40009000), %g3 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; 4000929c: 82 10 20 01 mov 1, %g1 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; if ( !_System_state_Is_up( _System_state_Get() ) ) { 400092a0: 80 a0 a0 03 cmp %g2, 3 400092a4: 02 80 00 0c be 400092d4 <_Heap_Walk+0x60> <== ALWAYS TAKEN 400092a8: ae 10 e2 10 or %g3, 0x210, %l7 400092ac: b0 08 60 ff and %g1, 0xff, %i0 400092b0: 81 c7 e0 08 ret 400092b4: 81 e8 00 00 restore 400092b8: 03 10 00 65 sethi %hi(0x40019400), %g1 400092bc: c4 00 60 b8 ld [ %g1 + 0xb8 ], %g2 ! 400194b8 <_System_state_Current> 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; 400092c0: 07 10 00 24 sethi %hi(0x40009000), %g3 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; 400092c4: 82 10 20 01 mov 1, %g1 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; if ( !_System_state_Is_up( _System_state_Get() ) ) { 400092c8: 80 a0 a0 03 cmp %g2, 3 400092cc: 12 bf ff f8 bne 400092ac <_Heap_Walk+0x38> 400092d0: ae 10 e2 08 or %g3, 0x208, %l7 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)( 400092d4: da 06 20 18 ld [ %i0 + 0x18 ], %o5 400092d8: c8 06 20 1c ld [ %i0 + 0x1c ], %g4 400092dc: c4 06 20 08 ld [ %i0 + 8 ], %g2 400092e0: c2 06 20 0c ld [ %i0 + 0xc ], %g1 400092e4: 90 10 00 19 mov %i1, %o0 400092e8: c8 23 a0 5c st %g4, [ %sp + 0x5c ] 400092ec: f8 23 a0 60 st %i4, [ %sp + 0x60 ] 400092f0: e2 23 a0 64 st %l1, [ %sp + 0x64 ] 400092f4: c4 23 a0 68 st %g2, [ %sp + 0x68 ] 400092f8: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 400092fc: 92 10 20 00 clr %o1 40009300: 96 10 00 1b mov %i3, %o3 40009304: 15 10 00 59 sethi %hi(0x40016400), %o2 40009308: 98 10 00 10 mov %l0, %o4 4000930c: 9f c5 c0 00 call %l7 40009310: 94 12 a2 78 or %o2, 0x278, %o2 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 40009314: 80 a6 e0 00 cmp %i3, 0 40009318: 02 80 00 2a be 400093c0 <_Heap_Walk+0x14c> 4000931c: 80 8e e0 07 btst 7, %i3 (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 40009320: 12 80 00 2f bne 400093dc <_Heap_Walk+0x168> 40009324: 90 10 00 10 mov %l0, %o0 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40009328: 7f ff e2 12 call 40001b70 <.urem> 4000932c: 92 10 00 1b mov %i3, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 40009330: 80 a2 20 00 cmp %o0, 0 40009334: 12 80 00 32 bne 400093fc <_Heap_Walk+0x188> 40009338: 90 07 20 08 add %i4, 8, %o0 4000933c: 7f ff e2 0d call 40001b70 <.urem> 40009340: 92 10 00 1b mov %i3, %o1 ); return false; } if ( 40009344: 80 a2 20 00 cmp %o0, 0 40009348: 32 80 00 35 bne,a 4000941c <_Heap_Walk+0x1a8> 4000934c: 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; 40009350: ec 07 20 04 ld [ %i4 + 4 ], %l6 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 40009354: b4 8d a0 01 andcc %l6, 1, %i2 40009358: 22 80 00 38 be,a 40009438 <_Heap_Walk+0x1c4> 4000935c: 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; 40009360: c2 04 60 04 ld [ %l1 + 4 ], %g1 40009364: 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); 40009368: 82 04 40 01 add %l1, %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; 4000936c: fa 00 60 04 ld [ %g1 + 4 ], %i5 ); return false; } if ( _Heap_Is_free( last_block ) ) { 40009370: 80 8f 60 01 btst 1, %i5 40009374: 02 80 00 0c be 400093a4 <_Heap_Walk+0x130> 40009378: 80 a7 00 01 cmp %i4, %g1 ); return false; } if ( 4000937c: 02 80 00 35 be 40009450 <_Heap_Walk+0x1dc> 40009380: 90 10 00 19 mov %i1, %o0 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 40009384: 92 10 20 01 mov 1, %o1 40009388: 15 10 00 59 sethi %hi(0x40016400), %o2 4000938c: 9f c5 c0 00 call %l7 40009390: 94 12 a3 f0 or %o2, 0x3f0, %o2 ! 400167f0 <__log2table+0x2d8> if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009394: 82 10 20 00 clr %g1 40009398: b0 08 60 ff and %g1, 0xff, %i0 4000939c: 81 c7 e0 08 ret 400093a0: 81 e8 00 00 restore return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( 400093a4: 90 10 00 19 mov %i1, %o0 400093a8: 92 10 20 01 mov 1, %o1 400093ac: 15 10 00 59 sethi %hi(0x40016400), %o2 400093b0: 9f c5 c0 00 call %l7 400093b4: 94 12 a3 d8 or %o2, 0x3d8, %o2 ! 400167d8 <__log2table+0x2c0> if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400093b8: 10 bf ff f8 b 40009398 <_Heap_Walk+0x124> 400093bc: 82 10 20 00 clr %g1 first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); 400093c0: 90 10 00 19 mov %i1, %o0 400093c4: 92 10 20 01 mov 1, %o1 400093c8: 15 10 00 59 sethi %hi(0x40016400), %o2 400093cc: 9f c5 c0 00 call %l7 400093d0: 94 12 a3 10 or %o2, 0x310, %o2 ! 40016710 <__log2table+0x1f8> if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400093d4: 10 bf ff f1 b 40009398 <_Heap_Walk+0x124> 400093d8: 82 10 20 00 clr %g1 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( 400093dc: 90 10 00 19 mov %i1, %o0 400093e0: 92 10 20 01 mov 1, %o1 400093e4: 15 10 00 59 sethi %hi(0x40016400), %o2 400093e8: 96 10 00 1b mov %i3, %o3 400093ec: 9f c5 c0 00 call %l7 400093f0: 94 12 a3 28 or %o2, 0x328, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400093f4: 10 bf ff e9 b 40009398 <_Heap_Walk+0x124> 400093f8: 82 10 20 00 clr %g1 return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( 400093fc: 90 10 00 19 mov %i1, %o0 40009400: 92 10 20 01 mov 1, %o1 40009404: 15 10 00 59 sethi %hi(0x40016400), %o2 40009408: 96 10 00 10 mov %l0, %o3 4000940c: 9f c5 c0 00 call %l7 40009410: 94 12 a3 48 or %o2, 0x348, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009414: 10 bf ff e1 b 40009398 <_Heap_Walk+0x124> 40009418: 82 10 20 00 clr %g1 } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 4000941c: 92 10 20 01 mov 1, %o1 40009420: 15 10 00 59 sethi %hi(0x40016400), %o2 40009424: 96 10 00 1c mov %i4, %o3 40009428: 9f c5 c0 00 call %l7 4000942c: 94 12 a3 70 or %o2, 0x370, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009430: 10 bf ff da b 40009398 <_Heap_Walk+0x124> 40009434: 82 10 20 00 clr %g1 return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( 40009438: 92 10 20 01 mov 1, %o1 4000943c: 15 10 00 59 sethi %hi(0x40016400), %o2 40009440: 9f c5 c0 00 call %l7 40009444: 94 12 a3 a8 or %o2, 0x3a8, %o2 ! 400167a8 <__log2table+0x290> if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009448: 10 bf ff d4 b 40009398 <_Heap_Walk+0x124> 4000944c: 82 10 20 00 clr %g1 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 40009450: fa 06 20 08 ld [ %i0 + 8 ], %i5 int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 40009454: e8 06 20 10 ld [ %i0 + 0x10 ], %l4 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 ) { 40009458: 80 a6 00 1d cmp %i0, %i5 4000945c: 02 80 00 0d be 40009490 <_Heap_Walk+0x21c> 40009460: da 06 20 20 ld [ %i0 + 0x20 ], %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; 40009464: 80 a3 40 1d cmp %o5, %i5 40009468: 28 80 00 bf bleu,a 40009764 <_Heap_Walk+0x4f0> <== ALWAYS TAKEN 4000946c: e6 06 20 24 ld [ %i0 + 0x24 ], %l3 if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( 40009470: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 40009474: 92 10 20 01 mov 1, %o1 40009478: 15 10 00 5a sethi %hi(0x40016800), %o2 4000947c: 96 10 00 1d mov %i5, %o3 40009480: 9f c5 c0 00 call %l7 40009484: 94 12 a0 20 or %o2, 0x20, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009488: 10 bf ff c4 b 40009398 <_Heap_Walk+0x124> 4000948c: 82 10 20 00 clr %g1 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 40009490: 27 10 00 5a sethi %hi(0x40016800), %l3 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 40009494: 25 10 00 5a sethi %hi(0x40016800), %l2 ); return false; } if ( _Heap_Is_used( free_block ) ) { 40009498: aa 10 00 1c mov %i4, %l5 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 4000949c: a6 14 e2 50 or %l3, 0x250, %l3 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 400094a0: a4 14 a2 38 or %l2, 0x238, %l2 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 400094a4: 29 10 00 5a sethi %hi(0x40016800), %l4 - 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; 400094a8: ac 0d bf fe and %l6, -2, %l6 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 400094ac: ba 05 80 15 add %l6, %l5, %i5 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 400094b0: 80 a3 40 1d cmp %o5, %i5 400094b4: 28 80 00 0b bleu,a 400094e0 <_Heap_Walk+0x26c> <== ALWAYS TAKEN 400094b8: de 06 20 24 ld [ %i0 + 0x24 ], %o7 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)( 400094bc: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 400094c0: 92 10 20 01 mov 1, %o1 400094c4: 96 10 00 15 mov %l5, %o3 400094c8: 15 10 00 5a sethi %hi(0x40016800), %o2 400094cc: 98 10 00 1d mov %i5, %o4 400094d0: 9f c5 c0 00 call %l7 400094d4: 94 12 a0 c8 or %o2, 0xc8, %o2 "block 0x%08x: next block 0x%08x not in heap\n", block, next_block ); return false; 400094d8: 10 bf ff 75 b 400092ac <_Heap_Walk+0x38> 400094dc: 82 10 20 00 clr %g1 400094e0: 80 a3 c0 1d cmp %o7, %i5 400094e4: 0a bf ff f7 bcs 400094c0 <_Heap_Walk+0x24c> 400094e8: 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; 400094ec: 9e 1d 40 11 xor %l5, %l1, %o7 400094f0: 80 a0 00 0f cmp %g0, %o7 400094f4: 9a 40 20 00 addx %g0, 0, %o5 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 400094f8: 90 10 00 16 mov %l6, %o0 400094fc: da 27 bf fc st %o5, [ %fp + -4 ] 40009500: 7f ff e1 9c call 40001b70 <.urem> 40009504: 92 10 00 1b mov %i3, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 40009508: 80 a2 20 00 cmp %o0, 0 4000950c: 02 80 00 18 be 4000956c <_Heap_Walk+0x2f8> 40009510: da 07 bf fc ld [ %fp + -4 ], %o5 40009514: 80 8b 60 ff btst 0xff, %o5 40009518: 12 80 00 8b bne 40009744 <_Heap_Walk+0x4d0> 4000951c: 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; 40009520: de 07 60 04 ld [ %i5 + 4 ], %o7 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 40009524: 80 8b e0 01 btst 1, %o7 40009528: 02 80 00 2b be 400095d4 <_Heap_Walk+0x360> 4000952c: 80 a6 a0 00 cmp %i2, 0 if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 40009530: 22 80 00 21 be,a 400095b4 <_Heap_Walk+0x340> 40009534: da 05 40 00 ld [ %l5 ], %o5 (*printer)( 40009538: 90 10 00 19 mov %i1, %o0 4000953c: 92 10 20 00 clr %o1 40009540: 94 10 00 12 mov %l2, %o2 40009544: 96 10 00 15 mov %l5, %o3 40009548: 9f c5 c0 00 call %l7 4000954c: 98 10 00 16 mov %l6, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 40009550: 80 a7 00 1d cmp %i4, %i5 40009554: 02 80 00 51 be 40009698 <_Heap_Walk+0x424> 40009558: aa 10 00 1d mov %i5, %l5 4000955c: ec 07 60 04 ld [ %i5 + 4 ], %l6 40009560: da 06 20 20 ld [ %i0 + 0x20 ], %o5 40009564: 10 bf ff d1 b 400094a8 <_Heap_Walk+0x234> 40009568: b4 0d a0 01 and %l6, 1, %i2 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 4000956c: 80 a5 80 10 cmp %l6, %l0 40009570: 0a 80 00 69 bcs 40009714 <_Heap_Walk+0x4a0> 40009574: 80 8b 60 ff btst 0xff, %o5 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 40009578: 80 a5 40 1d cmp %l5, %i5 4000957c: 2a bf ff ea bcs,a 40009524 <_Heap_Walk+0x2b0> 40009580: de 07 60 04 ld [ %i5 + 4 ], %o7 40009584: 80 8b 60 ff btst 0xff, %o5 40009588: 22 bf ff e7 be,a 40009524 <_Heap_Walk+0x2b0> 4000958c: de 07 60 04 ld [ %i5 + 4 ], %o7 (*printer)( 40009590: 90 10 00 19 mov %i1, %o0 40009594: 92 10 20 01 mov 1, %o1 40009598: 96 10 00 15 mov %l5, %o3 4000959c: 15 10 00 5a sethi %hi(0x40016800), %o2 400095a0: 98 10 00 1d mov %i5, %o4 400095a4: 9f c5 c0 00 call %l7 400095a8: 94 12 a1 58 or %o2, 0x158, %o2 "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 400095ac: 10 bf ff 40 b 400092ac <_Heap_Walk+0x38> 400095b0: 82 10 20 00 clr %g1 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 400095b4: 96 10 00 15 mov %l5, %o3 400095b8: 90 10 00 19 mov %i1, %o0 400095bc: 92 10 20 00 clr %o1 400095c0: 94 10 00 13 mov %l3, %o2 400095c4: 9f c5 c0 00 call %l7 400095c8: 98 10 00 16 mov %l6, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 400095cc: 10 bf ff e2 b 40009554 <_Heap_Walk+0x2e0> 400095d0: 80 a7 00 1d cmp %i4, %i5 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 ? 400095d4: da 05 60 0c ld [ %l5 + 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)( 400095d8: de 06 20 08 ld [ %i0 + 8 ], %o7 400095dc: 80 a3 c0 0d cmp %o7, %o5 400095e0: 02 80 00 3d be 400096d4 <_Heap_Walk+0x460> 400095e4: d8 06 20 0c ld [ %i0 + 0xc ], %o4 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 400095e8: 80 a6 00 0d cmp %i0, %o5 400095ec: 02 80 00 40 be 400096ec <_Heap_Walk+0x478> 400095f0: 96 15 22 00 or %l4, 0x200, %o3 block->next, block->next == last_free_block ? 400095f4: de 05 60 08 ld [ %l5 + 8 ], %o7 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)( 400095f8: 80 a3 00 0f cmp %o4, %o7 400095fc: 02 80 00 33 be 400096c8 <_Heap_Walk+0x454> 40009600: 80 a6 00 0f cmp %i0, %o7 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 40009604: 02 80 00 37 be 400096e0 <_Heap_Walk+0x46c> 40009608: 98 15 22 00 or %l4, 0x200, %o4 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)( 4000960c: d6 23 a0 5c st %o3, [ %sp + 0x5c ] 40009610: d8 23 a0 64 st %o4, [ %sp + 0x64 ] 40009614: de 23 a0 60 st %o7, [ %sp + 0x60 ] 40009618: 90 10 00 19 mov %i1, %o0 4000961c: 92 10 20 00 clr %o1 40009620: 15 10 00 5a sethi %hi(0x40016800), %o2 40009624: 96 10 00 15 mov %l5, %o3 40009628: 94 12 a1 90 or %o2, 0x190, %o2 4000962c: 9f c5 c0 00 call %l7 40009630: 98 10 00 16 mov %l6, %o4 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 40009634: da 07 40 00 ld [ %i5 ], %o5 40009638: 80 a5 80 0d cmp %l6, %o5 4000963c: 12 80 00 19 bne 400096a0 <_Heap_Walk+0x42c> 40009640: 80 a6 a0 00 cmp %i2, 0 ); return false; } if ( !prev_used ) { 40009644: 02 80 00 2d be 400096f8 <_Heap_Walk+0x484> 40009648: 90 10 00 19 mov %i1, %o0 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 4000964c: c4 06 20 08 ld [ %i0 + 8 ], %g2 ) { 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 ) { 40009650: 80 a6 00 02 cmp %i0, %g2 40009654: 02 80 00 0b be 40009680 <_Heap_Walk+0x40c> <== NEVER TAKEN 40009658: 92 10 20 01 mov 1, %o1 if ( free_block == block ) { 4000965c: 80 a5 40 02 cmp %l5, %g2 40009660: 02 bf ff bd be 40009554 <_Heap_Walk+0x2e0> 40009664: 80 a7 00 1d cmp %i4, %i5 return true; } free_block = free_block->next; 40009668: c4 00 a0 08 ld [ %g2 + 8 ], %g2 ) { 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 ) { 4000966c: 80 a6 00 02 cmp %i0, %g2 40009670: 12 bf ff fc bne 40009660 <_Heap_Walk+0x3ec> 40009674: 80 a5 40 02 cmp %l5, %g2 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 40009678: 90 10 00 19 mov %i1, %o0 4000967c: 92 10 20 01 mov 1, %o1 40009680: 15 10 00 5a sethi %hi(0x40016800), %o2 40009684: 96 10 00 15 mov %l5, %o3 40009688: 9f c5 c0 00 call %l7 4000968c: 94 12 a2 78 or %o2, 0x278, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009690: 10 bf ff 42 b 40009398 <_Heap_Walk+0x124> 40009694: 82 10 20 00 clr %g1 } block = next_block; } while ( block != first_block ); return true; 40009698: 10 bf ff 05 b 400092ac <_Heap_Walk+0x38> 4000969c: 82 10 20 01 mov 1, %g1 " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( 400096a0: fa 23 a0 5c st %i5, [ %sp + 0x5c ] 400096a4: 90 10 00 19 mov %i1, %o0 400096a8: 92 10 20 01 mov 1, %o1 400096ac: 15 10 00 5a sethi %hi(0x40016800), %o2 400096b0: 96 10 00 15 mov %l5, %o3 400096b4: 94 12 a1 c8 or %o2, 0x1c8, %o2 400096b8: 9f c5 c0 00 call %l7 400096bc: 98 10 00 16 mov %l6, %o4 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 400096c0: 10 bf ff 36 b 40009398 <_Heap_Walk+0x124> 400096c4: 82 10 20 00 clr %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)( 400096c8: 03 10 00 59 sethi %hi(0x40016400), %g1 400096cc: 10 bf ff d0 b 4000960c <_Heap_Walk+0x398> 400096d0: 98 10 62 58 or %g1, 0x258, %o4 ! 40016658 <__log2table+0x140> 400096d4: 03 10 00 59 sethi %hi(0x40016400), %g1 400096d8: 10 bf ff c7 b 400095f4 <_Heap_Walk+0x380> 400096dc: 96 10 62 38 or %g1, 0x238, %o3 ! 40016638 <__log2table+0x120> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 400096e0: 03 10 00 59 sethi %hi(0x40016400), %g1 400096e4: 10 bf ff ca b 4000960c <_Heap_Walk+0x398> 400096e8: 98 10 62 68 or %g1, 0x268, %o4 ! 40016668 <__log2table+0x150> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 400096ec: 17 10 00 59 sethi %hi(0x40016400), %o3 400096f0: 10 bf ff c1 b 400095f4 <_Heap_Walk+0x380> 400096f4: 96 12 e2 48 or %o3, 0x248, %o3 ! 40016648 <__log2table+0x130> return false; } if ( !prev_used ) { (*printer)( 400096f8: 92 10 20 01 mov 1, %o1 400096fc: 15 10 00 5a sethi %hi(0x40016800), %o2 40009700: 96 10 00 15 mov %l5, %o3 40009704: 9f c5 c0 00 call %l7 40009708: 94 12 a2 08 or %o2, 0x208, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 4000970c: 10 bf ff 23 b 40009398 <_Heap_Walk+0x124> 40009710: 82 10 20 00 clr %g1 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 40009714: 02 bf ff 9a be 4000957c <_Heap_Walk+0x308> <== NEVER TAKEN 40009718: 80 a5 40 1d cmp %l5, %i5 (*printer)( 4000971c: 90 10 00 19 mov %i1, %o0 40009720: 92 10 20 01 mov 1, %o1 40009724: 96 10 00 15 mov %l5, %o3 40009728: 15 10 00 5a sethi %hi(0x40016800), %o2 4000972c: 98 10 00 16 mov %l6, %o4 40009730: 94 12 a1 28 or %o2, 0x128, %o2 40009734: 9f c5 c0 00 call %l7 40009738: 9a 10 00 10 mov %l0, %o5 block, block_size, min_block_size ); return false; 4000973c: 10 bf fe dc b 400092ac <_Heap_Walk+0x38> 40009740: 82 10 20 00 clr %g1 return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( 40009744: 92 10 20 01 mov 1, %o1 40009748: 96 10 00 15 mov %l5, %o3 4000974c: 15 10 00 5a sethi %hi(0x40016800), %o2 40009750: 98 10 00 16 mov %l6, %o4 40009754: 9f c5 c0 00 call %l7 40009758: 94 12 a0 f8 or %o2, 0xf8, %o2 "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; 4000975c: 10 bf fe d4 b 400092ac <_Heap_Walk+0x38> 40009760: 82 10 20 00 clr %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; 40009764: 80 a4 c0 1d cmp %l3, %i5 40009768: 0a bf ff 43 bcs 40009474 <_Heap_Walk+0x200> <== NEVER TAKEN 4000976c: 90 10 00 19 mov %i1, %o0 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 40009770: da 27 bf fc st %o5, [ %fp + -4 ] 40009774: 90 07 60 08 add %i5, 8, %o0 40009778: 7f ff e0 fe call 40001b70 <.urem> 4000977c: 92 10 00 14 mov %l4, %o1 ); return false; } if ( 40009780: 80 a2 20 00 cmp %o0, 0 40009784: 12 80 00 36 bne 4000985c <_Heap_Walk+0x5e8> <== NEVER TAKEN 40009788: da 07 bf fc ld [ %fp + -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; 4000978c: c2 07 60 04 ld [ %i5 + 4 ], %g1 40009790: 82 08 7f fe and %g1, -2, %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; 40009794: 82 07 40 01 add %i5, %g1, %g1 40009798: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 4000979c: 80 88 60 01 btst 1, %g1 400097a0: 12 80 00 27 bne 4000983c <_Heap_Walk+0x5c8> <== NEVER TAKEN 400097a4: a4 10 00 1d mov %i5, %l2 400097a8: 10 80 00 19 b 4000980c <_Heap_Walk+0x598> 400097ac: 82 10 00 18 mov %i0, %g1 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 ) { 400097b0: 80 a6 00 1d cmp %i0, %i5 400097b4: 02 bf ff 37 be 40009490 <_Heap_Walk+0x21c> 400097b8: 80 a7 40 0d cmp %i5, %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; 400097bc: 0a bf ff 2e bcs 40009474 <_Heap_Walk+0x200> 400097c0: 90 10 00 19 mov %i1, %o0 400097c4: 80 a7 40 13 cmp %i5, %l3 400097c8: 18 bf ff 2c bgu 40009478 <_Heap_Walk+0x204> <== NEVER TAKEN 400097cc: 92 10 20 01 mov 1, %o1 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 400097d0: da 27 bf fc st %o5, [ %fp + -4 ] 400097d4: 90 07 60 08 add %i5, 8, %o0 400097d8: 7f ff e0 e6 call 40001b70 <.urem> 400097dc: 92 10 00 14 mov %l4, %o1 ); return false; } if ( 400097e0: 80 a2 20 00 cmp %o0, 0 400097e4: 12 80 00 1e bne 4000985c <_Heap_Walk+0x5e8> 400097e8: da 07 bf fc ld [ %fp + -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; 400097ec: de 07 60 04 ld [ %i5 + 4 ], %o7 400097f0: 82 10 00 12 mov %l2, %g1 400097f4: 9e 0b ff fe and %o7, -2, %o7 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; 400097f8: 9e 03 c0 1d add %o7, %i5, %o7 400097fc: de 03 e0 04 ld [ %o7 + 4 ], %o7 ); return false; } if ( _Heap_Is_used( free_block ) ) { 40009800: 80 8b e0 01 btst 1, %o7 40009804: 12 80 00 0e bne 4000983c <_Heap_Walk+0x5c8> 40009808: a4 10 00 1d mov %i5, %l2 ); return false; } if ( free_block->prev != prev_block ) { 4000980c: d8 07 60 0c ld [ %i5 + 0xc ], %o4 40009810: 80 a3 00 01 cmp %o4, %g1 40009814: 22 bf ff e7 be,a 400097b0 <_Heap_Walk+0x53c> 40009818: fa 07 60 08 ld [ %i5 + 8 ], %i5 (*printer)( 4000981c: 90 10 00 19 mov %i1, %o0 40009820: 92 10 20 01 mov 1, %o1 40009824: 15 10 00 5a sethi %hi(0x40016800), %o2 40009828: 96 10 00 1d mov %i5, %o3 4000982c: 9f c5 c0 00 call %l7 40009830: 94 12 a0 90 or %o2, 0x90, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009834: 10 bf fe d9 b 40009398 <_Heap_Walk+0x124> 40009838: 82 10 20 00 clr %g1 return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( 4000983c: 90 10 00 19 mov %i1, %o0 40009840: 92 10 20 01 mov 1, %o1 40009844: 15 10 00 5a sethi %hi(0x40016800), %o2 40009848: 96 10 00 1d mov %i5, %o3 4000984c: 9f c5 c0 00 call %l7 40009850: 94 12 a0 70 or %o2, 0x70, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009854: 10 bf fe d1 b 40009398 <_Heap_Walk+0x124> 40009858: 82 10 20 00 clr %g1 } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 4000985c: 90 10 00 19 mov %i1, %o0 40009860: 92 10 20 01 mov 1, %o1 40009864: 15 10 00 5a sethi %hi(0x40016800), %o2 40009868: 96 10 00 1d mov %i5, %o3 4000986c: 9f c5 c0 00 call %l7 40009870: 94 12 a0 40 or %o2, 0x40, %o2 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 40009874: 10 bf fe c9 b 40009398 <_Heap_Walk+0x124> 40009878: 82 10 20 00 clr %g1 =============================================================================== 40007c14 <_IO_Initialize_all_drivers>: _IO_Driver_address_table[index] = driver_table[index]; } void _IO_Initialize_all_drivers( void ) { 40007c14: 9d e3 bf a0 save %sp, -96, %sp rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) 40007c18: 39 10 00 7e sethi %hi(0x4001f800), %i4 40007c1c: c2 07 20 18 ld [ %i4 + 0x18 ], %g1 ! 4001f818 <_IO_Number_of_drivers> 40007c20: ba 10 20 00 clr %i5 40007c24: 80 a0 60 00 cmp %g1, 0 40007c28: 02 80 00 0b be 40007c54 <_IO_Initialize_all_drivers+0x40> <== NEVER TAKEN 40007c2c: b8 17 20 18 or %i4, 0x18, %i4 (void) rtems_io_initialize( major, 0, NULL ); 40007c30: 90 10 00 1d mov %i5, %o0 40007c34: 92 10 20 00 clr %o1 40007c38: 40 00 15 91 call 4000d27c 40007c3c: 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 ++ ) 40007c40: c2 07 00 00 ld [ %i4 ], %g1 40007c44: ba 07 60 01 inc %i5 40007c48: 80 a0 40 1d cmp %g1, %i5 40007c4c: 18 bf ff fa bgu 40007c34 <_IO_Initialize_all_drivers+0x20> 40007c50: 90 10 00 1d mov %i5, %o0 40007c54: 81 c7 e0 08 ret 40007c58: 81 e8 00 00 restore =============================================================================== 40007b44 <_IO_Manager_initialization>: #include #include void _IO_Manager_initialization(void) { 40007b44: 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 = rtems_configuration_get_device_driver_table(); 40007b48: 03 10 00 71 sethi %hi(0x4001c400), %g1 40007b4c: 82 10 60 18 or %g1, 0x18, %g1 ! 4001c418 drivers_in_table = rtems_configuration_get_number_of_device_drivers(); 40007b50: f8 00 60 38 ld [ %g1 + 0x38 ], %i4 number_of_drivers = rtems_configuration_get_maximum_drivers(); 40007b54: f6 00 60 34 ld [ %g1 + 0x34 ], %i3 /* * 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 ) 40007b58: 80 a7 00 1b cmp %i4, %i3 40007b5c: 0a 80 00 08 bcs 40007b7c <_IO_Manager_initialization+0x38> 40007b60: fa 00 60 3c ld [ %g1 + 0x3c ], %i5 * 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; 40007b64: 03 10 00 7e sethi %hi(0x4001f800), %g1 40007b68: fa 20 60 1c st %i5, [ %g1 + 0x1c ] ! 4001f81c <_IO_Driver_address_table> _IO_Number_of_drivers = number_of_drivers; 40007b6c: 03 10 00 7e sethi %hi(0x4001f800), %g1 40007b70: f8 20 60 18 st %i4, [ %g1 + 0x18 ] ! 4001f818 <_IO_Number_of_drivers> return; 40007b74: 81 c7 e0 08 ret 40007b78: 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 ) 40007b7c: 83 2e e0 03 sll %i3, 3, %g1 40007b80: b5 2e e0 05 sll %i3, 5, %i2 40007b84: b4 26 80 01 sub %i2, %g1, %i2 * 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( 40007b88: 40 00 0d 2f call 4000b044 <_Workspace_Allocate_or_fatal_error> 40007b8c: 90 10 00 1a mov %i2, %o0 sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 40007b90: 03 10 00 7e sethi %hi(0x4001f800), %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 *) 40007b94: 33 10 00 7e sethi %hi(0x4001f800), %i1 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 40007b98: f6 20 60 18 st %i3, [ %g1 + 0x18 ] /* * 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 *) 40007b9c: d0 26 60 1c st %o0, [ %i1 + 0x1c ] _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 40007ba0: 92 10 20 00 clr %o1 40007ba4: 40 00 21 75 call 40010178 40007ba8: 94 10 00 1a mov %i2, %o2 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 40007bac: 80 a7 20 00 cmp %i4, 0 40007bb0: 02 bf ff f1 be 40007b74 <_IO_Manager_initialization+0x30> <== NEVER TAKEN 40007bb4: c8 06 60 1c ld [ %i1 + 0x1c ], %g4 #include #include #include void _IO_Manager_initialization(void) 40007bb8: 85 2f 20 03 sll %i4, 3, %g2 40007bbc: b7 2f 20 05 sll %i4, 5, %i3 40007bc0: 82 10 20 00 clr %g1 40007bc4: b6 26 c0 02 sub %i3, %g2, %i3 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) _IO_Driver_address_table[index] = driver_table[index]; 40007bc8: c4 07 40 01 ld [ %i5 + %g1 ], %g2 40007bcc: 86 07 40 01 add %i5, %g1, %g3 40007bd0: c4 21 00 01 st %g2, [ %g4 + %g1 ] 40007bd4: f8 00 e0 04 ld [ %g3 + 4 ], %i4 40007bd8: 84 01 00 01 add %g4, %g1, %g2 40007bdc: f8 20 a0 04 st %i4, [ %g2 + 4 ] 40007be0: f8 00 e0 08 ld [ %g3 + 8 ], %i4 40007be4: 82 00 60 18 add %g1, 0x18, %g1 40007be8: f8 20 a0 08 st %i4, [ %g2 + 8 ] 40007bec: f8 00 e0 0c ld [ %g3 + 0xc ], %i4 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 40007bf0: 80 a0 40 1b cmp %g1, %i3 _IO_Driver_address_table[index] = driver_table[index]; 40007bf4: f8 20 a0 0c st %i4, [ %g2 + 0xc ] 40007bf8: f8 00 e0 10 ld [ %g3 + 0x10 ], %i4 40007bfc: f8 20 a0 10 st %i4, [ %g2 + 0x10 ] 40007c00: 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++ ) 40007c04: 12 bf ff f1 bne 40007bc8 <_IO_Manager_initialization+0x84> 40007c08: c6 20 a0 14 st %g3, [ %g2 + 0x14 ] 40007c0c: 81 c7 e0 08 ret 40007c10: 81 e8 00 00 restore =============================================================================== 4000890c <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { 4000890c: 9d e3 bf 90 save %sp, -112, %sp Internal_errors_t error ) { User_extensions_Fatal_context ctx = { source, is_internal, error }; _User_extensions_Iterate( &ctx, _User_extensions_Fatal_visitor ); 40008910: 13 10 00 2a sethi %hi(0x4000a800), %o1 40008914: 90 07 bf f4 add %fp, -12, %o0 40008918: 92 12 62 7c or %o1, 0x27c, %o1 Internal_errors_Source source, bool is_internal, Internal_errors_t error ) { User_extensions_Fatal_context ctx = { source, is_internal, error }; 4000891c: f0 27 bf f4 st %i0, [ %fp + -12 ] 40008920: f2 2f bf f8 stb %i1, [ %fp + -8 ] _User_extensions_Iterate( &ctx, _User_extensions_Fatal_visitor ); 40008924: 40 00 08 61 call 4000aaa8 <_User_extensions_Iterate> 40008928: f4 27 bf fc st %i2, [ %fp + -4 ] _User_extensions_Fatal( the_source, is_internal, the_error ); _Internal_errors_What_happened.the_source = the_source; 4000892c: 05 10 00 7c sethi %hi(0x4001f000), %g2 <== NOT EXECUTED 40008930: 82 10 a3 bc or %g2, 0x3bc, %g1 ! 4001f3bc <_Internal_errors_What_happened><== NOT EXECUTED 40008934: f0 20 a3 bc st %i0, [ %g2 + 0x3bc ] <== NOT EXECUTED _Internal_errors_What_happened.is_internal = is_internal; 40008938: f2 28 60 04 stb %i1, [ %g1 + 4 ] <== NOT EXECUTED _Internal_errors_What_happened.the_error = the_error; 4000893c: f4 20 60 08 st %i2, [ %g1 + 8 ] <== NOT EXECUTED RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; 40008940: 84 10 20 05 mov 5, %g2 <== NOT EXECUTED 40008944: 03 10 00 7c sethi %hi(0x4001f000), %g1 <== NOT EXECUTED _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); 40008948: 7f ff e5 d7 call 400020a4 <== NOT EXECUTED 4000894c: c4 20 63 c8 st %g2, [ %g1 + 0x3c8 ] ! 4001f3c8 <_System_state_Current><== NOT EXECUTED 40008950: 82 10 00 08 mov %o0, %g1 <== NOT EXECUTED 40008954: 30 80 00 00 b,a 40008954 <_Internal_error_Occurred+0x48> <== NOT EXECUTED =============================================================================== 400089c4 <_Objects_Allocate>: #endif Objects_Control *_Objects_Allocate( Objects_Information *information ) { 400089c4: 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 ) 400089c8: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 400089cc: 80 a0 60 00 cmp %g1, 0 400089d0: 02 80 00 26 be 40008a68 <_Objects_Allocate+0xa4> <== NEVER TAKEN 400089d4: ba 10 00 18 mov %i0, %i5 /* * 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 ); 400089d8: b8 06 20 20 add %i0, 0x20, %i4 400089dc: 7f ff fd 4c call 40007f0c <_Chain_Get> 400089e0: 90 10 00 1c mov %i4, %o0 if ( information->auto_extend ) { 400089e4: c2 0f 60 12 ldub [ %i5 + 0x12 ], %g1 400089e8: 80 a0 60 00 cmp %g1, 0 400089ec: 02 80 00 16 be 40008a44 <_Objects_Allocate+0x80> 400089f0: 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 ) { 400089f4: 80 a2 20 00 cmp %o0, 0 400089f8: 02 80 00 15 be 40008a4c <_Objects_Allocate+0x88> 400089fc: 01 00 00 00 nop } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 40008a00: c4 07 60 08 ld [ %i5 + 8 ], %g2 40008a04: d0 06 20 08 ld [ %i0 + 8 ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 40008a08: d2 17 60 14 lduh [ %i5 + 0x14 ], %o1 } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 40008a0c: 03 00 00 3f sethi %hi(0xfc00), %g1 40008a10: 82 10 63 ff or %g1, 0x3ff, %g1 ! ffff 40008a14: 90 0a 00 01 and %o0, %g1, %o0 40008a18: 82 08 80 01 and %g2, %g1, %g1 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 40008a1c: 40 00 3f 96 call 40018874 <.udiv> 40008a20: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 40008a24: c2 07 60 30 ld [ %i5 + 0x30 ], %g1 40008a28: 91 2a 20 02 sll %o0, 2, %o0 40008a2c: c6 00 40 08 ld [ %g1 + %o0 ], %g3 information->inactive--; 40008a30: c4 17 60 2c lduh [ %i5 + 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 ]--; 40008a34: 86 00 ff ff add %g3, -1, %g3 40008a38: c6 20 40 08 st %g3, [ %g1 + %o0 ] information->inactive--; 40008a3c: 82 00 bf ff add %g2, -1, %g1 40008a40: c2 37 60 2c sth %g1, [ %i5 + 0x2c ] ); } #endif return the_object; } 40008a44: 81 c7 e0 08 ret 40008a48: 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 ); 40008a4c: 40 00 00 10 call 40008a8c <_Objects_Extend_information> 40008a50: 90 10 00 1d mov %i5, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 40008a54: 7f ff fd 2e call 40007f0c <_Chain_Get> 40008a58: 90 10 00 1c mov %i4, %o0 } if ( the_object ) { 40008a5c: b0 92 20 00 orcc %o0, 0, %i0 40008a60: 32 bf ff e9 bne,a 40008a04 <_Objects_Allocate+0x40> 40008a64: c4 07 60 08 ld [ %i5 + 8 ], %g2 * 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 ) return NULL; 40008a68: 81 c7 e0 08 ret 40008a6c: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 40008a8c <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { 40008a8c: 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 ) 40008a90: f2 06 20 34 ld [ %i0 + 0x34 ], %i1 /* * 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 ); 40008a94: e0 16 20 0a lduh [ %i0 + 0xa ], %l0 index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 40008a98: 80 a6 60 00 cmp %i1, 0 40008a9c: 02 80 00 a1 be 40008d20 <_Objects_Extend_information+0x294> 40008aa0: e2 16 20 10 lduh [ %i0 + 0x10 ], %l1 block_count = 0; else { block_count = information->maximum / information->allocation_size; 40008aa4: f6 16 20 14 lduh [ %i0 + 0x14 ], %i3 40008aa8: a3 2c 60 10 sll %l1, 0x10, %l1 40008aac: 92 10 00 1b mov %i3, %o1 40008ab0: 40 00 3f 71 call 40018874 <.udiv> 40008ab4: 91 34 60 10 srl %l1, 0x10, %o0 40008ab8: 91 2a 20 10 sll %o0, 0x10, %o0 40008abc: b5 32 20 10 srl %o0, 0x10, %i2 for ( ; block < block_count; block++ ) { 40008ac0: 80 a6 a0 00 cmp %i2, 0 40008ac4: 02 80 00 af be 40008d80 <_Objects_Extend_information+0x2f4><== NEVER TAKEN 40008ac8: 90 10 00 1b mov %i3, %o0 if ( information->object_blocks[ block ] == NULL ) { 40008acc: c2 06 40 00 ld [ %i1 ], %g1 40008ad0: 80 a0 60 00 cmp %g1, 0 40008ad4: 02 80 00 b1 be 40008d98 <_Objects_Extend_information+0x30c><== NEVER TAKEN 40008ad8: b8 10 00 10 mov %l0, %i4 * 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; 40008adc: 10 80 00 06 b 40008af4 <_Objects_Extend_information+0x68> 40008ae0: ba 10 20 00 clr %i5 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { 40008ae4: c2 06 40 01 ld [ %i1 + %g1 ], %g1 40008ae8: 80 a0 60 00 cmp %g1, 0 40008aec: 22 80 00 08 be,a 40008b0c <_Objects_Extend_information+0x80> 40008af0: b6 10 20 00 clr %i3 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 40008af4: ba 07 60 01 inc %i5 if ( information->object_blocks[ block ] == NULL ) { do_extend = false; break; } else index_base += information->allocation_size; 40008af8: b8 07 00 1b add %i4, %i3, %i4 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 40008afc: 80 a6 80 1d cmp %i2, %i5 40008b00: 18 bf ff f9 bgu 40008ae4 <_Objects_Extend_information+0x58> 40008b04: 83 2f 60 02 sll %i5, 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; 40008b08: b6 10 20 01 mov 1, %i3 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 40008b0c: b3 34 60 10 srl %l1, 0x10, %i1 /* * 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 ) { 40008b10: 03 00 00 3f sethi %hi(0xfc00), %g1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 40008b14: b2 06 40 08 add %i1, %o0, %i1 /* * 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 ) { 40008b18: 82 10 63 ff or %g1, 0x3ff, %g1 40008b1c: 80 a6 40 01 cmp %i1, %g1 40008b20: 18 80 00 9c bgu 40008d90 <_Objects_Extend_information+0x304> 40008b24: 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; 40008b28: 40 00 3f 19 call 4001878c <.umul> 40008b2c: d2 06 20 18 ld [ %i0 + 0x18 ], %o1 if ( information->auto_extend ) { 40008b30: c2 0e 20 12 ldub [ %i0 + 0x12 ], %g1 40008b34: 80 a0 60 00 cmp %g1, 0 40008b38: 02 80 00 6d be 40008cec <_Objects_Extend_information+0x260> 40008b3c: 01 00 00 00 nop new_object_block = _Workspace_Allocate( block_size ); 40008b40: 40 00 09 33 call 4000b00c <_Workspace_Allocate> 40008b44: 01 00 00 00 nop if ( !new_object_block ) 40008b48: a2 92 20 00 orcc %o0, 0, %l1 40008b4c: 02 80 00 91 be 40008d90 <_Objects_Extend_information+0x304> 40008b50: 01 00 00 00 nop } /* * Do we need to grow the tables? */ if ( do_extend ) { 40008b54: 80 8e e0 ff btst 0xff, %i3 40008b58: 22 80 00 42 be,a 40008c60 <_Objects_Extend_information+0x1d4> 40008b5c: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); if ( information->auto_extend ) { 40008b60: c2 0e 20 12 ldub [ %i0 + 0x12 ], %g1 */ /* * Up the block count and maximum */ block_count++; 40008b64: b6 06 a0 01 add %i2, 1, %i3 * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); if ( information->auto_extend ) { 40008b68: 80 a0 60 00 cmp %g1, 0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 40008b6c: 91 2e e0 01 sll %i3, 1, %o0 40008b70: 90 02 00 1b add %o0, %i3, %o0 ((maximum + minimum_index) * sizeof(Objects_Control *)); 40008b74: 90 06 40 08 add %i1, %o0, %o0 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + 40008b78: 90 02 00 10 add %o0, %l0, %o0 ((maximum + minimum_index) * sizeof(Objects_Control *)); if ( information->auto_extend ) { 40008b7c: 12 80 00 60 bne 40008cfc <_Objects_Extend_information+0x270> 40008b80: 91 2a 20 02 sll %o0, 2, %o0 if ( !object_blocks ) { _Workspace_Free( new_object_block ); return; } } else { object_blocks = _Workspace_Allocate_or_fatal_error( block_size ); 40008b84: 40 00 09 30 call 4000b044 <_Workspace_Allocate_or_fatal_error> 40008b88: 01 00 00 00 nop 40008b8c: a4 10 00 08 mov %o0, %l2 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 40008b90: c2 16 20 10 lduh [ %i0 + 0x10 ], %g1 /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( object_blocks, block_count * sizeof(void*) ); 40008b94: b7 2e e0 02 sll %i3, 2, %i3 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 40008b98: 80 a4 00 01 cmp %l0, %g1 40008b9c: a6 04 80 1b add %l2, %i3, %l3 40008ba0: 0a 80 00 67 bcs 40008d3c <_Objects_Extend_information+0x2b0> 40008ba4: b6 04 c0 1b add %l3, %i3, %i3 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 40008ba8: 85 2c 20 02 sll %l0, 2, %g2 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 40008bac: 80 a4 20 00 cmp %l0, 0 40008bb0: 02 80 00 07 be 40008bcc <_Objects_Extend_information+0x140><== NEVER TAKEN 40008bb4: 82 10 20 00 clr %g1 local_table[ index ] = NULL; 40008bb8: c0 20 40 1b clr [ %g1 + %i3 ] 40008bbc: 82 00 60 04 add %g1, 4, %g1 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 40008bc0: 80 a0 40 02 cmp %g1, %g2 40008bc4: 32 bf ff fe bne,a 40008bbc <_Objects_Extend_information+0x130><== NEVER TAKEN 40008bc8: c0 20 40 1b clr [ %g1 + %i3 ] <== NOT EXECUTED 40008bcc: b5 2e a0 02 sll %i2, 2, %i2 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 40008bd0: c6 16 20 14 lduh [ %i0 + 0x14 ], %g3 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 40008bd4: c0 24 80 1a clr [ %l2 + %i2 ] inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 40008bd8: 82 07 00 03 add %i4, %g3, %g1 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 40008bdc: 80 a7 00 01 cmp %i4, %g1 40008be0: 1a 80 00 0b bcc 40008c0c <_Objects_Extend_information+0x180><== NEVER TAKEN 40008be4: c0 24 c0 1a clr [ %l3 + %i2 ] * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( 40008be8: 85 2f 20 02 sll %i4, 2, %g2 40008bec: 87 28 e0 02 sll %g3, 2, %g3 40008bf0: 84 06 c0 02 add %i3, %g2, %g2 40008bf4: 82 10 20 00 clr %g1 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; 40008bf8: c0 20 80 01 clr [ %g2 + %g1 ] 40008bfc: 82 00 60 04 add %g1, 4, %g1 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 40008c00: 80 a0 40 03 cmp %g1, %g3 40008c04: 32 bf ff fe bne,a 40008bfc <_Objects_Extend_information+0x170> 40008c08: c0 20 80 01 clr [ %g2 + %g1 ] index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; } _ISR_Disable( level ); 40008c0c: 7f ff e5 26 call 400020a4 40008c10: 01 00 00 00 nop uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 40008c14: 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( 40008c18: c4 16 20 04 lduh [ %i0 + 4 ], %g2 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; 40008c1c: f4 06 20 34 ld [ %i0 + 0x34 ], %i2 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; 40008c20: f2 36 20 10 sth %i1, [ %i0 + 0x10 ] 40008c24: 87 28 e0 18 sll %g3, 0x18, %g3 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 40008c28: 85 28 a0 1b sll %g2, 0x1b, %g2 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; 40008c2c: e4 26 20 34 st %l2, [ %i0 + 0x34 ] information->inactive_per_block = inactive_per_block; 40008c30: e6 26 20 30 st %l3, [ %i0 + 0x30 ] information->local_table = local_table; 40008c34: f6 26 20 1c st %i3, [ %i0 + 0x1c ] uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 40008c38: 03 00 00 40 sethi %hi(0x10000), %g1 40008c3c: 82 10 c0 01 or %g3, %g1, %g1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 40008c40: 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) | 40008c44: b2 10 40 19 or %g1, %i1, %i1 information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 40008c48: f2 26 20 0c st %i1, [ %i0 + 0xc ] information->the_class, _Objects_Local_node, information->maximum ); _ISR_Enable( level ); 40008c4c: 7f ff e5 1a call 400020b4 40008c50: 01 00 00 00 nop _Workspace_Free( old_tables ); 40008c54: 40 00 08 f6 call 4000b02c <_Workspace_Free> 40008c58: 90 10 00 1a mov %i2, %o0 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 40008c5c: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 40008c60: bb 2f 60 02 sll %i5, 2, %i5 40008c64: e2 20 40 1d st %l1, [ %g1 + %i5 ] /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 40008c68: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 40008c6c: d4 16 20 14 lduh [ %i0 + 0x14 ], %o2 40008c70: d2 00 40 1d ld [ %g1 + %i5 ], %o1 40008c74: d6 06 20 18 ld [ %i0 + 0x18 ], %o3 40008c78: 90 07 bf f4 add %fp, -12, %o0 40008c7c: 7f ff fc b4 call 40007f4c <_Chain_Initialize> 40008c80: 35 00 00 40 sethi %hi(0x10000), %i2 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 40008c84: 10 80 00 0d b 40008cb8 <_Objects_Extend_information+0x22c> 40008c88: b6 06 20 20 add %i0, 0x20, %i3 the_object->id = _Objects_Build_id( 40008c8c: c6 16 20 04 lduh [ %i0 + 4 ], %g3 40008c90: 85 28 a0 18 sll %g2, 0x18, %g2 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 40008c94: 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) | 40008c98: 84 10 80 1a or %g2, %i2, %g2 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 40008c9c: 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) | 40008ca0: 84 10 80 1c or %g2, %i4, %g2 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 40008ca4: 90 10 00 1b mov %i3, %o0 40008ca8: 92 10 00 01 mov %g1, %o1 index++; 40008cac: b8 07 20 01 inc %i4 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 40008cb0: 7f ff fc 8c call 40007ee0 <_Chain_Append> 40008cb4: 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 ) { 40008cb8: 7f ff fc 95 call 40007f0c <_Chain_Get> 40008cbc: 90 07 bf f4 add %fp, -12, %o0 40008cc0: 82 92 20 00 orcc %o0, 0, %g1 40008cc4: 32 bf ff f2 bne,a 40008c8c <_Objects_Extend_information+0x200> 40008cc8: c4 06 00 00 ld [ %i0 ], %g2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 40008ccc: c8 16 20 14 lduh [ %i0 + 0x14 ], %g4 40008cd0: c6 06 20 30 ld [ %i0 + 0x30 ], %g3 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 40008cd4: c4 16 20 2c lduh [ %i0 + 0x2c ], %g2 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 40008cd8: c8 20 c0 1d st %g4, [ %g3 + %i5 ] information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); 40008cdc: 82 00 80 04 add %g2, %g4, %g1 index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = 40008ce0: c2 36 20 2c sth %g1, [ %i0 + 0x2c ] 40008ce4: 81 c7 e0 08 ret 40008ce8: 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 ); 40008cec: 40 00 08 d6 call 4000b044 <_Workspace_Allocate_or_fatal_error> 40008cf0: 01 00 00 00 nop 40008cf4: 10 bf ff 98 b 40008b54 <_Objects_Extend_information+0xc8> 40008cf8: a2 10 00 08 mov %o0, %l1 */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); if ( information->auto_extend ) { object_blocks = _Workspace_Allocate( block_size ); 40008cfc: 40 00 08 c4 call 4000b00c <_Workspace_Allocate> 40008d00: 01 00 00 00 nop if ( !object_blocks ) { 40008d04: a4 92 20 00 orcc %o0, 0, %l2 40008d08: 32 bf ff a3 bne,a 40008b94 <_Objects_Extend_information+0x108> 40008d0c: c2 16 20 10 lduh [ %i0 + 0x10 ], %g1 _Workspace_Free( new_object_block ); 40008d10: 40 00 08 c7 call 4000b02c <_Workspace_Free> 40008d14: 90 10 00 11 mov %l1, %o0 40008d18: 81 c7 e0 08 ret 40008d1c: 81 e8 00 00 restore 40008d20: 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 ); 40008d24: b8 10 00 10 mov %l0, %i4 /* * 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; 40008d28: b6 10 20 01 mov 1, %i3 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 40008d2c: ba 10 20 00 clr %i5 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; 40008d30: b4 10 20 00 clr %i2 40008d34: 10 bf ff 76 b 40008b0c <_Objects_Extend_information+0x80> 40008d38: a3 2c 60 10 sll %l1, 0x10, %l1 /* * 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, 40008d3c: d2 06 20 34 ld [ %i0 + 0x34 ], %o1 information->object_blocks, block_count * sizeof(void*) ); 40008d40: b5 2e a0 02 sll %i2, 2, %i2 /* * 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, 40008d44: 90 10 00 12 mov %l2, %o0 40008d48: 40 00 1c cf call 40010084 40008d4c: 94 10 00 1a mov %i2, %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, 40008d50: d2 06 20 30 ld [ %i0 + 0x30 ], %o1 40008d54: 94 10 00 1a mov %i2, %o2 40008d58: 40 00 1c cb call 40010084 40008d5c: 90 10 00 13 mov %l3, %o0 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 40008d60: 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, 40008d64: d2 06 20 1c ld [ %i0 + 0x1c ], %o1 information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); 40008d68: 94 02 80 10 add %o2, %l0, %o2 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 40008d6c: 90 10 00 1b mov %i3, %o0 40008d70: 40 00 1c c5 call 40010084 40008d74: 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 ); 40008d78: 10 bf ff 97 b 40008bd4 <_Objects_Extend_information+0x148> 40008d7c: c6 16 20 14 lduh [ %i0 + 0x14 ], %g3 /* * 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 ); 40008d80: b8 10 00 10 mov %l0, %i4 <== 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; 40008d84: b6 10 20 01 mov 1, %i3 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; 40008d88: 10 bf ff 61 b 40008b0c <_Objects_Extend_information+0x80> <== NOT EXECUTED 40008d8c: ba 10 20 00 clr %i5 <== NOT EXECUTED 40008d90: 81 c7 e0 08 ret 40008d94: 81 e8 00 00 restore else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { do_extend = false; 40008d98: b6 10 20 00 clr %i3 <== 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; 40008d9c: 10 bf ff 5c b 40008b0c <_Objects_Extend_information+0x80> <== NOT EXECUTED 40008da0: ba 10 20 00 clr %i5 <== NOT EXECUTED =============================================================================== 40008e54 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 40008e54: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 40008e58: 80 a6 60 00 cmp %i1, 0 40008e5c: 02 80 00 19 be 40008ec0 <_Objects_Get_information+0x6c> 40008e60: 01 00 00 00 nop /* * 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 ); 40008e64: 40 00 12 82 call 4000d86c <_Objects_API_maximum_class> 40008e68: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 40008e6c: 80 a2 20 00 cmp %o0, 0 40008e70: 02 80 00 14 be 40008ec0 <_Objects_Get_information+0x6c> 40008e74: 80 a2 00 19 cmp %o0, %i1 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 40008e78: 0a 80 00 12 bcs 40008ec0 <_Objects_Get_information+0x6c> 40008e7c: 03 10 00 7b sethi %hi(0x4001ec00), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 40008e80: b1 2e 20 02 sll %i0, 2, %i0 40008e84: 82 10 62 24 or %g1, 0x224, %g1 40008e88: c2 00 40 18 ld [ %g1 + %i0 ], %g1 40008e8c: 80 a0 60 00 cmp %g1, 0 40008e90: 02 80 00 0c be 40008ec0 <_Objects_Get_information+0x6c> <== NEVER TAKEN 40008e94: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 40008e98: f0 00 40 19 ld [ %g1 + %i1 ], %i0 if ( !info ) 40008e9c: 80 a6 20 00 cmp %i0, 0 40008ea0: 02 80 00 08 be 40008ec0 <_Objects_Get_information+0x6c> <== NEVER TAKEN 40008ea4: 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 ) 40008ea8: c2 16 20 10 lduh [ %i0 + 0x10 ], %g1 40008eac: 80 a0 60 00 cmp %g1, 0 40008eb0: 02 80 00 04 be 40008ec0 <_Objects_Get_information+0x6c> 40008eb4: 01 00 00 00 nop return NULL; #endif return info; } 40008eb8: 81 c7 e0 08 ret 40008ebc: 81 e8 00 00 restore { Objects_Information *info; int the_class_api_maximum; if ( !the_class ) return NULL; 40008ec0: 81 c7 e0 08 ret 40008ec4: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 40017328 <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { 40017328: 9d e3 bf 90 save %sp, -112, %sp char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) 4001732c: 80 a6 60 00 cmp %i1, 0 40017330: 02 80 00 11 be 40017374 <_Objects_Get_name_as_string+0x4c> 40017334: 80 a6 a0 00 cmp %i2, 0 return NULL; if ( name == NULL ) 40017338: 02 80 00 0f be 40017374 <_Objects_Get_name_as_string+0x4c> 4001733c: ba 96 20 00 orcc %i0, 0, %i5 return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 40017340: 02 80 00 3d be 40017434 <_Objects_Get_name_as_string+0x10c> 40017344: 03 10 00 ca sethi %hi(0x40032800), %g1 information = _Objects_Get_information_id( tmpId ); 40017348: 7f ff e0 8e call 4000f580 <_Objects_Get_information_id> 4001734c: 90 10 00 1d mov %i5, %o0 if ( !information ) 40017350: b8 92 20 00 orcc %o0, 0, %i4 40017354: 02 80 00 08 be 40017374 <_Objects_Get_name_as_string+0x4c> 40017358: 92 10 00 1d mov %i5, %o1 return NULL; the_object = _Objects_Get( information, tmpId, &location ); 4001735c: 7f ff e0 c9 call 4000f680 <_Objects_Get> 40017360: 94 07 bf f4 add %fp, -12, %o2 switch ( location ) { 40017364: c2 07 bf f4 ld [ %fp + -12 ], %g1 40017368: 80 a0 60 00 cmp %g1, 0 4001736c: 22 80 00 05 be,a 40017380 <_Objects_Get_name_as_string+0x58> 40017370: c2 0f 20 38 ldub [ %i4 + 0x38 ], %g1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; 40017374: b4 10 20 00 clr %i2 _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } 40017378: 81 c7 e0 08 ret 4001737c: 91 e8 00 1a restore %g0, %i2, %o0 return NULL; case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 40017380: 80 a0 60 00 cmp %g1, 0 40017384: 12 80 00 2f bne 40017440 <_Objects_Get_name_as_string+0x118> 40017388: c2 02 20 0c ld [ %o0 + 0xc ], %g1 } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; 4001738c: 89 30 60 18 srl %g1, 0x18, %g4 lname[ 1 ] = (u32_name >> 16) & 0xff; 40017390: 87 30 60 10 srl %g1, 0x10, %g3 lname[ 2 ] = (u32_name >> 8) & 0xff; 40017394: 85 30 60 08 srl %g1, 8, %g2 lname[ 3 ] = (u32_name >> 0) & 0xff; 40017398: c2 2f bf fb stb %g1, [ %fp + -5 ] lname[ 4 ] = '\0'; 4001739c: c0 2f bf fc clrb [ %fp + -4 ] } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; 400173a0: c8 2f bf f8 stb %g4, [ %fp + -8 ] lname[ 1 ] = (u32_name >> 16) & 0xff; 400173a4: c6 2f bf f9 stb %g3, [ %fp + -7 ] lname[ 2 ] = (u32_name >> 8) & 0xff; 400173a8: c4 2f bf fa stb %g2, [ %fp + -6 ] lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; s = lname; 400173ac: 82 07 bf f8 add %fp, -8, %g1 } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 400173b0: 80 a6 60 01 cmp %i1, 1 400173b4: 02 80 00 27 be 40017450 <_Objects_Get_name_as_string+0x128><== NEVER TAKEN 400173b8: 86 10 00 1a mov %i2, %g3 400173bc: c6 48 40 00 ldsb [ %g1 ], %g3 400173c0: 80 a0 e0 00 cmp %g3, 0 400173c4: 02 80 00 22 be 4001744c <_Objects_Get_name_as_string+0x124> 400173c8: c4 08 40 00 ldub [ %g1 ], %g2 * This method objects the name of an object and returns its name * in the form of a C string. It attempts to be careful about * overflowing the user's string and about returning unprintable characters. */ char *_Objects_Get_name_as_string( 400173cc: b6 06 7f ff add %i1, -1, %i3 400173d0: 39 10 00 c4 sethi %hi(0x40031000), %i4 400173d4: b6 00 40 1b add %g1, %i3, %i3 400173d8: 86 10 00 1a mov %i2, %g3 400173dc: 10 80 00 06 b 400173f4 <_Objects_Get_name_as_string+0xcc> 400173e0: b8 17 22 58 or %i4, 0x258, %i4 s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 400173e4: c8 48 40 00 ldsb [ %g1 ], %g4 400173e8: 80 a1 20 00 cmp %g4, 0 400173ec: 02 80 00 0e be 40017424 <_Objects_Get_name_as_string+0xfc> 400173f0: c4 08 40 00 ldub [ %g1 ], %g2 *d = (isprint((unsigned char)*s)) ? *s : '*'; 400173f4: fa 07 00 00 ld [ %i4 ], %i5 400173f8: 88 08 a0 ff and %g2, 0xff, %g4 400173fc: 88 07 40 04 add %i5, %g4, %g4 40017400: c8 49 20 01 ldsb [ %g4 + 1 ], %g4 40017404: 80 89 20 97 btst 0x97, %g4 40017408: 12 80 00 03 bne 40017414 <_Objects_Get_name_as_string+0xec> 4001740c: 82 00 60 01 inc %g1 40017410: 84 10 20 2a mov 0x2a, %g2 40017414: c4 28 c0 00 stb %g2, [ %g3 ] s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 40017418: 80 a0 40 1b cmp %g1, %i3 4001741c: 12 bf ff f2 bne 400173e4 <_Objects_Get_name_as_string+0xbc> 40017420: 86 00 e0 01 inc %g3 *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; _Thread_Enable_dispatch(); 40017424: 7f ff e4 a3 call 400106b0 <_Thread_Enable_dispatch> 40017428: c0 28 c0 00 clrb [ %g3 ] return name; } return NULL; /* unreachable path */ } 4001742c: 81 c7 e0 08 ret 40017430: 91 e8 00 1a restore %g0, %i2, %o0 return NULL; if ( name == NULL ) return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 40017434: c2 00 60 20 ld [ %g1 + 0x20 ], %g1 40017438: 10 bf ff c4 b 40017348 <_Objects_Get_name_as_string+0x20> 4001743c: fa 00 60 08 ld [ %g1 + 8 ], %i5 lname[ 4 ] = '\0'; s = lname; } d = name; if ( s ) { 40017440: 80 a0 60 00 cmp %g1, 0 40017444: 12 bf ff dc bne 400173b4 <_Objects_Get_name_as_string+0x8c> 40017448: 80 a6 60 01 cmp %i1, 1 for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { *d = (isprint((unsigned char)*s)) ? *s : '*'; 4001744c: 86 10 00 1a mov %i2, %g3 } } *d = '\0'; _Thread_Enable_dispatch(); 40017450: 7f ff e4 98 call 400106b0 <_Thread_Enable_dispatch> 40017454: c0 28 c0 00 clrb [ %g3 ] 40017458: 30 bf ff f5 b,a 4001742c <_Objects_Get_name_as_string+0x104> =============================================================================== 4001a1f8 <_Objects_Get_next>: Objects_Information *information, Objects_Id id, Objects_Locations *location_p, Objects_Id *next_id_p ) { 4001a1f8: 9d e3 bf a0 save %sp, -96, %sp Objects_Control *object; Objects_Id next_id; if ( !information ) 4001a1fc: 80 a6 20 00 cmp %i0, 0 4001a200: 02 80 00 29 be 4001a2a4 <_Objects_Get_next+0xac> 4001a204: 80 a6 a0 00 cmp %i2, 0 return NULL; if ( !location_p ) 4001a208: 02 80 00 27 be 4001a2a4 <_Objects_Get_next+0xac> 4001a20c: 80 a6 e0 00 cmp %i3, 0 return NULL; if ( !next_id_p ) 4001a210: 02 80 00 25 be 4001a2a4 <_Objects_Get_next+0xac> 4001a214: 83 2e 60 10 sll %i1, 0x10, %g1 return NULL; if (_Objects_Get_index(id) == OBJECTS_ID_INITIAL_INDEX) 4001a218: 80 a0 60 00 cmp %g1, 0 4001a21c: 22 80 00 13 be,a 4001a268 <_Objects_Get_next+0x70> 4001a220: f2 06 20 08 ld [ %i0 + 8 ], %i1 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) 4001a224: c4 16 20 10 lduh [ %i0 + 0x10 ], %g2 4001a228: 83 2e 60 10 sll %i1, 0x10, %g1 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 4001a22c: 92 10 00 19 mov %i1, %o1 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) 4001a230: 83 30 60 10 srl %g1, 0x10, %g1 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 4001a234: 90 10 00 18 mov %i0, %o0 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) 4001a238: 80 a0 80 01 cmp %g2, %g1 4001a23c: 0a 80 00 13 bcs 4001a288 <_Objects_Get_next+0x90> 4001a240: 94 10 00 1a mov %i2, %o2 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 4001a244: 7f ff d5 0f call 4000f680 <_Objects_Get> 4001a248: b2 06 60 01 inc %i1 next_id++; } while (*location_p != OBJECTS_LOCAL); 4001a24c: c2 06 80 00 ld [ %i2 ], %g1 4001a250: 80 a0 60 00 cmp %g1, 0 4001a254: 32 bf ff f5 bne,a 4001a228 <_Objects_Get_next+0x30> 4001a258: c4 16 20 10 lduh [ %i0 + 0x10 ], %g2 *next_id_p = next_id; 4001a25c: f2 26 c0 00 st %i1, [ %i3 ] return object; final: *next_id_p = OBJECTS_ID_FINAL; return 0; } 4001a260: 81 c7 e0 08 ret 4001a264: 91 e8 00 08 restore %g0, %o0, %o0 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) 4001a268: c4 16 20 10 lduh [ %i0 + 0x10 ], %g2 4001a26c: 83 2e 60 10 sll %i1, 0x10, %g1 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 4001a270: 92 10 00 19 mov %i1, %o1 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) 4001a274: 83 30 60 10 srl %g1, 0x10, %g1 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); 4001a278: 90 10 00 18 mov %i0, %o0 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) 4001a27c: 80 a0 80 01 cmp %g2, %g1 4001a280: 1a bf ff f1 bcc 4001a244 <_Objects_Get_next+0x4c> <== ALWAYS TAKEN 4001a284: 94 10 00 1a mov %i2, %o2 { *location_p = OBJECTS_ERROR; 4001a288: 82 10 20 01 mov 1, %g1 4001a28c: c2 26 80 00 st %g1, [ %i2 ] *next_id_p = next_id; return object; final: *next_id_p = OBJECTS_ID_FINAL; return 0; 4001a290: 90 10 20 00 clr %o0 *next_id_p = next_id; return object; final: *next_id_p = OBJECTS_ID_FINAL; 4001a294: 82 10 3f ff mov -1, %g1 4001a298: c2 26 c0 00 st %g1, [ %i3 ] return 0; } 4001a29c: 81 c7 e0 08 ret 4001a2a0: 91 e8 00 08 restore %g0, %o0, %o0 { Objects_Control *object; Objects_Id next_id; if ( !information ) return NULL; 4001a2a4: 10 bf ff ef b 4001a260 <_Objects_Get_next+0x68> 4001a2a8: 90 10 20 00 clr %o0 =============================================================================== 4001a43c <_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; 4001a43c: c4 02 20 08 ld [ %o0 + 8 ], %g2 if ( information->maximum >= index ) { 4001a440: 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; 4001a444: 92 22 40 02 sub %o1, %g2, %o1 4001a448: 92 02 60 01 inc %o1 if ( information->maximum >= index ) { 4001a44c: 80 a2 40 01 cmp %o1, %g1 4001a450: 18 80 00 09 bgu 4001a474 <_Objects_Get_no_protection+0x38> 4001a454: 93 2a 60 02 sll %o1, 2, %o1 if ( (the_object = information->local_table[ index ]) != NULL ) { 4001a458: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4001a45c: d0 00 40 09 ld [ %g1 + %o1 ], %o0 4001a460: 80 a2 20 00 cmp %o0, 0 4001a464: 02 80 00 05 be 4001a478 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 4001a468: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 4001a46c: 81 c3 e0 08 retl 4001a470: 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; 4001a474: 82 10 20 01 mov 1, %g1 return NULL; 4001a478: 90 10 20 00 clr %o0 } 4001a47c: 81 c3 e0 08 retl 4001a480: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 4000f6f4 <_Objects_Id_to_name>: Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 4000f6f4: 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; 4000f6f8: 80 a6 20 00 cmp %i0, 0 4000f6fc: 12 80 00 06 bne 4000f714 <_Objects_Id_to_name+0x20> 4000f700: 83 36 20 18 srl %i0, 0x18, %g1 4000f704: 03 10 00 ca sethi %hi(0x40032800), %g1 4000f708: c2 00 60 20 ld [ %g1 + 0x20 ], %g1 ! 40032820 <_Per_CPU_Information+0x10> 4000f70c: f0 00 60 08 ld [ %g1 + 8 ], %i0 4000f710: 83 36 20 18 srl %i0, 0x18, %g1 4000f714: 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 ) 4000f718: 84 00 7f ff add %g1, -1, %g2 4000f71c: 80 a0 a0 02 cmp %g2, 2 4000f720: 18 80 00 11 bgu 4000f764 <_Objects_Id_to_name+0x70> 4000f724: 83 28 60 02 sll %g1, 2, %g1 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 4000f728: 05 10 00 c8 sethi %hi(0x40032000), %g2 4000f72c: 84 10 a2 24 or %g2, 0x224, %g2 ! 40032224 <_Objects_Information_table> 4000f730: c2 00 80 01 ld [ %g2 + %g1 ], %g1 4000f734: 80 a0 60 00 cmp %g1, 0 4000f738: 02 80 00 0b be 4000f764 <_Objects_Id_to_name+0x70> 4000f73c: 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 ]; 4000f740: 85 28 a0 02 sll %g2, 2, %g2 4000f744: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 4000f748: 80 a2 20 00 cmp %o0, 0 4000f74c: 02 80 00 06 be 4000f764 <_Objects_Id_to_name+0x70> <== NEVER TAKEN 4000f750: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 4000f754: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 4000f758: 80 a0 60 00 cmp %g1, 0 4000f75c: 02 80 00 04 be 4000f76c <_Objects_Id_to_name+0x78> <== ALWAYS TAKEN 4000f760: 92 10 00 18 mov %i0, %o1 tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; 4000f764: 81 c7 e0 08 ret 4000f768: 91 e8 20 03 restore %g0, 3, %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 ); 4000f76c: 7f ff ff c5 call 4000f680 <_Objects_Get> 4000f770: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 4000f774: 80 a2 20 00 cmp %o0, 0 4000f778: 02 bf ff fb be 4000f764 <_Objects_Id_to_name+0x70> 4000f77c: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 4000f780: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 4000f784: b0 10 20 00 clr %i0 the_object = _Objects_Get( information, tmpId, &ignored_location ); if ( !the_object ) return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); 4000f788: 40 00 03 ca call 400106b0 <_Thread_Enable_dispatch> 4000f78c: c2 26 40 00 st %g1, [ %i1 ] 4000f790: 81 c7 e0 08 ret 4000f794: 81 e8 00 00 restore =============================================================================== 40009164 <_Objects_Shrink_information>: #include void _Objects_Shrink_information( Objects_Information *information ) { 40009164: 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 ); 40009168: f8 16 20 0a lduh [ %i0 + 0xa ], %i4 block_count = (information->maximum - index_base) / 4000916c: f6 16 20 14 lduh [ %i0 + 0x14 ], %i3 40009170: d0 16 20 10 lduh [ %i0 + 0x10 ], %o0 40009174: 92 10 00 1b mov %i3, %o1 40009178: 40 00 3d bf call 40018874 <.udiv> 4000917c: 90 22 00 1c sub %o0, %i4, %o0 information->allocation_size; for ( block = 0; block < block_count; block++ ) { 40009180: 80 a2 20 00 cmp %o0, 0 40009184: 02 80 00 36 be 4000925c <_Objects_Shrink_information+0xf8><== NEVER TAKEN 40009188: 01 00 00 00 nop if ( information->inactive_per_block[ block ] == 4000918c: c8 06 20 30 ld [ %i0 + 0x30 ], %g4 40009190: c2 01 00 00 ld [ %g4 ], %g1 40009194: 80 a6 c0 01 cmp %i3, %g1 40009198: 02 80 00 0f be 400091d4 <_Objects_Shrink_information+0x70><== NEVER TAKEN 4000919c: 82 10 20 00 clr %g1 400091a0: 10 80 00 07 b 400091bc <_Objects_Shrink_information+0x58> 400091a4: ba 10 20 04 mov 4, %i5 400091a8: c4 01 00 1d ld [ %g4 + %i5 ], %g2 400091ac: 80 a6 c0 02 cmp %i3, %g2 400091b0: 02 80 00 0a be 400091d8 <_Objects_Shrink_information+0x74> 400091b4: 86 07 60 04 add %i5, 4, %g3 400091b8: ba 10 00 03 mov %g3, %i5 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { 400091bc: 82 00 60 01 inc %g1 400091c0: 80 a0 40 08 cmp %g1, %o0 400091c4: 12 bf ff f9 bne 400091a8 <_Objects_Shrink_information+0x44> 400091c8: b8 07 00 1b add %i4, %i3, %i4 400091cc: 81 c7 e0 08 ret 400091d0: 81 e8 00 00 restore if ( information->inactive_per_block[ block ] == 400091d4: ba 10 20 00 clr %i5 <== NOT EXECUTED * 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 ); 400091d8: 35 00 00 3f sethi %hi(0xfc00), %i2 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; 400091dc: d0 06 20 20 ld [ %i0 + 0x20 ], %o0 400091e0: 10 80 00 05 b 400091f4 <_Objects_Shrink_information+0x90> 400091e4: b4 16 a3 ff or %i2, 0x3ff, %i2 if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); 400091e8: 90 96 e0 00 orcc %i3, 0, %o0 400091ec: 22 80 00 12 be,a 40009234 <_Objects_Shrink_information+0xd0> 400091f0: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 * 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 ); 400091f4: c2 02 20 08 ld [ %o0 + 8 ], %g1 400091f8: 82 08 40 1a and %g1, %i2, %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) && 400091fc: 80 a0 40 1c cmp %g1, %i4 40009200: 0a bf ff fa bcs 400091e8 <_Objects_Shrink_information+0x84> 40009204: f6 02 00 00 ld [ %o0 ], %i3 (index < (index_base + information->allocation_size))) { 40009208: c4 16 20 14 lduh [ %i0 + 0x14 ], %g2 4000920c: 84 07 00 02 add %i4, %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) && 40009210: 80 a0 40 02 cmp %g1, %g2 40009214: 3a bf ff f6 bcc,a 400091ec <_Objects_Shrink_information+0x88> 40009218: 90 96 e0 00 orcc %i3, 0, %o0 (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); 4000921c: 40 00 10 2f call 4000d2d8 <_Chain_Extract> 40009220: 01 00 00 00 nop } } while ( the_object ); 40009224: 90 96 e0 00 orcc %i3, 0, %o0 40009228: 32 bf ff f4 bne,a 400091f8 <_Objects_Shrink_information+0x94><== ALWAYS TAKEN 4000922c: c2 02 20 08 ld [ %o0 + 8 ], %g1 /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); 40009230: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 <== NOT EXECUTED 40009234: 40 00 07 7e call 4000b02c <_Workspace_Free> 40009238: d0 00 40 1d ld [ %g1 + %i5 ], %o0 information->object_blocks[ block ] = NULL; 4000923c: c2 06 20 34 ld [ %i0 + 0x34 ], %g1 information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; 40009240: 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; 40009244: c0 20 40 1d clr [ %g1 + %i5 ] information->inactive_per_block[ block ] = 0; 40009248: c6 06 20 30 ld [ %i0 + 0x30 ], %g3 information->inactive -= information->allocation_size; 4000924c: 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; 40009250: c0 20 c0 1d clr [ %g3 + %i5 ] information->inactive -= information->allocation_size; 40009254: 82 20 80 01 sub %g2, %g1, %g1 40009258: c2 36 20 2c sth %g1, [ %i0 + 0x2c ] return; 4000925c: 81 c7 e0 08 ret 40009260: 81 e8 00 00 restore =============================================================================== 4000ef14 <_POSIX_Keys_Run_destructors>: */ void _POSIX_Keys_Run_destructors( Thread_Control *thread ) { 4000ef14: 9d e3 bf a0 save %sp, -96, %sp Objects_Maximum thread_index = _Objects_Get_index( thread->Object.id ); 4000ef18: c2 06 20 08 ld [ %i0 + 8 ], %g1 for ( index = 1 ; index <= max ; ++index ) { POSIX_Keys_Control *key = (POSIX_Keys_Control *) _POSIX_Keys_Information.local_table [ index ]; if ( key != NULL && key->destructor != NULL ) { void *value = key->Values [ thread_api ][ thread_index ]; 4000ef1c: 35 00 00 3f sethi %hi(0xfc00), %i2 4000ef20: b3 30 60 18 srl %g1, 0x18, %i1 4000ef24: b4 16 a3 ff or %i2, 0x3ff, %i2 4000ef28: b2 0e 60 07 and %i1, 7, %i1 4000ef2c: b4 08 40 1a and %g1, %i2, %i2 4000ef30: b2 06 60 04 add %i1, 4, %i1 4000ef34: 3b 10 00 7c sethi %hi(0x4001f000), %i5 4000ef38: b5 2e a0 02 sll %i2, 2, %i2 4000ef3c: ba 17 62 9c or %i5, 0x29c, %i5 4000ef40: b3 2e 60 02 sll %i1, 2, %i1 Objects_Maximum index = 0; Objects_Maximum max = _POSIX_Keys_Information.maximum; done = true; for ( index = 1 ; index <= max ; ++index ) { 4000ef44: c2 17 60 10 lduh [ %i5 + 0x10 ], %g1 4000ef48: 80 a0 60 00 cmp %g1, 0 4000ef4c: 02 80 00 21 be 4000efd0 <_POSIX_Keys_Run_destructors+0xbc> 4000ef50: b8 10 20 01 mov 1, %i4 4000ef54: 86 10 20 01 mov 1, %g3 4000ef58: b6 10 00 01 mov %g1, %i3 POSIX_Keys_Control *key = (POSIX_Keys_Control *) 4000ef5c: c8 07 60 1c ld [ %i5 + 0x1c ], %g4 _POSIX_Keys_Information.local_table [ index ]; 4000ef60: 85 2f 20 10 sll %i4, 0x10, %g2 Objects_Maximum max = _POSIX_Keys_Information.maximum; done = true; for ( index = 1 ; index <= max ; ++index ) { POSIX_Keys_Control *key = (POSIX_Keys_Control *) 4000ef64: 85 30 a0 0e srl %g2, 0xe, %g2 4000ef68: c4 01 00 02 ld [ %g4 + %g2 ], %g2 _POSIX_Keys_Information.local_table [ index ]; if ( key != NULL && key->destructor != NULL ) { 4000ef6c: 80 a0 a0 00 cmp %g2, 0 4000ef70: 02 80 00 10 be 4000efb0 <_POSIX_Keys_Run_destructors+0x9c> 4000ef74: 82 00 80 19 add %g2, %i1, %g1 4000ef78: c8 00 a0 10 ld [ %g2 + 0x10 ], %g4 4000ef7c: 80 a1 20 00 cmp %g4, 0 4000ef80: 22 80 00 0d be,a 4000efb4 <_POSIX_Keys_Run_destructors+0xa0> 4000ef84: b8 07 20 01 inc %i4 void *value = key->Values [ thread_api ][ thread_index ]; 4000ef88: c8 00 60 04 ld [ %g1 + 4 ], %g4 4000ef8c: d0 01 00 1a ld [ %g4 + %i2 ], %o0 if ( value != NULL ) { 4000ef90: 80 a2 20 00 cmp %o0, 0 4000ef94: 22 80 00 08 be,a 4000efb4 <_POSIX_Keys_Run_destructors+0xa0><== ALWAYS TAKEN 4000ef98: b8 07 20 01 inc %i4 key->Values [ thread_api ][ thread_index ] = NULL; 4000ef9c: c0 21 00 1a clr [ %g4 + %i2 ] <== NOT EXECUTED (*key->destructor)( value ); 4000efa0: c2 00 a0 10 ld [ %g2 + 0x10 ], %g1 <== NOT EXECUTED 4000efa4: 9f c0 40 00 call %g1 <== NOT EXECUTED 4000efa8: 01 00 00 00 nop <== NOT EXECUTED done = false; 4000efac: 86 10 20 00 clr %g3 ! 0 <== NOT EXECUTED Objects_Maximum index = 0; Objects_Maximum max = _POSIX_Keys_Information.maximum; done = true; for ( index = 1 ; index <= max ; ++index ) { 4000efb0: b8 07 20 01 inc %i4 4000efb4: 85 2f 20 10 sll %i4, 0x10, %g2 4000efb8: 85 30 a0 10 srl %g2, 0x10, %g2 4000efbc: 80 a6 c0 02 cmp %i3, %g2 4000efc0: 1a bf ff e7 bcc 4000ef5c <_POSIX_Keys_Run_destructors+0x48> 4000efc4: 80 88 e0 ff btst 0xff, %g3 * number of iterations. An infinite loop may happen if destructors set * thread specific data. This can be considered dubious. * * Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99. */ while ( !done ) { 4000efc8: 22 bf ff e0 be,a 4000ef48 <_POSIX_Keys_Run_destructors+0x34><== NEVER TAKEN 4000efcc: c2 17 60 10 lduh [ %i5 + 0x10 ], %g1 <== NOT EXECUTED 4000efd0: 81 c7 e0 08 ret 4000efd4: 81 e8 00 00 restore =============================================================================== 4000c228 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 4000c228: 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( 4000c22c: 11 10 00 a3 sethi %hi(0x40028c00), %o0 4000c230: 92 10 00 18 mov %i0, %o1 4000c234: 90 12 23 a0 or %o0, 0x3a0, %o0 4000c238: 40 00 0d 8d call 4000f86c <_Objects_Get> 4000c23c: 94 07 bf f8 add %fp, -8, %o2 Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 4000c240: c2 07 bf f8 ld [ %fp + -8 ], %g1 4000c244: 80 a0 60 00 cmp %g1, 0 4000c248: 22 80 00 08 be,a 4000c268 <_POSIX_Message_queue_Receive_support+0x40> 4000c24c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 4000c250: 40 00 29 59 call 400167b4 <__errno> 4000c254: b0 10 3f ff mov -1, %i0 4000c258: 82 10 20 09 mov 9, %g1 4000c25c: c2 22 00 00 st %g1, [ %o0 ] } 4000c260: 81 c7 e0 08 ret 4000c264: 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 ) { 4000c268: 84 08 60 03 and %g1, 3, %g2 4000c26c: 80 a0 a0 01 cmp %g2, 1 4000c270: 02 80 00 39 be 4000c354 <_POSIX_Message_queue_Receive_support+0x12c> 4000c274: 01 00 00 00 nop _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 4000c278: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 4000c27c: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 4000c280: 80 a0 80 1a cmp %g2, %i2 4000c284: 18 80 00 23 bgu 4000c310 <_POSIX_Message_queue_Receive_support+0xe8> 4000c288: 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; 4000c28c: c4 27 bf fc st %g2, [ %fp + -4 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 4000c290: 80 a7 20 00 cmp %i4, 0 4000c294: 12 80 00 1b bne 4000c300 <_POSIX_Message_queue_Receive_support+0xd8> 4000c298: 98 10 20 00 clr %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 4000c29c: 9a 10 00 1d mov %i5, %o5 4000c2a0: 90 02 20 1c add %o0, 0x1c, %o0 4000c2a4: 92 10 00 18 mov %i0, %o1 4000c2a8: 94 10 00 19 mov %i1, %o2 4000c2ac: 96 07 bf fc add %fp, -4, %o3 4000c2b0: 40 00 08 f2 call 4000e678 <_CORE_message_queue_Seize> 4000c2b4: 98 0b 20 01 and %o4, 1, %o4 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 4000c2b8: 40 00 11 48 call 400107d8 <_Thread_Enable_dispatch> 4000c2bc: 3b 10 00 a4 sethi %hi(0x40029000), %i5 if (msg_prio) { 4000c2c0: 80 a6 e0 00 cmp %i3, 0 *msg_prio = _POSIX_Message_queue_Priority_from_core( _Thread_Executing->Wait.count 4000c2c4: ba 17 60 20 or %i5, 0x20, %i5 do_wait, timeout ); _Thread_Enable_dispatch(); if (msg_prio) { 4000c2c8: 02 80 00 07 be 4000c2e4 <_POSIX_Message_queue_Receive_support+0xbc><== NEVER TAKEN 4000c2cc: c2 07 60 10 ld [ %i5 + 0x10 ], %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 (unsigned int) ((priority >= 0) ? priority : -priority); 4000c2d0: c6 00 60 24 ld [ %g1 + 0x24 ], %g3 4000c2d4: 85 38 e0 1f sra %g3, 0x1f, %g2 4000c2d8: 86 18 80 03 xor %g2, %g3, %g3 4000c2dc: 84 20 c0 02 sub %g3, %g2, %g2 *msg_prio = _POSIX_Message_queue_Priority_from_core( 4000c2e0: c4 26 c0 00 st %g2, [ %i3 ] _Thread_Executing->Wait.count ); } if ( !_Thread_Executing->Wait.return_code ) 4000c2e4: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 4000c2e8: 80 a0 60 00 cmp %g1, 0 4000c2ec: 12 80 00 11 bne 4000c330 <_POSIX_Message_queue_Receive_support+0x108> 4000c2f0: 01 00 00 00 nop return length_out; 4000c2f4: f0 07 bf fc ld [ %fp + -4 ], %i0 4000c2f8: 81 c7 e0 08 ret 4000c2fc: 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; 4000c300: 99 30 60 0e srl %g1, 0xe, %o4 4000c304: 98 1b 20 01 xor %o4, 1, %o4 4000c308: 10 bf ff e5 b 4000c29c <_POSIX_Message_queue_Receive_support+0x74> 4000c30c: 98 0b 20 01 and %o4, 1, %o4 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { _Thread_Enable_dispatch(); 4000c310: 40 00 11 32 call 400107d8 <_Thread_Enable_dispatch> 4000c314: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EMSGSIZE ); 4000c318: 40 00 29 27 call 400167b4 <__errno> 4000c31c: 01 00 00 00 nop 4000c320: 82 10 20 7a mov 0x7a, %g1 ! 7a 4000c324: c2 22 00 00 st %g1, [ %o0 ] 4000c328: 81 c7 e0 08 ret 4000c32c: 81 e8 00 00 restore } if ( !_Thread_Executing->Wait.return_code ) return length_out; rtems_set_errno_and_return_minus_one( 4000c330: 40 00 29 21 call 400167b4 <__errno> 4000c334: b0 10 3f ff mov -1, %i0 4000c338: c2 07 60 10 ld [ %i5 + 0x10 ], %g1 4000c33c: b8 10 00 08 mov %o0, %i4 4000c340: 40 00 00 a2 call 4000c5c8 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 4000c344: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 4000c348: d0 27 00 00 st %o0, [ %i4 ] 4000c34c: 81 c7 e0 08 ret 4000c350: 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(); 4000c354: 40 00 11 21 call 400107d8 <_Thread_Enable_dispatch> 4000c358: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EBADF ); 4000c35c: 40 00 29 16 call 400167b4 <__errno> 4000c360: 01 00 00 00 nop 4000c364: 82 10 20 09 mov 9, %g1 ! 9 4000c368: c2 22 00 00 st %g1, [ %o0 ] 4000c36c: 81 c7 e0 08 ret 4000c370: 81 e8 00 00 restore =============================================================================== 4000ecf0 <_POSIX_Semaphore_Create_support>: size_t name_len, int pshared, unsigned int value, POSIX_Semaphore_Control **the_sem ) { 4000ecf0: 9d e3 bf a0 save %sp, -96, %sp POSIX_Semaphore_Control *the_semaphore; CORE_semaphore_Attributes *the_sem_attr; char *name; /* Sharing semaphores among processes is not currently supported */ if (pshared != 0) 4000ecf4: 80 a6 a0 00 cmp %i2, 0 4000ecf8: 12 80 00 2f bne 4000edb4 <_POSIX_Semaphore_Create_support+0xc4> 4000ecfc: 03 10 00 8e sethi %hi(0x40023800), %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 4000ed00: c4 00 60 c0 ld [ %g1 + 0xc0 ], %g2 ! 400238c0 <_Thread_Dispatch_disable_level> ++level; 4000ed04: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 4000ed08: c4 20 60 c0 st %g2, [ %g1 + 0xc0 ] * _POSIX_Semaphore_Allocate */ RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Allocate( void ) { return (POSIX_Semaphore_Control *) 4000ed0c: 35 10 00 8e sethi %hi(0x40023800), %i2 4000ed10: 7f ff ee 48 call 4000a630 <_Objects_Allocate> 4000ed14: 90 16 a3 84 or %i2, 0x384, %o0 ! 40023b84 <_POSIX_Semaphore_Information> rtems_set_errno_and_return_minus_one( ENOSYS ); _Thread_Disable_dispatch(); the_semaphore = _POSIX_Semaphore_Allocate(); if ( !the_semaphore ) { 4000ed18: ba 92 20 00 orcc %o0, 0, %i5 4000ed1c: 02 80 00 2c be 4000edcc <_POSIX_Semaphore_Create_support+0xdc> 4000ed20: 80 a6 20 00 cmp %i0, 0 /* * Make a copy of the user's string for name just in case it was * dynamically constructed. */ if ( name_arg != NULL ) { 4000ed24: 02 80 00 1e be 4000ed9c <_POSIX_Semaphore_Create_support+0xac> 4000ed28: 92 10 00 19 mov %i1, %o1 name = _Workspace_String_duplicate( name_arg, name_len ); 4000ed2c: 40 00 04 10 call 4000fd6c <_Workspace_String_duplicate> 4000ed30: 90 10 00 18 mov %i0, %o0 if ( !name ) { 4000ed34: b2 92 20 00 orcc %o0, 0, %i1 4000ed38: 02 80 00 2d be 4000edec <_POSIX_Semaphore_Create_support+0xfc><== NEVER TAKEN 4000ed3c: 82 10 20 01 mov 1, %g1 } the_semaphore->process_shared = pshared; if ( name ) { the_semaphore->named = true; 4000ed40: 84 10 20 01 mov 1, %g2 } } else { name = NULL; } the_semaphore->process_shared = pshared; 4000ed44: c0 27 60 10 clr [ %i5 + 0x10 ] if ( name ) { the_semaphore->named = true; 4000ed48: c4 2f 60 14 stb %g2, [ %i5 + 0x14 ] the_semaphore->open_count = 1; 4000ed4c: c2 27 60 18 st %g1, [ %i5 + 0x18 ] the_semaphore->linked = true; 4000ed50: c2 2f 60 15 stb %g1, [ %i5 + 0x15 ] the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO; /* * This effectively disables limit checking. */ the_sem_attr->maximum_count = 0xFFFFFFFF; 4000ed54: 82 10 3f ff mov -1, %g1 _CORE_semaphore_Initialize( &the_semaphore->Semaphore, the_sem_attr, value ); 4000ed58: 90 07 60 1c add %i5, 0x1c, %o0 4000ed5c: 92 07 60 5c add %i5, 0x5c, %o1 4000ed60: 94 10 00 1b mov %i3, %o2 the_sem_attr->discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO; /* * This effectively disables limit checking. */ the_sem_attr->maximum_count = 0xFFFFFFFF; 4000ed64: c2 27 60 5c st %g1, [ %i5 + 0x5c ] _CORE_semaphore_Initialize( &the_semaphore->Semaphore, the_sem_attr, value ); 4000ed68: 7f ff ec 8f call 40009fa4 <_CORE_semaphore_Initialize> 4000ed6c: c0 27 60 60 clr [ %i5 + 0x60 ] Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( 4000ed70: c2 17 60 0a lduh [ %i5 + 0xa ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000ed74: b4 16 a3 84 or %i2, 0x384, %i2 4000ed78: c4 06 a0 1c ld [ %i2 + 0x1c ], %g2 4000ed7c: 83 28 60 02 sll %g1, 2, %g1 4000ed80: fa 20 80 01 st %i5, [ %g2 + %g1 ] the_object ); #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) /* ASSERT: information->is_string */ the_object->name.name_p = name; 4000ed84: f2 27 60 0c st %i1, [ %i5 + 0xc ] &_POSIX_Semaphore_Information, &the_semaphore->Object, name ); *the_sem = the_semaphore; 4000ed88: fa 27 00 00 st %i5, [ %i4 ] _Thread_Enable_dispatch(); 4000ed8c: 7f ff f3 75 call 4000bb60 <_Thread_Enable_dispatch> 4000ed90: b0 10 20 00 clr %i0 return 0; 4000ed94: 81 c7 e0 08 ret 4000ed98: 81 e8 00 00 restore } } else { name = NULL; } the_semaphore->process_shared = pshared; 4000ed9c: c0 27 60 10 clr [ %i5 + 0x10 ] if ( name ) { the_semaphore->named = true; the_semaphore->open_count = 1; the_semaphore->linked = true; } else { the_semaphore->named = false; 4000eda0: c0 2f 60 14 clrb [ %i5 + 0x14 ] the_semaphore->open_count = 0; 4000eda4: c0 27 60 18 clr [ %i5 + 0x18 ] the_semaphore->linked = false; 4000eda8: c0 2f 60 15 clrb [ %i5 + 0x15 ] _POSIX_Semaphore_Free( the_semaphore ); _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENOMEM ); } } else { name = NULL; 4000edac: 10 bf ff ea b 4000ed54 <_POSIX_Semaphore_Create_support+0x64> 4000edb0: b2 10 20 00 clr %i1 CORE_semaphore_Attributes *the_sem_attr; char *name; /* Sharing semaphores among processes is not currently supported */ if (pshared != 0) rtems_set_errno_and_return_minus_one( ENOSYS ); 4000edb4: 40 00 0a 2a call 4001165c <__errno> 4000edb8: b0 10 3f ff mov -1, %i0 4000edbc: 82 10 20 58 mov 0x58, %g1 4000edc0: c2 22 00 00 st %g1, [ %o0 ] 4000edc4: 81 c7 e0 08 ret 4000edc8: 81 e8 00 00 restore _Thread_Disable_dispatch(); the_semaphore = _POSIX_Semaphore_Allocate(); if ( !the_semaphore ) { _Thread_Enable_dispatch(); 4000edcc: 7f ff f3 65 call 4000bb60 <_Thread_Enable_dispatch> 4000edd0: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( ENOSPC ); 4000edd4: 40 00 0a 22 call 4001165c <__errno> 4000edd8: 01 00 00 00 nop 4000eddc: 82 10 20 1c mov 0x1c, %g1 ! 1c 4000ede0: c2 22 00 00 st %g1, [ %o0 ] 4000ede4: 81 c7 e0 08 ret 4000ede8: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE void _POSIX_Semaphore_Free ( POSIX_Semaphore_Control *the_semaphore ) { _Objects_Free( &_POSIX_Semaphore_Information, &the_semaphore->Object ); 4000edec: 90 16 a3 84 or %i2, 0x384, %o0 <== NOT EXECUTED 4000edf0: 7f ff ef 08 call 4000aa10 <_Objects_Free> <== NOT EXECUTED 4000edf4: 92 10 00 1d mov %i5, %o1 <== NOT EXECUTED */ if ( name_arg != NULL ) { name = _Workspace_String_duplicate( name_arg, name_len ); if ( !name ) { _POSIX_Semaphore_Free( the_semaphore ); _Thread_Enable_dispatch(); 4000edf8: 7f ff f3 5a call 4000bb60 <_Thread_Enable_dispatch> <== NOT EXECUTED 4000edfc: b0 10 3f ff mov -1, %i0 <== NOT EXECUTED rtems_set_errno_and_return_minus_one( ENOMEM ); 4000ee00: 40 00 0a 17 call 4001165c <__errno> <== NOT EXECUTED 4000ee04: 01 00 00 00 nop <== NOT EXECUTED 4000ee08: 82 10 20 0c mov 0xc, %g1 ! c <== NOT EXECUTED 4000ee0c: c2 22 00 00 st %g1, [ %o0 ] <== NOT EXECUTED 4000ee10: 81 c7 e0 08 ret <== NOT EXECUTED 4000ee14: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 4000c3a4 <_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 ]; 4000c3a4: c2 02 21 50 ld [ %o0 + 0x150 ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 4000c3a8: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 4000c3ac: 80 a0 a0 00 cmp %g2, 0 4000c3b0: 12 80 00 06 bne 4000c3c8 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x24><== NEVER TAKEN 4000c3b4: 01 00 00 00 nop 4000c3b8: c4 00 60 dc ld [ %g1 + 0xdc ], %g2 4000c3bc: 80 a0 a0 01 cmp %g2, 1 4000c3c0: 22 80 00 05 be,a 4000c3d4 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x30> 4000c3c4: 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(); 4000c3c8: 82 13 c0 00 mov %o7, %g1 4000c3cc: 7f ff f6 3c call 40009cbc <_Thread_Enable_dispatch> 4000c3d0: 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 && 4000c3d4: 80 a0 60 00 cmp %g1, 0 4000c3d8: 02 bf ff fc be 4000c3c8 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x24> 4000c3dc: 01 00 00 00 nop * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 4000c3e0: 03 10 00 5f sethi %hi(0x40017c00), %g1 4000c3e4: c4 00 60 f0 ld [ %g1 + 0xf0 ], %g2 ! 40017cf0 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 4000c3e8: 92 10 3f ff mov -1, %o1 --level; 4000c3ec: 84 00 bf ff add %g2, -1, %g2 _Thread_Dispatch_disable_level = level; 4000c3f0: c4 20 60 f0 st %g2, [ %g1 + 0xf0 ] 4000c3f4: 82 13 c0 00 mov %o7, %g1 4000c3f8: 40 00 01 d9 call 4000cb5c <_POSIX_Thread_Exit> 4000c3fc: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000d8a0 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 4000d8a0: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 4000d8a4: 7f ff ff f2 call 4000d86c <_POSIX_Priority_Is_valid> 4000d8a8: d0 06 40 00 ld [ %i1 ], %o0 4000d8ac: 80 8a 20 ff btst 0xff, %o0 4000d8b0: 32 80 00 04 bne,a 4000d8c0 <_POSIX_Thread_Translate_sched_param+0x20><== ALWAYS TAKEN 4000d8b4: c0 26 80 00 clr [ %i2 ] return EINVAL; 4000d8b8: 81 c7 e0 08 ret 4000d8bc: 91 e8 20 16 restore %g0, 0x16, %o0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 4000d8c0: 80 a6 20 00 cmp %i0, 0 4000d8c4: 02 80 00 2c be 4000d974 <_POSIX_Thread_Translate_sched_param+0xd4> 4000d8c8: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { 4000d8cc: 80 a6 20 01 cmp %i0, 1 4000d8d0: 02 80 00 2d be 4000d984 <_POSIX_Thread_Translate_sched_param+0xe4> 4000d8d4: 80 a6 20 02 cmp %i0, 2 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 4000d8d8: 02 80 00 2d be 4000d98c <_POSIX_Thread_Translate_sched_param+0xec> 4000d8dc: 80 a6 20 04 cmp %i0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { 4000d8e0: 12 bf ff f6 bne 4000d8b8 <_POSIX_Thread_Translate_sched_param+0x18> 4000d8e4: 01 00 00 00 nop if ( (param->sched_ss_repl_period.tv_sec == 0) && 4000d8e8: c2 06 60 08 ld [ %i1 + 8 ], %g1 4000d8ec: 80 a0 60 00 cmp %g1, 0 4000d8f0: 32 80 00 07 bne,a 4000d90c <_POSIX_Thread_Translate_sched_param+0x6c> 4000d8f4: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d8f8: c2 06 60 0c ld [ %i1 + 0xc ], %g1 4000d8fc: 80 a0 60 00 cmp %g1, 0 4000d900: 02 bf ff ee be 4000d8b8 <_POSIX_Thread_Translate_sched_param+0x18> 4000d904: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 4000d908: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 4000d90c: 80 a0 60 00 cmp %g1, 0 4000d910: 12 80 00 06 bne 4000d928 <_POSIX_Thread_Translate_sched_param+0x88> 4000d914: 01 00 00 00 nop 4000d918: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000d91c: 80 a0 60 00 cmp %g1, 0 4000d920: 02 bf ff e6 be 4000d8b8 <_POSIX_Thread_Translate_sched_param+0x18> 4000d924: 01 00 00 00 nop (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 4000d928: 7f ff f7 45 call 4000b63c <_Timespec_To_ticks> 4000d92c: 90 06 60 08 add %i1, 8, %o0 4000d930: ba 10 00 08 mov %o0, %i5 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 4000d934: 7f ff f7 42 call 4000b63c <_Timespec_To_ticks> 4000d938: 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 ) < 4000d93c: 80 a7 40 08 cmp %i5, %o0 4000d940: 0a bf ff de bcs 4000d8b8 <_POSIX_Thread_Translate_sched_param+0x18> 4000d944: 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 ) ) 4000d948: 7f ff ff c9 call 4000d86c <_POSIX_Priority_Is_valid> 4000d94c: d0 06 60 04 ld [ %i1 + 4 ], %o0 4000d950: 80 8a 20 ff btst 0xff, %o0 4000d954: 02 bf ff d9 be 4000d8b8 <_POSIX_Thread_Translate_sched_param+0x18> 4000d958: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 4000d95c: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 4000d960: 03 10 00 1d sethi %hi(0x40007400), %g1 4000d964: 82 10 62 ac or %g1, 0x2ac, %g1 ! 400076ac <_POSIX_Threads_Sporadic_budget_callout> 4000d968: c2 26 c0 00 st %g1, [ %i3 ] return 0; 4000d96c: 81 c7 e0 08 ret 4000d970: 91 e8 20 00 restore %g0, 0, %o0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 4000d974: 82 10 20 01 mov 1, %g1 4000d978: c2 26 80 00 st %g1, [ %i2 ] return 0; 4000d97c: 81 c7 e0 08 ret 4000d980: 81 e8 00 00 restore *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } 4000d984: 81 c7 e0 08 ret 4000d988: 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; 4000d98c: f0 26 80 00 st %i0, [ %i2 ] return 0; 4000d990: 81 c7 e0 08 ret 4000d994: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000cadc <_POSIX_Threads_Delete_extension>: */ static void _POSIX_Threads_Delete_extension( Thread_Control *executing __attribute__((unused)), Thread_Control *deleted ) { 4000cadc: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *the_thread; POSIX_API_Control *api; void **value_ptr; api = deleted->API_Extensions[ THREAD_API_POSIX ]; 4000cae0: f0 06 61 50 ld [ %i1 + 0x150 ], %i0 /* * Run the POSIX cancellation handlers */ _POSIX_Threads_cancel_run( deleted ); 4000cae4: 40 00 08 f0 call 4000eea4 <_POSIX_Threads_cancel_run> 4000cae8: 90 10 00 19 mov %i1, %o0 /* * Run all the key destructors */ _POSIX_Keys_Run_destructors( deleted ); 4000caec: 90 10 00 19 mov %i1, %o0 4000caf0: 40 00 09 09 call 4000ef14 <_POSIX_Keys_Run_destructors> 4000caf4: ba 06 20 44 add %i0, 0x44, %i5 /* * Wakeup all the tasks which joined with this one */ value_ptr = (void **) deleted->Wait.return_argument; while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) ) 4000caf8: 10 80 00 03 b 4000cb04 <_POSIX_Threads_Delete_extension+0x28> 4000cafc: f8 06 60 28 ld [ %i1 + 0x28 ], %i4 *(void **)the_thread->Wait.return_argument = value_ptr; 4000cb00: f8 20 40 00 st %i4, [ %g1 ] <== NOT EXECUTED /* * Wakeup all the tasks which joined with this one */ value_ptr = (void **) deleted->Wait.return_argument; while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) ) 4000cb04: 7f ff f5 ca call 4000a22c <_Thread_queue_Dequeue> 4000cb08: 90 10 00 1d mov %i5, %o0 4000cb0c: 80 a2 20 00 cmp %o0, 0 4000cb10: 32 bf ff fc bne,a 4000cb00 <_POSIX_Threads_Delete_extension+0x24><== NEVER TAKEN 4000cb14: c2 02 20 28 ld [ %o0 + 0x28 ], %g1 <== NOT EXECUTED *(void **)the_thread->Wait.return_argument = value_ptr; if ( api->schedpolicy == SCHED_SPORADIC ) 4000cb18: c2 06 20 84 ld [ %i0 + 0x84 ], %g1 4000cb1c: 80 a0 60 04 cmp %g1, 4 4000cb20: 02 80 00 05 be 4000cb34 <_POSIX_Threads_Delete_extension+0x58> 4000cb24: 01 00 00 00 nop (void) _Watchdog_Remove( &api->Sporadic_timer ); deleted->API_Extensions[ THREAD_API_POSIX ] = NULL; 4000cb28: c0 26 61 50 clr [ %i1 + 0x150 ] _Workspace_Free( api ); 4000cb2c: 7f ff f9 40 call 4000b02c <_Workspace_Free> 4000cb30: 81 e8 00 00 restore while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) ) *(void **)the_thread->Wait.return_argument = value_ptr; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); 4000cb34: 7f ff f8 80 call 4000ad34 <_Watchdog_Remove> 4000cb38: 90 06 20 a8 add %i0, 0xa8, %o0 deleted->API_Extensions[ THREAD_API_POSIX ] = NULL; 4000cb3c: c0 26 61 50 clr [ %i1 + 0x150 ] _Workspace_Free( api ); 4000cb40: 7f ff f9 3b call 4000b02c <_Workspace_Free> 4000cb44: 81 e8 00 00 restore =============================================================================== 400073c0 <_POSIX_Threads_Initialize_user_threads_body>: #include #include #include void _POSIX_Threads_Initialize_user_threads_body(void) { 400073c0: 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; 400073c4: 03 10 00 7b sethi %hi(0x4001ec00), %g1 400073c8: 82 10 62 04 or %g1, 0x204, %g1 ! 4001ee04 maximum = Configuration_POSIX_API.number_of_initialization_threads; 400073cc: f6 00 60 30 ld [ %g1 + 0x30 ], %i3 if ( !user_threads || maximum == 0 ) 400073d0: 80 a6 e0 00 cmp %i3, 0 400073d4: 02 80 00 18 be 40007434 <_POSIX_Threads_Initialize_user_threads_body+0x74><== NEVER TAKEN 400073d8: fa 00 60 34 ld [ %g1 + 0x34 ], %i5 400073dc: 80 a7 60 00 cmp %i5, 0 400073e0: 02 80 00 15 be 40007434 <_POSIX_Threads_Initialize_user_threads_body+0x74><== NEVER TAKEN 400073e4: b8 10 20 00 clr %i4 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); 400073e8: 40 00 19 6c call 4000d998 400073ec: 90 07 bf c0 add %fp, -64, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 400073f0: 92 10 20 02 mov 2, %o1 400073f4: 40 00 19 75 call 4000d9c8 400073f8: 90 07 bf c0 add %fp, -64, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 400073fc: d2 07 60 04 ld [ %i5 + 4 ], %o1 40007400: 40 00 19 82 call 4000da08 40007404: 90 07 bf c0 add %fp, -64, %o0 status = pthread_create( 40007408: d4 07 40 00 ld [ %i5 ], %o2 4000740c: 90 07 bf bc add %fp, -68, %o0 40007410: 92 07 bf c0 add %fp, -64, %o1 40007414: 7f ff ff 00 call 40007014 40007418: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 4000741c: 94 92 20 00 orcc %o0, 0, %o2 40007420: 12 80 00 07 bne 4000743c <_POSIX_Threads_Initialize_user_threads_body+0x7c> 40007424: b8 07 20 01 inc %i4 * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { 40007428: 80 a7 00 1b cmp %i4, %i3 4000742c: 12 bf ff ef bne 400073e8 <_POSIX_Threads_Initialize_user_threads_body+0x28><== NEVER TAKEN 40007430: ba 07 60 08 add %i5, 8, %i5 40007434: 81 c7 e0 08 ret 40007438: 81 e8 00 00 restore &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 4000743c: 90 10 20 02 mov 2, %o0 40007440: 40 00 08 79 call 40009624 <_Internal_error_Occurred> 40007444: 92 10 20 01 mov 1, %o1 =============================================================================== 4000cc68 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 4000cc68: 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 ]; 4000cc6c: fa 06 61 50 ld [ %i1 + 0x150 ], %i5 /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); 4000cc70: 40 00 03 bb call 4000db5c <_Timespec_To_ticks> 4000cc74: 90 07 60 98 add %i5, 0x98, %o0 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 4000cc78: c4 07 60 88 ld [ %i5 + 0x88 ], %g2 4000cc7c: 03 10 00 78 sethi %hi(0x4001e000), %g1 4000cc80: d2 08 62 dc ldub [ %g1 + 0x2dc ], %o1 ! 4001e2dc */ #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 ) { 4000cc84: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 4000cc88: 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; 4000cc8c: d0 26 60 74 st %o0, [ %i1 + 0x74 ] */ #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 ) { 4000cc90: 80 a0 60 00 cmp %g1, 0 4000cc94: 12 80 00 06 bne 4000ccac <_POSIX_Threads_Sporadic_budget_TSR+0x44><== NEVER TAKEN 4000cc98: 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 ) { 4000cc9c: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 4000cca0: 80 a0 40 09 cmp %g1, %o1 4000cca4: 18 80 00 09 bgu 4000ccc8 <_POSIX_Threads_Sporadic_budget_TSR+0x60> 4000cca8: 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 ); 4000ccac: 90 07 60 90 add %i5, 0x90, %o0 4000ccb0: 40 00 03 ab call 4000db5c <_Timespec_To_ticks> 4000ccb4: 31 10 00 7b sethi %hi(0x4001ec00), %i0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000ccb8: b2 07 60 a8 add %i5, 0xa8, %i1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000ccbc: d0 27 60 b4 st %o0, [ %i5 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000ccc0: 7f ff f7 be call 4000abb8 <_Watchdog_Insert> 4000ccc4: 91 ee 23 58 restore %i0, 0x358, %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 ); 4000ccc8: 7f ff f3 46 call 400099e0 <_Thread_Change_priority> 4000cccc: 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 ); 4000ccd0: 90 07 60 90 add %i5, 0x90, %o0 4000ccd4: 40 00 03 a2 call 4000db5c <_Timespec_To_ticks> 4000ccd8: 31 10 00 7b sethi %hi(0x4001ec00), %i0 4000ccdc: b2 07 60 a8 add %i5, 0xa8, %i1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000cce0: d0 27 60 b4 st %o0, [ %i5 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 4000cce4: 7f ff f7 b5 call 4000abb8 <_Watchdog_Insert> 4000cce8: 91 ee 23 58 restore %i0, 0x358, %o0 =============================================================================== 4000ccec <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000ccec: c4 02 21 50 ld [ %o0 + 0x150 ], %g2 4000ccf0: c6 00 a0 8c ld [ %g2 + 0x8c ], %g3 4000ccf4: 05 10 00 78 sethi %hi(0x4001e000), %g2 4000ccf8: d2 08 a2 dc ldub [ %g2 + 0x2dc ], %o1 ! 4001e2dc */ #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 ) { 4000ccfc: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 4000cd00: 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 */ 4000cd04: 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; 4000cd08: 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 ) { 4000cd0c: 80 a0 a0 00 cmp %g2, 0 4000cd10: 12 80 00 06 bne 4000cd28 <_POSIX_Threads_Sporadic_budget_callout+0x3c><== NEVER TAKEN 4000cd14: c6 22 20 74 st %g3, [ %o0 + 0x74 ] /* * 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 ) { 4000cd18: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000cd1c: 80 a0 40 09 cmp %g1, %o1 4000cd20: 0a 80 00 04 bcs 4000cd30 <_POSIX_Threads_Sporadic_budget_callout+0x44><== ALWAYS TAKEN 4000cd24: 94 10 20 01 mov 1, %o2 4000cd28: 81 c3 e0 08 retl <== NOT EXECUTED 4000cd2c: 01 00 00 00 nop <== NOT EXECUTED _Thread_Change_priority( the_thread, new_priority, true ); 4000cd30: 82 13 c0 00 mov %o7, %g1 4000cd34: 7f ff f3 2b call 400099e0 <_Thread_Change_priority> 4000cd38: 9e 10 40 00 mov %g1, %o7 =============================================================================== 4000eea4 <_POSIX_Threads_cancel_run>: #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { 4000eea4: 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 ]; 4000eea8: f8 06 21 50 ld [ %i0 + 0x150 ], %i4 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; 4000eeac: 84 10 20 01 mov 1, %g2 while ( !_Chain_Is_empty( handler_stack ) ) { 4000eeb0: c2 07 20 e4 ld [ %i4 + 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 ); 4000eeb4: b6 07 20 e8 add %i4, 0xe8, %i3 4000eeb8: 80 a0 40 1b cmp %g1, %i3 4000eebc: 02 80 00 14 be 4000ef0c <_POSIX_Threads_cancel_run+0x68> 4000eec0: c4 27 20 d8 st %g2, [ %i4 + 0xd8 ] _ISR_Disable( level ); 4000eec4: 7f ff cc 78 call 400020a4 4000eec8: 01 00 00 00 nop handler = (POSIX_Cancel_Handler_control *) 4000eecc: fa 07 20 ec ld [ %i4 + 0xec ], %i5 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4000eed0: c4 07 40 00 ld [ %i5 ], %g2 previous = the_node->previous; 4000eed4: c2 07 60 04 ld [ %i5 + 4 ], %g1 next->previous = previous; 4000eed8: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000eedc: c4 20 40 00 st %g2, [ %g1 ] _Chain_Tail( handler_stack )->previous; _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); 4000eee0: 7f ff cc 75 call 400020b4 4000eee4: 01 00 00 00 nop (*handler->routine)( handler->arg ); 4000eee8: c2 07 60 08 ld [ %i5 + 8 ], %g1 4000eeec: 9f c0 40 00 call %g1 4000eef0: d0 07 60 0c ld [ %i5 + 0xc ], %o0 _Workspace_Free( handler ); 4000eef4: 7f ff f0 4e call 4000b02c <_Workspace_Free> 4000eef8: 90 10 00 1d mov %i5, %o0 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { 4000eefc: c2 07 20 e4 ld [ %i4 + 0xe4 ], %g1 4000ef00: 80 a0 40 1b cmp %g1, %i3 4000ef04: 12 bf ff f0 bne 4000eec4 <_POSIX_Threads_cancel_run+0x20> <== NEVER TAKEN 4000ef08: 01 00 00 00 nop 4000ef0c: 81 c7 e0 08 ret 4000ef10: 81 e8 00 00 restore =============================================================================== 4000714c <_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) { 4000714c: 9d e3 bf 98 save %sp, -104, %sp bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 40007150: c4 06 60 68 ld [ %i1 + 0x68 ], %g2 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 40007154: 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; 40007158: 84 00 a0 01 inc %g2 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 4000715c: 80 a0 60 00 cmp %g1, 0 40007160: 12 80 00 0e bne 40007198 <_POSIX_Timer_TSR+0x4c> 40007164: c4 26 60 68 st %g2, [ %i1 + 0x68 ] 40007168: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 4000716c: 80 a0 60 00 cmp %g1, 0 40007170: 32 80 00 0b bne,a 4000719c <_POSIX_Timer_TSR+0x50> <== ALWAYS TAKEN 40007174: 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; 40007178: 82 10 20 04 mov 4, %g1 <== NOT EXECUTED 4000717c: 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 ) ) { 40007180: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 40007184: 40 00 18 1c call 4000d1f4 40007188: 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; 4000718c: c0 26 60 68 clr [ %i1 + 0x68 ] 40007190: 81 c7 e0 08 ret 40007194: 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( 40007198: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 4000719c: d4 06 60 08 ld [ %i1 + 8 ], %o2 400071a0: 90 06 60 10 add %i1, 0x10, %o0 400071a4: 98 10 00 19 mov %i1, %o4 400071a8: 17 10 00 1c sethi %hi(0x40007000), %o3 400071ac: 40 00 19 39 call 4000d690 <_POSIX_Timer_Insert_helper> 400071b0: 96 12 e1 4c or %o3, 0x14c, %o3 ! 4000714c <_POSIX_Timer_TSR> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 400071b4: 80 8a 20 ff btst 0xff, %o0 400071b8: 02 bf ff f6 be 40007190 <_POSIX_Timer_TSR+0x44> <== NEVER TAKEN 400071bc: 90 07 bf f8 add %fp, -8, %o0 400071c0: 13 10 00 7e sethi %hi(0x4001f800), %o1 400071c4: 40 00 06 3b call 40008ab0 <_TOD_Get_with_nanoseconds> 400071c8: 92 12 61 58 or %o1, 0x158, %o1 ! 4001f958 <_TOD> /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; } 400071cc: f8 1a 00 00 ldd [ %o0 ], %i4 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 400071d0: 94 10 20 00 clr %o2 400071d4: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 400071d8: 90 10 00 1c mov %i4, %o0 400071dc: 96 12 e2 00 or %o3, 0x200, %o3 400071e0: 40 00 4a 34 call 40019ab0 <__divdi3> 400071e4: 92 10 00 1d mov %i5, %o1 _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 400071e8: 94 10 20 00 clr %o2 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 400071ec: d2 26 60 6c st %o1, [ %i1 + 0x6c ] _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 400071f0: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 400071f4: 90 10 00 1c mov %i4, %o0 400071f8: 96 12 e2 00 or %o3, 0x200, %o3 400071fc: 40 00 4b 18 call 40019e5c <__moddi3> 40007200: 92 10 00 1d mov %i5, %o1 /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40007204: 82 10 20 03 mov 3, %g1 40007208: d2 26 60 70 st %o1, [ %i1 + 0x70 ] 4000720c: 10 bf ff dd b 40007180 <_POSIX_Timer_TSR+0x34> 40007210: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] =============================================================================== 4000efd8 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 4000efd8: 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, 4000efdc: 98 10 20 01 mov 1, %o4 4000efe0: 90 10 00 18 mov %i0, %o0 4000efe4: 92 10 00 19 mov %i1, %o1 4000efe8: 94 07 bf cc add %fp, -52, %o2 4000efec: 40 00 00 2e call 4000f0a4 <_POSIX_signals_Clear_signals> 4000eff0: 96 10 00 1a mov %i2, %o3 4000eff4: 80 8a 20 ff btst 0xff, %o0 4000eff8: 02 80 00 23 be 4000f084 <_POSIX_signals_Check_signal+0xac> 4000effc: 82 10 20 00 clr %g1 #endif /* * Just to prevent sending a signal which is currently being ignored. */ if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN ) 4000f000: 85 2e 60 02 sll %i1, 2, %g2 4000f004: 37 10 00 7d sethi %hi(0x4001f400), %i3 4000f008: b9 2e 60 04 sll %i1, 4, %i4 4000f00c: b6 16 e0 30 or %i3, 0x30, %i3 4000f010: b8 27 00 02 sub %i4, %g2, %i4 4000f014: 84 06 c0 1c add %i3, %i4, %g2 4000f018: fa 00 a0 08 ld [ %g2 + 8 ], %i5 4000f01c: 80 a7 60 01 cmp %i5, 1 4000f020: 02 80 00 19 be 4000f084 <_POSIX_signals_Check_signal+0xac><== NEVER TAKEN 4000f024: 21 10 00 7c sethi %hi(0x4001f000), %l0 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 4000f028: f4 06 20 d0 ld [ %i0 + 0xd0 ], %i2 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000f02c: c2 00 a0 04 ld [ %g2 + 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, 4000f030: a0 14 23 d0 or %l0, 0x3d0, %l0 4000f034: d2 04 20 10 ld [ %l0 + 0x10 ], %o1 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000f038: 82 10 40 1a or %g1, %i2, %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, 4000f03c: 90 07 bf d8 add %fp, -40, %o0 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 4000f040: c2 26 20 d0 st %g1, [ %i0 + 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, 4000f044: 92 02 60 20 add %o1, 0x20, %o1 4000f048: 40 00 04 0f call 40010084 4000f04c: 94 10 20 28 mov 0x28, %o2 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 4000f050: c2 06 c0 1c ld [ %i3 + %i4 ], %g1 4000f054: 80 a0 60 02 cmp %g1, 2 4000f058: 02 80 00 0e be 4000f090 <_POSIX_signals_Check_signal+0xb8> 4000f05c: 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 ); 4000f060: 9f c7 40 00 call %i5 4000f064: 01 00 00 00 nop } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 4000f068: d0 04 20 10 ld [ %l0 + 0x10 ], %o0 4000f06c: 92 07 bf d8 add %fp, -40, %o1 4000f070: 90 02 20 20 add %o0, 0x20, %o0 4000f074: 40 00 04 04 call 40010084 4000f078: 94 10 20 28 mov 0x28, %o2 /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; return true; 4000f07c: 82 10 20 01 mov 1, %g1 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 4000f080: f4 26 20 d0 st %i2, [ %i0 + 0xd0 ] return true; } 4000f084: b0 08 60 01 and %g1, 1, %i0 4000f088: 81 c7 e0 08 ret 4000f08c: 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)( 4000f090: 92 07 bf cc add %fp, -52, %o1 4000f094: 9f c7 40 00 call %i5 4000f098: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 4000f09c: 10 bf ff f4 b 4000f06c <_POSIX_signals_Check_signal+0x94> 4000f0a0: d0 04 20 10 ld [ %l0 + 0x10 ], %o0 =============================================================================== 4000f698 <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 4000f698: 9d e3 bf a0 save %sp, -96, %sp 4000f69c: 84 10 20 01 mov 1, %g2 4000f6a0: 82 06 3f ff add %i0, -1, %g1 clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 4000f6a4: 7f ff ca 80 call 400020a4 4000f6a8: bb 28 80 01 sll %g2, %g1, %i5 if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 4000f6ac: 05 10 00 7d sethi %hi(0x4001f400), %g2 4000f6b0: 83 2e 20 02 sll %i0, 2, %g1 4000f6b4: 84 10 a0 30 or %g2, 0x30, %g2 4000f6b8: b1 2e 20 04 sll %i0, 4, %i0 4000f6bc: 82 26 00 01 sub %i0, %g1, %g1 4000f6c0: c4 00 80 01 ld [ %g2 + %g1 ], %g2 4000f6c4: 80 a0 a0 02 cmp %g2, 2 4000f6c8: 02 80 00 08 be 4000f6e8 <_POSIX_signals_Clear_process_signals+0x50> 4000f6cc: 31 10 00 7d sethi %hi(0x4001f400), %i0 if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 4000f6d0: 03 10 00 7d sethi %hi(0x4001f400), %g1 4000f6d4: c4 00 62 24 ld [ %g1 + 0x224 ], %g2 ! 4001f624 <_POSIX_signals_Pending> 4000f6d8: ba 28 80 1d andn %g2, %i5, %i5 4000f6dc: fa 20 62 24 st %i5, [ %g1 + 0x224 ] } _ISR_Enable( level ); 4000f6e0: 7f ff ca 75 call 400020b4 4000f6e4: 91 e8 00 08 restore %g0, %o0, %o0 ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 4000f6e8: b0 16 22 28 or %i0, 0x228, %i0 4000f6ec: c4 00 40 18 ld [ %g1 + %i0 ], %g2 4000f6f0: b0 00 40 18 add %g1, %i0, %i0 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000f6f4: b0 06 20 04 add %i0, 4, %i0 4000f6f8: 80 a0 80 18 cmp %g2, %i0 4000f6fc: 02 bf ff f6 be 4000f6d4 <_POSIX_signals_Clear_process_signals+0x3c><== ALWAYS TAKEN 4000f700: 03 10 00 7d sethi %hi(0x4001f400), %g1 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); 4000f704: 7f ff ca 6c call 400020b4 <== NOT EXECUTED 4000f708: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED =============================================================================== 40007cc0 <_POSIX_signals_Get_lowest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40007cc0: 82 10 20 1b mov 0x1b, %g1 40007cc4: 86 10 20 01 mov 1, %g3 #include #include #include #include static int _POSIX_signals_Get_lowest( 40007cc8: 84 00 7f ff add %g1, -1, %g2 40007ccc: 85 28 c0 02 sll %g3, %g2, %g2 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 40007cd0: 80 88 80 08 btst %g2, %o0 40007cd4: 12 80 00 11 bne 40007d18 <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 40007cd8: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 40007cdc: 82 00 60 01 inc %g1 40007ce0: 80 a0 60 20 cmp %g1, 0x20 40007ce4: 12 bf ff fa bne 40007ccc <_POSIX_signals_Get_lowest+0xc> 40007ce8: 84 00 7f ff add %g1, -1, %g2 40007cec: 82 10 20 01 mov 1, %g1 40007cf0: 10 80 00 05 b 40007d04 <_POSIX_signals_Get_lowest+0x44> 40007cf4: 86 10 20 01 mov 1, %g3 */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 40007cf8: 80 a0 60 1b cmp %g1, 0x1b 40007cfc: 02 80 00 07 be 40007d18 <_POSIX_signals_Get_lowest+0x58> <== NEVER TAKEN 40007d00: 01 00 00 00 nop #include #include #include #include static int _POSIX_signals_Get_lowest( 40007d04: 84 00 7f ff add %g1, -1, %g2 40007d08: 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 ) ) { 40007d0c: 80 88 80 08 btst %g2, %o0 40007d10: 22 bf ff fa be,a 40007cf8 <_POSIX_signals_Get_lowest+0x38> 40007d14: 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; } 40007d18: 81 c3 e0 08 retl 40007d1c: 90 10 00 01 mov %g1, %o0 =============================================================================== 4000c81c <_POSIX_signals_Post_switch_hook>: */ static void _POSIX_signals_Post_switch_hook( Thread_Control *the_thread ) { 4000c81c: 9d e3 bf a0 save %sp, -96, %sp /* * We need to ensure that if the signal handler executes a call * which overwrites the unblocking status, we restore it. */ hold_errno = _Thread_Executing->Wait.return_code; 4000c820: 35 10 00 7c sethi %hi(0x4001f000), %i2 POSIX_API_Control *api; int signo; ISR_Level level; int hold_errno; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4000c824: f8 06 21 50 ld [ %i0 + 0x150 ], %i4 /* * We need to ensure that if the signal handler executes a call * which overwrites the unblocking status, we restore it. */ hold_errno = _Thread_Executing->Wait.return_code; 4000c828: b4 16 a3 d0 or %i2, 0x3d0, %i2 4000c82c: c2 06 a0 10 ld [ %i2 + 0x10 ], %g1 /* * api may be NULL in case of a thread close in progress */ if ( !api ) 4000c830: 80 a7 20 00 cmp %i4, 0 4000c834: 02 80 00 34 be 4000c904 <_POSIX_signals_Post_switch_hook+0xe8><== NEVER TAKEN 4000c838: f2 00 60 34 ld [ %g1 + 0x34 ], %i1 * * 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 ); 4000c83c: 7f ff d6 1a call 400020a4 4000c840: 37 10 00 7d sethi %hi(0x4001f400), %i3 4000c844: b6 16 e2 24 or %i3, 0x224, %i3 ! 4001f624 <_POSIX_signals_Pending> if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { 4000c848: c6 06 c0 00 ld [ %i3 ], %g3 4000c84c: c2 07 20 d4 ld [ %i4 + 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 & 4000c850: c4 07 20 d0 ld [ %i4 + 0xd0 ], %g2 (api->signals_pending | _POSIX_signals_Pending)) ) { 4000c854: 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 & 4000c858: 80 a8 40 02 andncc %g1, %g2, %g0 4000c85c: 02 80 00 26 be 4000c8f4 <_POSIX_signals_Post_switch_hook+0xd8> 4000c860: 01 00 00 00 nop (api->signals_pending | _POSIX_signals_Pending)) ) { _ISR_Enable( level ); break; } _ISR_Enable( level ); 4000c864: 7f ff d6 14 call 400020b4 4000c868: ba 10 20 1b mov 0x1b, %i5 ! 1b for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); 4000c86c: 92 10 00 1d mov %i5, %o1 4000c870: 94 10 20 00 clr %o2 4000c874: 40 00 09 d9 call 4000efd8 <_POSIX_signals_Check_signal> 4000c878: 90 10 00 1c mov %i4, %o0 _POSIX_signals_Check_signal( api, signo, true ); 4000c87c: 92 10 00 1d mov %i5, %o1 4000c880: 90 10 00 1c mov %i4, %o0 4000c884: 40 00 09 d5 call 4000efd8 <_POSIX_signals_Check_signal> 4000c888: 94 10 20 01 mov 1, %o2 _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 4000c88c: ba 07 60 01 inc %i5 4000c890: 80 a7 60 20 cmp %i5, 0x20 4000c894: 12 bf ff f7 bne 4000c870 <_POSIX_signals_Post_switch_hook+0x54> 4000c898: 92 10 00 1d mov %i5, %o1 4000c89c: ba 10 20 01 mov 1, %i5 _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 ); 4000c8a0: 92 10 00 1d mov %i5, %o1 4000c8a4: 94 10 20 00 clr %o2 4000c8a8: 40 00 09 cc call 4000efd8 <_POSIX_signals_Check_signal> 4000c8ac: 90 10 00 1c mov %i4, %o0 _POSIX_signals_Check_signal( api, signo, true ); 4000c8b0: 92 10 00 1d mov %i5, %o1 4000c8b4: 90 10 00 1c mov %i4, %o0 4000c8b8: 40 00 09 c8 call 4000efd8 <_POSIX_signals_Check_signal> 4000c8bc: 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++ ) { 4000c8c0: ba 07 60 01 inc %i5 4000c8c4: 80 a7 60 1b cmp %i5, 0x1b 4000c8c8: 12 bf ff f7 bne 4000c8a4 <_POSIX_signals_Post_switch_hook+0x88> 4000c8cc: 92 10 00 1d mov %i5, %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 ); 4000c8d0: 7f ff d5 f5 call 400020a4 4000c8d4: 01 00 00 00 nop if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { 4000c8d8: c6 06 c0 00 ld [ %i3 ], %g3 4000c8dc: c2 07 20 d4 ld [ %i4 + 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 & 4000c8e0: c4 07 20 d0 ld [ %i4 + 0xd0 ], %g2 (api->signals_pending | _POSIX_signals_Pending)) ) { 4000c8e4: 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 & 4000c8e8: 80 a8 40 02 andncc %g1, %g2, %g0 4000c8ec: 12 bf ff de bne 4000c864 <_POSIX_signals_Post_switch_hook+0x48><== NEVER TAKEN 4000c8f0: 01 00 00 00 nop (api->signals_pending | _POSIX_signals_Pending)) ) { _ISR_Enable( level ); 4000c8f4: 7f ff d5 f0 call 400020b4 4000c8f8: 01 00 00 00 nop _POSIX_signals_Check_signal( api, signo, false ); _POSIX_signals_Check_signal( api, signo, true ); } } _Thread_Executing->Wait.return_code = hold_errno; 4000c8fc: c2 06 a0 10 ld [ %i2 + 0x10 ], %g1 4000c900: f2 20 60 34 st %i1, [ %g1 + 0x34 ] 4000c904: 81 c7 e0 08 ret 4000c908: 81 e8 00 00 restore =============================================================================== 4001bcf8 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 4001bcf8: 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 ) ) { 4001bcfc: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 4001bd00: 05 04 00 20 sethi %hi(0x10008000), %g2 4001bd04: 88 10 20 01 mov 1, %g4 4001bd08: 86 06 7f ff add %i1, -1, %g3 4001bd0c: ba 08 40 02 and %g1, %g2, %i5 { POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 4001bd10: f8 06 21 50 ld [ %i0 + 0x150 ], %i4 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 4001bd14: 80 a7 40 02 cmp %i5, %g2 4001bd18: 02 80 00 2c be 4001bdc8 <_POSIX_signals_Unblock_thread+0xd0> 4001bd1c: 87 29 00 03 sll %g4, %g3, %g3 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 4001bd20: c4 07 20 d0 ld [ %i4 + 0xd0 ], %g2 4001bd24: 80 a8 c0 02 andncc %g3, %g2, %g0 4001bd28: 02 80 00 24 be 4001bdb8 <_POSIX_signals_Unblock_thread+0xc0> 4001bd2c: 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 ) ) { 4001bd30: 80 88 40 02 btst %g1, %g2 4001bd34: 02 80 00 15 be 4001bd88 <_POSIX_signals_Unblock_thread+0x90> 4001bd38: 80 a0 60 00 cmp %g1, 0 the_thread->Wait.return_code = EINTR; 4001bd3c: 84 10 20 04 mov 4, %g2 4001bd40: c4 26 20 34 st %g2, [ %i0 + 0x34 ] */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 4001bd44: 05 00 00 ef sethi %hi(0x3bc00), %g2 4001bd48: 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) ) 4001bd4c: 80 88 40 02 btst %g1, %g2 4001bd50: 12 80 00 38 bne 4001be30 <_POSIX_signals_Unblock_thread+0x138> 4001bd54: 80 88 60 08 btst 8, %g1 _Thread_queue_Extract_with_proxy( the_thread ); else if ( _States_Is_delaying(the_thread->current_state) ) { 4001bd58: 22 80 00 19 be,a 4001bdbc <_POSIX_signals_Unblock_thread+0xc4><== NEVER TAKEN 4001bd5c: b0 10 20 00 clr %i0 <== NOT EXECUTED (void) _Watchdog_Remove( &the_thread->Timer ); 4001bd60: 7f ff bb f5 call 4000ad34 <_Watchdog_Remove> 4001bd64: 90 06 20 48 add %i0, 0x48, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 4001bd68: 90 10 00 18 mov %i0, %o0 4001bd6c: 13 04 01 ff sethi %hi(0x1007fc00), %o1 } else if ( the_thread->current_state == STATES_READY ) { if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; 4001bd70: b0 10 20 00 clr %i0 4001bd74: 7f ff b7 68 call 40009b14 <_Thread_Clear_state> 4001bd78: 92 12 63 f8 or %o1, 0x3f8, %o1 4001bd7c: b0 0e 20 01 and %i0, 1, %i0 4001bd80: 81 c7 e0 08 ret 4001bd84: 81 e8 00 00 restore else if ( _States_Is_delaying(the_thread->current_state) ) { (void) _Watchdog_Remove( &the_thread->Timer ); _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 4001bd88: 32 80 00 0d bne,a 4001bdbc <_POSIX_signals_Unblock_thread+0xc4><== NEVER TAKEN 4001bd8c: b0 10 20 00 clr %i0 <== NOT EXECUTED if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 4001bd90: 03 10 00 7c sethi %hi(0x4001f000), %g1 4001bd94: 82 10 63 d0 or %g1, 0x3d0, %g1 ! 4001f3d0 <_Per_CPU_Information> 4001bd98: c4 00 60 08 ld [ %g1 + 8 ], %g2 4001bd9c: 80 a0 a0 00 cmp %g2, 0 4001bda0: 22 80 00 07 be,a 4001bdbc <_POSIX_signals_Unblock_thread+0xc4> 4001bda4: b0 10 20 00 clr %i0 4001bda8: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4001bdac: 80 a6 00 02 cmp %i0, %g2 4001bdb0: 22 80 00 02 be,a 4001bdb8 <_POSIX_signals_Unblock_thread+0xc0><== ALWAYS TAKEN 4001bdb4: c8 28 60 0c stb %g4, [ %g1 + 0xc ] _Thread_Dispatch_necessary = true; } } return false; 4001bdb8: b0 10 20 00 clr %i0 } 4001bdbc: b0 0e 20 01 and %i0, 1, %i0 4001bdc0: 81 c7 e0 08 ret 4001bdc4: 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) ) { 4001bdc8: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 4001bdcc: 80 88 c0 01 btst %g3, %g1 4001bdd0: 22 80 00 13 be,a 4001be1c <_POSIX_signals_Unblock_thread+0x124> 4001bdd4: c2 07 20 d0 ld [ %i4 + 0xd0 ], %g1 the_thread->Wait.return_code = EINTR; 4001bdd8: 82 10 20 04 mov 4, %g1 4001bddc: c2 26 20 34 st %g1, [ %i0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 4001bde0: 80 a6 a0 00 cmp %i2, 0 4001bde4: 02 80 00 19 be 4001be48 <_POSIX_signals_Unblock_thread+0x150> 4001bde8: c2 06 20 28 ld [ %i0 + 0x28 ], %g1 the_info->si_signo = signo; the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; } else { *the_info = *info; 4001bdec: c4 06 80 00 ld [ %i2 ], %g2 4001bdf0: c4 20 40 00 st %g2, [ %g1 ] 4001bdf4: c4 06 a0 04 ld [ %i2 + 4 ], %g2 4001bdf8: c4 20 60 04 st %g2, [ %g1 + 4 ] 4001bdfc: c4 06 a0 08 ld [ %i2 + 8 ], %g2 4001be00: c4 20 60 08 st %g2, [ %g1 + 8 ] } _Thread_queue_Extract_with_proxy( the_thread ); 4001be04: 90 10 00 18 mov %i0, %o0 4001be08: 7f ff ba 19 call 4000a66c <_Thread_queue_Extract_with_proxy> 4001be0c: b0 10 20 01 mov 1, %i0 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } 4001be10: b0 0e 20 01 and %i0, 1, %i0 4001be14: 81 c7 e0 08 ret 4001be18: 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) ) { 4001be1c: 80 a8 c0 01 andncc %g3, %g1, %g0 4001be20: 32 bf ff ef bne,a 4001bddc <_POSIX_signals_Unblock_thread+0xe4> 4001be24: 82 10 20 04 mov 4, %g1 } else if ( the_thread->current_state == STATES_READY ) { if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; 4001be28: 10 bf ff e5 b 4001bdbc <_POSIX_signals_Unblock_thread+0xc4> 4001be2c: b0 10 20 00 clr %i0 /* * 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 ); 4001be30: 90 10 00 18 mov %i0, %o0 4001be34: 7f ff ba 0e call 4000a66c <_Thread_queue_Extract_with_proxy> 4001be38: b0 10 20 00 clr %i0 4001be3c: b0 0e 20 01 and %i0, 1, %i0 4001be40: 81 c7 e0 08 ret 4001be44: 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; 4001be48: 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; 4001be4c: f2 20 40 00 st %i1, [ %g1 ] the_info->si_code = SI_USER; 4001be50: c4 20 60 04 st %g2, [ %g1 + 4 ] the_info->si_value.sival_int = 0; 4001be54: 10 bf ff ec b 4001be04 <_POSIX_signals_Unblock_thread+0x10c> 4001be58: c0 20 60 08 clr [ %g1 + 8 ] =============================================================================== 40009df4 <_RBTree_Extract_unprotected>: */ void _RBTree_Extract_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { 40009df4: 9d e3 bf a0 save %sp, -96, %sp RBTree_Node *leaf, *target; RBTree_Color victim_color; RBTree_Direction dir; if (!the_node) return; 40009df8: 80 a6 60 00 cmp %i1, 0 40009dfc: 02 80 00 4c be 40009f2c <_RBTree_Extract_unprotected+0x138> 40009e00: 01 00 00 00 nop /* check if min needs to be updated */ if (the_node == the_rbtree->first[RBT_LEFT]) { 40009e04: c2 06 20 08 ld [ %i0 + 8 ], %g1 40009e08: 80 a0 40 19 cmp %g1, %i1 40009e0c: 02 80 00 56 be 40009f64 <_RBTree_Extract_unprotected+0x170> 40009e10: 90 10 00 19 mov %i1, %o0 the_rbtree->first[RBT_LEFT] = next; } /* Check if max needs to be updated. min=max for 1 element trees so * do not use else if here. */ if (the_node == the_rbtree->first[RBT_RIGHT]) { 40009e14: c2 06 20 0c ld [ %i0 + 0xc ], %g1 40009e18: 80 a0 40 19 cmp %g1, %i1 40009e1c: 02 80 00 56 be 40009f74 <_RBTree_Extract_unprotected+0x180> 40009e20: 90 10 00 19 mov %i1, %o0 * either max in node->child[RBT_LEFT] or min in node->child[RBT_RIGHT], * and replace the_node with the target node. This maintains the binary * search tree property, but may violate the red-black properties. */ if (the_node->child[RBT_LEFT] && the_node->child[RBT_RIGHT]) { 40009e24: fa 06 60 04 ld [ %i1 + 4 ], %i5 40009e28: 80 a7 60 00 cmp %i5, 0 40009e2c: 22 80 00 5a be,a 40009f94 <_RBTree_Extract_unprotected+0x1a0> 40009e30: f8 06 60 08 ld [ %i1 + 8 ], %i4 40009e34: c2 06 60 08 ld [ %i1 + 8 ], %g1 40009e38: 80 a0 60 00 cmp %g1, 0 40009e3c: 32 80 00 05 bne,a 40009e50 <_RBTree_Extract_unprotected+0x5c> 40009e40: c2 07 60 08 ld [ %i5 + 8 ], %g1 40009e44: 10 80 00 3c b 40009f34 <_RBTree_Extract_unprotected+0x140> 40009e48: b8 10 00 1d mov %i5, %i4 target = the_node->child[RBT_LEFT]; /* find max in node->child[RBT_LEFT] */ while (target->child[RBT_RIGHT]) target = target->child[RBT_RIGHT]; 40009e4c: c2 07 60 08 ld [ %i5 + 8 ], %g1 40009e50: 80 a0 60 00 cmp %g1, 0 40009e54: 32 bf ff fe bne,a 40009e4c <_RBTree_Extract_unprotected+0x58> 40009e58: ba 10 00 01 mov %g1, %i5 * target's position (target is the right child of target->parent) * when target vacates it. if there is no child, then target->parent * should become NULL. This may cause the coloring to be violated. * For now we store the color of the node being deleted in victim_color. */ leaf = target->child[RBT_LEFT]; 40009e5c: f8 07 60 04 ld [ %i5 + 4 ], %i4 if(leaf) { 40009e60: 80 a7 20 00 cmp %i4, 0 40009e64: 02 80 00 48 be 40009f84 <_RBTree_Extract_unprotected+0x190> 40009e68: 01 00 00 00 nop leaf->parent = target->parent; 40009e6c: c2 07 40 00 ld [ %i5 ], %g1 40009e70: c2 27 00 00 st %g1, [ %i4 ] } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); } victim_color = target->color; dir = target != target->parent->child[0]; 40009e74: c4 07 40 00 ld [ %i5 ], %g2 target->parent->child[dir] = leaf; /* now replace the_node with target */ dir = the_node != the_node->parent->child[0]; 40009e78: c2 06 40 00 ld [ %i1 ], %g1 } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); } victim_color = target->color; dir = target != target->parent->child[0]; 40009e7c: c8 00 a0 04 ld [ %g2 + 4 ], %g4 leaf->parent = target->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); } victim_color = target->color; 40009e80: c6 07 60 0c ld [ %i5 + 0xc ], %g3 dir = target != target->parent->child[0]; 40009e84: 88 1f 40 04 xor %i5, %g4, %g4 40009e88: 80 a0 00 04 cmp %g0, %g4 40009e8c: 88 40 20 00 addx %g0, 0, %g4 target->parent->child[dir] = leaf; 40009e90: 89 29 20 02 sll %g4, 2, %g4 40009e94: 84 00 80 04 add %g2, %g4, %g2 40009e98: f8 20 a0 04 st %i4, [ %g2 + 4 ] /* now replace the_node with target */ dir = the_node != the_node->parent->child[0]; 40009e9c: c4 00 60 04 ld [ %g1 + 4 ], %g2 40009ea0: 84 18 80 19 xor %g2, %i1, %g2 40009ea4: 80 a0 00 02 cmp %g0, %g2 40009ea8: 84 40 20 00 addx %g0, 0, %g2 the_node->parent->child[dir] = target; 40009eac: 85 28 a0 02 sll %g2, 2, %g2 40009eb0: 82 00 40 02 add %g1, %g2, %g1 40009eb4: fa 20 60 04 st %i5, [ %g1 + 4 ] /* set target's new children to the original node's children */ target->child[RBT_RIGHT] = the_node->child[RBT_RIGHT]; 40009eb8: c2 06 60 08 ld [ %i1 + 8 ], %g1 40009ebc: c2 27 60 08 st %g1, [ %i5 + 8 ] if (the_node->child[RBT_RIGHT]) 40009ec0: c2 06 60 08 ld [ %i1 + 8 ], %g1 40009ec4: 80 a0 60 00 cmp %g1, 0 40009ec8: 32 80 00 02 bne,a 40009ed0 <_RBTree_Extract_unprotected+0xdc><== ALWAYS TAKEN 40009ecc: fa 20 40 00 st %i5, [ %g1 ] the_node->child[RBT_RIGHT]->parent = target; target->child[RBT_LEFT] = the_node->child[RBT_LEFT]; 40009ed0: c2 06 60 04 ld [ %i1 + 4 ], %g1 40009ed4: c2 27 60 04 st %g1, [ %i5 + 4 ] if (the_node->child[RBT_LEFT]) 40009ed8: c2 06 60 04 ld [ %i1 + 4 ], %g1 40009edc: 80 a0 60 00 cmp %g1, 0 40009ee0: 32 80 00 02 bne,a 40009ee8 <_RBTree_Extract_unprotected+0xf4> 40009ee4: fa 20 40 00 st %i5, [ %g1 ] /* finally, update the parent node and recolor. target has completely * replaced the_node, and target's child has moved up the tree if needed. * the_node is no longer part of the tree, although it has valid pointers * still. */ target->parent = the_node->parent; 40009ee8: c4 06 40 00 ld [ %i1 ], %g2 target->color = the_node->color; 40009eec: c2 06 60 0c ld [ %i1 + 0xc ], %g1 /* finally, update the parent node and recolor. target has completely * replaced the_node, and target's child has moved up the tree if needed. * the_node is no longer part of the tree, although it has valid pointers * still. */ target->parent = the_node->parent; 40009ef0: c4 27 40 00 st %g2, [ %i5 ] target->color = the_node->color; 40009ef4: c2 27 60 0c st %g1, [ %i5 + 0xc ] /* fix coloring. leaf has moved up the tree. The color of the deleted * node is in victim_color. There are two cases: * 1. Deleted a red node, its child must be black. Nothing must be done. * 2. Deleted a black node, its child must be red. Paint child black. */ if (victim_color == RBT_BLACK) { /* eliminate case 1 */ 40009ef8: 80 a0 e0 00 cmp %g3, 0 40009efc: 32 80 00 06 bne,a 40009f14 <_RBTree_Extract_unprotected+0x120> 40009f00: c2 06 20 04 ld [ %i0 + 4 ], %g1 if (leaf) { 40009f04: 80 a7 20 00 cmp %i4, 0 40009f08: 32 80 00 02 bne,a 40009f10 <_RBTree_Extract_unprotected+0x11c> 40009f0c: c0 27 20 0c clr [ %i4 + 0xc ] /* Wipe the_node */ _RBTree_Set_off_rbtree(the_node); /* set root to black, if it exists */ if (the_rbtree->root) the_rbtree->root->color = RBT_BLACK; 40009f10: c2 06 20 04 ld [ %i0 + 4 ], %g1 */ RTEMS_INLINE_ROUTINE void _RBTree_Set_off_rbtree( RBTree_Node *node ) { node->parent = node->child[RBT_LEFT] = node->child[RBT_RIGHT] = NULL; 40009f14: c0 26 60 08 clr [ %i1 + 8 ] 40009f18: c0 26 60 04 clr [ %i1 + 4 ] 40009f1c: 80 a0 60 00 cmp %g1, 0 40009f20: 02 80 00 03 be 40009f2c <_RBTree_Extract_unprotected+0x138> 40009f24: c0 26 40 00 clr [ %i1 ] 40009f28: c0 20 60 0c clr [ %g1 + 0xc ] 40009f2c: 81 c7 e0 08 ret 40009f30: 81 e8 00 00 restore * For now we store the color of the node being deleted in victim_color. */ leaf = the_node->child[RBT_LEFT] ? the_node->child[RBT_LEFT] : the_node->child[RBT_RIGHT]; if( leaf ) { leaf->parent = the_node->parent; 40009f34: c2 06 40 00 ld [ %i1 ], %g1 40009f38: c2 27 00 00 st %g1, [ %i4 ] _RBTree_Extract_validate_unprotected(the_node); } victim_color = the_node->color; /* remove the_node from the tree */ dir = the_node != the_node->parent->child[0]; 40009f3c: c2 06 40 00 ld [ %i1 ], %g1 leaf->parent = the_node->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(the_node); } victim_color = the_node->color; 40009f40: c6 06 60 0c ld [ %i1 + 0xc ], %g3 /* remove the_node from the tree */ dir = the_node != the_node->parent->child[0]; 40009f44: c4 00 60 04 ld [ %g1 + 4 ], %g2 40009f48: 84 18 80 19 xor %g2, %i1, %g2 40009f4c: 80 a0 00 02 cmp %g0, %g2 40009f50: 84 40 20 00 addx %g0, 0, %g2 the_node->parent->child[dir] = leaf; 40009f54: 85 28 a0 02 sll %g2, 2, %g2 40009f58: 82 00 40 02 add %g1, %g2, %g1 40009f5c: 10 bf ff e7 b 40009ef8 <_RBTree_Extract_unprotected+0x104> 40009f60: f8 20 60 04 st %i4, [ %g1 + 4 ] */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Successor_unprotected( const RBTree_Node *node ) { return _RBTree_Next_unprotected( node, RBT_RIGHT ); 40009f64: 40 00 00 eb call 4000a310 <_RBTree_Next_unprotected> 40009f68: 92 10 20 01 mov 1, %o1 /* check if min needs to be updated */ if (the_node == the_rbtree->first[RBT_LEFT]) { RBTree_Node *next; next = _RBTree_Successor_unprotected(the_node); the_rbtree->first[RBT_LEFT] = next; 40009f6c: 10 bf ff aa b 40009e14 <_RBTree_Extract_unprotected+0x20> 40009f70: d0 26 20 08 st %o0, [ %i0 + 8 ] */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Predecessor_unprotected( const RBTree_Node *node ) { return _RBTree_Next_unprotected( node, RBT_LEFT ); 40009f74: 40 00 00 e7 call 4000a310 <_RBTree_Next_unprotected> 40009f78: 92 10 20 00 clr %o1 /* Check if max needs to be updated. min=max for 1 element trees so * do not use else if here. */ if (the_node == the_rbtree->first[RBT_RIGHT]) { RBTree_Node *previous; previous = _RBTree_Predecessor_unprotected(the_node); the_rbtree->first[RBT_RIGHT] = previous; 40009f7c: 10 bf ff aa b 40009e24 <_RBTree_Extract_unprotected+0x30> 40009f80: d0 26 20 0c st %o0, [ %i0 + 0xc ] leaf = target->child[RBT_LEFT]; if(leaf) { leaf->parent = target->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); 40009f84: 7f ff fe d3 call 40009ad0 <_RBTree_Extract_validate_unprotected> 40009f88: 90 10 00 1d mov %i5, %o0 } victim_color = target->color; dir = target != target->parent->child[0]; 40009f8c: 10 bf ff bb b 40009e78 <_RBTree_Extract_unprotected+0x84> 40009f90: c4 07 40 00 ld [ %i5 ], %g2 * violated. We will fix it later. * For now we store the color of the node being deleted in victim_color. */ leaf = the_node->child[RBT_LEFT] ? the_node->child[RBT_LEFT] : the_node->child[RBT_RIGHT]; if( leaf ) { 40009f94: 80 a7 20 00 cmp %i4, 0 40009f98: 32 bf ff e8 bne,a 40009f38 <_RBTree_Extract_unprotected+0x144> 40009f9c: c2 06 40 00 ld [ %i1 ], %g1 leaf->parent = the_node->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(the_node); 40009fa0: 7f ff fe cc call 40009ad0 <_RBTree_Extract_validate_unprotected> 40009fa4: 90 10 00 19 mov %i1, %o0 } victim_color = the_node->color; /* remove the_node from the tree */ dir = the_node != the_node->parent->child[0]; 40009fa8: 10 bf ff e6 b 40009f40 <_RBTree_Extract_unprotected+0x14c> 40009fac: c2 06 40 00 ld [ %i1 ], %g1 =============================================================================== 40009ad0 <_RBTree_Extract_validate_unprotected>: ) { RBTree_Node *parent, *sibling; RBTree_Direction dir; parent = the_node->parent; 40009ad0: c2 02 00 00 ld [ %o0 ], %g1 if(!parent->parent) return; 40009ad4: c4 00 40 00 ld [ %g1 ], %g2 40009ad8: 80 a0 a0 00 cmp %g2, 0 40009adc: 02 80 00 3f be 40009bd8 <_RBTree_Extract_validate_unprotected+0x108> 40009ae0: 01 00 00 00 nop { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(the_node == the_node->parent->child[RBT_LEFT]) 40009ae4: c4 00 60 04 ld [ %g1 + 4 ], %g2 40009ae8: 80 a2 00 02 cmp %o0, %g2 40009aec: 22 80 00 02 be,a 40009af4 <_RBTree_Extract_validate_unprotected+0x24> 40009af0: c4 00 60 08 ld [ %g1 + 8 ], %g2 */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); 40009af4: c6 02 20 0c ld [ %o0 + 0xc ], %g3 40009af8: 80 a0 e0 01 cmp %g3, 1 40009afc: 02 80 00 32 be 40009bc4 <_RBTree_Extract_validate_unprotected+0xf4> 40009b00: 9a 10 20 01 mov 1, %o5 sibling = _RBTree_Sibling(the_node); /* continue to correct tree as long as the_node is black and not the root */ while (!_RBTree_Is_red(the_node) && parent->parent) { 40009b04: c6 00 40 00 ld [ %g1 ], %g3 40009b08: 80 a0 e0 00 cmp %g3, 0 40009b0c: 02 80 00 2e be 40009bc4 <_RBTree_Extract_validate_unprotected+0xf4> 40009b10: 80 a0 a0 00 cmp %g2, 0 40009b14: 22 80 00 07 be,a 40009b30 <_RBTree_Extract_validate_unprotected+0x60><== NEVER TAKEN 40009b18: c6 00 a0 08 ld [ %g2 + 8 ], %g3 <== NOT EXECUTED 40009b1c: c8 00 a0 0c ld [ %g2 + 0xc ], %g4 40009b20: 80 a1 20 01 cmp %g4, 1 40009b24: 22 80 00 63 be,a 40009cb0 <_RBTree_Extract_validate_unprotected+0x1e0> 40009b28: d8 00 60 04 ld [ %g1 + 4 ], %o4 _RBTree_Rotate(parent, dir); sibling = parent->child[_RBTree_Opposite_direction(dir)]; } /* sibling is black, see if both of its children are also black. */ if (!_RBTree_Is_red(sibling->child[RBT_RIGHT]) && 40009b2c: c6 00 a0 08 ld [ %g2 + 8 ], %g3 40009b30: 80 a0 e0 00 cmp %g3, 0 40009b34: 22 80 00 07 be,a 40009b50 <_RBTree_Extract_validate_unprotected+0x80> 40009b38: c6 00 a0 04 ld [ %g2 + 4 ], %g3 40009b3c: c6 00 e0 0c ld [ %g3 + 0xc ], %g3 40009b40: 80 a0 e0 01 cmp %g3, 1 40009b44: 22 80 00 29 be,a 40009be8 <_RBTree_Extract_validate_unprotected+0x118> 40009b48: c6 00 60 04 ld [ %g1 + 4 ], %g3 !_RBTree_Is_red(sibling->child[RBT_LEFT])) { 40009b4c: c6 00 a0 04 ld [ %g2 + 4 ], %g3 40009b50: 80 a0 e0 00 cmp %g3, 0 40009b54: 22 80 00 07 be,a 40009b70 <_RBTree_Extract_validate_unprotected+0xa0> 40009b58: da 20 a0 0c st %o5, [ %g2 + 0xc ] 40009b5c: c6 00 e0 0c ld [ %g3 + 0xc ], %g3 40009b60: 80 a0 e0 01 cmp %g3, 1 40009b64: 22 80 00 21 be,a 40009be8 <_RBTree_Extract_validate_unprotected+0x118> 40009b68: c6 00 60 04 ld [ %g1 + 4 ], %g3 sibling->color = RBT_RED; 40009b6c: da 20 a0 0c st %o5, [ %g2 + 0xc ] 40009b70: c4 00 60 0c ld [ %g1 + 0xc ], %g2 40009b74: 80 a0 a0 01 cmp %g2, 1 40009b78: 22 80 00 99 be,a 40009ddc <_RBTree_Extract_validate_unprotected+0x30c> 40009b7c: c0 20 60 0c clr [ %g1 + 0xc ] if (_RBTree_Is_red(parent)) { parent->color = RBT_BLACK; break; } the_node = parent; /* done if parent is red */ parent = the_node->parent; 40009b80: c6 00 40 00 ld [ %g1 ], %g3 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( const RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; 40009b84: 80 a0 e0 00 cmp %g3, 0 40009b88: 02 80 00 6c be 40009d38 <_RBTree_Extract_validate_unprotected+0x268><== NEVER TAKEN 40009b8c: 90 10 00 01 mov %g1, %o0 if(!(the_node->parent->parent)) return NULL; 40009b90: c4 00 c0 00 ld [ %g3 ], %g2 40009b94: 80 a0 a0 00 cmp %g2, 0 40009b98: 02 80 00 69 be 40009d3c <_RBTree_Extract_validate_unprotected+0x26c> 40009b9c: 84 10 20 00 clr %g2 if(the_node == the_node->parent->child[RBT_LEFT]) 40009ba0: c4 00 e0 04 ld [ %g3 + 4 ], %g2 40009ba4: 80 a0 40 02 cmp %g1, %g2 40009ba8: 22 80 00 0e be,a 40009be0 <_RBTree_Extract_validate_unprotected+0x110> 40009bac: c4 00 e0 08 ld [ %g3 + 8 ], %g2 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( const RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; 40009bb0: 82 10 00 03 mov %g3, %g1 */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); 40009bb4: c6 02 20 0c ld [ %o0 + 0xc ], %g3 40009bb8: 80 a0 e0 01 cmp %g3, 1 40009bbc: 32 bf ff d3 bne,a 40009b08 <_RBTree_Extract_validate_unprotected+0x38><== ALWAYS TAKEN 40009bc0: c6 00 40 00 ld [ %g1 ], %g3 sibling->child[_RBTree_Opposite_direction(dir)]->color = RBT_BLACK; _RBTree_Rotate(parent, dir); break; /* done */ } } /* while */ if(!the_node->parent->parent) the_node->color = RBT_BLACK; 40009bc4: c2 02 00 00 ld [ %o0 ], %g1 40009bc8: c2 00 40 00 ld [ %g1 ], %g1 40009bcc: 80 a0 60 00 cmp %g1, 0 40009bd0: 02 80 00 5f be 40009d4c <_RBTree_Extract_validate_unprotected+0x27c> 40009bd4: 01 00 00 00 nop 40009bd8: 81 c3 e0 08 retl 40009bdc: 01 00 00 00 nop RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( const RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; 40009be0: 10 bf ff f5 b 40009bb4 <_RBTree_Extract_validate_unprotected+0xe4> 40009be4: 82 10 00 03 mov %g3, %g1 * cases, either the_node is to the left or the right of the parent. * In both cases, first check if one of sibling's children is black, * and if so rotate in the proper direction and update sibling pointer. * Then switch the sibling and parent colors, and rotate through parent. */ dir = the_node != parent->child[0]; 40009be8: 86 1a 00 03 xor %o0, %g3, %g3 40009bec: 80 a0 00 03 cmp %g0, %g3 40009bf0: 9a 40 20 00 addx %g0, 0, %o5 */ RTEMS_INLINE_ROUTINE RBTree_Direction _RBTree_Opposite_direction( RBTree_Direction the_dir ) { return (RBTree_Direction) !((int) the_dir); 40009bf4: 86 1b 60 01 xor %o5, 1, %g3 if (!_RBTree_Is_red(sibling->child[_RBTree_Opposite_direction(dir)])) { 40009bf8: 87 28 e0 02 sll %g3, 2, %g3 40009bfc: 88 00 80 03 add %g2, %g3, %g4 40009c00: c8 01 20 04 ld [ %g4 + 4 ], %g4 */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); 40009c04: 80 a1 20 00 cmp %g4, 0 40009c08: 22 80 00 07 be,a 40009c24 <_RBTree_Extract_validate_unprotected+0x154> 40009c0c: 9b 2b 60 02 sll %o5, 2, %o5 40009c10: d8 01 20 0c ld [ %g4 + 0xc ], %o4 40009c14: 80 a3 20 01 cmp %o4, 1 40009c18: 22 80 00 4f be,a 40009d54 <_RBTree_Extract_validate_unprotected+0x284> 40009c1c: d6 00 60 0c ld [ %g1 + 0xc ], %o3 sibling->color = RBT_RED; sibling->child[dir]->color = RBT_BLACK; 40009c20: 9b 2b 60 02 sll %o5, 2, %o5 40009c24: 98 00 80 0d add %g2, %o5, %o4 40009c28: c8 03 20 04 ld [ %o4 + 4 ], %g4 * and if so rotate in the proper direction and update sibling pointer. * Then switch the sibling and parent colors, and rotate through parent. */ dir = the_node != parent->child[0]; if (!_RBTree_Is_red(sibling->child[_RBTree_Opposite_direction(dir)])) { sibling->color = RBT_RED; 40009c2c: 96 10 20 01 mov 1, %o3 40009c30: d6 20 a0 0c st %o3, [ %g2 + 0xc ] RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[_RBTree_Opposite_direction(dir)] == NULL) return; 40009c34: 80 a1 20 00 cmp %g4, 0 40009c38: 02 80 00 15 be 40009c8c <_RBTree_Extract_validate_unprotected+0x1bc><== NEVER TAKEN 40009c3c: c0 21 20 0c clr [ %g4 + 0xc ] c = the_node->child[_RBTree_Opposite_direction(dir)]; the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; 40009c40: 96 01 00 03 add %g4, %g3, %o3 40009c44: d4 02 e0 04 ld [ %o3 + 4 ], %o2 40009c48: d4 23 20 04 st %o2, [ %o4 + 4 ] if (c->child[dir]) 40009c4c: d8 02 e0 04 ld [ %o3 + 4 ], %o4 40009c50: 80 a3 20 00 cmp %o4, 0 40009c54: 32 80 00 02 bne,a 40009c5c <_RBTree_Extract_validate_unprotected+0x18c> 40009c58: c4 23 00 00 st %g2, [ %o4 ] c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009c5c: d8 00 80 00 ld [ %g2 ], %o4 the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; 40009c60: 96 01 00 03 add %g4, %g3, %o3 40009c64: c4 22 e0 04 st %g2, [ %o3 + 4 ] the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009c68: d6 03 20 04 ld [ %o4 + 4 ], %o3 c->parent = the_node->parent; 40009c6c: d8 21 00 00 st %o4, [ %g4 ] if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009c70: 96 18 80 0b xor %g2, %o3, %o3 c->parent = the_node->parent; the_node->parent = c; 40009c74: c8 20 80 00 st %g4, [ %g2 ] if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009c78: 80 a0 00 0b cmp %g0, %o3 40009c7c: 84 40 20 00 addx %g0, 0, %g2 40009c80: 85 28 a0 02 sll %g2, 2, %g2 40009c84: 98 03 00 02 add %o4, %g2, %o4 40009c88: c8 23 20 04 st %g4, [ %o4 + 4 ] sibling->child[dir]->color = RBT_BLACK; _RBTree_Rotate(sibling, _RBTree_Opposite_direction(dir)); sibling = parent->child[_RBTree_Opposite_direction(dir)]; } sibling->color = parent->color; 40009c8c: c8 00 60 0c ld [ %g1 + 0xc ], %g4 dir = the_node != parent->child[0]; if (!_RBTree_Is_red(sibling->child[_RBTree_Opposite_direction(dir)])) { sibling->color = RBT_RED; sibling->child[dir]->color = RBT_BLACK; _RBTree_Rotate(sibling, _RBTree_Opposite_direction(dir)); sibling = parent->child[_RBTree_Opposite_direction(dir)]; 40009c90: 84 00 40 03 add %g1, %g3, %g2 40009c94: c4 00 a0 04 ld [ %g2 + 4 ], %g2 } sibling->color = parent->color; 40009c98: c8 20 a0 0c st %g4, [ %g2 + 0xc ] 40009c9c: 88 00 80 03 add %g2, %g3, %g4 40009ca0: c8 01 20 04 ld [ %g4 + 4 ], %g4 parent->color = RBT_BLACK; 40009ca4: c0 20 60 0c clr [ %g1 + 0xc ] sibling->child[_RBTree_Opposite_direction(dir)]->color = RBT_BLACK; 40009ca8: 10 80 00 33 b 40009d74 <_RBTree_Extract_validate_unprotected+0x2a4> 40009cac: c0 21 20 0c clr [ %g4 + 0xc ] * then rotate parent left, making the sibling be the_node's grandparent. * Now the_node has a black sibling and red parent. After rotation, * update sibling pointer. */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; 40009cb0: c8 20 60 0c st %g4, [ %g1 + 0xc ] sibling->color = RBT_BLACK; dir = the_node != parent->child[0]; 40009cb4: 88 1b 00 08 xor %o4, %o0, %g4 40009cb8: 80 a0 00 04 cmp %g0, %g4 40009cbc: 94 40 20 00 addx %g0, 0, %o2 */ RTEMS_INLINE_ROUTINE RBTree_Direction _RBTree_Opposite_direction( RBTree_Direction the_dir ) { return (RBTree_Direction) !((int) the_dir); 40009cc0: 96 1a a0 01 xor %o2, 1, %o3 RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[_RBTree_Opposite_direction(dir)] == NULL) return; 40009cc4: 97 2a e0 02 sll %o3, 2, %o3 40009cc8: 98 00 40 0b add %g1, %o3, %o4 40009ccc: c8 03 20 04 ld [ %o4 + 4 ], %g4 40009cd0: 80 a1 20 00 cmp %g4, 0 40009cd4: 02 80 00 1c be 40009d44 <_RBTree_Extract_validate_unprotected+0x274><== NEVER TAKEN 40009cd8: c0 20 a0 0c clr [ %g2 + 0xc ] c = the_node->child[_RBTree_Opposite_direction(dir)]; the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; 40009cdc: 95 2a a0 02 sll %o2, 2, %o2 40009ce0: 84 01 00 0a add %g4, %o2, %g2 40009ce4: d2 00 a0 04 ld [ %g2 + 4 ], %o1 40009ce8: d2 23 20 04 st %o1, [ %o4 + 4 ] if (c->child[dir]) 40009cec: c4 00 a0 04 ld [ %g2 + 4 ], %g2 40009cf0: 80 a0 a0 00 cmp %g2, 0 40009cf4: 02 80 00 04 be 40009d04 <_RBTree_Extract_validate_unprotected+0x234><== NEVER TAKEN 40009cf8: 94 01 00 0a add %g4, %o2, %o2 c->child[dir]->parent = the_node; 40009cfc: c2 20 80 00 st %g1, [ %g2 ] 40009d00: c6 00 40 00 ld [ %g1 ], %g3 c->child[dir] = the_node; 40009d04: c2 22 a0 04 st %g1, [ %o2 + 4 ] the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009d08: c4 00 e0 04 ld [ %g3 + 4 ], %g2 c->parent = the_node->parent; 40009d0c: c6 21 00 00 st %g3, [ %g4 ] if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009d10: 84 18 40 02 xor %g1, %g2, %g2 40009d14: 80 a0 00 02 cmp %g0, %g2 40009d18: 84 40 20 00 addx %g0, 0, %g2 40009d1c: 85 28 a0 02 sll %g2, 2, %g2 40009d20: 96 00 40 0b add %g1, %o3, %o3 40009d24: 86 00 c0 02 add %g3, %g2, %g3 c->parent = the_node->parent; the_node->parent = c; 40009d28: c8 20 40 00 st %g4, [ %g1 ] if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009d2c: c8 20 e0 04 st %g4, [ %g3 + 4 ] 40009d30: 10 bf ff 7f b 40009b2c <_RBTree_Extract_validate_unprotected+0x5c> 40009d34: c4 02 e0 04 ld [ %o3 + 4 ], %g2 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( const RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; 40009d38: 84 10 20 00 clr %g2 <== NOT EXECUTED 40009d3c: 10 bf ff 9e b 40009bb4 <_RBTree_Extract_validate_unprotected+0xe4> 40009d40: 82 10 00 03 mov %g3, %g1 RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[_RBTree_Opposite_direction(dir)] == NULL) return; 40009d44: 10 bf ff 7a b 40009b2c <_RBTree_Extract_validate_unprotected+0x5c><== NOT EXECUTED 40009d48: 84 10 20 00 clr %g2 <== NOT EXECUTED sibling->child[_RBTree_Opposite_direction(dir)]->color = RBT_BLACK; _RBTree_Rotate(parent, dir); break; /* done */ } } /* while */ if(!the_node->parent->parent) the_node->color = RBT_BLACK; 40009d4c: 81 c3 e0 08 retl 40009d50: c0 22 20 0c clr [ %o0 + 0xc ] 40009d54: 98 00 40 03 add %g1, %g3, %o4 sibling->color = RBT_RED; sibling->child[dir]->color = RBT_BLACK; _RBTree_Rotate(sibling, _RBTree_Opposite_direction(dir)); sibling = parent->child[_RBTree_Opposite_direction(dir)]; } sibling->color = parent->color; 40009d58: d6 20 a0 0c st %o3, [ %g2 + 0xc ] parent->color = RBT_BLACK; 40009d5c: c0 20 60 0c clr [ %g1 + 0xc ] 40009d60: c4 03 20 04 ld [ %o4 + 4 ], %g2 40009d64: 80 a0 a0 00 cmp %g2, 0 40009d68: 02 bf ff 97 be 40009bc4 <_RBTree_Extract_validate_unprotected+0xf4><== NEVER TAKEN 40009d6c: c0 21 20 0c clr [ %g4 + 0xc ] 40009d70: 9b 2b 60 02 sll %o5, 2, %o5 c = the_node->child[_RBTree_Opposite_direction(dir)]; the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; 40009d74: 88 00 80 0d add %g2, %o5, %g4 40009d78: d8 01 20 04 ld [ %g4 + 4 ], %o4 40009d7c: 86 00 40 03 add %g1, %g3, %g3 40009d80: d8 20 e0 04 st %o4, [ %g3 + 4 ] if (c->child[dir]) 40009d84: c6 01 20 04 ld [ %g4 + 4 ], %g3 40009d88: 80 a0 e0 00 cmp %g3, 0 40009d8c: 32 80 00 02 bne,a 40009d94 <_RBTree_Extract_validate_unprotected+0x2c4> 40009d90: c2 20 c0 00 st %g1, [ %g3 ] c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009d94: c6 00 40 00 ld [ %g1 ], %g3 the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; 40009d98: 9a 00 80 0d add %g2, %o5, %o5 40009d9c: c2 23 60 04 st %g1, [ %o5 + 4 ] the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009da0: c8 00 e0 04 ld [ %g3 + 4 ], %g4 c->parent = the_node->parent; 40009da4: c6 20 80 00 st %g3, [ %g2 ] the_node->parent = c; 40009da8: c4 20 40 00 st %g2, [ %g1 ] if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 40009dac: 88 18 40 04 xor %g1, %g4, %g4 40009db0: 80 a0 00 04 cmp %g0, %g4 40009db4: 82 40 20 00 addx %g0, 0, %g1 40009db8: 83 28 60 02 sll %g1, 2, %g1 40009dbc: 86 00 c0 01 add %g3, %g1, %g3 sibling->child[_RBTree_Opposite_direction(dir)]->color = RBT_BLACK; _RBTree_Rotate(parent, dir); break; /* done */ } } /* while */ if(!the_node->parent->parent) the_node->color = RBT_BLACK; 40009dc0: c2 02 00 00 ld [ %o0 ], %g1 40009dc4: c4 20 e0 04 st %g2, [ %g3 + 4 ] 40009dc8: c2 00 40 00 ld [ %g1 ], %g1 40009dcc: 80 a0 60 00 cmp %g1, 0 40009dd0: 12 bf ff 82 bne 40009bd8 <_RBTree_Extract_validate_unprotected+0x108><== ALWAYS TAKEN 40009dd4: 01 00 00 00 nop 40009dd8: 30 bf ff dd b,a 40009d4c <_RBTree_Extract_validate_unprotected+0x27c><== NOT EXECUTED 40009ddc: c2 02 00 00 ld [ %o0 ], %g1 40009de0: c2 00 40 00 ld [ %g1 ], %g1 40009de4: 80 a0 60 00 cmp %g1, 0 40009de8: 12 bf ff 7c bne 40009bd8 <_RBTree_Extract_validate_unprotected+0x108><== ALWAYS TAKEN 40009dec: 01 00 00 00 nop 40009df0: 30 bf ff d7 b,a 40009d4c <_RBTree_Extract_validate_unprotected+0x27c><== NOT EXECUTED =============================================================================== 4000aa6c <_RBTree_Find>: RBTree_Node *_RBTree_Find( RBTree_Control *the_rbtree, RBTree_Node *search_node ) { 4000aa6c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; RBTree_Node *return_node; return_node = NULL; _ISR_Disable( level ); 4000aa70: 7f ff e3 50 call 400037b0 4000aa74: b8 10 00 18 mov %i0, %i4 4000aa78: b6 10 00 08 mov %o0, %i3 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Find_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { RBTree_Node* iter_node = the_rbtree->root; 4000aa7c: fa 06 20 04 ld [ %i0 + 4 ], %i5 RBTree_Node* found = NULL; int compare_result; while (iter_node) { 4000aa80: 80 a7 60 00 cmp %i5, 0 4000aa84: 02 80 00 15 be 4000aad8 <_RBTree_Find+0x6c> <== NEVER TAKEN 4000aa88: b0 10 20 00 clr %i0 compare_result = the_rbtree->compare_function(the_node, iter_node); 4000aa8c: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 4000aa90: 92 10 00 1d mov %i5, %o1 4000aa94: 9f c0 40 00 call %g1 4000aa98: 90 10 00 19 mov %i1, %o0 RTEMS_INLINE_ROUTINE bool _RBTree_Is_greater( int compare_result ) { return compare_result > 0; 4000aa9c: 83 3a 20 1f sra %o0, 0x1f, %g1 RBTree_Node* iter_node = the_rbtree->root; RBTree_Node* found = NULL; int compare_result; while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); if ( _RBTree_Is_equal( compare_result ) ) { 4000aaa0: 80 a2 20 00 cmp %o0, 0 RTEMS_INLINE_ROUTINE bool _RBTree_Is_greater( int compare_result ) { return compare_result > 0; 4000aaa4: 82 20 40 08 sub %g1, %o0, %g1 4000aaa8: 83 30 60 1f srl %g1, 0x1f, %g1 break; } RBTree_Direction dir = (RBTree_Direction) _RBTree_Is_greater( compare_result ); iter_node = iter_node->child[dir]; 4000aaac: 83 28 60 02 sll %g1, 2, %g1 RBTree_Node* iter_node = the_rbtree->root; RBTree_Node* found = NULL; int compare_result; while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); if ( _RBTree_Is_equal( compare_result ) ) { 4000aab0: 12 80 00 06 bne 4000aac8 <_RBTree_Find+0x5c> 4000aab4: 82 07 40 01 add %i5, %g1, %g1 found = iter_node; if ( the_rbtree->is_unique ) 4000aab8: c4 0f 20 14 ldub [ %i4 + 0x14 ], %g2 4000aabc: 80 a0 a0 00 cmp %g2, 0 4000aac0: 12 80 00 0a bne 4000aae8 <_RBTree_Find+0x7c> 4000aac4: b0 10 00 1d mov %i5, %i0 break; } RBTree_Direction dir = (RBTree_Direction) _RBTree_Is_greater( compare_result ); iter_node = iter_node->child[dir]; 4000aac8: fa 00 60 04 ld [ %g1 + 4 ], %i5 ) { RBTree_Node* iter_node = the_rbtree->root; RBTree_Node* found = NULL; int compare_result; while (iter_node) { 4000aacc: 80 a7 60 00 cmp %i5, 0 4000aad0: 32 bf ff f0 bne,a 4000aa90 <_RBTree_Find+0x24> 4000aad4: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 return_node = _RBTree_Find_unprotected( the_rbtree, search_node ); _ISR_Enable( level ); 4000aad8: 7f ff e3 3a call 400037c0 4000aadc: 90 10 00 1b mov %i3, %o0 return return_node; } 4000aae0: 81 c7 e0 08 ret 4000aae4: 81 e8 00 00 restore RBTree_Node *return_node; return_node = NULL; _ISR_Disable( level ); return_node = _RBTree_Find_unprotected( the_rbtree, search_node ); _ISR_Enable( level ); 4000aae8: 7f ff e3 36 call 400037c0 4000aaec: 90 10 00 1b mov %i3, %o0 return return_node; } 4000aaf0: 81 c7 e0 08 ret 4000aaf4: 81 e8 00 00 restore =============================================================================== 4000aed8 <_RBTree_Initialize>: void *starting_address, size_t number_nodes, size_t node_size, bool is_unique ) { 4000aed8: 9d e3 bf a0 save %sp, -96, %sp size_t count; RBTree_Node *next; /* TODO: Error message? */ if (!the_rbtree) return; 4000aedc: 80 a6 20 00 cmp %i0, 0 4000aee0: 02 80 00 0f be 4000af1c <_RBTree_Initialize+0x44> <== NEVER TAKEN 4000aee4: 80 a6 e0 00 cmp %i3, 0 RBTree_Control *the_rbtree, RBTree_Compare_function compare_function, bool is_unique ) { the_rbtree->permanent_null = NULL; 4000aee8: c0 26 00 00 clr [ %i0 ] the_rbtree->root = NULL; 4000aeec: c0 26 20 04 clr [ %i0 + 4 ] the_rbtree->first[0] = NULL; 4000aef0: c0 26 20 08 clr [ %i0 + 8 ] the_rbtree->first[1] = NULL; 4000aef4: c0 26 20 0c clr [ %i0 + 0xc ] the_rbtree->compare_function = compare_function; 4000aef8: f2 26 20 10 st %i1, [ %i0 + 0x10 ] /* could do sanity checks here */ _RBTree_Initialize_empty(the_rbtree, compare_function, is_unique); count = number_nodes; next = starting_address; while ( count-- ) { 4000aefc: 02 80 00 08 be 4000af1c <_RBTree_Initialize+0x44> <== NEVER TAKEN 4000af00: fa 2e 20 14 stb %i5, [ %i0 + 0x14 ] _RBTree_Insert_unprotected(the_rbtree, next); 4000af04: 92 10 00 1a mov %i2, %o1 4000af08: 7f ff ff 0b call 4000ab34 <_RBTree_Insert_unprotected> 4000af0c: 90 10 00 18 mov %i0, %o0 /* could do sanity checks here */ _RBTree_Initialize_empty(the_rbtree, compare_function, is_unique); count = number_nodes; next = starting_address; while ( count-- ) { 4000af10: b6 86 ff ff addcc %i3, -1, %i3 4000af14: 12 bf ff fc bne 4000af04 <_RBTree_Initialize+0x2c> 4000af18: b4 06 80 1c add %i2, %i4, %i2 4000af1c: 81 c7 e0 08 ret 4000af20: 81 e8 00 00 restore =============================================================================== 40009fd4 <_RBTree_Insert_unprotected>: */ RBTree_Node *_RBTree_Insert_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { 40009fd4: 9d e3 bf a0 save %sp, -96, %sp if(!the_node) return (RBTree_Node*)-1; 40009fd8: 80 a6 60 00 cmp %i1, 0 40009fdc: 02 80 00 9c be 4000a24c <_RBTree_Insert_unprotected+0x278> 40009fe0: b8 10 00 18 mov %i0, %i4 RBTree_Node *iter_node = the_rbtree->root; 40009fe4: fa 06 20 04 ld [ %i0 + 4 ], %i5 int compare_result; if (!iter_node) { /* special case: first node inserted */ 40009fe8: 80 a7 60 00 cmp %i5, 0 40009fec: 32 80 00 05 bne,a 4000a000 <_RBTree_Insert_unprotected+0x2c> 40009ff0: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 the_node->color = RBT_BLACK; 40009ff4: 10 80 00 9a b 4000a25c <_RBTree_Insert_unprotected+0x288> 40009ff8: c0 26 60 0c clr [ %i1 + 0xc ] the_node->parent = (RBTree_Node *) the_rbtree; the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; } else { /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); 40009ffc: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 4000a000: 92 10 00 1d mov %i5, %o1 4000a004: 9f c0 40 00 call %g1 4000a008: 90 10 00 19 mov %i1, %o0 if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) ) 4000a00c: c4 0f 20 14 ldub [ %i4 + 0x14 ], %g2 return iter_node; RBTree_Direction dir = !_RBTree_Is_lesser( compare_result ); 4000a010: b6 38 00 08 xnor %g0, %o0, %i3 the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; } else { /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) ) 4000a014: 80 a0 a0 00 cmp %g2, 0 return iter_node; RBTree_Direction dir = !_RBTree_Is_lesser( compare_result ); 4000a018: b7 36 e0 1f srl %i3, 0x1f, %i3 if (!iter_node->child[dir]) { 4000a01c: 83 2e e0 02 sll %i3, 2, %g1 the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; } else { /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) ) 4000a020: 02 80 00 05 be 4000a034 <_RBTree_Insert_unprotected+0x60> 4000a024: 82 07 40 01 add %i5, %g1, %g1 4000a028: 80 a2 20 00 cmp %o0, 0 4000a02c: 02 80 00 8a be 4000a254 <_RBTree_Insert_unprotected+0x280> 4000a030: 01 00 00 00 nop return iter_node; RBTree_Direction dir = !_RBTree_Is_lesser( compare_result ); if (!iter_node->child[dir]) { 4000a034: f0 00 60 04 ld [ %g1 + 4 ], %i0 4000a038: 80 a6 20 00 cmp %i0, 0 4000a03c: 32 bf ff f0 bne,a 40009ffc <_RBTree_Insert_unprotected+0x28> 4000a040: ba 10 00 18 mov %i0, %i5 the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; the_node->color = RBT_RED; iter_node->child[dir] = the_node; the_node->parent = iter_node; /* update min/max */ compare_result = the_rbtree->compare_function( 4000a044: c4 07 20 10 ld [ %i4 + 0x10 ], %g2 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_First( const RBTree_Control *the_rbtree, RBTree_Direction dir ) { return the_rbtree->first[dir]; 4000a048: b4 06 e0 02 add %i3, 2, %i2 4000a04c: 87 2e a0 02 sll %i2, 2, %g3 4000a050: d2 07 00 03 ld [ %i4 + %g3 ], %o1 compare_result = the_rbtree->compare_function(the_node, iter_node); if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) ) return iter_node; RBTree_Direction dir = !_RBTree_Is_lesser( compare_result ); if (!iter_node->child[dir]) { the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; 4000a054: c0 26 60 08 clr [ %i1 + 8 ] 4000a058: c0 26 60 04 clr [ %i1 + 4 ] the_node->color = RBT_RED; iter_node->child[dir] = the_node; 4000a05c: f2 20 60 04 st %i1, [ %g1 + 4 ] if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) ) return iter_node; RBTree_Direction dir = !_RBTree_Is_lesser( compare_result ); if (!iter_node->child[dir]) { the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; the_node->color = RBT_RED; 4000a060: 82 10 20 01 mov 1, %g1 iter_node->child[dir] = the_node; the_node->parent = iter_node; 4000a064: fa 26 40 00 st %i5, [ %i1 ] if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) ) return iter_node; RBTree_Direction dir = !_RBTree_Is_lesser( compare_result ); if (!iter_node->child[dir]) { the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; the_node->color = RBT_RED; 4000a068: c2 26 60 0c st %g1, [ %i1 + 0xc ] iter_node->child[dir] = the_node; the_node->parent = iter_node; /* update min/max */ compare_result = the_rbtree->compare_function( 4000a06c: 9f c0 80 00 call %g2 4000a070: 90 10 00 19 mov %i1, %o0 the_node, _RBTree_First(the_rbtree, dir) ); if ( (!dir && _RBTree_Is_lesser(compare_result)) || 4000a074: 80 a6 e0 00 cmp %i3, 0 4000a078: 12 80 00 10 bne 4000a0b8 <_RBTree_Insert_unprotected+0xe4> 4000a07c: 80 a2 20 00 cmp %o0, 0 4000a080: 06 80 00 10 bl 4000a0c0 <_RBTree_Insert_unprotected+0xec> 4000a084: b5 2e a0 02 sll %i2, 2, %i2 4000a088: c2 06 40 00 ld [ %i1 ], %g1 if (dir != pdir) { _RBTree_Rotate(the_node->parent, pdir); the_node = the_node->child[pdir]; } the_node->parent->color = RBT_BLACK; g->color = RBT_RED; 4000a08c: b4 10 20 01 mov 1, %i2 */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Parent( const RBTree_Node *the_node ) { if (!the_node->parent->parent) return NULL; 4000a090: c4 00 40 00 ld [ %g1 ], %g2 4000a094: 86 90 a0 00 orcc %g2, 0, %g3 4000a098: 22 80 00 06 be,a 4000a0b0 <_RBTree_Insert_unprotected+0xdc> 4000a09c: c0 26 60 0c clr [ %i1 + 0xc ] */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); 4000a0a0: c8 00 60 0c ld [ %g1 + 0xc ], %g4 4000a0a4: 80 a1 20 01 cmp %g4, 1 4000a0a8: 22 80 00 08 be,a 4000a0c8 <_RBTree_Insert_unprotected+0xf4> 4000a0ac: f6 00 80 00 ld [ %g2 ], %i3 /* verify red-black properties */ _RBTree_Validate_insert_unprotected(the_node); } return (RBTree_Node*)0; } 4000a0b0: 81 c7 e0 08 ret 4000a0b4: 81 e8 00 00 restore compare_result = the_rbtree->compare_function( the_node, _RBTree_First(the_rbtree, dir) ); if ( (!dir && _RBTree_Is_lesser(compare_result)) || (dir && _RBTree_Is_greater(compare_result)) ) { 4000a0b8: 04 bf ff f4 ble 4000a088 <_RBTree_Insert_unprotected+0xb4> 4000a0bc: b5 2e a0 02 sll %i2, 2, %i2 the_rbtree->first[dir] = the_node; 4000a0c0: 10 bf ff f2 b 4000a088 <_RBTree_Insert_unprotected+0xb4> 4000a0c4: f2 27 00 1a st %i1, [ %i4 + %i2 ] ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(!(the_node->parent->parent->parent)) return NULL; 4000a0c8: 80 a6 e0 00 cmp %i3, 0 4000a0cc: 02 80 00 0c be 4000a0fc <_RBTree_Insert_unprotected+0x128><== NEVER TAKEN 4000a0d0: c8 00 a0 04 ld [ %g2 + 4 ], %g4 { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(the_node == the_node->parent->child[RBT_LEFT]) 4000a0d4: 80 a1 00 01 cmp %g4, %g1 4000a0d8: 02 80 00 5b be 4000a244 <_RBTree_Insert_unprotected+0x270> 4000a0dc: ba 10 00 04 mov %g4, %i5 */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); 4000a0e0: 80 a7 60 00 cmp %i5, 0 4000a0e4: 22 80 00 07 be,a 4000a100 <_RBTree_Insert_unprotected+0x12c> 4000a0e8: fa 00 60 04 ld [ %g1 + 4 ], %i5 4000a0ec: f8 07 60 0c ld [ %i5 + 0xc ], %i4 4000a0f0: 80 a7 20 01 cmp %i4, 1 4000a0f4: 22 80 00 4f be,a 4000a230 <_RBTree_Insert_unprotected+0x25c> 4000a0f8: c0 20 60 0c clr [ %g1 + 0xc ] the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; 4000a0fc: fa 00 60 04 ld [ %g1 + 4 ], %i5 RBTree_Direction pdir = the_node->parent != g->child[0]; 4000a100: 88 18 40 04 xor %g1, %g4, %g4 4000a104: 80 a0 00 04 cmp %g0, %g4 the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; 4000a108: ba 1e 40 1d xor %i1, %i5, %i5 RBTree_Direction pdir = the_node->parent != g->child[0]; 4000a10c: 88 40 20 00 addx %g0, 0, %g4 the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; 4000a110: 80 a0 00 1d cmp %g0, %i5 4000a114: ba 40 20 00 addx %g0, 0, %i5 RBTree_Direction pdir = the_node->parent != g->child[0]; /* ensure node is on the same branch direction as parent */ if (dir != pdir) { 4000a118: 80 a7 40 04 cmp %i5, %g4 4000a11c: 02 80 00 20 be 4000a19c <_RBTree_Insert_unprotected+0x1c8> 4000a120: 80 a0 00 04 cmp %g0, %g4 */ RTEMS_INLINE_ROUTINE RBTree_Direction _RBTree_Opposite_direction( RBTree_Direction the_dir ) { return (RBTree_Direction) !((int) the_dir); 4000a124: b6 60 3f ff subx %g0, -1, %i3 RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[_RBTree_Opposite_direction(dir)] == NULL) return; 4000a128: b7 2e e0 02 sll %i3, 2, %i3 4000a12c: b6 00 40 1b add %g1, %i3, %i3 4000a130: fa 06 e0 04 ld [ %i3 + 4 ], %i5 4000a134: 80 a7 60 00 cmp %i5, 0 4000a138: 02 80 00 16 be 4000a190 <_RBTree_Insert_unprotected+0x1bc><== NEVER TAKEN 4000a13c: b9 29 20 02 sll %g4, 2, %i4 c = the_node->child[_RBTree_Opposite_direction(dir)]; the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; 4000a140: 9e 07 40 1c add %i5, %i4, %o7 4000a144: da 03 e0 04 ld [ %o7 + 4 ], %o5 4000a148: da 26 e0 04 st %o5, [ %i3 + 4 ] if (c->child[dir]) 4000a14c: f6 03 e0 04 ld [ %o7 + 4 ], %i3 4000a150: 80 a6 e0 00 cmp %i3, 0 4000a154: 22 80 00 05 be,a 4000a168 <_RBTree_Insert_unprotected+0x194> 4000a158: b6 07 40 1c add %i5, %i4, %i3 c->child[dir]->parent = the_node; 4000a15c: c2 26 c0 00 st %g1, [ %i3 ] 4000a160: c4 00 40 00 ld [ %g1 ], %g2 c->child[dir] = the_node; 4000a164: b6 07 40 1c add %i5, %i4, %i3 4000a168: c2 26 e0 04 st %g1, [ %i3 + 4 ] the_node->parent->child[the_node != the_node->parent->child[0]] = c; 4000a16c: f6 00 a0 04 ld [ %g2 + 4 ], %i3 c->parent = the_node->parent; 4000a170: c4 27 40 00 st %g2, [ %i5 ] if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 4000a174: b6 1e c0 01 xor %i3, %g1, %i3 c->parent = the_node->parent; the_node->parent = c; 4000a178: fa 20 40 00 st %i5, [ %g1 ] if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 4000a17c: 80 a0 00 1b cmp %g0, %i3 4000a180: 82 40 20 00 addx %g0, 0, %g1 4000a184: 83 28 60 02 sll %g1, 2, %g1 4000a188: 84 00 80 01 add %g2, %g1, %g2 4000a18c: fa 20 a0 04 st %i5, [ %g2 + 4 ] _RBTree_Rotate(the_node->parent, pdir); the_node = the_node->child[pdir]; 4000a190: b2 06 40 1c add %i1, %i4, %i1 4000a194: f2 06 60 04 ld [ %i1 + 4 ], %i1 4000a198: c2 06 40 00 ld [ %i1 ], %g1 } the_node->parent->color = RBT_BLACK; 4000a19c: c0 20 60 0c clr [ %g1 + 0xc ] g->color = RBT_RED; /* now rotate grandparent in the other branch direction (toward uncle) */ _RBTree_Rotate(g, (1-pdir)); 4000a1a0: 88 26 80 04 sub %i2, %g4, %g4 4000a1a4: ba 19 20 01 xor %g4, 1, %i5 RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[_RBTree_Opposite_direction(dir)] == NULL) return; 4000a1a8: bb 2f 60 02 sll %i5, 2, %i5 4000a1ac: ba 00 c0 1d add %g3, %i5, %i5 4000a1b0: c4 07 60 04 ld [ %i5 + 4 ], %g2 4000a1b4: 80 a0 a0 00 cmp %g2, 0 4000a1b8: 02 bf ff b6 be 4000a090 <_RBTree_Insert_unprotected+0xbc> <== NEVER TAKEN 4000a1bc: f4 20 e0 0c st %i2, [ %g3 + 0xc ] c = the_node->child[_RBTree_Opposite_direction(dir)]; the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; 4000a1c0: 89 29 20 02 sll %g4, 2, %g4 4000a1c4: 82 00 80 04 add %g2, %g4, %g1 4000a1c8: f8 00 60 04 ld [ %g1 + 4 ], %i4 4000a1cc: f8 27 60 04 st %i4, [ %i5 + 4 ] if (c->child[dir]) 4000a1d0: c2 00 60 04 ld [ %g1 + 4 ], %g1 4000a1d4: 80 a0 60 00 cmp %g1, 0 4000a1d8: 32 80 00 02 bne,a 4000a1e0 <_RBTree_Insert_unprotected+0x20c> 4000a1dc: c6 20 40 00 st %g3, [ %g1 ] c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 4000a1e0: fa 00 c0 00 ld [ %g3 ], %i5 the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; 4000a1e4: 88 00 80 04 add %g2, %g4, %g4 the_node->parent->child[the_node != the_node->parent->child[0]] = c; c->parent = the_node->parent; 4000a1e8: fa 20 80 00 st %i5, [ %g2 ] the_node->child[_RBTree_Opposite_direction(dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; 4000a1ec: c6 21 20 04 st %g3, [ %g4 + 4 ] the_node->parent->child[the_node != the_node->parent->child[0]] = c; 4000a1f0: c8 07 60 04 ld [ %i5 + 4 ], %g4 c->parent = the_node->parent; the_node->parent = c; 4000a1f4: c4 20 c0 00 st %g2, [ %g3 ] 4000a1f8: c2 06 40 00 ld [ %i1 ], %g1 if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; 4000a1fc: 86 18 c0 04 xor %g3, %g4, %g3 4000a200: 80 a0 00 03 cmp %g0, %g3 4000a204: 86 40 20 00 addx %g0, 0, %g3 4000a208: 87 28 e0 02 sll %g3, 2, %g3 4000a20c: ba 07 40 03 add %i5, %g3, %i5 4000a210: c4 27 60 04 st %g2, [ %i5 + 4 ] */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Parent( const RBTree_Node *the_node ) { if (!the_node->parent->parent) return NULL; 4000a214: c4 00 40 00 ld [ %g1 ], %g2 4000a218: 86 90 a0 00 orcc %g2, 0, %g3 4000a21c: 32 bf ff a2 bne,a 4000a0a4 <_RBTree_Insert_unprotected+0xd0><== ALWAYS TAKEN 4000a220: c8 00 60 0c ld [ %g1 + 0xc ], %g4 } } if(!the_node->parent->parent) the_node->color = RBT_BLACK; 4000a224: c0 26 60 0c clr [ %i1 + 0xc ] <== NOT EXECUTED /* verify red-black properties */ _RBTree_Validate_insert_unprotected(the_node); } return (RBTree_Node*)0; } 4000a228: 81 c7 e0 08 ret <== NOT EXECUTED 4000a22c: 81 e8 00 00 restore <== NOT EXECUTED g = the_node->parent->parent; /* if uncle is red, repaint uncle/parent black and grandparent red */ if(_RBTree_Is_red(u)) { the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; 4000a230: c0 27 60 0c clr [ %i5 + 0xc ] g->color = RBT_RED; 4000a234: f8 20 a0 0c st %i4, [ %g2 + 0xc ] 4000a238: 82 10 00 1b mov %i3, %g1 4000a23c: 10 bf ff 95 b 4000a090 <_RBTree_Insert_unprotected+0xbc> 4000a240: b2 10 00 02 mov %g2, %i1 if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(the_node == the_node->parent->child[RBT_LEFT]) return the_node->parent->child[RBT_RIGHT]; 4000a244: 10 bf ff a7 b 4000a0e0 <_RBTree_Insert_unprotected+0x10c> 4000a248: fa 00 a0 08 ld [ %g2 + 8 ], %i5 RBTree_Node *_RBTree_Insert_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { if(!the_node) return (RBTree_Node*)-1; 4000a24c: 81 c7 e0 08 ret 4000a250: 91 e8 3f ff restore %g0, -1, %o0 the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; } else { /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); if ( the_rbtree->is_unique && _RBTree_Is_equal( compare_result ) ) 4000a254: 81 c7 e0 08 ret 4000a258: 91 e8 00 1d restore %g0, %i5, %o0 RBTree_Node *iter_node = the_rbtree->root; int compare_result; if (!iter_node) { /* special case: first node inserted */ the_node->color = RBT_BLACK; the_rbtree->root = the_node; 4000a25c: f2 26 20 04 st %i1, [ %i0 + 4 ] the_rbtree->first[0] = the_rbtree->first[1] = the_node; 4000a260: f2 26 20 0c st %i1, [ %i0 + 0xc ] 4000a264: f2 26 20 08 st %i1, [ %i0 + 8 ] the_node->parent = (RBTree_Node *) the_rbtree; 4000a268: f0 26 40 00 st %i0, [ %i1 ] the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; 4000a26c: c0 26 60 08 clr [ %i1 + 8 ] 4000a270: c0 26 60 04 clr [ %i1 + 4 ] } /* while(iter_node) */ /* verify red-black properties */ _RBTree_Validate_insert_unprotected(the_node); } return (RBTree_Node*)0; 4000a274: 81 c7 e0 08 ret 4000a278: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 4000a2ac <_RBTree_Iterate_unprotected>: const RBTree_Control *rbtree, RBTree_Direction dir, RBTree_Visitor visitor, void *visitor_arg ) { 4000a2ac: 9d e3 bf a0 save %sp, -96, %sp */ RTEMS_INLINE_ROUTINE RBTree_Direction _RBTree_Opposite_direction( RBTree_Direction the_dir ) { return (RBTree_Direction) !((int) the_dir); 4000a2b0: 80 a0 00 19 cmp %g0, %i1 4000a2b4: 82 60 3f ff subx %g0, -1, %g1 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_First( const RBTree_Control *the_rbtree, RBTree_Direction dir ) { return the_rbtree->first[dir]; 4000a2b8: 82 00 60 02 add %g1, 2, %g1 4000a2bc: 83 28 60 02 sll %g1, 2, %g1 4000a2c0: fa 06 00 01 ld [ %i0 + %g1 ], %i5 RBTree_Direction opp_dir = _RBTree_Opposite_direction( dir ); const RBTree_Node *current = _RBTree_First( rbtree, opp_dir ); bool stop = false; while ( !stop && current != NULL ) { 4000a2c4: 80 a7 60 00 cmp %i5, 0 4000a2c8: 12 80 00 06 bne 4000a2e0 <_RBTree_Iterate_unprotected+0x34><== ALWAYS TAKEN 4000a2cc: 94 10 00 1b mov %i3, %o2 4000a2d0: 30 80 00 0e b,a 4000a308 <_RBTree_Iterate_unprotected+0x5c><== NOT EXECUTED 4000a2d4: 80 8f 20 ff btst 0xff, %i4 4000a2d8: 02 80 00 0c be 4000a308 <_RBTree_Iterate_unprotected+0x5c><== NEVER TAKEN 4000a2dc: 94 10 00 1b mov %i3, %o2 stop = (*visitor)( current, dir, visitor_arg ); 4000a2e0: 90 10 00 1d mov %i5, %o0 4000a2e4: 9f c6 80 00 call %i2 4000a2e8: 92 10 00 19 mov %i1, %o1 current = _RBTree_Next_unprotected( current, dir ); 4000a2ec: 92 10 00 19 mov %i1, %o1 RBTree_Direction opp_dir = _RBTree_Opposite_direction( dir ); const RBTree_Node *current = _RBTree_First( rbtree, opp_dir ); bool stop = false; while ( !stop && current != NULL ) { stop = (*visitor)( current, dir, visitor_arg ); 4000a2f0: b8 10 00 08 mov %o0, %i4 current = _RBTree_Next_unprotected( current, dir ); 4000a2f4: 40 00 00 07 call 4000a310 <_RBTree_Next_unprotected> 4000a2f8: 90 10 00 1d mov %i5, %o0 { RBTree_Direction opp_dir = _RBTree_Opposite_direction( dir ); const RBTree_Node *current = _RBTree_First( rbtree, opp_dir ); bool stop = false; while ( !stop && current != NULL ) { 4000a2fc: ba 92 20 00 orcc %o0, 0, %i5 4000a300: 12 bf ff f5 bne 4000a2d4 <_RBTree_Iterate_unprotected+0x28> 4000a304: b8 1f 20 01 xor %i4, 1, %i4 4000a308: 81 c7 e0 08 ret 4000a30c: 81 e8 00 00 restore =============================================================================== 40008418 <_RTEMS_signal_Post_switch_hook>: #include #include #include static void _RTEMS_signal_Post_switch_hook( Thread_Control *executing ) { 40008418: 9d e3 bf 98 save %sp, -104, %sp RTEMS_API_Control *api; ASR_Information *asr; rtems_signal_set signal_set; Modes_Control prev_mode; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 4000841c: fa 06 21 4c ld [ %i0 + 0x14c ], %i5 if ( !api ) 40008420: 80 a7 60 00 cmp %i5, 0 40008424: 02 80 00 1e be 4000849c <_RTEMS_signal_Post_switch_hook+0x84><== NEVER TAKEN 40008428: 01 00 00 00 nop * Signal Processing */ asr = &api->Signal; _ISR_Disable( level ); 4000842c: 7f ff ea c7 call 40002f48 40008430: 01 00 00 00 nop signal_set = asr->signals_posted; 40008434: f8 07 60 14 ld [ %i5 + 0x14 ], %i4 asr->signals_posted = 0; 40008438: c0 27 60 14 clr [ %i5 + 0x14 ] _ISR_Enable( level ); 4000843c: 7f ff ea c7 call 40002f58 40008440: 01 00 00 00 nop if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ 40008444: 80 a7 20 00 cmp %i4, 0 40008448: 32 80 00 04 bne,a 40008458 <_RTEMS_signal_Post_switch_hook+0x40> 4000844c: c2 07 60 1c ld [ %i5 + 0x1c ], %g1 40008450: 81 c7 e0 08 ret 40008454: 81 e8 00 00 restore return; asr->nest_level += 1; rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 40008458: d0 07 60 10 ld [ %i5 + 0x10 ], %o0 if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ return; asr->nest_level += 1; 4000845c: 82 00 60 01 inc %g1 rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 40008460: 94 07 bf fc add %fp, -4, %o2 40008464: 37 00 00 3f sethi %hi(0xfc00), %i3 if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ return; asr->nest_level += 1; 40008468: c2 27 60 1c st %g1, [ %i5 + 0x1c ] rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 4000846c: 40 00 01 07 call 40008888 40008470: 92 16 e3 ff or %i3, 0x3ff, %o1 (*asr->handler)( signal_set ); 40008474: c2 07 60 0c ld [ %i5 + 0xc ], %g1 40008478: 9f c0 40 00 call %g1 4000847c: 90 10 00 1c mov %i4, %o0 asr->nest_level -= 1; 40008480: c2 07 60 1c ld [ %i5 + 0x1c ], %g1 rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 40008484: d0 07 bf fc ld [ %fp + -4 ], %o0 asr->nest_level += 1; rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); (*asr->handler)( signal_set ); asr->nest_level -= 1; 40008488: 82 00 7f ff add %g1, -1, %g1 rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 4000848c: 92 16 e3 ff or %i3, 0x3ff, %o1 40008490: 94 07 bf fc add %fp, -4, %o2 40008494: 40 00 00 fd call 40008888 40008498: c2 27 60 1c st %g1, [ %i5 + 0x1c ] 4000849c: 81 c7 e0 08 ret 400084a0: 81 e8 00 00 restore =============================================================================== 400077cc <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { 400077cc: 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; 400077d0: 03 10 00 78 sethi %hi(0x4001e000), %g1 400077d4: 82 10 62 e4 or %g1, 0x2e4, %g1 ! 4001e2e4 400077d8: fa 00 60 2c ld [ %g1 + 0x2c ], %i5 maximum = Configuration_RTEMS_API.number_of_initialization_tasks; /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) 400077dc: 80 a7 60 00 cmp %i5, 0 400077e0: 02 80 00 18 be 40007840 <_RTEMS_tasks_Initialize_user_tasks_body+0x74> 400077e4: f6 00 60 28 ld [ %g1 + 0x28 ], %i3 return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 400077e8: 80 a6 e0 00 cmp %i3, 0 400077ec: 02 80 00 15 be 40007840 <_RTEMS_tasks_Initialize_user_tasks_body+0x74><== NEVER TAKEN 400077f0: b8 10 20 00 clr %i4 return_value = rtems_task_create( 400077f4: d4 07 60 04 ld [ %i5 + 4 ], %o2 400077f8: d0 07 40 00 ld [ %i5 ], %o0 400077fc: d2 07 60 08 ld [ %i5 + 8 ], %o1 40007800: d6 07 60 14 ld [ %i5 + 0x14 ], %o3 40007804: d8 07 60 0c ld [ %i5 + 0xc ], %o4 40007808: 7f ff ff 70 call 400075c8 4000780c: 9a 07 bf fc add %fp, -4, %o5 user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) 40007810: 94 92 20 00 orcc %o0, 0, %o2 40007814: 12 80 00 0d bne 40007848 <_RTEMS_tasks_Initialize_user_tasks_body+0x7c> 40007818: d0 07 bf fc ld [ %fp + -4 ], %o0 _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( 4000781c: d4 07 60 18 ld [ %i5 + 0x18 ], %o2 40007820: 40 00 00 0e call 40007858 40007824: d2 07 60 10 ld [ %i5 + 0x10 ], %o1 id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) 40007828: 94 92 20 00 orcc %o0, 0, %o2 4000782c: 12 80 00 07 bne 40007848 <_RTEMS_tasks_Initialize_user_tasks_body+0x7c> 40007830: b8 07 20 01 inc %i4 return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 40007834: 80 a7 00 1b cmp %i4, %i3 40007838: 12 bf ff ef bne 400077f4 <_RTEMS_tasks_Initialize_user_tasks_body+0x28><== NEVER TAKEN 4000783c: ba 07 60 1c add %i5, 0x1c, %i5 40007840: 81 c7 e0 08 ret 40007844: 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 ); 40007848: 90 10 20 01 mov 1, %o0 4000784c: 40 00 04 30 call 4000890c <_Internal_error_Occurred> 40007850: 92 10 20 01 mov 1, %o1 =============================================================================== 4000d020 <_RTEMS_tasks_Switch_extension>: /* * Per Task Variables */ tvp = executing->task_variables; 4000d020: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 while (tvp) { 4000d024: 80 a0 60 00 cmp %g1, 0 4000d028: 22 80 00 0c be,a 4000d058 <_RTEMS_tasks_Switch_extension+0x38> 4000d02c: c2 02 61 58 ld [ %o1 + 0x158 ], %g1 tvp->tval = *tvp->ptr; 4000d030: c4 00 60 04 ld [ %g1 + 4 ], %g2 *tvp->ptr = tvp->gval; 4000d034: c6 00 60 08 ld [ %g1 + 8 ], %g3 * Per Task Variables */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; 4000d038: c8 00 80 00 ld [ %g2 ], %g4 4000d03c: c8 20 60 0c st %g4, [ %g1 + 0xc ] *tvp->ptr = tvp->gval; 4000d040: c6 20 80 00 st %g3, [ %g2 ] tvp = (rtems_task_variable_t *)tvp->next; 4000d044: c2 00 40 00 ld [ %g1 ], %g1 /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { 4000d048: 80 a0 60 00 cmp %g1, 0 4000d04c: 32 bf ff fa bne,a 4000d034 <_RTEMS_tasks_Switch_extension+0x14><== NEVER TAKEN 4000d050: c4 00 60 04 ld [ %g1 + 4 ], %g2 <== NOT EXECUTED tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; 4000d054: c2 02 61 58 ld [ %o1 + 0x158 ], %g1 while (tvp) { 4000d058: 80 a0 60 00 cmp %g1, 0 4000d05c: 02 80 00 0d be 4000d090 <_RTEMS_tasks_Switch_extension+0x70> 4000d060: 01 00 00 00 nop tvp->gval = *tvp->ptr; 4000d064: c4 00 60 04 ld [ %g1 + 4 ], %g2 *tvp->ptr = tvp->tval; 4000d068: 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; 4000d06c: c8 00 80 00 ld [ %g2 ], %g4 4000d070: c8 20 60 08 st %g4, [ %g1 + 8 ] *tvp->ptr = tvp->tval; 4000d074: c6 20 80 00 st %g3, [ %g2 ] tvp = (rtems_task_variable_t *)tvp->next; 4000d078: c2 00 40 00 ld [ %g1 ], %g1 *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { 4000d07c: 80 a0 60 00 cmp %g1, 0 4000d080: 32 bf ff fa bne,a 4000d068 <_RTEMS_tasks_Switch_extension+0x48><== NEVER TAKEN 4000d084: c4 00 60 04 ld [ %g1 + 4 ], %g2 <== NOT EXECUTED 4000d088: 81 c3 e0 08 retl 4000d08c: 01 00 00 00 nop 4000d090: 81 c3 e0 08 retl =============================================================================== 4003768c <_Rate_monotonic_Get_status>: bool _Rate_monotonic_Get_status( Rate_monotonic_Control *the_period, Rate_monotonic_Period_time_t *wall_since_last_period, Thread_CPU_usage_t *cpu_since_last_period ) { 4003768c: 9d e3 bf 98 save %sp, -104, %sp */ static inline void _TOD_Get_uptime( Timestamp_Control *time ) { _TOD_Get_with_nanoseconds( time, &_TOD.uptime ); 40037690: 13 10 01 a0 sethi %hi(0x40068000), %o1 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ Timestamp_Control uptime; #endif Thread_Control *owning_thread = the_period->owner; 40037694: f6 06 20 40 ld [ %i0 + 0x40 ], %i3 40037698: 90 07 bf f8 add %fp, -8, %o0 4003769c: 7f ff 41 e1 call 40007e20 <_TOD_Get_with_nanoseconds> 400376a0: 92 12 63 f0 or %o1, 0x3f0, %o1 /* * Determine elapsed wall time since period initiated. */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 400376a4: c4 1f bf f8 ldd [ %fp + -8 ], %g2 const Timestamp64_Control *_start, const Timestamp64_Control *_end, Timestamp64_Control *_result ) { *_result = *_end - *_start; 400376a8: f8 1e 20 50 ldd [ %i0 + 0x50 ], %i4 * Determine cpu usage since period initiated. */ used = owning_thread->cpu_time_used; #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ if (owning_thread == _Thread_Executing) { 400376ac: 03 10 01 a2 sethi %hi(0x40068800), %g1 400376b0: 82 10 61 b0 or %g1, 0x1b0, %g1 ! 400689b0 <_Per_CPU_Information> 400376b4: de 00 60 10 ld [ %g1 + 0x10 ], %o7 400376b8: ba a0 c0 1d subcc %g3, %i5, %i5 400376bc: b8 60 80 1c subx %g2, %i4, %i4 400376c0: f8 3e 40 00 std %i4, [ %i1 ] if (used < the_period->cpu_usage_period_initiated) return false; *cpu_since_last_period = used - the_period->cpu_usage_period_initiated; #endif return true; 400376c4: 88 10 20 01 mov 1, %g4 * Determine cpu usage since period initiated. */ used = owning_thread->cpu_time_used; #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ if (owning_thread == _Thread_Executing) { 400376c8: 80 a3 c0 1b cmp %o7, %i3 400376cc: 02 80 00 05 be 400376e0 <_Rate_monotonic_Get_status+0x54> 400376d0: f8 1e e0 80 ldd [ %i3 + 0x80 ], %i4 return false; *cpu_since_last_period = used - the_period->cpu_usage_period_initiated; #endif return true; } 400376d4: b0 09 20 01 and %g4, 1, %i0 400376d8: 81 c7 e0 08 ret 400376dc: 81 e8 00 00 restore 400376e0: d8 18 60 20 ldd [ %g1 + 0x20 ], %o4 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400376e4: f0 1e 20 48 ldd [ %i0 + 0x48 ], %i0 400376e8: 86 a0 c0 0d subcc %g3, %o5, %g3 400376ec: 84 60 80 0c subx %g2, %o4, %g2 static inline void _Timestamp64_implementation_Add_to( Timestamp64_Control *_time, const Timestamp64_Control *_add ) { *_time += *_add; 400376f0: 9a 87 40 03 addcc %i5, %g3, %o5 400376f4: 98 47 00 02 addx %i4, %g2, %o4 /* * The cpu usage info was reset while executing. Can't * determine a status. */ if (_Timestamp_Less_than(&used, &the_period->cpu_usage_period_initiated)) 400376f8: 80 a6 00 0c cmp %i0, %o4 400376fc: 14 bf ff f6 bg 400376d4 <_Rate_monotonic_Get_status+0x48> <== NEVER TAKEN 40037700: 88 10 20 00 clr %g4 40037704: 02 80 00 09 be 40037728 <_Rate_monotonic_Get_status+0x9c> 40037708: 80 a6 40 0d cmp %i1, %o5 const Timestamp64_Control *_start, const Timestamp64_Control *_end, Timestamp64_Control *_result ) { *_result = *_end - *_start; 4003770c: 9a a3 40 19 subcc %o5, %i1, %o5 if (used < the_period->cpu_usage_period_initiated) return false; *cpu_since_last_period = used - the_period->cpu_usage_period_initiated; #endif return true; 40037710: 88 10 20 01 mov 1, %g4 40037714: 98 63 00 18 subx %o4, %i0, %o4 } 40037718: b0 09 20 01 and %g4, 1, %i0 4003771c: d8 3e 80 00 std %o4, [ %i2 ] 40037720: 81 c7 e0 08 ret 40037724: 81 e8 00 00 restore /* * The cpu usage info was reset while executing. Can't * determine a status. */ if (_Timestamp_Less_than(&used, &the_period->cpu_usage_period_initiated)) 40037728: 28 bf ff fa bleu,a 40037710 <_Rate_monotonic_Get_status+0x84> 4003772c: 9a a3 40 19 subcc %o5, %i1, %o5 return false; 40037730: 10 bf ff e9 b 400376d4 <_Rate_monotonic_Get_status+0x48> 40037734: 88 10 20 00 clr %g4 =============================================================================== 40037adc <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 40037adc: 9d e3 bf 98 save %sp, -104, %sp 40037ae0: 11 10 01 a3 sethi %hi(0x40068c00), %o0 40037ae4: 92 10 00 18 mov %i0, %o1 40037ae8: 90 12 23 78 or %o0, 0x378, %o0 40037aec: 7f ff 43 a1 call 40008970 <_Objects_Get> 40037af0: 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 ) { 40037af4: c2 07 bf fc ld [ %fp + -4 ], %g1 40037af8: 80 a0 60 00 cmp %g1, 0 40037afc: 12 80 00 16 bne 40037b54 <_Rate_monotonic_Timeout+0x78> <== NEVER TAKEN 40037b00: ba 10 00 08 mov %o0, %i5 case OBJECTS_LOCAL: the_thread = the_period->owner; 40037b04: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 40037b08: 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); 40037b0c: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 40037b10: 80 88 80 01 btst %g2, %g1 40037b14: 22 80 00 08 be,a 40037b34 <_Rate_monotonic_Timeout+0x58> 40037b18: c2 07 60 38 ld [ %i5 + 0x38 ], %g1 40037b1c: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 40037b20: c2 07 60 08 ld [ %i5 + 8 ], %g1 40037b24: 80 a0 80 01 cmp %g2, %g1 40037b28: 02 80 00 19 be 40037b8c <_Rate_monotonic_Timeout+0xb0> 40037b2c: 13 04 01 ff sethi %hi(0x1007fc00), %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 ) { 40037b30: c2 07 60 38 ld [ %i5 + 0x38 ], %g1 40037b34: 80 a0 60 01 cmp %g1, 1 40037b38: 02 80 00 09 be 40037b5c <_Rate_monotonic_Timeout+0x80> 40037b3c: 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; 40037b40: c2 27 60 38 st %g1, [ %i5 + 0x38 ] * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40037b44: 03 10 01 a1 sethi %hi(0x40068400), %g1 40037b48: c4 00 60 a0 ld [ %g1 + 0xa0 ], %g2 ! 400684a0 <_Thread_Dispatch_disable_level> --level; 40037b4c: 84 00 bf ff add %g2, -1, %g2 _Thread_Dispatch_disable_level = level; 40037b50: c4 20 60 a0 st %g2, [ %g1 + 0xa0 ] 40037b54: 81 c7 e0 08 ret 40037b58: 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; 40037b5c: 82 10 20 03 mov 3, %g1 _Rate_monotonic_Initiate_statistics( the_period ); 40037b60: 90 10 00 1d mov %i5, %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; 40037b64: c2 27 60 38 st %g1, [ %i5 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 40037b68: 7f ff ff 43 call 40037874 <_Rate_monotonic_Initiate_statistics> 40037b6c: 01 00 00 00 nop Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40037b70: c2 07 60 3c ld [ %i5 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40037b74: 11 10 01 a1 sethi %hi(0x40068400), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40037b78: c2 27 60 1c st %g1, [ %i5 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40037b7c: 90 12 21 38 or %o0, 0x138, %o0 40037b80: 7f ff 4a 6f call 4000a53c <_Watchdog_Insert> 40037b84: 92 07 60 10 add %i5, 0x10, %o1 40037b88: 30 bf ff ef b,a 40037b44 <_Rate_monotonic_Timeout+0x68> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 40037b8c: 7f ff 46 43 call 40009498 <_Thread_Clear_state> 40037b90: 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 ); 40037b94: 10 bf ff f5 b 40037b68 <_Rate_monotonic_Timeout+0x8c> 40037b98: 90 10 00 1d mov %i5, %o0 =============================================================================== 40037738 <_Rate_monotonic_Update_statistics>: } static void _Rate_monotonic_Update_statistics( Rate_monotonic_Control *the_period ) { 40037738: 9d e3 bf 90 save %sp, -112, %sp /* * Update the counts. */ stats = &the_period->Statistics; stats->count++; 4003773c: c4 06 20 58 ld [ %i0 + 0x58 ], %g2 if ( the_period->state == RATE_MONOTONIC_EXPIRED ) 40037740: c2 06 20 38 ld [ %i0 + 0x38 ], %g1 /* * Update the counts. */ stats = &the_period->Statistics; stats->count++; 40037744: 84 00 a0 01 inc %g2 if ( the_period->state == RATE_MONOTONIC_EXPIRED ) 40037748: 80 a0 60 04 cmp %g1, 4 4003774c: 02 80 00 32 be 40037814 <_Rate_monotonic_Update_statistics+0xdc> 40037750: c4 26 20 58 st %g2, [ %i0 + 0x58 ] stats->missed_count++; /* * Grab status for time statistics. */ valid_status = 40037754: 90 10 00 18 mov %i0, %o0 40037758: 92 07 bf f8 add %fp, -8, %o1 4003775c: 7f ff ff cc call 4003768c <_Rate_monotonic_Get_status> 40037760: 94 07 bf f0 add %fp, -16, %o2 _Rate_monotonic_Get_status( the_period, &since_last_period, &executed ); if (!valid_status) 40037764: 80 8a 20 ff btst 0xff, %o0 40037768: 02 80 00 21 be 400377ec <_Rate_monotonic_Update_statistics+0xb4> 4003776c: c4 1f bf f0 ldd [ %fp + -16 ], %g2 static inline void _Timestamp64_implementation_Add_to( Timestamp64_Control *_time, const Timestamp64_Control *_add ) { *_time += *_add; 40037770: f8 1e 20 70 ldd [ %i0 + 0x70 ], %i4 * Update CPU time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_cpu_time, &executed ); if ( _Timestamp_Less_than( &executed, &stats->min_cpu_time ) ) 40037774: c2 06 20 60 ld [ %i0 + 0x60 ], %g1 40037778: b6 87 40 03 addcc %i5, %g3, %i3 4003777c: b4 47 00 02 addx %i4, %g2, %i2 40037780: 80 a0 40 02 cmp %g1, %g2 40037784: 04 80 00 1c ble 400377f4 <_Rate_monotonic_Update_statistics+0xbc> 40037788: f4 3e 20 70 std %i2, [ %i0 + 0x70 ] stats->min_cpu_time = executed; 4003778c: c4 3e 20 60 std %g2, [ %i0 + 0x60 ] if ( _Timestamp_Greater_than( &executed, &stats->max_cpu_time ) ) 40037790: c2 06 20 68 ld [ %i0 + 0x68 ], %g1 40037794: 80 a0 40 02 cmp %g1, %g2 40037798: 26 80 00 05 bl,a 400377ac <_Rate_monotonic_Update_statistics+0x74><== NEVER TAKEN 4003779c: c4 3e 20 68 std %g2, [ %i0 + 0x68 ] <== NOT EXECUTED 400377a0: 80 a0 40 02 cmp %g1, %g2 400377a4: 22 80 00 28 be,a 40037844 <_Rate_monotonic_Update_statistics+0x10c><== ALWAYS TAKEN 400377a8: c2 06 20 6c ld [ %i0 + 0x6c ], %g1 /* * Update Wall time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_wall_time, &since_last_period ); 400377ac: c4 1f bf f8 ldd [ %fp + -8 ], %g2 400377b0: f8 1e 20 88 ldd [ %i0 + 0x88 ], %i4 if ( _Timestamp_Less_than( &since_last_period, &stats->min_wall_time ) ) 400377b4: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 400377b8: b6 87 40 03 addcc %i5, %g3, %i3 400377bc: b4 47 00 02 addx %i4, %g2, %i2 400377c0: 80 a0 40 02 cmp %g1, %g2 400377c4: 14 80 00 1b bg 40037830 <_Rate_monotonic_Update_statistics+0xf8> 400377c8: f4 3e 20 88 std %i2, [ %i0 + 0x88 ] 400377cc: 80 a0 40 02 cmp %g1, %g2 400377d0: 22 80 00 15 be,a 40037824 <_Rate_monotonic_Update_statistics+0xec><== ALWAYS TAKEN 400377d4: c2 06 20 7c ld [ %i0 + 0x7c ], %g1 stats->min_wall_time = since_last_period; if ( _Timestamp_Greater_than( &since_last_period, &stats->max_wall_time ) ) 400377d8: c2 06 20 80 ld [ %i0 + 0x80 ], %g1 <== NOT EXECUTED 400377dc: 80 a0 40 02 cmp %g1, %g2 400377e0: 16 80 00 1e bge 40037858 <_Rate_monotonic_Update_statistics+0x120><== ALWAYS TAKEN 400377e4: 01 00 00 00 nop stats->max_wall_time = since_last_period; 400377e8: c4 3e 20 80 std %g2, [ %i0 + 0x80 ] <== NOT EXECUTED 400377ec: 81 c7 e0 08 ret 400377f0: 81 e8 00 00 restore * Update CPU time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_cpu_time, &executed ); if ( _Timestamp_Less_than( &executed, &stats->min_cpu_time ) ) 400377f4: 32 bf ff e8 bne,a 40037794 <_Rate_monotonic_Update_statistics+0x5c><== NEVER TAKEN 400377f8: c2 06 20 68 ld [ %i0 + 0x68 ], %g1 <== NOT EXECUTED 400377fc: c2 06 20 64 ld [ %i0 + 0x64 ], %g1 40037800: 80 a0 40 03 cmp %g1, %g3 40037804: 28 bf ff e4 bleu,a 40037794 <_Rate_monotonic_Update_statistics+0x5c> 40037808: c2 06 20 68 ld [ %i0 + 0x68 ], %g1 stats->min_cpu_time = executed; 4003780c: 10 bf ff e1 b 40037790 <_Rate_monotonic_Update_statistics+0x58> 40037810: c4 3e 20 60 std %g2, [ %i0 + 0x60 ] */ stats = &the_period->Statistics; stats->count++; if ( the_period->state == RATE_MONOTONIC_EXPIRED ) stats->missed_count++; 40037814: c2 06 20 5c ld [ %i0 + 0x5c ], %g1 40037818: 82 00 60 01 inc %g1 4003781c: 10 bf ff ce b 40037754 <_Rate_monotonic_Update_statistics+0x1c> 40037820: c2 26 20 5c st %g1, [ %i0 + 0x5c ] * Update Wall time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_wall_time, &since_last_period ); if ( _Timestamp_Less_than( &since_last_period, &stats->min_wall_time ) ) 40037824: 80 a0 40 03 cmp %g1, %g3 40037828: 28 bf ff ed bleu,a 400377dc <_Rate_monotonic_Update_statistics+0xa4> 4003782c: c2 06 20 80 ld [ %i0 + 0x80 ], %g1 stats->min_wall_time = since_last_period; if ( _Timestamp_Greater_than( &since_last_period, &stats->max_wall_time ) ) 40037830: c2 06 20 80 ld [ %i0 + 0x80 ], %g1 40037834: 80 a0 40 02 cmp %g1, %g2 40037838: 06 bf ff ec bl 400377e8 <_Rate_monotonic_Update_statistics+0xb0><== NEVER TAKEN 4003783c: c4 3e 20 78 std %g2, [ %i0 + 0x78 ] 40037840: 30 80 00 06 b,a 40037858 <_Rate_monotonic_Update_statistics+0x120> _Timestamp_Add_to( &stats->total_cpu_time, &executed ); if ( _Timestamp_Less_than( &executed, &stats->min_cpu_time ) ) stats->min_cpu_time = executed; if ( _Timestamp_Greater_than( &executed, &stats->max_cpu_time ) ) 40037844: 80 a0 40 03 cmp %g1, %g3 40037848: 3a bf ff da bcc,a 400377b0 <_Rate_monotonic_Update_statistics+0x78> 4003784c: c4 1f bf f8 ldd [ %fp + -8 ], %g2 stats->max_cpu_time = executed; 40037850: 10 bf ff d7 b 400377ac <_Rate_monotonic_Update_statistics+0x74> 40037854: c4 3e 20 68 std %g2, [ %i0 + 0x68 ] _Timestamp_Add_to( &stats->total_wall_time, &since_last_period ); if ( _Timestamp_Less_than( &since_last_period, &stats->min_wall_time ) ) stats->min_wall_time = since_last_period; if ( _Timestamp_Greater_than( &since_last_period, &stats->max_wall_time ) ) 40037858: 12 bf ff e5 bne 400377ec <_Rate_monotonic_Update_statistics+0xb4><== NEVER TAKEN 4003785c: 01 00 00 00 nop 40037860: c2 06 20 84 ld [ %i0 + 0x84 ], %g1 40037864: 80 a0 40 03 cmp %g1, %g3 40037868: 2a bf ff e1 bcs,a 400377ec <_Rate_monotonic_Update_statistics+0xb4> 4003786c: c4 3e 20 80 std %g2, [ %i0 + 0x80 ] 40037870: 30 bf ff df b,a 400377ec <_Rate_monotonic_Update_statistics+0xb4> =============================================================================== 40009dbc <_Scheduler_CBS_Allocate>: #include void *_Scheduler_CBS_Allocate( Thread_Control *the_thread ) { 40009dbc: 9d e3 bf a0 save %sp, -96, %sp void *sched; Scheduler_CBS_Per_thread *schinfo; sched = _Workspace_Allocate(sizeof(Scheduler_CBS_Per_thread)); 40009dc0: 40 00 07 11 call 4000ba04 <_Workspace_Allocate> 40009dc4: 90 10 20 1c mov 0x1c, %o0 if ( sched ) { 40009dc8: 80 a2 20 00 cmp %o0, 0 40009dcc: 02 80 00 06 be 40009de4 <_Scheduler_CBS_Allocate+0x28> <== NEVER TAKEN 40009dd0: 82 10 20 02 mov 2, %g1 the_thread->scheduler_info = sched; 40009dd4: d0 26 20 88 st %o0, [ %i0 + 0x88 ] schinfo = (Scheduler_CBS_Per_thread *)(the_thread->scheduler_info); schinfo->edf_per_thread.thread = the_thread; 40009dd8: f0 22 00 00 st %i0, [ %o0 ] schinfo->edf_per_thread.queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN; 40009ddc: c2 22 20 14 st %g1, [ %o0 + 0x14 ] schinfo->cbs_server = NULL; 40009de0: c0 22 20 18 clr [ %o0 + 0x18 ] } return sched; } 40009de4: 81 c7 e0 08 ret 40009de8: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 4000b190 <_Scheduler_CBS_Budget_callout>: Scheduler_CBS_Server **_Scheduler_CBS_Server_list; void _Scheduler_CBS_Budget_callout( Thread_Control *the_thread ) { 4000b190: 9d e3 bf 98 save %sp, -104, %sp Priority_Control new_priority; Scheduler_CBS_Per_thread *sched_info; Scheduler_CBS_Server_id server_id; /* Put violating task to background until the end of period. */ new_priority = the_thread->Start.initial_priority; 4000b194: d2 06 20 ac ld [ %i0 + 0xac ], %o1 if ( the_thread->real_priority != new_priority ) 4000b198: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 4000b19c: 80 a0 40 09 cmp %g1, %o1 4000b1a0: 32 80 00 02 bne,a 4000b1a8 <_Scheduler_CBS_Budget_callout+0x18><== ALWAYS TAKEN 4000b1a4: d2 26 20 18 st %o1, [ %i0 + 0x18 ] the_thread->real_priority = new_priority; if ( the_thread->current_priority != new_priority ) 4000b1a8: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 4000b1ac: 80 a0 40 09 cmp %g1, %o1 4000b1b0: 02 80 00 04 be 4000b1c0 <_Scheduler_CBS_Budget_callout+0x30><== NEVER TAKEN 4000b1b4: 90 10 00 18 mov %i0, %o0 _Thread_Change_priority(the_thread, new_priority, true); 4000b1b8: 40 00 01 92 call 4000b800 <_Thread_Change_priority> 4000b1bc: 94 10 20 01 mov 1, %o2 /* Invoke callback function if any. */ sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info; 4000b1c0: fa 06 20 88 ld [ %i0 + 0x88 ], %i5 if ( sched_info->cbs_server->cbs_budget_overrun ) { 4000b1c4: c2 07 60 18 ld [ %i5 + 0x18 ], %g1 4000b1c8: c4 00 60 0c ld [ %g1 + 0xc ], %g2 4000b1cc: 80 a0 a0 00 cmp %g2, 0 4000b1d0: 02 80 00 09 be 4000b1f4 <_Scheduler_CBS_Budget_callout+0x64><== NEVER TAKEN 4000b1d4: 01 00 00 00 nop _Scheduler_CBS_Get_server_id( 4000b1d8: d0 00 40 00 ld [ %g1 ], %o0 4000b1dc: 7f ff ff d5 call 4000b130 <_Scheduler_CBS_Get_server_id> 4000b1e0: 92 07 bf fc add %fp, -4, %o1 sched_info->cbs_server->task_id, &server_id ); sched_info->cbs_server->cbs_budget_overrun( server_id ); 4000b1e4: c2 07 60 18 ld [ %i5 + 0x18 ], %g1 4000b1e8: c2 00 60 0c ld [ %g1 + 0xc ], %g1 4000b1ec: 9f c0 40 00 call %g1 4000b1f0: d0 07 bf fc ld [ %fp + -4 ], %o0 4000b1f4: 81 c7 e0 08 ret 4000b1f8: 81 e8 00 00 restore =============================================================================== 4000ace8 <_Scheduler_CBS_Cleanup>: #include #include #include int _Scheduler_CBS_Cleanup (void) { 4000ace8: 9d e3 bf a0 save %sp, -96, %sp unsigned int i; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { 4000acec: 39 10 00 86 sethi %hi(0x40021800), %i4 4000acf0: c2 07 23 20 ld [ %i4 + 0x320 ], %g1 ! 40021b20 <_Scheduler_CBS_Maximum_servers> 4000acf4: 80 a0 60 00 cmp %g1, 0 4000acf8: 02 80 00 18 be 4000ad58 <_Scheduler_CBS_Cleanup+0x70> <== NEVER TAKEN 4000acfc: 03 10 00 8b sethi %hi(0x40022c00), %g1 4000ad00: 37 10 00 8b sethi %hi(0x40022c00), %i3 4000ad04: c4 06 e0 38 ld [ %i3 + 0x38 ], %g2 ! 40022c38 <_Scheduler_CBS_Server_list> 4000ad08: ba 10 20 00 clr %i5 4000ad0c: b8 17 23 20 or %i4, 0x320, %i4 if ( _Scheduler_CBS_Server_list[ i ] ) 4000ad10: 83 2f 60 02 sll %i5, 2, %g1 4000ad14: c2 00 80 01 ld [ %g2 + %g1 ], %g1 4000ad18: 80 a0 60 00 cmp %g1, 0 4000ad1c: 02 80 00 05 be 4000ad30 <_Scheduler_CBS_Cleanup+0x48> 4000ad20: 90 10 00 1d mov %i5, %o0 _Scheduler_CBS_Destroy_server( i ); 4000ad24: 40 00 00 46 call 4000ae3c <_Scheduler_CBS_Destroy_server> 4000ad28: 01 00 00 00 nop 4000ad2c: c4 06 e0 38 ld [ %i3 + 0x38 ], %g2 int _Scheduler_CBS_Cleanup (void) { unsigned int i; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { 4000ad30: c2 07 00 00 ld [ %i4 ], %g1 4000ad34: ba 07 60 01 inc %i5 4000ad38: 80 a0 40 1d cmp %g1, %i5 4000ad3c: 18 bf ff f6 bgu 4000ad14 <_Scheduler_CBS_Cleanup+0x2c> 4000ad40: 83 2f 60 02 sll %i5, 2, %g1 if ( _Scheduler_CBS_Server_list[ i ] ) _Scheduler_CBS_Destroy_server( i ); } _Workspace_Free( _Scheduler_CBS_Server_list ); return SCHEDULER_CBS_OK; } 4000ad44: b0 10 20 00 clr %i0 for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { if ( _Scheduler_CBS_Server_list[ i ] ) _Scheduler_CBS_Destroy_server( i ); } _Workspace_Free( _Scheduler_CBS_Server_list ); 4000ad48: 40 00 08 41 call 4000ce4c <_Workspace_Free> 4000ad4c: 90 10 00 02 mov %g2, %o0 return SCHEDULER_CBS_OK; } 4000ad50: 81 c7 e0 08 ret 4000ad54: 81 e8 00 00 restore 4000ad58: 10 bf ff fb b 4000ad44 <_Scheduler_CBS_Cleanup+0x5c> <== NOT EXECUTED 4000ad5c: c4 00 60 38 ld [ %g1 + 0x38 ], %g2 <== NOT EXECUTED =============================================================================== 4000ad60 <_Scheduler_CBS_Create_server>: int _Scheduler_CBS_Create_server ( Scheduler_CBS_Parameters *params, Scheduler_CBS_Budget_overrun budget_overrun_callback, rtems_id *server_id ) { 4000ad60: 9d e3 bf a0 save %sp, -96, %sp unsigned int i; Scheduler_CBS_Server *the_server; if ( params->budget <= 0 || 4000ad64: c2 06 20 04 ld [ %i0 + 4 ], %g1 4000ad68: 80 a0 60 00 cmp %g1, 0 4000ad6c: 04 80 00 30 ble 4000ae2c <_Scheduler_CBS_Create_server+0xcc> 4000ad70: b8 10 00 18 mov %i0, %i4 4000ad74: c2 06 00 00 ld [ %i0 ], %g1 4000ad78: 80 a0 60 00 cmp %g1, 0 4000ad7c: 04 80 00 2c ble 4000ae2c <_Scheduler_CBS_Create_server+0xcc> 4000ad80: 03 10 00 86 sethi %hi(0x40021800), %g1 params->deadline <= 0 || params->budget >= SCHEDULER_EDF_PRIO_MSB || params->deadline >= SCHEDULER_EDF_PRIO_MSB ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { 4000ad84: c8 00 63 20 ld [ %g1 + 0x320 ], %g4 ! 40021b20 <_Scheduler_CBS_Maximum_servers> 4000ad88: 80 a1 20 00 cmp %g4, 0 4000ad8c: 02 80 00 11 be 4000add0 <_Scheduler_CBS_Create_server+0x70><== NEVER TAKEN 4000ad90: 37 10 00 8b sethi %hi(0x40022c00), %i3 if ( !_Scheduler_CBS_Server_list[i] ) 4000ad94: fa 06 e0 38 ld [ %i3 + 0x38 ], %i5 ! 40022c38 <_Scheduler_CBS_Server_list> 4000ad98: c2 07 40 00 ld [ %i5 ], %g1 4000ad9c: 80 a0 60 00 cmp %g1, 0 4000ada0: 02 80 00 21 be 4000ae24 <_Scheduler_CBS_Create_server+0xc4> 4000ada4: b0 10 20 00 clr %i0 4000ada8: 10 80 00 06 b 4000adc0 <_Scheduler_CBS_Create_server+0x60> 4000adac: 82 10 20 00 clr %g1 4000adb0: c6 07 40 02 ld [ %i5 + %g2 ], %g3 4000adb4: 80 a0 e0 00 cmp %g3, 0 4000adb8: 02 80 00 08 be 4000add8 <_Scheduler_CBS_Create_server+0x78> 4000adbc: b0 10 00 02 mov %g2, %i0 params->deadline <= 0 || params->budget >= SCHEDULER_EDF_PRIO_MSB || params->deadline >= SCHEDULER_EDF_PRIO_MSB ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { 4000adc0: 82 00 60 01 inc %g1 4000adc4: 80 a0 40 04 cmp %g1, %g4 4000adc8: 12 bf ff fa bne 4000adb0 <_Scheduler_CBS_Create_server+0x50> 4000adcc: 85 28 60 02 sll %g1, 2, %g2 if ( !_Scheduler_CBS_Server_list[i] ) break; } if ( i == _Scheduler_CBS_Maximum_servers ) return SCHEDULER_CBS_ERROR_FULL; 4000add0: 81 c7 e0 08 ret 4000add4: 91 e8 3f e6 restore %g0, -26, %o0 *server_id = i; 4000add8: c2 26 80 00 st %g1, [ %i2 ] _Scheduler_CBS_Server_list[*server_id] = (Scheduler_CBS_Server *) _Workspace_Allocate( sizeof(Scheduler_CBS_Server) ); 4000addc: 40 00 08 14 call 4000ce2c <_Workspace_Allocate> 4000ade0: 90 10 20 10 mov 0x10, %o0 the_server = _Scheduler_CBS_Server_list[*server_id]; 4000ade4: c2 06 80 00 ld [ %i2 ], %g1 if ( i == _Scheduler_CBS_Maximum_servers ) return SCHEDULER_CBS_ERROR_FULL; *server_id = i; _Scheduler_CBS_Server_list[*server_id] = (Scheduler_CBS_Server *) 4000ade8: d0 27 40 18 st %o0, [ %i5 + %i0 ] _Workspace_Allocate( sizeof(Scheduler_CBS_Server) ); the_server = _Scheduler_CBS_Server_list[*server_id]; 4000adec: c4 06 e0 38 ld [ %i3 + 0x38 ], %g2 4000adf0: 83 28 60 02 sll %g1, 2, %g1 4000adf4: c2 00 80 01 ld [ %g2 + %g1 ], %g1 if ( !the_server ) 4000adf8: 80 a0 60 00 cmp %g1, 0 4000adfc: 02 80 00 0e be 4000ae34 <_Scheduler_CBS_Create_server+0xd4><== NEVER TAKEN 4000ae00: 86 10 3f ff mov -1, %g3 return SCHEDULER_CBS_ERROR_NO_MEMORY; the_server->parameters = *params; 4000ae04: c4 07 00 00 ld [ %i4 ], %g2 4000ae08: c4 20 60 04 st %g2, [ %g1 + 4 ] 4000ae0c: c4 07 20 04 ld [ %i4 + 4 ], %g2 the_server->task_id = -1; 4000ae10: c6 20 40 00 st %g3, [ %g1 ] _Workspace_Allocate( sizeof(Scheduler_CBS_Server) ); the_server = _Scheduler_CBS_Server_list[*server_id]; if ( !the_server ) return SCHEDULER_CBS_ERROR_NO_MEMORY; the_server->parameters = *params; 4000ae14: c4 20 60 08 st %g2, [ %g1 + 8 ] the_server->task_id = -1; the_server->cbs_budget_overrun = budget_overrun_callback; 4000ae18: f2 20 60 0c st %i1, [ %g1 + 0xc ] return SCHEDULER_CBS_OK; 4000ae1c: 81 c7 e0 08 ret 4000ae20: 91 e8 20 00 restore %g0, 0, %o0 params->budget >= SCHEDULER_EDF_PRIO_MSB || params->deadline >= SCHEDULER_EDF_PRIO_MSB ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { if ( !_Scheduler_CBS_Server_list[i] ) 4000ae24: 10 bf ff ed b 4000add8 <_Scheduler_CBS_Create_server+0x78> 4000ae28: 82 10 20 00 clr %g1 if ( params->budget <= 0 || params->deadline <= 0 || params->budget >= SCHEDULER_EDF_PRIO_MSB || params->deadline >= SCHEDULER_EDF_PRIO_MSB ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; 4000ae2c: 81 c7 e0 08 ret 4000ae30: 91 e8 3f ee restore %g0, -18, %o0 the_server->parameters = *params; the_server->task_id = -1; the_server->cbs_budget_overrun = budget_overrun_callback; return SCHEDULER_CBS_OK; } 4000ae34: 81 c7 e0 08 ret <== NOT EXECUTED 4000ae38: 91 e8 3f ef restore %g0, -17, %o0 <== NOT EXECUTED =============================================================================== 4000aebc <_Scheduler_CBS_Detach_thread>: int _Scheduler_CBS_Detach_thread ( Scheduler_CBS_Server_id server_id, rtems_id task_id ) { 4000aebc: 9d e3 bf 98 save %sp, -104, %sp Objects_Locations location; Thread_Control *the_thread; Scheduler_CBS_Per_thread *sched_info; the_thread = _Thread_Get(task_id, &location); 4000aec0: 92 07 bf fc add %fp, -4, %o1 4000aec4: 40 00 03 95 call 4000bd18 <_Thread_Get> 4000aec8: 90 10 00 19 mov %i1, %o0 /* The routine _Thread_Get may disable dispatch and not enable again. */ if ( the_thread ) { 4000aecc: ba 92 20 00 orcc %o0, 0, %i5 4000aed0: 02 80 00 1e be 4000af48 <_Scheduler_CBS_Detach_thread+0x8c> 4000aed4: 01 00 00 00 nop _Thread_Enable_dispatch(); 4000aed8: 40 00 03 84 call 4000bce8 <_Thread_Enable_dispatch> 4000aedc: 01 00 00 00 nop } if ( server_id >= _Scheduler_CBS_Maximum_servers ) 4000aee0: 03 10 00 86 sethi %hi(0x40021800), %g1 4000aee4: c2 00 63 20 ld [ %g1 + 0x320 ], %g1 ! 40021b20 <_Scheduler_CBS_Maximum_servers> 4000aee8: 80 a6 00 01 cmp %i0, %g1 4000aeec: 1a 80 00 17 bcc 4000af48 <_Scheduler_CBS_Detach_thread+0x8c> 4000aef0: 03 10 00 8b sethi %hi(0x40022c00), %g1 return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; if ( !the_thread ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; /* Server is not valid. */ if ( !_Scheduler_CBS_Server_list[server_id] ) 4000aef4: c2 00 60 38 ld [ %g1 + 0x38 ], %g1 ! 40022c38 <_Scheduler_CBS_Server_list> 4000aef8: b1 2e 20 02 sll %i0, 2, %i0 4000aefc: c2 00 40 18 ld [ %g1 + %i0 ], %g1 4000af00: 80 a0 60 00 cmp %g1, 0 4000af04: 02 80 00 13 be 4000af50 <_Scheduler_CBS_Detach_thread+0x94> 4000af08: 01 00 00 00 nop return SCHEDULER_CBS_ERROR_NOSERVER; /* Thread and server are not attached. */ if ( _Scheduler_CBS_Server_list[server_id]->task_id != task_id ) 4000af0c: c4 00 40 00 ld [ %g1 ], %g2 4000af10: 80 a0 80 19 cmp %g2, %i1 4000af14: 12 80 00 0d bne 4000af48 <_Scheduler_CBS_Detach_thread+0x8c><== NEVER TAKEN 4000af18: 84 10 3f ff mov -1, %g2 return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; _Scheduler_CBS_Server_list[server_id]->task_id = -1; sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info; sched_info->cbs_server = NULL; 4000af1c: c8 07 60 88 ld [ %i5 + 0x88 ], %g4 the_thread->budget_algorithm = the_thread->Start.budget_algorithm; 4000af20: c6 07 60 a0 ld [ %i5 + 0xa0 ], %g3 return SCHEDULER_CBS_ERROR_NOSERVER; /* Thread and server are not attached. */ if ( _Scheduler_CBS_Server_list[server_id]->task_id != task_id ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; _Scheduler_CBS_Server_list[server_id]->task_id = -1; 4000af24: c4 20 40 00 st %g2, [ %g1 ] sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info; sched_info->cbs_server = NULL; the_thread->budget_algorithm = the_thread->Start.budget_algorithm; the_thread->budget_callout = the_thread->Start.budget_callout; 4000af28: c4 07 60 a4 ld [ %i5 + 0xa4 ], %g2 the_thread->is_preemptible = the_thread->Start.is_preemptible; 4000af2c: c2 0f 60 9c ldub [ %i5 + 0x9c ], %g1 if ( _Scheduler_CBS_Server_list[server_id]->task_id != task_id ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; _Scheduler_CBS_Server_list[server_id]->task_id = -1; sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info; sched_info->cbs_server = NULL; 4000af30: c0 21 20 18 clr [ %g4 + 0x18 ] the_thread->budget_algorithm = the_thread->Start.budget_algorithm; 4000af34: c6 27 60 78 st %g3, [ %i5 + 0x78 ] the_thread->budget_callout = the_thread->Start.budget_callout; 4000af38: c4 27 60 7c st %g2, [ %i5 + 0x7c ] the_thread->is_preemptible = the_thread->Start.is_preemptible; 4000af3c: c2 2f 60 70 stb %g1, [ %i5 + 0x70 ] return SCHEDULER_CBS_OK; 4000af40: 81 c7 e0 08 ret 4000af44: 91 e8 20 00 restore %g0, 0, %o0 if ( the_thread ) { _Thread_Enable_dispatch(); } if ( server_id >= _Scheduler_CBS_Maximum_servers ) return SCHEDULER_CBS_ERROR_INVALID_PARAMETER; 4000af48: 81 c7 e0 08 ret 4000af4c: 91 e8 3f ee restore %g0, -18, %o0 the_thread->budget_algorithm = the_thread->Start.budget_algorithm; the_thread->budget_callout = the_thread->Start.budget_callout; the_thread->is_preemptible = the_thread->Start.is_preemptible; return SCHEDULER_CBS_OK; } 4000af50: 81 c7 e0 08 ret 4000af54: 91 e8 3f e7 restore %g0, -25, %o0 =============================================================================== 4000b130 <_Scheduler_CBS_Get_server_id>: rtems_id task_id, Scheduler_CBS_Server_id *server_id ) { unsigned int i; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { 4000b130: 03 10 00 86 sethi %hi(0x40021800), %g1 4000b134: c6 00 63 20 ld [ %g1 + 0x320 ], %g3 ! 40021b20 <_Scheduler_CBS_Maximum_servers> 4000b138: 80 a0 e0 00 cmp %g3, 0 4000b13c: 02 80 00 11 be 4000b180 <_Scheduler_CBS_Get_server_id+0x50><== NEVER TAKEN 4000b140: 03 10 00 8b sethi %hi(0x40022c00), %g1 4000b144: c8 00 60 38 ld [ %g1 + 0x38 ], %g4 ! 40022c38 <_Scheduler_CBS_Server_list> 4000b148: 82 10 20 00 clr %g1 #include #include #include #include int _Scheduler_CBS_Get_server_id ( 4000b14c: 85 28 60 02 sll %g1, 2, %g2 Scheduler_CBS_Server_id *server_id ) { unsigned int i; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { if ( _Scheduler_CBS_Server_list[i] && 4000b150: c4 01 00 02 ld [ %g4 + %g2 ], %g2 4000b154: 80 a0 a0 00 cmp %g2, 0 4000b158: 22 80 00 07 be,a 4000b174 <_Scheduler_CBS_Get_server_id+0x44> 4000b15c: 82 00 60 01 inc %g1 4000b160: c4 00 80 00 ld [ %g2 ], %g2 4000b164: 80 a0 80 08 cmp %g2, %o0 4000b168: 22 80 00 08 be,a 4000b188 <_Scheduler_CBS_Get_server_id+0x58> 4000b16c: c2 22 40 00 st %g1, [ %o1 ] rtems_id task_id, Scheduler_CBS_Server_id *server_id ) { unsigned int i; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { 4000b170: 82 00 60 01 inc %g1 4000b174: 80 a0 40 03 cmp %g1, %g3 4000b178: 12 bf ff f6 bne 4000b150 <_Scheduler_CBS_Get_server_id+0x20> 4000b17c: 85 28 60 02 sll %g1, 2, %g2 *server_id = i; return SCHEDULER_CBS_OK; } } return SCHEDULER_CBS_ERROR_NOSERVER; } 4000b180: 81 c3 e0 08 retl 4000b184: 90 10 3f e7 mov -25, %o0 unsigned int i; for ( i = 0; i<_Scheduler_CBS_Maximum_servers; i++ ) { if ( _Scheduler_CBS_Server_list[i] && _Scheduler_CBS_Server_list[i]->task_id == task_id ) { *server_id = i; return SCHEDULER_CBS_OK; 4000b188: 81 c3 e0 08 retl 4000b18c: 90 10 20 00 clr %o0 =============================================================================== 4000b1fc <_Scheduler_CBS_Initialize>: } } int _Scheduler_CBS_Initialize(void) { 4000b1fc: 9d e3 bf a0 save %sp, -96, %sp unsigned int i; _Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate( _Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) ); 4000b200: 3b 10 00 86 sethi %hi(0x40021800), %i5 4000b204: d0 07 63 20 ld [ %i5 + 0x320 ], %o0 ! 40021b20 <_Scheduler_CBS_Maximum_servers> } int _Scheduler_CBS_Initialize(void) { unsigned int i; _Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate( 4000b208: 40 00 07 09 call 4000ce2c <_Workspace_Allocate> 4000b20c: 91 2a 20 02 sll %o0, 2, %o0 4000b210: 09 10 00 8b sethi %hi(0x40022c00), %g4 _Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) ); if ( !_Scheduler_CBS_Server_list ) 4000b214: 80 a2 20 00 cmp %o0, 0 4000b218: 02 80 00 10 be 4000b258 <_Scheduler_CBS_Initialize+0x5c> <== NEVER TAKEN 4000b21c: d0 21 20 38 st %o0, [ %g4 + 0x38 ] return SCHEDULER_CBS_ERROR_NO_MEMORY; for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) { 4000b220: c6 07 63 20 ld [ %i5 + 0x320 ], %g3 4000b224: 80 a0 e0 00 cmp %g3, 0 4000b228: 12 80 00 05 bne 4000b23c <_Scheduler_CBS_Initialize+0x40> <== ALWAYS TAKEN 4000b22c: 82 10 20 00 clr %g1 _Scheduler_CBS_Server_list[i] = NULL; } return SCHEDULER_CBS_OK; 4000b230: 81 c7 e0 08 ret <== NOT EXECUTED 4000b234: 91 e8 20 00 restore %g0, 0, %o0 <== NOT EXECUTED 4000b238: d0 01 20 38 ld [ %g4 + 0x38 ], %o0 _Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate( _Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) ); if ( !_Scheduler_CBS_Server_list ) return SCHEDULER_CBS_ERROR_NO_MEMORY; for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) { _Scheduler_CBS_Server_list[i] = NULL; 4000b23c: 85 28 60 02 sll %g1, 2, %g2 unsigned int i; _Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate( _Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) ); if ( !_Scheduler_CBS_Server_list ) return SCHEDULER_CBS_ERROR_NO_MEMORY; for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) { 4000b240: 82 00 60 01 inc %g1 4000b244: 80 a0 40 03 cmp %g1, %g3 4000b248: 12 bf ff fc bne 4000b238 <_Scheduler_CBS_Initialize+0x3c> 4000b24c: c0 22 00 02 clr [ %o0 + %g2 ] _Scheduler_CBS_Server_list[i] = NULL; } return SCHEDULER_CBS_OK; 4000b250: 81 c7 e0 08 ret 4000b254: 91 e8 20 00 restore %g0, 0, %o0 { unsigned int i; _Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate( _Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) ); if ( !_Scheduler_CBS_Server_list ) return SCHEDULER_CBS_ERROR_NO_MEMORY; 4000b258: b0 10 3f ef mov -17, %i0 <== NOT EXECUTED for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) { _Scheduler_CBS_Server_list[i] = NULL; } return SCHEDULER_CBS_OK; } 4000b25c: 81 c7 e0 08 ret <== NOT EXECUTED 4000b260: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40009dec <_Scheduler_CBS_Release_job>: { Priority_Control new_priority; Scheduler_CBS_Per_thread *sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info; Scheduler_CBS_Server *serv_info = (Scheduler_CBS_Server *) sched_info->cbs_server; 40009dec: c2 02 20 88 ld [ %o0 + 0x88 ], %g1 if (deadline) { 40009df0: 80 a2 60 00 cmp %o1, 0 40009df4: 02 80 00 11 be 40009e38 <_Scheduler_CBS_Release_job+0x4c> 40009df8: c2 00 60 18 ld [ %g1 + 0x18 ], %g1 /* Initializing or shifting deadline. */ if (serv_info) 40009dfc: 80 a0 60 00 cmp %g1, 0 40009e00: 02 80 00 13 be 40009e4c <_Scheduler_CBS_Release_job+0x60> 40009e04: 07 10 00 83 sethi %hi(0x40020c00), %g3 new_priority = (_Watchdog_Ticks_since_boot + serv_info->parameters.deadline) 40009e08: c4 00 60 04 ld [ %g1 + 4 ], %g2 40009e0c: d2 00 e0 08 ld [ %g3 + 8 ], %o1 40009e10: 92 02 40 02 add %o1, %g2, %o1 40009e14: 05 20 00 00 sethi %hi(0x80000000), %g2 40009e18: 92 2a 40 02 andn %o1, %g2, %o1 new_priority = the_thread->Start.initial_priority; } /* Budget replenishment for the next job. */ if (serv_info) the_thread->cpu_time_budget = serv_info->parameters.budget; 40009e1c: c2 00 60 08 ld [ %g1 + 8 ], %g1 40009e20: c2 22 20 74 st %g1, [ %o0 + 0x74 ] the_thread->real_priority = new_priority; 40009e24: d2 22 20 18 st %o1, [ %o0 + 0x18 ] _Thread_Change_priority(the_thread, new_priority, true); 40009e28: 94 10 20 01 mov 1, %o2 40009e2c: 82 13 c0 00 mov %o7, %g1 40009e30: 40 00 01 3a call 4000a318 <_Thread_Change_priority> 40009e34: 9e 10 40 00 mov %g1, %o7 /* Switch back to background priority. */ new_priority = the_thread->Start.initial_priority; } /* Budget replenishment for the next job. */ if (serv_info) 40009e38: 80 a0 60 00 cmp %g1, 0 40009e3c: 12 bf ff f8 bne 40009e1c <_Scheduler_CBS_Release_job+0x30><== ALWAYS TAKEN 40009e40: d2 02 20 ac ld [ %o0 + 0xac ], %o1 the_thread->cpu_time_budget = serv_info->parameters.budget; the_thread->real_priority = new_priority; 40009e44: 10 bf ff f9 b 40009e28 <_Scheduler_CBS_Release_job+0x3c> <== NOT EXECUTED 40009e48: d2 22 20 18 st %o1, [ %o0 + 0x18 ] <== NOT EXECUTED /* Initializing or shifting deadline. */ if (serv_info) new_priority = (_Watchdog_Ticks_since_boot + serv_info->parameters.deadline) & ~SCHEDULER_EDF_PRIO_MSB; else new_priority = (_Watchdog_Ticks_since_boot + deadline) 40009e4c: 03 10 00 83 sethi %hi(0x40020c00), %g1 40009e50: c2 00 60 08 ld [ %g1 + 8 ], %g1 ! 40020c08 <_Watchdog_Ticks_since_boot> 40009e54: 92 02 40 01 add %o1, %g1, %o1 40009e58: 03 20 00 00 sethi %hi(0x80000000), %g1 40009e5c: 10 bf ff f2 b 40009e24 <_Scheduler_CBS_Release_job+0x38> 40009e60: 92 2a 40 01 andn %o1, %g1, %o1 =============================================================================== 40009e64 <_Scheduler_CBS_Unblock>: #include void _Scheduler_CBS_Unblock( Thread_Control *the_thread ) { 40009e64: 9d e3 bf a0 save %sp, -96, %sp Scheduler_CBS_Per_thread *sched_info; Scheduler_CBS_Server *serv_info; Priority_Control new_priority; _Scheduler_EDF_Enqueue(the_thread); 40009e68: 40 00 00 50 call 40009fa8 <_Scheduler_EDF_Enqueue> 40009e6c: 90 10 00 18 mov %i0, %o0 /* TODO: flash critical section? */ sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info; serv_info = (Scheduler_CBS_Server *) sched_info->cbs_server; 40009e70: c2 06 20 88 ld [ %i0 + 0x88 ], %g1 40009e74: fa 00 60 18 ld [ %g1 + 0x18 ], %i5 * Late unblock rule for deadline-driven tasks. The remaining time to * deadline must be sufficient to serve the remaining computation time * without increased utilization of this task. It might cause a deadline * miss of another task. */ if (serv_info) { 40009e78: 80 a7 60 00 cmp %i5, 0 40009e7c: 02 80 00 19 be 40009ee0 <_Scheduler_CBS_Unblock+0x7c> 40009e80: 03 10 00 83 sethi %hi(0x40020c00), %g1 time_t budget = serv_info->parameters.budget; time_t deadline_left = the_thread->cpu_time_budget; time_t budget_left = the_thread->real_priority - _Watchdog_Ticks_since_boot; if ( deadline*budget_left > budget*deadline_left ) { 40009e84: d2 07 60 04 ld [ %i5 + 4 ], %o1 */ if (serv_info) { time_t deadline = serv_info->parameters.deadline; time_t budget = serv_info->parameters.budget; time_t deadline_left = the_thread->cpu_time_budget; time_t budget_left = the_thread->real_priority - 40009e88: d0 00 60 08 ld [ %g1 + 8 ], %o0 40009e8c: f8 06 20 18 ld [ %i0 + 0x18 ], %i4 _Watchdog_Ticks_since_boot; if ( deadline*budget_left > budget*deadline_left ) { 40009e90: 40 00 40 c1 call 4001a194 <.umul> 40009e94: 90 27 00 08 sub %i4, %o0, %o0 40009e98: d2 06 20 74 ld [ %i0 + 0x74 ], %o1 40009e9c: b6 10 00 08 mov %o0, %i3 40009ea0: 40 00 40 bd call 4001a194 <.umul> 40009ea4: d0 07 60 08 ld [ %i5 + 8 ], %o0 40009ea8: 80 a6 c0 08 cmp %i3, %o0 40009eac: 24 80 00 0e ble,a 40009ee4 <_Scheduler_CBS_Unblock+0x80> 40009eb0: d0 06 20 14 ld [ %i0 + 0x14 ], %o0 /* Put late unblocked task to background until the end of period. */ new_priority = the_thread->Start.initial_priority; 40009eb4: d2 06 20 ac ld [ %i0 + 0xac ], %o1 if ( the_thread->real_priority != new_priority ) 40009eb8: 80 a7 00 09 cmp %i4, %o1 40009ebc: 32 80 00 02 bne,a 40009ec4 <_Scheduler_CBS_Unblock+0x60> 40009ec0: d2 26 20 18 st %o1, [ %i0 + 0x18 ] the_thread->real_priority = new_priority; if ( the_thread->current_priority != new_priority ) 40009ec4: d0 06 20 14 ld [ %i0 + 0x14 ], %o0 40009ec8: 80 a2 00 09 cmp %o0, %o1 40009ecc: 02 80 00 07 be 40009ee8 <_Scheduler_CBS_Unblock+0x84> 40009ed0: 3b 10 00 84 sethi %hi(0x40021000), %i5 _Thread_Change_priority(the_thread, new_priority, true); 40009ed4: 90 10 00 18 mov %i0, %o0 40009ed8: 40 00 01 10 call 4000a318 <_Thread_Change_priority> 40009edc: 94 10 20 01 mov 1, %o2 40009ee0: d0 06 20 14 ld [ %i0 + 0x14 ], %o0 * a context switch. * Pseudo-ISR case: * Even if the thread isn't preemptible, if the new heir is * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_higher_than( the_thread->current_priority, 40009ee4: 3b 10 00 84 sethi %hi(0x40021000), %i5 40009ee8: ba 17 60 30 or %i5, 0x30, %i5 ! 40021030 <_Per_CPU_Information> 40009eec: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 40009ef0: d2 00 60 14 ld [ %g1 + 0x14 ], %o1 40009ef4: 03 10 00 7f sethi %hi(0x4001fc00), %g1 40009ef8: c2 00 63 74 ld [ %g1 + 0x374 ], %g1 ! 4001ff74 <_Scheduler+0x30> 40009efc: 9f c0 40 00 call %g1 40009f00: 01 00 00 00 nop 40009f04: 80 a2 20 00 cmp %o0, 0 40009f08: 04 80 00 0a ble 40009f30 <_Scheduler_CBS_Unblock+0xcc> 40009f0c: 01 00 00 00 nop _Thread_Heir->current_priority)) { _Thread_Heir = the_thread; if ( _Thread_Executing->is_preemptible || 40009f10: c2 07 60 10 ld [ %i5 + 0x10 ], %g1 * Even if the thread isn't preemptible, if the new heir is * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_higher_than( the_thread->current_priority, _Thread_Heir->current_priority)) { _Thread_Heir = the_thread; 40009f14: f0 27 60 14 st %i0, [ %i5 + 0x14 ] if ( _Thread_Executing->is_preemptible || 40009f18: c2 08 60 70 ldub [ %g1 + 0x70 ], %g1 40009f1c: 80 a0 60 00 cmp %g1, 0 40009f20: 22 80 00 06 be,a 40009f38 <_Scheduler_CBS_Unblock+0xd4> 40009f24: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 the_thread->current_priority == 0 ) _Thread_Dispatch_necessary = true; 40009f28: 82 10 20 01 mov 1, %g1 40009f2c: c2 2f 60 0c stb %g1, [ %i5 + 0xc ] 40009f30: 81 c7 e0 08 ret 40009f34: 81 e8 00 00 restore * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_higher_than( the_thread->current_priority, _Thread_Heir->current_priority)) { _Thread_Heir = the_thread; if ( _Thread_Executing->is_preemptible || 40009f38: 80 a0 60 00 cmp %g1, 0 40009f3c: 12 bf ff fd bne 40009f30 <_Scheduler_CBS_Unblock+0xcc> <== ALWAYS TAKEN 40009f40: 82 10 20 01 mov 1, %g1 the_thread->current_priority == 0 ) _Thread_Dispatch_necessary = true; 40009f44: c2 2f 60 0c stb %g1, [ %i5 + 0xc ] <== NOT EXECUTED 40009f48: 30 bf ff fa b,a 40009f30 <_Scheduler_CBS_Unblock+0xcc> <== NOT EXECUTED =============================================================================== 40009dbc <_Scheduler_EDF_Allocate>: #include void *_Scheduler_EDF_Allocate( Thread_Control *the_thread ) { 40009dbc: 9d e3 bf a0 save %sp, -96, %sp void *sched; Scheduler_EDF_Per_thread *schinfo; sched = _Workspace_Allocate( sizeof(Scheduler_EDF_Per_thread) ); 40009dc0: 40 00 06 e8 call 4000b960 <_Workspace_Allocate> 40009dc4: 90 10 20 18 mov 0x18, %o0 if ( sched ) { 40009dc8: 80 a2 20 00 cmp %o0, 0 40009dcc: 02 80 00 05 be 40009de0 <_Scheduler_EDF_Allocate+0x24> <== NEVER TAKEN 40009dd0: 82 10 20 02 mov 2, %g1 the_thread->scheduler_info = sched; 40009dd4: d0 26 20 88 st %o0, [ %i0 + 0x88 ] schinfo = (Scheduler_EDF_Per_thread *)(the_thread->scheduler_info); schinfo->thread = the_thread; 40009dd8: f0 22 00 00 st %i0, [ %o0 ] schinfo->queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN; 40009ddc: c2 22 20 14 st %g1, [ %o0 + 0x14 ] } return sched; } 40009de0: 81 c7 e0 08 ret 40009de4: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40009fa0 <_Scheduler_EDF_Unblock>: #include void _Scheduler_EDF_Unblock( Thread_Control *the_thread ) { 40009fa0: 9d e3 bf a0 save %sp, -96, %sp _Scheduler_EDF_Enqueue(the_thread); 40009fa4: 7f ff ff a8 call 40009e44 <_Scheduler_EDF_Enqueue> 40009fa8: 90 10 00 18 mov %i0, %o0 * a context switch. * Pseudo-ISR case: * Even if the thread isn't preemptible, if the new heir is * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_lower_than( 40009fac: 3b 10 00 83 sethi %hi(0x40020c00), %i5 40009fb0: ba 17 63 90 or %i5, 0x390, %i5 ! 40020f90 <_Per_CPU_Information> 40009fb4: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 40009fb8: d0 00 60 14 ld [ %g1 + 0x14 ], %o0 40009fbc: 03 10 00 7f sethi %hi(0x4001fc00), %g1 40009fc0: c2 00 62 d4 ld [ %g1 + 0x2d4 ], %g1 ! 4001fed4 <_Scheduler+0x30> 40009fc4: 9f c0 40 00 call %g1 40009fc8: d2 06 20 14 ld [ %i0 + 0x14 ], %o1 40009fcc: 80 a2 20 00 cmp %o0, 0 40009fd0: 26 80 00 04 bl,a 40009fe0 <_Scheduler_EDF_Unblock+0x40> 40009fd4: c2 07 60 10 ld [ %i5 + 0x10 ], %g1 40009fd8: 81 c7 e0 08 ret 40009fdc: 81 e8 00 00 restore _Thread_Heir->current_priority, the_thread->current_priority )) { _Thread_Heir = the_thread; 40009fe0: f0 27 60 14 st %i0, [ %i5 + 0x14 ] if ( _Thread_Executing->is_preemptible || 40009fe4: c2 08 60 70 ldub [ %g1 + 0x70 ], %g1 40009fe8: 80 a0 60 00 cmp %g1, 0 40009fec: 22 80 00 06 be,a 4000a004 <_Scheduler_EDF_Unblock+0x64> 40009ff0: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 the_thread->current_priority == 0 ) _Thread_Dispatch_necessary = true; 40009ff4: 82 10 20 01 mov 1, %g1 40009ff8: c2 2f 60 0c stb %g1, [ %i5 + 0xc ] 40009ffc: 81 c7 e0 08 ret 4000a000: 81 e8 00 00 restore */ if ( _Scheduler_Is_priority_lower_than( _Thread_Heir->current_priority, the_thread->current_priority )) { _Thread_Heir = the_thread; if ( _Thread_Executing->is_preemptible || 4000a004: 80 a0 60 00 cmp %g1, 0 4000a008: 12 bf ff f4 bne 40009fd8 <_Scheduler_EDF_Unblock+0x38> <== ALWAYS TAKEN 4000a00c: 82 10 20 01 mov 1, %g1 the_thread->current_priority == 0 ) _Thread_Dispatch_necessary = true; 4000a010: c2 2f 60 0c stb %g1, [ %i5 + 0xc ] <== NOT EXECUTED 4000a014: 30 bf ff fa b,a 40009ffc <_Scheduler_EDF_Unblock+0x5c> <== NOT EXECUTED =============================================================================== 40009710 <_Scheduler_priority_Tick>: #include #include void _Scheduler_priority_Tick( void ) { 40009710: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *executing; executing = _Thread_Executing; 40009714: 03 10 00 7c sethi %hi(0x4001f000), %g1 40009718: d0 00 63 e0 ld [ %g1 + 0x3e0 ], %o0 ! 4001f3e0 <_Per_CPU_Information+0x10> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 4000971c: c2 0a 20 70 ldub [ %o0 + 0x70 ], %g1 40009720: 80 a0 60 00 cmp %g1, 0 40009724: 02 80 00 26 be 400097bc <_Scheduler_priority_Tick+0xac> 40009728: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 4000972c: c2 02 20 10 ld [ %o0 + 0x10 ], %g1 40009730: 80 a0 60 00 cmp %g1, 0 40009734: 12 80 00 22 bne 400097bc <_Scheduler_priority_Tick+0xac> 40009738: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 4000973c: c2 02 20 78 ld [ %o0 + 0x78 ], %g1 40009740: 80 a0 60 01 cmp %g1, 1 40009744: 0a 80 00 07 bcs 40009760 <_Scheduler_priority_Tick+0x50> 40009748: 80 a0 60 02 cmp %g1, 2 4000974c: 28 80 00 10 bleu,a 4000978c <_Scheduler_priority_Tick+0x7c> 40009750: c2 02 20 74 ld [ %o0 + 0x74 ], %g1 40009754: 80 a0 60 03 cmp %g1, 3 40009758: 22 80 00 04 be,a 40009768 <_Scheduler_priority_Tick+0x58><== ALWAYS TAKEN 4000975c: c2 02 20 74 ld [ %o0 + 0x74 ], %g1 40009760: 81 c7 e0 08 ret 40009764: 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 ) 40009768: 82 00 7f ff add %g1, -1, %g1 4000976c: 80 a0 60 00 cmp %g1, 0 40009770: 12 bf ff fc bne 40009760 <_Scheduler_priority_Tick+0x50> 40009774: c2 22 20 74 st %g1, [ %o0 + 0x74 ] (*executing->budget_callout)( executing ); 40009778: c2 02 20 7c ld [ %o0 + 0x7c ], %g1 4000977c: 9f c0 40 00 call %g1 40009780: 01 00 00 00 nop 40009784: 81 c7 e0 08 ret 40009788: 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 ) { 4000978c: 82 00 7f ff add %g1, -1, %g1 40009790: 80 a0 60 00 cmp %g1, 0 40009794: 14 bf ff f3 bg 40009760 <_Scheduler_priority_Tick+0x50> 40009798: c2 22 20 74 st %g1, [ %o0 + 0x74 ] * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield(); 4000979c: 03 10 00 78 sethi %hi(0x4001e000), %g1 400097a0: c2 00 63 70 ld [ %g1 + 0x370 ], %g1 ! 4001e370 <_Scheduler+0xc> 400097a4: 9f c0 40 00 call %g1 400097a8: d0 27 bf fc st %o0, [ %fp + -4 ] * 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; 400097ac: 03 10 00 7b sethi %hi(0x4001ec00), %g1 400097b0: d0 07 bf fc ld [ %fp + -4 ], %o0 400097b4: c2 00 62 20 ld [ %g1 + 0x220 ], %g1 400097b8: c2 22 20 74 st %g1, [ %o0 + 0x74 ] 400097bc: 81 c7 e0 08 ret 400097c0: 81 e8 00 00 restore =============================================================================== 40009fb8 <_Scheduler_simple_Ready_queue_enqueue_first>: { Chain_Control *ready; Chain_Node *the_node; Thread_Control *current; ready = (Chain_Control *)_Scheduler.information; 40009fb8: 03 10 00 7c sethi %hi(0x4001f000), %g1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; 40009fbc: c2 00 63 64 ld [ %g1 + 0x364 ], %g1 ! 4001f364 <_Scheduler> */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { 40009fc0: c6 02 20 14 ld [ %o0 + 0x14 ], %g3 40009fc4: c2 00 40 00 ld [ %g1 ], %g1 40009fc8: c4 00 60 14 ld [ %g1 + 0x14 ], %g2 40009fcc: 80 a0 80 03 cmp %g2, %g3 40009fd0: 3a 80 00 08 bcc,a 40009ff0 <_Scheduler_simple_Ready_queue_enqueue_first+0x38> 40009fd4: c2 00 60 04 ld [ %g1 + 4 ], %g1 * Do NOT need to check for end of chain because there is always * at least one task on the ready chain -- the IDLE task. It can * never block, should never attempt to obtain a semaphore or mutex, * and thus will always be there. */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { 40009fd8: c2 00 40 00 ld [ %g1 ], %g1 current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { 40009fdc: c4 00 60 14 ld [ %g1 + 0x14 ], %g2 40009fe0: 80 a0 80 03 cmp %g2, %g3 40009fe4: 2a bf ff fe bcs,a 40009fdc <_Scheduler_simple_Ready_queue_enqueue_first+0x24><== NEVER TAKEN 40009fe8: c2 00 40 00 ld [ %g1 ], %g1 <== NOT EXECUTED current = (Thread_Control *)current->Object.Node.previous; 40009fec: c2 00 60 04 ld [ %g1 + 4 ], %g1 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 40009ff0: c4 00 40 00 ld [ %g1 ], %g2 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 40009ff4: c2 22 20 04 st %g1, [ %o0 + 4 ] before_node = after_node->next; after_node->next = the_node; 40009ff8: d0 20 40 00 st %o0, [ %g1 ] the_node->next = before_node; 40009ffc: c4 22 00 00 st %g2, [ %o0 ] before_node->previous = the_node; 4000a000: 81 c3 e0 08 retl 4000a004: d0 20 a0 04 st %o0, [ %g2 + 4 ] =============================================================================== 40008034 <_TOD_Validate>: }; bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 40008034: 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(); 40008038: 03 10 00 79 sethi %hi(0x4001e400), %g1 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 4000803c: d2 00 62 7c ld [ %g1 + 0x27c ], %o1 ! 4001e67c 40008040: 11 00 03 d0 sethi %hi(0xf4000), %o0 40008044: 40 00 4a 77 call 4001aa20 <.udiv> 40008048: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 4000804c: 80 a6 20 00 cmp %i0, 0 40008050: 02 80 00 2c be 40008100 <_TOD_Validate+0xcc> <== NEVER TAKEN 40008054: 82 10 20 00 clr %g1 40008058: c4 06 20 18 ld [ %i0 + 0x18 ], %g2 4000805c: 80 a2 00 02 cmp %o0, %g2 40008060: 28 80 00 26 bleu,a 400080f8 <_TOD_Validate+0xc4> 40008064: b0 08 60 01 and %g1, 1, %i0 (the_tod->ticks >= ticks_per_second) || 40008068: c4 06 20 14 ld [ %i0 + 0x14 ], %g2 4000806c: 80 a0 a0 3b cmp %g2, 0x3b 40008070: 38 80 00 22 bgu,a 400080f8 <_TOD_Validate+0xc4> 40008074: b0 08 60 01 and %g1, 1, %i0 (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 40008078: c4 06 20 10 ld [ %i0 + 0x10 ], %g2 4000807c: 80 a0 a0 3b cmp %g2, 0x3b 40008080: 38 80 00 1e bgu,a 400080f8 <_TOD_Validate+0xc4> 40008084: b0 08 60 01 and %g1, 1, %i0 (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 40008088: c4 06 20 0c ld [ %i0 + 0xc ], %g2 4000808c: 80 a0 a0 17 cmp %g2, 0x17 40008090: 38 80 00 1a bgu,a 400080f8 <_TOD_Validate+0xc4> 40008094: b0 08 60 01 and %g1, 1, %i0 (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 40008098: c4 06 20 04 ld [ %i0 + 4 ], %g2 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) || 4000809c: 80 a0 a0 00 cmp %g2, 0 400080a0: 02 80 00 15 be 400080f4 <_TOD_Validate+0xc0> <== NEVER TAKEN 400080a4: 80 a0 a0 0c cmp %g2, 0xc (the_tod->month == 0) || 400080a8: 38 80 00 14 bgu,a 400080f8 <_TOD_Validate+0xc4> 400080ac: b0 08 60 01 and %g1, 1, %i0 (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 400080b0: c6 06 00 00 ld [ %i0 ], %g3 (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || 400080b4: 80 a0 e7 c3 cmp %g3, 0x7c3 400080b8: 28 80 00 10 bleu,a 400080f8 <_TOD_Validate+0xc4> 400080bc: b0 08 60 01 and %g1, 1, %i0 (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 400080c0: c8 06 20 08 ld [ %i0 + 8 ], %g4 (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) || 400080c4: 80 a1 20 00 cmp %g4, 0 400080c8: 02 80 00 0b be 400080f4 <_TOD_Validate+0xc0> <== NEVER TAKEN 400080cc: 80 88 e0 03 btst 3, %g3 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 400080d0: 32 80 00 0f bne,a 4000810c <_TOD_Validate+0xd8> 400080d4: 85 28 a0 02 sll %g2, 2, %g2 days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 400080d8: 82 00 a0 0d add %g2, 0xd, %g1 400080dc: 05 10 00 7d sethi %hi(0x4001f400), %g2 400080e0: 83 28 60 02 sll %g1, 2, %g1 400080e4: 84 10 a3 70 or %g2, 0x370, %g2 400080e8: c2 00 80 01 ld [ %g2 + %g1 ], %g1 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; if ( the_tod->day > days_in_month ) 400080ec: 80 a0 40 04 cmp %g1, %g4 400080f0: 82 60 3f ff subx %g0, -1, %g1 return false; return true; } 400080f4: b0 08 60 01 and %g1, 1, %i0 400080f8: 81 c7 e0 08 ret 400080fc: 81 e8 00 00 restore 40008100: b0 08 60 01 and %g1, 1, %i0 <== NOT EXECUTED 40008104: 81 c7 e0 08 ret <== NOT EXECUTED 40008108: 81 e8 00 00 restore <== NOT EXECUTED 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 ]; 4000810c: 03 10 00 7d sethi %hi(0x4001f400), %g1 40008110: 82 10 63 70 or %g1, 0x370, %g1 ! 4001f770 <_TOD_Days_per_month> 40008114: c2 00 40 02 ld [ %g1 + %g2 ], %g1 if ( the_tod->day > days_in_month ) 40008118: 80 a0 40 04 cmp %g1, %g4 4000811c: 10 bf ff f6 b 400080f4 <_TOD_Validate+0xc0> 40008120: 82 60 3f ff subx %g0, -1, %g1 =============================================================================== 400099e0 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 400099e0: 9d e3 bf a0 save %sp, -96, %sp States_Control state, original_state; /* * Save original state */ original_state = the_thread->current_state; 400099e4: f6 06 20 10 ld [ %i0 + 0x10 ], %i3 /* * 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 ); 400099e8: 40 00 03 9a call 4000a850 <_Thread_Set_transient> 400099ec: 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 ) 400099f0: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 400099f4: 80 a0 40 19 cmp %g1, %i1 400099f8: 02 80 00 05 be 40009a0c <_Thread_Change_priority+0x2c> 400099fc: ba 10 00 18 mov %i0, %i5 _Thread_Set_priority( the_thread, new_priority ); 40009a00: 90 10 00 18 mov %i0, %o0 40009a04: 40 00 03 79 call 4000a7e8 <_Thread_Set_priority> 40009a08: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 40009a0c: 7f ff e1 a6 call 400020a4 40009a10: 01 00 00 00 nop 40009a14: b2 10 00 08 mov %o0, %i1 /* * 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; 40009a18: f8 07 60 10 ld [ %i5 + 0x10 ], %i4 if ( state != STATES_TRANSIENT ) { 40009a1c: 80 a7 20 04 cmp %i4, 4 40009a20: 02 80 00 18 be 40009a80 <_Thread_Change_priority+0xa0> 40009a24: 80 8e e0 04 btst 4, %i3 /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 40009a28: 02 80 00 0b be 40009a54 <_Thread_Change_priority+0x74> <== ALWAYS TAKEN 40009a2c: 82 0f 3f fb and %i4, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); _ISR_Enable( level ); 40009a30: 7f ff e1 a1 call 400020b4 <== NOT EXECUTED 40009a34: 90 10 00 19 mov %i1, %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); 40009a38: 03 00 00 ef sethi %hi(0x3bc00), %g1 <== NOT EXECUTED 40009a3c: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 <== NOT EXECUTED if ( _States_Is_waiting_on_thread_queue( state ) ) { 40009a40: 80 8f 00 01 btst %i4, %g1 <== NOT EXECUTED 40009a44: 32 80 00 0d bne,a 40009a78 <_Thread_Change_priority+0x98><== NOT EXECUTED 40009a48: f0 07 60 44 ld [ %i5 + 0x44 ], %i0 <== NOT EXECUTED 40009a4c: 81 c7 e0 08 ret 40009a50: 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 ); 40009a54: c2 27 60 10 st %g1, [ %i5 + 0x10 ] _ISR_Enable( level ); 40009a58: 7f ff e1 97 call 400020b4 40009a5c: 90 10 00 19 mov %i1, %o0 40009a60: 03 00 00 ef sethi %hi(0x3bc00), %g1 40009a64: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 40009a68: 80 8f 00 01 btst %i4, %g1 40009a6c: 02 bf ff f8 be 40009a4c <_Thread_Change_priority+0x6c> 40009a70: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 40009a74: f0 07 60 44 ld [ %i5 + 0x44 ], %i0 40009a78: 40 00 03 2c call 4000a728 <_Thread_queue_Requeue> 40009a7c: 93 e8 00 1d restore %g0, %i5, %o1 } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { 40009a80: 22 80 00 19 be,a 40009ae4 <_Thread_Change_priority+0x104><== ALWAYS TAKEN 40009a84: c0 27 60 10 clr [ %i5 + 0x10 ] 40009a88: 39 10 00 78 sethi %hi(0x4001e000), %i4 <== NOT EXECUTED 40009a8c: b8 17 23 64 or %i4, 0x364, %i4 ! 4001e364 <_Scheduler> <== NOT EXECUTED _Scheduler_Enqueue_first( the_thread ); else _Scheduler_Enqueue( the_thread ); } _ISR_Flash( level ); 40009a90: 7f ff e1 89 call 400020b4 40009a94: 90 10 00 19 mov %i1, %o0 40009a98: 7f ff e1 83 call 400020a4 40009a9c: 01 00 00 00 nop 40009aa0: b0 10 00 08 mov %o0, %i0 * This kernel routine implements the scheduling decision logic for * the scheduler. It does NOT dispatch. */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( void ) { _Scheduler.Operations.schedule(); 40009aa4: c2 07 20 08 ld [ %i4 + 8 ], %g1 40009aa8: 9f c0 40 00 call %g1 40009aac: 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 ); 40009ab0: 03 10 00 7c sethi %hi(0x4001f000), %g1 40009ab4: 82 10 63 d0 or %g1, 0x3d0, %g1 ! 4001f3d0 <_Per_CPU_Information> * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Scheduler_Schedule(); if ( !_Thread_Is_executing_also_the_heir() && 40009ab8: c4 18 60 10 ldd [ %g1 + 0x10 ], %g2 40009abc: 80 a0 80 03 cmp %g2, %g3 40009ac0: 02 80 00 07 be 40009adc <_Thread_Change_priority+0xfc> 40009ac4: 01 00 00 00 nop 40009ac8: c4 08 a0 70 ldub [ %g2 + 0x70 ], %g2 40009acc: 80 a0 a0 00 cmp %g2, 0 40009ad0: 02 80 00 03 be 40009adc <_Thread_Change_priority+0xfc> 40009ad4: 84 10 20 01 mov 1, %g2 _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 40009ad8: c4 28 60 0c stb %g2, [ %g1 + 0xc ] _ISR_Enable( level ); 40009adc: 7f ff e1 76 call 400020b4 40009ae0: 81 e8 00 00 restore */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue_first( the_thread ); 40009ae4: 39 10 00 78 sethi %hi(0x4001e000), %i4 * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); if ( prepend_it ) 40009ae8: 80 a6 a0 00 cmp %i2, 0 40009aec: 02 80 00 06 be 40009b04 <_Thread_Change_priority+0x124> 40009af0: b8 17 23 64 or %i4, 0x364, %i4 40009af4: c2 07 20 28 ld [ %i4 + 0x28 ], %g1 40009af8: 9f c0 40 00 call %g1 40009afc: 90 10 00 1d mov %i5, %o0 40009b00: 30 bf ff e4 b,a 40009a90 <_Thread_Change_priority+0xb0> */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue( the_thread ); 40009b04: c2 07 20 24 ld [ %i4 + 0x24 ], %g1 40009b08: 9f c0 40 00 call %g1 40009b0c: 90 10 00 1d mov %i5, %o0 40009b10: 30 bf ff e0 b,a 40009a90 <_Thread_Change_priority+0xb0> =============================================================================== 40009d00 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 40009d00: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 40009d04: 90 10 00 18 mov %i0, %o0 40009d08: 40 00 00 7c call 40009ef8 <_Thread_Get> 40009d0c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009d10: c2 07 bf fc ld [ %fp + -4 ], %g1 40009d14: 80 a0 60 00 cmp %g1, 0 40009d18: 12 80 00 08 bne 40009d38 <_Thread_Delay_ended+0x38> <== NEVER TAKEN 40009d1c: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 40009d20: 7f ff ff 7d call 40009b14 <_Thread_Clear_state> 40009d24: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40009d28: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40009d2c: c4 00 62 c0 ld [ %g1 + 0x2c0 ], %g2 ! 4001eec0 <_Thread_Dispatch_disable_level> --level; 40009d30: 84 00 bf ff add %g2, -1, %g2 _Thread_Dispatch_disable_level = level; 40009d34: c4 20 62 c0 st %g2, [ %g1 + 0x2c0 ] 40009d38: 81 c7 e0 08 ret 40009d3c: 81 e8 00 00 restore =============================================================================== 40009d40 <_Thread_Dispatch>: #if defined(RTEMS_SMP) #include #endif void _Thread_Dispatch( void ) { 40009d40: 9d e3 bf 98 save %sp, -104, %sp #endif /* * Now determine if we need to perform a dispatch on the current CPU. */ executing = _Thread_Executing; 40009d44: 31 10 00 7c sethi %hi(0x4001f000), %i0 40009d48: b0 16 23 d0 or %i0, 0x3d0, %i0 ! 4001f3d0 <_Per_CPU_Information> _ISR_Disable( level ); 40009d4c: 7f ff e0 d6 call 400020a4 40009d50: f6 06 20 10 ld [ %i0 + 0x10 ], %i3 while ( _Thread_Dispatch_necessary == true ) { 40009d54: c2 0e 20 0c ldub [ %i0 + 0xc ], %g1 40009d58: 80 a0 60 00 cmp %g1, 0 40009d5c: 02 80 00 46 be 40009e74 <_Thread_Dispatch+0x134> 40009d60: 21 10 00 7b sethi %hi(0x4001ec00), %l0 heir = _Thread_Heir; 40009d64: f4 06 20 14 ld [ %i0 + 0x14 ], %i2 * This routine sets thread dispatch level to the * value passed in. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_set_disable_level(uint32_t value) { _Thread_Dispatch_disable_level = value; 40009d68: 82 10 20 01 mov 1, %g1 40009d6c: c2 24 22 c0 st %g1, [ %l0 + 0x2c0 ] #ifndef RTEMS_SMP _Thread_Dispatch_set_disable_level( 1 ); #endif _Thread_Dispatch_necessary = false; 40009d70: c0 2e 20 0c clrb [ %i0 + 0xc ] /* * 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 ) 40009d74: 80 a6 c0 1a cmp %i3, %i2 40009d78: 02 80 00 3f be 40009e74 <_Thread_Dispatch+0x134> 40009d7c: f4 26 20 10 st %i2, [ %i0 + 0x10 ] 40009d80: 23 10 00 79 sethi %hi(0x4001e400), %l1 40009d84: 27 10 00 7b sethi %hi(0x4001ec00), %l3 40009d88: a2 14 60 8c or %l1, 0x8c, %l1 */ static inline void _TOD_Get_uptime( Timestamp_Control *time ) { _TOD_Get_with_nanoseconds( time, &_TOD.uptime ); 40009d8c: 25 10 00 7b sethi %hi(0x4001ec00), %l2 40009d90: a6 14 e3 2c or %l3, 0x32c, %l3 40009d94: b2 04 60 04 add %l1, 4, %i1 #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; 40009d98: 2b 10 00 7b sethi %hi(0x4001ec00), %l5 40009d9c: a4 14 a2 10 or %l2, 0x210, %l2 40009da0: a8 10 20 01 mov 1, %l4 */ #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 ) 40009da4: c2 06 a0 78 ld [ %i2 + 0x78 ], %g1 40009da8: 80 a0 60 01 cmp %g1, 1 40009dac: 02 80 00 45 be 40009ec0 <_Thread_Dispatch+0x180> 40009db0: c2 05 62 20 ld [ %l5 + 0x220 ], %g1 heir->cpu_time_budget = _Thread_Ticks_per_timeslice; _ISR_Enable( level ); 40009db4: 7f ff e0 c0 call 400020b4 40009db8: 01 00 00 00 nop 40009dbc: 90 07 bf f8 add %fp, -8, %o0 40009dc0: 7f ff f9 8b call 400083ec <_TOD_Get_with_nanoseconds> 40009dc4: 92 10 00 12 mov %l2, %o1 40009dc8: c4 1e e0 80 ldd [ %i3 + 0x80 ], %g2 const Timestamp64_Control *_start, const Timestamp64_Control *_end, Timestamp64_Control *_result ) { *_result = *_end - *_start; 40009dcc: f8 1e 20 20 ldd [ %i0 + 0x20 ], %i4 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 40009dd0: d8 1f bf f8 ldd [ %fp + -8 ], %o4 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 40009dd4: c2 04 c0 00 ld [ %l3 ], %g1 40009dd8: ba a3 40 1d subcc %o5, %i5, %i5 40009ddc: b8 63 00 1c subx %o4, %i4, %i4 static inline void _Timestamp64_implementation_Add_to( Timestamp64_Control *_time, const Timestamp64_Control *_add ) { *_time += *_add; 40009de0: 96 80 c0 1d addcc %g3, %i5, %o3 40009de4: 94 40 80 1c addx %g2, %i4, %o2 40009de8: d4 3e e0 80 std %o2, [ %i3 + 0x80 ] 40009dec: 80 a0 60 00 cmp %g1, 0 40009df0: 02 80 00 06 be 40009e08 <_Thread_Dispatch+0xc8> <== NEVER TAKEN 40009df4: d8 3e 20 20 std %o4, [ %i0 + 0x20 ] executing->libc_reent = *_Thread_libc_reent; 40009df8: c4 00 40 00 ld [ %g1 ], %g2 40009dfc: c4 26 e1 48 st %g2, [ %i3 + 0x148 ] *_Thread_libc_reent = heir->libc_reent; 40009e00: c4 06 a1 48 ld [ %i2 + 0x148 ], %g2 40009e04: c4 20 40 00 st %g2, [ %g1 ] */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 40009e08: fa 04 40 00 ld [ %l1 ], %i5 { const Chain_Control *chain = &_User_extensions_Switches_list; const Chain_Node *tail = _Chain_Immutable_tail( chain ); const Chain_Node *node = _Chain_Immutable_first( chain ); while ( node != tail ) { 40009e0c: 80 a7 40 19 cmp %i5, %i1 40009e10: 02 80 00 0b be 40009e3c <_Thread_Dispatch+0xfc> <== NEVER TAKEN 40009e14: 90 06 e0 c0 add %i3, 0xc0, %o0 const User_extensions_Switch_control *extension = (const User_extensions_Switch_control *) node; (*extension->thread_switch)( executing, heir ); 40009e18: c2 07 60 08 ld [ %i5 + 8 ], %g1 40009e1c: 90 10 00 1b mov %i3, %o0 40009e20: 9f c0 40 00 call %g1 40009e24: 92 10 00 1a mov %i2, %o1 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_next( const Chain_Node *the_node ) { return the_node->next; 40009e28: fa 07 40 00 ld [ %i5 ], %i5 { const Chain_Control *chain = &_User_extensions_Switches_list; const Chain_Node *tail = _Chain_Immutable_tail( chain ); const Chain_Node *node = _Chain_Immutable_first( chain ); while ( node != tail ) { 40009e2c: 80 a7 40 19 cmp %i5, %i1 40009e30: 32 bf ff fb bne,a 40009e1c <_Thread_Dispatch+0xdc> 40009e34: c2 07 60 08 ld [ %i5 + 8 ], %g1 if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 40009e38: 90 06 e0 c0 add %i3, 0xc0, %o0 40009e3c: 40 00 04 91 call 4000b080 <_CPU_Context_switch> 40009e40: 92 06 a0 c0 add %i2, 0xc0, %o1 #endif #endif executing = _Thread_Executing; _ISR_Disable( level ); 40009e44: 7f ff e0 98 call 400020a4 40009e48: f6 06 20 10 ld [ %i0 + 0x10 ], %i3 /* * Now determine if we need to perform a dispatch on the current CPU. */ executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 40009e4c: c2 0e 20 0c ldub [ %i0 + 0xc ], %g1 40009e50: 80 a0 60 00 cmp %g1, 0 40009e54: 02 80 00 08 be 40009e74 <_Thread_Dispatch+0x134> 40009e58: 01 00 00 00 nop heir = _Thread_Heir; 40009e5c: f4 06 20 14 ld [ %i0 + 0x14 ], %i2 40009e60: e8 24 22 c0 st %l4, [ %l0 + 0x2c0 ] #ifndef RTEMS_SMP _Thread_Dispatch_set_disable_level( 1 ); #endif _Thread_Dispatch_necessary = false; 40009e64: c0 2e 20 0c clrb [ %i0 + 0xc ] /* * 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 ) 40009e68: 80 a6 80 1b cmp %i2, %i3 40009e6c: 12 bf ff ce bne 40009da4 <_Thread_Dispatch+0x64> <== ALWAYS TAKEN 40009e70: f4 26 20 10 st %i2, [ %i0 + 0x10 ] 40009e74: c0 24 22 c0 clr [ %l0 + 0x2c0 ] post_switch: #ifndef RTEMS_SMP _Thread_Dispatch_set_disable_level( 0 ); #endif _ISR_Enable( level ); 40009e78: 7f ff e0 8f call 400020b4 40009e7c: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 40009e80: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40009e84: fa 00 63 30 ld [ %g1 + 0x330 ], %i5 ! 4001ef30 <_API_extensions_Post_switch_list> 40009e88: 82 10 63 30 or %g1, 0x330, %g1 { const Chain_Control *chain = &_API_extensions_Post_switch_list; const Chain_Node *tail = _Chain_Immutable_tail( chain ); const Chain_Node *node = _Chain_Immutable_first( chain ); while ( node != tail ) { 40009e8c: b8 00 60 04 add %g1, 4, %i4 40009e90: 80 a7 40 1c cmp %i5, %i4 40009e94: 02 80 00 09 be 40009eb8 <_Thread_Dispatch+0x178> 40009e98: 01 00 00 00 nop const API_extensions_Post_switch_control *post_switch = (const API_extensions_Post_switch_control *) node; (*post_switch->hook)( executing ); 40009e9c: c2 07 60 08 ld [ %i5 + 8 ], %g1 40009ea0: 9f c0 40 00 call %g1 40009ea4: 90 10 00 1b mov %i3, %o0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_next( const Chain_Node *the_node ) { return the_node->next; 40009ea8: fa 07 40 00 ld [ %i5 ], %i5 { const Chain_Control *chain = &_API_extensions_Post_switch_list; const Chain_Node *tail = _Chain_Immutable_tail( chain ); const Chain_Node *node = _Chain_Immutable_first( chain ); while ( node != tail ) { 40009eac: 80 a7 40 1c cmp %i5, %i4 40009eb0: 32 bf ff fc bne,a 40009ea0 <_Thread_Dispatch+0x160> <== NEVER TAKEN 40009eb4: c2 07 60 08 ld [ %i5 + 8 ], %g1 <== NOT EXECUTED 40009eb8: 81 c7 e0 08 ret 40009ebc: 81 e8 00 00 restore #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; 40009ec0: 10 bf ff bd b 40009db4 <_Thread_Dispatch+0x74> 40009ec4: c2 26 a0 74 st %g1, [ %i2 + 0x74 ] =============================================================================== 4000f504 <_Thread_Handler>: #define INIT_NAME __main #define EXECUTE_GLOBAL_CONSTRUCTORS #endif void _Thread_Handler( void ) { 4000f504: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static bool doneConstructors; bool doCons; #endif executing = _Thread_Executing; 4000f508: 03 10 00 7c sethi %hi(0x4001f000), %g1 4000f50c: fa 00 63 e0 ld [ %g1 + 0x3e0 ], %i5 ! 4001f3e0 <_Per_CPU_Information+0x10> /* * 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(); 4000f510: 3f 10 00 3d sethi %hi(0x4000f400), %i7 4000f514: be 17 e1 04 or %i7, 0x104, %i7 ! 4000f504 <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 4000f518: d0 07 60 a8 ld [ %i5 + 0xa8 ], %o0 _ISR_Set_level(level); 4000f51c: 7f ff ca e6 call 400020b4 4000f520: 91 2a 20 08 sll %o0, 8, %o0 doCons = !doneConstructors && _Objects_Get_API( executing->Object.id ) != OBJECTS_INTERNAL_API; if (doCons) doneConstructors = true; #else doCons = !doneConstructors; 4000f524: 03 10 00 7a sethi %hi(0x4001e800), %g1 doneConstructors = true; 4000f528: 84 10 20 01 mov 1, %g2 doCons = !doneConstructors && _Objects_Get_API( executing->Object.id ) != OBJECTS_INTERNAL_API; if (doCons) doneConstructors = true; #else doCons = !doneConstructors; 4000f52c: f8 08 63 b8 ldub [ %g1 + 0x3b8 ], %i4 ); } static inline void _User_extensions_Thread_begin( Thread_Control *executing ) { _User_extensions_Iterate( 4000f530: 90 10 00 1d mov %i5, %o0 4000f534: 13 10 00 2a sethi %hi(0x4000a800), %o1 4000f538: 92 12 62 34 or %o1, 0x234, %o1 ! 4000aa34 <_User_extensions_Thread_begin_visitor> 4000f53c: 7f ff ed 5b call 4000aaa8 <_User_extensions_Iterate> 4000f540: c4 28 63 b8 stb %g2, [ %g1 + 0x3b8 ] _User_extensions_Thread_begin( executing ); /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 4000f544: 7f ff ea 61 call 40009ec8 <_Thread_Enable_dispatch> 4000f548: 01 00 00 00 nop /* * _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 (doCons) /* && (volatile void *)_init) */ { 4000f54c: 80 8f 20 ff btst 0xff, %i4 4000f550: 02 80 00 10 be 4000f590 <_Thread_Handler+0x8c> 4000f554: 01 00 00 00 nop _Thread_Enable_dispatch(); #endif } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000f558: c2 07 60 90 ld [ %i5 + 0x90 ], %g1 4000f55c: 80 a0 60 00 cmp %g1, 0 4000f560: 02 80 00 10 be 4000f5a0 <_Thread_Handler+0x9c> 4000f564: 80 a0 60 01 cmp %g1, 1 (*(Thread_Entry_numeric) executing->Start.entry_point)( executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { 4000f568: 22 80 00 13 be,a 4000f5b4 <_Thread_Handler+0xb0> <== ALWAYS TAKEN 4000f56c: c2 07 60 8c ld [ %i5 + 0x8c ], %g1 } } static inline void _User_extensions_Thread_exitted( Thread_Control *executing ) { _User_extensions_Iterate( 4000f570: 90 10 00 1d mov %i5, %o0 4000f574: 13 10 00 2a sethi %hi(0x4000a800), %o1 4000f578: 7f ff ed 4c call 4000aaa8 <_User_extensions_Iterate> 4000f57c: 92 12 62 58 or %o1, 0x258, %o1 ! 4000aa58 <_User_extensions_Thread_exitted_visitor> * able to fit in a (void *). */ _User_extensions_Thread_exitted( executing ); _Internal_error_Occurred( 4000f580: 90 10 20 00 clr %o0 4000f584: 92 10 20 01 mov 1, %o1 4000f588: 7f ff e4 e1 call 4000890c <_Internal_error_Occurred> 4000f58c: 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 (doCons) /* && (volatile void *)_init) */ { INIT_NAME (); 4000f590: 40 00 3b 42 call 4001e298 <_init> 4000f594: 01 00 00 00 nop _Thread_Enable_dispatch(); #endif } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 4000f598: 10 bf ff f1 b 4000f55c <_Thread_Handler+0x58> 4000f59c: c2 07 60 90 ld [ %i5 + 0x90 ], %g1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 4000f5a0: c2 07 60 8c ld [ %i5 + 0x8c ], %g1 4000f5a4: 9f c0 40 00 call %g1 4000f5a8: d0 07 60 98 ld [ %i5 + 0x98 ], %o0 #endif } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = 4000f5ac: 10 bf ff f1 b 4000f570 <_Thread_Handler+0x6c> 4000f5b0: d0 27 60 28 st %o0, [ %i5 + 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)( 4000f5b4: 9f c0 40 00 call %g1 4000f5b8: d0 07 60 94 ld [ %i5 + 0x94 ], %o0 executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = 4000f5bc: 10 bf ff ed b 4000f570 <_Thread_Handler+0x6c> 4000f5c0: d0 27 60 28 st %o0, [ %i5 + 0x28 ] =============================================================================== 4000a180 <_Thread_Handler_initialization>: #if defined(RTEMS_SMP) #include #endif void _Thread_Handler_initialization(void) { 4000a180: 9d e3 bf 98 save %sp, -104, %sp uint32_t ticks_per_timeslice = 4000a184: 03 10 00 71 sethi %hi(0x4001c400), %g1 4000a188: 82 10 60 18 or %g1, 0x18, %g1 ! 4001c418 #if defined(RTEMS_MULTIPROCESSING) uint32_t maximum_proxies = _Configuration_MP_table->maximum_proxies; #endif if ( rtems_configuration_get_stack_allocate_hook() == NULL || 4000a18c: c6 00 60 28 ld [ %g1 + 0x28 ], %g3 #include #endif void _Thread_Handler_initialization(void) { uint32_t ticks_per_timeslice = 4000a190: fa 00 60 14 ld [ %g1 + 0x14 ], %i5 rtems_configuration_get_ticks_per_timeslice(); uint32_t maximum_extensions = 4000a194: f8 00 60 08 ld [ %g1 + 8 ], %i4 #if defined(RTEMS_MULTIPROCESSING) uint32_t maximum_proxies = _Configuration_MP_table->maximum_proxies; #endif if ( rtems_configuration_get_stack_allocate_hook() == NULL || 4000a198: 80 a0 e0 00 cmp %g3, 0 4000a19c: 02 80 00 1f be 4000a218 <_Thread_Handler_initialization+0x98><== NEVER TAKEN 4000a1a0: c4 00 60 24 ld [ %g1 + 0x24 ], %g2 4000a1a4: c6 00 60 2c ld [ %g1 + 0x2c ], %g3 4000a1a8: 80 a0 e0 00 cmp %g3, 0 4000a1ac: 02 80 00 1b be 4000a218 <_Thread_Handler_initialization+0x98> 4000a1b0: 80 a0 a0 00 cmp %g2, 0 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_BAD_STACK_HOOK ); if ( stack_allocate_init_hook != NULL ) 4000a1b4: 22 80 00 05 be,a 4000a1c8 <_Thread_Handler_initialization+0x48> 4000a1b8: 03 10 00 7c sethi %hi(0x4001f000), %g1 (*stack_allocate_init_hook)( rtems_configuration_get_stack_space_size() ); 4000a1bc: 9f c0 80 00 call %g2 4000a1c0: d0 00 60 04 ld [ %g1 + 4 ], %o0 ! 4001f004 <_CPU_Null_fp_context+0x14> _Thread_Dispatch_necessary = false; 4000a1c4: 03 10 00 7c sethi %hi(0x4001f000), %g1 4000a1c8: 82 10 63 d0 or %g1, 0x3d0, %g1 ! 4001f3d0 <_Per_CPU_Information> 4000a1cc: c0 28 60 0c clrb [ %g1 + 0xc ] _Thread_Executing = NULL; 4000a1d0: c0 20 60 10 clr [ %g1 + 0x10 ] _Thread_Heir = NULL; 4000a1d4: c0 20 60 14 clr [ %g1 + 0x14 ] #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Thread_Allocated_fp = NULL; #endif _Thread_Maximum_extensions = maximum_extensions; 4000a1d8: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4000a1dc: f8 20 63 3c st %i4, [ %g1 + 0x33c ] ! 4001ef3c <_Thread_Maximum_extensions> _Thread_Ticks_per_timeslice = ticks_per_timeslice; 4000a1e0: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4000a1e4: fa 20 62 20 st %i5, [ %g1 + 0x220 ] ! 4001ee20 <_Thread_Ticks_per_timeslice> #if defined(RTEMS_MULTIPROCESSING) if ( _System_state_Is_multiprocessing ) maximum_internal_threads += 1; #endif _Objects_Initialize_information( 4000a1e8: 82 10 20 08 mov 8, %g1 4000a1ec: 11 10 00 7b sethi %hi(0x4001ec00), %o0 4000a1f0: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 4000a1f4: 90 12 23 b0 or %o0, 0x3b0, %o0 4000a1f8: 92 10 20 01 mov 1, %o1 4000a1fc: 94 10 20 01 mov 1, %o2 4000a200: 96 10 20 01 mov 1, %o3 4000a204: 98 10 21 60 mov 0x160, %o4 4000a208: 7f ff fb 6a call 40008fb0 <_Objects_Initialize_information> 4000a20c: 9a 10 20 00 clr %o5 4000a210: 81 c7 e0 08 ret 4000a214: 81 e8 00 00 restore _Configuration_MP_table->maximum_proxies; #endif if ( rtems_configuration_get_stack_allocate_hook() == NULL || rtems_configuration_get_stack_free_hook() == NULL) _Internal_error_Occurred( 4000a218: 90 10 20 00 clr %o0 4000a21c: 92 10 20 01 mov 1, %o1 4000a220: 7f ff f9 bb call 4000890c <_Internal_error_Occurred> 4000a224: 94 10 20 0e mov 0xe, %o2 =============================================================================== 40009fa4 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 40009fa4: 9d e3 bf 98 save %sp, -104, %sp 40009fa8: 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; 40009fac: c0 26 61 4c clr [ %i1 + 0x14c ] 40009fb0: c0 26 61 50 clr [ %i1 + 0x150 ] extensions_area = NULL; the_thread->libc_reent = NULL; 40009fb4: c0 26 61 48 clr [ %i1 + 0x148 ] Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 40009fb8: f8 07 a0 60 ld [ %fp + 0x60 ], %i4 40009fbc: e0 00 40 00 ld [ %g1 ], %l0 if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { 40009fc0: 80 a6 a0 00 cmp %i2, 0 40009fc4: 02 80 00 60 be 4000a144 <_Thread_Initialize+0x1a0> 40009fc8: 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; 40009fcc: c0 2e 60 b0 clrb [ %i1 + 0xb0 ] 40009fd0: 90 10 00 1b mov %i3, %o0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 40009fd4: 37 10 00 7b sethi %hi(0x4001ec00), %i3 40009fd8: c2 06 e3 3c ld [ %i3 + 0x33c ], %g1 ! 4001ef3c <_Thread_Maximum_extensions> Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 40009fdc: f4 26 60 b8 st %i2, [ %i1 + 0xb8 ] the_stack->size = size; 40009fe0: d0 26 60 b4 st %o0, [ %i1 + 0xb4 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40009fe4: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 40009fe8: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 40009fec: c0 26 60 68 clr [ %i1 + 0x68 ] 40009ff0: 80 a0 60 00 cmp %g1, 0 40009ff4: 12 80 00 40 bne 4000a0f4 <_Thread_Initialize+0x150> 40009ff8: c0 26 60 6c clr [ %i1 + 0x6c ] (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; 40009ffc: c0 26 61 54 clr [ %i1 + 0x154 ] * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; 4000a000: b4 10 20 00 clr %i2 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 4000a004: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 4000a008: e2 2e 60 9c stb %l1, [ %i1 + 0x9c ] the_thread->Start.budget_algorithm = budget_algorithm; 4000a00c: f8 26 60 a0 st %i4, [ %i1 + 0xa0 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 4000a010: 80 a7 20 02 cmp %i4, 2 4000a014: 12 80 00 05 bne 4000a028 <_Thread_Initialize+0x84> 4000a018: c2 26 60 a4 st %g1, [ %i1 + 0xa4 ] 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; 4000a01c: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4000a020: c2 00 62 20 ld [ %g1 + 0x220 ], %g1 ! 4001ee20 <_Thread_Ticks_per_timeslice> 4000a024: c2 26 60 74 st %g1, [ %i1 + 0x74 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 4000a028: c4 07 a0 68 ld [ %fp + 0x68 ], %g2 */ RTEMS_INLINE_ROUTINE void* _Scheduler_Allocate( Thread_Control *the_thread ) { return _Scheduler.Operations.allocate( the_thread ); 4000a02c: 03 10 00 78 sethi %hi(0x4001e000), %g1 4000a030: c2 00 63 7c ld [ %g1 + 0x37c ], %g1 ! 4001e37c <_Scheduler+0x18> 4000a034: c4 26 60 a8 st %g2, [ %i1 + 0xa8 ] the_thread->current_state = STATES_DORMANT; 4000a038: b6 10 20 01 mov 1, %i3 the_thread->Wait.queue = NULL; 4000a03c: c0 26 60 44 clr [ %i1 + 0x44 ] #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; 4000a040: f6 26 60 10 st %i3, [ %i1 + 0x10 ] the_thread->Wait.queue = NULL; the_thread->resource_count = 0; 4000a044: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 4000a048: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; 4000a04c: fa 26 60 ac st %i5, [ %i1 + 0xac ] 4000a050: 9f c0 40 00 call %g1 4000a054: 90 10 00 19 mov %i1, %o0 sched =_Scheduler_Allocate( the_thread ); if ( !sched ) 4000a058: b8 92 20 00 orcc %o0, 0, %i4 4000a05c: 22 80 00 17 be,a 4000a0b8 <_Thread_Initialize+0x114> 4000a060: d0 06 61 48 ld [ %i1 + 0x148 ], %o0 goto failed; _Thread_Set_priority( the_thread, priority ); 4000a064: 90 10 00 19 mov %i1, %o0 4000a068: 40 00 01 e0 call 4000a7e8 <_Thread_Set_priority> 4000a06c: 92 10 00 1d mov %i5, %o1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000a070: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 4000a074: c2 16 60 0a lduh [ %i1 + 0xa ], %g1 static inline void _Timestamp64_implementation_Set_to_zero( Timestamp64_Control *_time ) { *_time = 0; 4000a078: c0 26 60 80 clr [ %i1 + 0x80 ] 4000a07c: c0 26 60 84 clr [ %i1 + 0x84 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000a080: 83 28 60 02 sll %g1, 2, %g1 4000a084: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 4000a088: e0 26 60 0c st %l0, [ %i1 + 0xc ] * @{ */ static inline bool _User_extensions_Thread_create( Thread_Control *created ) { User_extensions_Thread_create_context ctx = { created, true }; 4000a08c: f2 27 bf f8 st %i1, [ %fp + -8 ] 4000a090: f6 2f bf fc stb %i3, [ %fp + -4 ] _User_extensions_Iterate( &ctx, _User_extensions_Thread_create_visitor ); 4000a094: 90 07 bf f8 add %fp, -8, %o0 4000a098: 13 10 00 2a sethi %hi(0x4000a800), %o1 4000a09c: 40 00 02 83 call 4000aaa8 <_User_extensions_Iterate> 4000a0a0: 92 12 61 80 or %o1, 0x180, %o1 ! 4000a980 <_User_extensions_Thread_create_visitor> * 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 ); if ( extension_status ) 4000a0a4: c2 0f bf fc ldub [ %fp + -4 ], %g1 4000a0a8: 80 a0 60 00 cmp %g1, 0 4000a0ac: 12 80 00 0f bne 4000a0e8 <_Thread_Initialize+0x144> 4000a0b0: b0 10 20 01 mov 1, %i0 return true; failed: _Workspace_Free( the_thread->libc_reent ); 4000a0b4: d0 06 61 48 ld [ %i1 + 0x148 ], %o0 4000a0b8: 40 00 03 dd call 4000b02c <_Workspace_Free> 4000a0bc: b0 10 20 00 clr %i0 for ( i=0 ; i <= THREAD_API_LAST ; i++ ) _Workspace_Free( the_thread->API_Extensions[i] ); 4000a0c0: 40 00 03 db call 4000b02c <_Workspace_Free> 4000a0c4: d0 06 61 4c ld [ %i1 + 0x14c ], %o0 4000a0c8: 40 00 03 d9 call 4000b02c <_Workspace_Free> 4000a0cc: d0 06 61 50 ld [ %i1 + 0x150 ], %o0 _Workspace_Free( extensions_area ); 4000a0d0: 40 00 03 d7 call 4000b02c <_Workspace_Free> 4000a0d4: 90 10 00 1a mov %i2, %o0 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Workspace_Free( fp_area ); #endif _Workspace_Free( sched ); 4000a0d8: 40 00 03 d5 call 4000b02c <_Workspace_Free> 4000a0dc: 90 10 00 1c mov %i4, %o0 _Thread_Stack_Free( the_thread ); 4000a0e0: 40 00 01 fb call 4000a8cc <_Thread_Stack_Free> 4000a0e4: 90 10 00 19 mov %i1, %o0 4000a0e8: b0 0e 20 ff and %i0, 0xff, %i0 4000a0ec: 81 c7 e0 08 ret 4000a0f0: 81 e8 00 00 restore /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { extensions_area = _Workspace_Allocate( 4000a0f4: 90 00 60 01 add %g1, 1, %o0 4000a0f8: 40 00 03 c5 call 4000b00c <_Workspace_Allocate> 4000a0fc: 91 2a 20 02 sll %o0, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 4000a100: b4 92 20 00 orcc %o0, 0, %i2 4000a104: 02 80 00 1d be 4000a178 <_Thread_Initialize+0x1d4> 4000a108: 86 10 00 1a mov %i2, %g3 goto failed; } the_thread->extensions = (void **) extensions_area; 4000a10c: f4 26 61 54 st %i2, [ %i1 + 0x154 ] 4000a110: c8 06 e3 3c ld [ %i3 + 0x33c ], %g4 * 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++ ) 4000a114: 84 10 20 00 clr %g2 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; 4000a118: 10 80 00 03 b 4000a124 <_Thread_Initialize+0x180> 4000a11c: 82 10 20 00 clr %g1 4000a120: c6 06 61 54 ld [ %i1 + 0x154 ], %g3 * 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; 4000a124: 85 28 a0 02 sll %g2, 2, %g2 4000a128: c0 20 c0 02 clr [ %g3 + %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++ ) 4000a12c: 82 00 60 01 inc %g1 4000a130: 80 a0 40 04 cmp %g1, %g4 4000a134: 08 bf ff fb bleu 4000a120 <_Thread_Initialize+0x17c> 4000a138: 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; 4000a13c: 10 bf ff b3 b 4000a008 <_Thread_Initialize+0x64> 4000a140: 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 ); 4000a144: 90 10 00 19 mov %i1, %o0 4000a148: 40 00 01 d1 call 4000a88c <_Thread_Stack_Allocate> 4000a14c: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 4000a150: 80 a2 00 1b cmp %o0, %i3 4000a154: 0a 80 00 07 bcs 4000a170 <_Thread_Initialize+0x1cc> 4000a158: 80 a2 20 00 cmp %o0, 0 4000a15c: 02 80 00 05 be 4000a170 <_Thread_Initialize+0x1cc> <== NEVER TAKEN 4000a160: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 4000a164: f4 06 60 bc ld [ %i1 + 0xbc ], %i2 the_thread->Start.core_allocated_stack = true; 4000a168: 10 bf ff 9b b 40009fd4 <_Thread_Initialize+0x30> 4000a16c: c2 2e 60 b0 stb %g1, [ %i1 + 0xb0 ] stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ 4000a170: 10 bf ff de b 4000a0e8 <_Thread_Initialize+0x144> 4000a174: b0 10 20 00 clr %i0 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; 4000a178: 10 bf ff cf b 4000a0b4 <_Thread_Initialize+0x110> 4000a17c: b8 10 20 00 clr %i4 =============================================================================== 4000a8cc <_Thread_Stack_Free>: #include void _Thread_Stack_Free( Thread_Control *the_thread ) { 4000a8cc: 9d e3 bf a0 save %sp, -96, %sp #if defined(RTEMS_SCORE_THREAD_ENABLE_USER_PROVIDED_STACK_VIA_API) /* * If the API provided the stack space, then don't free it. */ if ( !the_thread->Start.core_allocated_stack ) 4000a8d0: c2 0e 20 b0 ldub [ %i0 + 0xb0 ], %g1 4000a8d4: 80 a0 60 00 cmp %g1, 0 void _Thread_Stack_Free( Thread_Control *the_thread ) { rtems_stack_free_hook stack_free_hook = 4000a8d8: 03 10 00 71 sethi %hi(0x4001c400), %g1 #if defined(RTEMS_SCORE_THREAD_ENABLE_USER_PROVIDED_STACK_VIA_API) /* * If the API provided the stack space, then don't free it. */ if ( !the_thread->Start.core_allocated_stack ) 4000a8dc: 02 80 00 04 be 4000a8ec <_Thread_Stack_Free+0x20> <== NEVER TAKEN 4000a8e0: c2 00 60 44 ld [ %g1 + 0x44 ], %g1 ! 4001c444 * Call ONLY the CPU table stack free hook, or the * the RTEMS workspace free. This is so the free * routine properly matches the allocation of the stack. */ (*stack_free_hook)( the_thread->Start.Initial_stack.area ); 4000a8e4: 9f c0 40 00 call %g1 4000a8e8: d0 06 20 b8 ld [ %i0 + 0xb8 ], %o0 4000a8ec: 81 c7 e0 08 ret 4000a8f0: 81 e8 00 00 restore =============================================================================== 4000f5c4 <_Thread_queue_Extract_fifo>: void _Thread_queue_Extract_fifo( Thread_queue_Control *the_thread_queue __attribute__((unused)), Thread_Control *the_thread ) { 4000f5c4: 9d e3 bf a0 save %sp, -96, %sp <== NOT EXECUTED ISR_Level level; _ISR_Disable( level ); 4000f5c8: 7f ff ca b7 call 400020a4 <== NOT EXECUTED 4000f5cc: 01 00 00 00 nop <== NOT EXECUTED 4000f5d0: b0 10 00 08 mov %o0, %i0 <== NOT EXECUTED 4000f5d4: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 <== NOT EXECUTED 4000f5d8: 03 00 00 ef sethi %hi(0x3bc00), %g1 <== NOT EXECUTED 4000f5dc: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 <== NOT EXECUTED if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 4000f5e0: 80 88 80 01 btst %g2, %g1 <== NOT EXECUTED 4000f5e4: 02 80 00 1a be 4000f64c <_Thread_queue_Extract_fifo+0x88> <== NOT EXECUTED 4000f5e8: 01 00 00 00 nop <== NOT EXECUTED ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4000f5ec: c4 06 40 00 ld [ %i1 ], %g2 <== NOT EXECUTED previous = the_node->previous; 4000f5f0: c2 06 60 04 ld [ %i1 + 4 ], %g1 <== NOT EXECUTED _Chain_Extract_unprotected( &the_thread->Object.Node ); the_thread->Wait.queue = NULL; if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 4000f5f4: c6 06 60 50 ld [ %i1 + 0x50 ], %g3 <== NOT EXECUTED next->previous = previous; 4000f5f8: c2 20 a0 04 st %g1, [ %g2 + 4 ] <== NOT EXECUTED previous->next = next; 4000f5fc: c4 20 40 00 st %g2, [ %g1 ] <== NOT EXECUTED 4000f600: 80 a0 e0 02 cmp %g3, 2 <== NOT EXECUTED 4000f604: 02 80 00 08 be 4000f624 <_Thread_queue_Extract_fifo+0x60> <== NOT EXECUTED 4000f608: c0 26 60 44 clr [ %i1 + 0x44 ] <== NOT EXECUTED _ISR_Enable( level ); 4000f60c: 7f ff ca aa call 400020b4 <== NOT EXECUTED 4000f610: b0 10 00 19 mov %i1, %i0 <== NOT EXECUTED 4000f614: 33 04 01 ff sethi %hi(0x1007fc00), %i1 <== NOT EXECUTED 4000f618: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1007fff8 <== NOT EXECUTED 4000f61c: 7f ff e9 3e call 40009b14 <_Thread_Clear_state> <== NOT EXECUTED 4000f620: 81 e8 00 00 restore <== NOT EXECUTED 4000f624: 82 10 20 03 mov 3, %g1 <== NOT EXECUTED 4000f628: c2 26 60 50 st %g1, [ %i1 + 0x50 ] <== NOT EXECUTED } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 4000f62c: 7f ff ca a2 call 400020b4 <== NOT EXECUTED 4000f630: b0 10 00 19 mov %i1, %i0 <== NOT EXECUTED (void) _Watchdog_Remove( &the_thread->Timer ); 4000f634: 7f ff ed c0 call 4000ad34 <_Watchdog_Remove> <== NOT EXECUTED 4000f638: 90 06 60 48 add %i1, 0x48, %o0 <== NOT EXECUTED 4000f63c: 33 04 01 ff sethi %hi(0x1007fc00), %i1 <== NOT EXECUTED 4000f640: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1007fff8 <== NOT EXECUTED 4000f644: 7f ff e9 34 call 40009b14 <_Thread_Clear_state> <== NOT EXECUTED 4000f648: 81 e8 00 00 restore <== NOT EXECUTED ISR_Level level; _ISR_Disable( level ); if ( !_States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { _ISR_Enable( level ); 4000f64c: 7f ff ca 9a call 400020b4 <== NOT EXECUTED 4000f650: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 4000a728 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 4000a728: 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 ) 4000a72c: 80 a6 20 00 cmp %i0, 0 4000a730: 02 80 00 13 be 4000a77c <_Thread_queue_Requeue+0x54> <== NEVER TAKEN 4000a734: 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 ) { 4000a738: fa 06 20 34 ld [ %i0 + 0x34 ], %i5 4000a73c: 80 a7 60 01 cmp %i5, 1 4000a740: 02 80 00 04 be 4000a750 <_Thread_queue_Requeue+0x28> <== ALWAYS TAKEN 4000a744: 01 00 00 00 nop 4000a748: 81 c7 e0 08 ret <== NOT EXECUTED 4000a74c: 81 e8 00 00 restore <== NOT EXECUTED Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 4000a750: 7f ff de 55 call 400020a4 4000a754: 01 00 00 00 nop 4000a758: b8 10 00 08 mov %o0, %i4 4000a75c: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 4000a760: 03 00 00 ef sethi %hi(0x3bc00), %g1 4000a764: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 4000a768: 80 88 80 01 btst %g2, %g1 4000a76c: 12 80 00 06 bne 4000a784 <_Thread_queue_Requeue+0x5c> <== ALWAYS TAKEN 4000a770: 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 ); 4000a774: 7f ff de 50 call 400020b4 4000a778: 90 10 00 1c mov %i4, %o0 4000a77c: 81 c7 e0 08 ret 4000a780: 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 ); 4000a784: 92 10 00 19 mov %i1, %o1 4000a788: 94 10 20 01 mov 1, %o2 4000a78c: 40 00 0c 98 call 4000d9ec <_Thread_queue_Extract_priority_helper> 4000a790: fa 26 20 30 st %i5, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 4000a794: 90 10 00 18 mov %i0, %o0 4000a798: 92 10 00 19 mov %i1, %o1 4000a79c: 7f ff ff 35 call 4000a470 <_Thread_queue_Enqueue_priority> 4000a7a0: 94 07 bf fc add %fp, -4, %o2 4000a7a4: 30 bf ff f4 b,a 4000a774 <_Thread_queue_Requeue+0x4c> =============================================================================== 4000a7a8 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 4000a7a8: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 4000a7ac: 90 10 00 18 mov %i0, %o0 4000a7b0: 7f ff fd d2 call 40009ef8 <_Thread_Get> 4000a7b4: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000a7b8: c2 07 bf fc ld [ %fp + -4 ], %g1 4000a7bc: 80 a0 60 00 cmp %g1, 0 4000a7c0: 12 80 00 08 bne 4000a7e0 <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 4000a7c4: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 4000a7c8: 40 00 0c c2 call 4000dad0 <_Thread_queue_Process_timeout> 4000a7cc: 01 00 00 00 nop * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 4000a7d0: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4000a7d4: c4 00 62 c0 ld [ %g1 + 0x2c0 ], %g2 ! 4001eec0 <_Thread_Dispatch_disable_level> --level; 4000a7d8: 84 00 bf ff add %g2, -1, %g2 _Thread_Dispatch_disable_level = level; 4000a7dc: c4 20 62 c0 st %g2, [ %g1 + 0x2c0 ] 4000a7e0: 81 c7 e0 08 ret 4000a7e4: 81 e8 00 00 restore =============================================================================== 400178f0 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 400178f0: 9d e3 bf 88 save %sp, -120, %sp 400178f4: 21 10 00 f5 sethi %hi(0x4003d400), %l0 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400178f8: a4 07 bf e8 add %fp, -24, %l2 400178fc: b4 07 bf ec add %fp, -20, %i2 40017900: b8 07 bf f4 add %fp, -12, %i4 40017904: a2 07 bf f8 add %fp, -8, %l1 40017908: 33 10 00 f4 sethi %hi(0x4003d000), %i1 4001790c: 27 10 00 f5 sethi %hi(0x4003d400), %l3 40017910: f4 27 bf e8 st %i2, [ %fp + -24 ] head->previous = NULL; 40017914: c0 27 bf ec clr [ %fp + -20 ] tail->previous = head; 40017918: e4 27 bf f0 st %l2, [ %fp + -16 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 4001791c: e2 27 bf f4 st %l1, [ %fp + -12 ] head->previous = NULL; 40017920: c0 27 bf f8 clr [ %fp + -8 ] tail->previous = head; 40017924: f8 27 bf fc st %i4, [ %fp + -4 ] 40017928: a0 14 21 58 or %l0, 0x158, %l0 4001792c: b6 06 20 30 add %i0, 0x30, %i3 40017930: b2 16 63 b8 or %i1, 0x3b8, %i1 40017934: ba 06 20 68 add %i0, 0x68, %i5 40017938: a6 14 e0 70 or %l3, 0x70, %l3 4001793c: ac 06 20 08 add %i0, 8, %l6 40017940: aa 06 20 40 add %i0, 0x40, %l5 _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; 40017944: a8 10 20 01 mov 1, %l4 { /* * 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; 40017948: e4 26 20 78 st %l2, [ %i0 + 0x78 ] static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 4001794c: c2 04 00 00 ld [ %l0 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 40017950: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40017954: 90 10 00 1b mov %i3, %o0 40017958: 92 20 40 09 sub %g1, %o1, %o1 4001795c: 94 10 00 1c mov %i4, %o2 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 40017960: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 40017964: 40 00 12 35 call 4001c238 <_Watchdog_Adjust_to_chain> 40017968: 01 00 00 00 nop 4001796c: d0 1e 40 00 ldd [ %i1 ], %o0 40017970: 94 10 20 00 clr %o2 40017974: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 40017978: 40 00 51 6b call 4002bf24 <__divdi3> 4001797c: 96 12 e2 00 or %o3, 0x200, %o3 ! 3b9aca00 Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 40017980: d4 06 20 74 ld [ %i0 + 0x74 ], %o2 /* * 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 ) { 40017984: 80 a2 40 0a cmp %o1, %o2 40017988: 18 80 00 2b bgu 40017a34 <_Timer_server_Body+0x144> 4001798c: ae 10 00 09 mov %o1, %l7 * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { 40017990: 80 a2 40 0a cmp %o1, %o2 40017994: 0a 80 00 20 bcs 40017a14 <_Timer_server_Body+0x124> 40017998: 90 10 00 1d mov %i5, %o0 */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; 4001799c: ee 26 20 74 st %l7, [ %i0 + 0x74 ] } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 400179a0: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 400179a4: 40 00 02 c2 call 400184ac <_Chain_Get> 400179a8: 01 00 00 00 nop if ( timer == NULL ) { 400179ac: 92 92 20 00 orcc %o0, 0, %o1 400179b0: 02 80 00 10 be 400179f0 <_Timer_server_Body+0x100> 400179b4: 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 ) { 400179b8: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 400179bc: 80 a0 60 01 cmp %g1, 1 400179c0: 02 80 00 19 be 40017a24 <_Timer_server_Body+0x134> 400179c4: 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 ) { 400179c8: 12 bf ff f6 bne 400179a0 <_Timer_server_Body+0xb0> <== NEVER TAKEN 400179cc: 92 02 60 10 add %o1, 0x10, %o1 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 400179d0: 40 00 12 46 call 4001c2e8 <_Watchdog_Insert> 400179d4: 90 10 00 1d mov %i5, %o0 } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 400179d8: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 400179dc: 40 00 02 b4 call 400184ac <_Chain_Get> 400179e0: 01 00 00 00 nop if ( timer == NULL ) { 400179e4: 92 92 20 00 orcc %o0, 0, %o1 400179e8: 32 bf ff f5 bne,a 400179bc <_Timer_server_Body+0xcc> <== NEVER TAKEN 400179ec: 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 ); 400179f0: 7f ff dd e8 call 4000f190 400179f4: 01 00 00 00 nop if ( _Chain_Is_empty( insert_chain ) ) { 400179f8: c2 07 bf e8 ld [ %fp + -24 ], %g1 400179fc: 80 a0 40 1a cmp %g1, %i2 40017a00: 02 80 00 12 be 40017a48 <_Timer_server_Body+0x158> <== ALWAYS TAKEN 40017a04: 01 00 00 00 nop ts->insert_chain = NULL; _ISR_Enable( level ); break; } else { _ISR_Enable( level ); 40017a08: 7f ff dd e6 call 4000f1a0 <== NOT EXECUTED 40017a0c: 01 00 00 00 nop <== NOT EXECUTED 40017a10: 30 bf ff cf b,a 4001794c <_Timer_server_Body+0x5c> <== NOT EXECUTED /* * 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 ); 40017a14: 92 10 20 01 mov 1, %o1 ! 1 40017a18: 40 00 11 d8 call 4001c178 <_Watchdog_Adjust> 40017a1c: 94 22 80 17 sub %o2, %l7, %o2 40017a20: 30 bf ff df b,a 4001799c <_Timer_server_Body+0xac> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 40017a24: 90 10 00 1b mov %i3, %o0 40017a28: 40 00 12 30 call 4001c2e8 <_Watchdog_Insert> 40017a2c: 92 02 60 10 add %o1, 0x10, %o1 40017a30: 30 bf ff dc b,a 400179a0 <_Timer_server_Body+0xb0> /* * 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 ); 40017a34: 92 22 40 0a sub %o1, %o2, %o1 40017a38: 90 10 00 1d mov %i5, %o0 40017a3c: 40 00 11 ff call 4001c238 <_Watchdog_Adjust_to_chain> 40017a40: 94 10 00 1c mov %i4, %o2 40017a44: 30 bf ff d6 b,a 4001799c <_Timer_server_Body+0xac> */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; 40017a48: c0 26 20 78 clr [ %i0 + 0x78 ] _ISR_Enable( level ); 40017a4c: 7f ff dd d5 call 4000f1a0 40017a50: 01 00 00 00 nop _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 ) ) { 40017a54: c2 07 bf f4 ld [ %fp + -12 ], %g1 40017a58: 80 a0 40 11 cmp %g1, %l1 40017a5c: 12 80 00 0c bne 40017a8c <_Timer_server_Body+0x19c> 40017a60: 01 00 00 00 nop 40017a64: 30 80 00 13 b,a 40017ab0 <_Timer_server_Body+0x1c0> 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; 40017a68: f8 20 60 04 st %i4, [ %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; 40017a6c: c2 27 bf f4 st %g1, [ %fp + -12 ] * 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; 40017a70: c0 25 e0 08 clr [ %l7 + 8 ] _ISR_Enable( level ); 40017a74: 7f ff dd cb call 4000f1a0 40017a78: 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 ); 40017a7c: d0 05 e0 20 ld [ %l7 + 0x20 ], %o0 40017a80: c2 05 e0 1c ld [ %l7 + 0x1c ], %g1 40017a84: 9f c0 40 00 call %g1 40017a88: d2 05 e0 24 ld [ %l7 + 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 ); 40017a8c: 7f ff dd c1 call 4000f190 40017a90: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 40017a94: ee 07 bf f4 ld [ %fp + -12 ], %l7 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 40017a98: 80 a5 c0 11 cmp %l7, %l1 40017a9c: 32 bf ff f3 bne,a 40017a68 <_Timer_server_Body+0x178> 40017aa0: c2 05 c0 00 ld [ %l7 ], %g1 watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 40017aa4: 7f ff dd bf call 4000f1a0 40017aa8: 01 00 00 00 nop 40017aac: 30 bf ff a7 b,a 40017948 <_Timer_server_Body+0x58> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 40017ab0: c0 2e 20 7c clrb [ %i0 + 0x7c ] * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40017ab4: c2 04 c0 00 ld [ %l3 ], %g1 ++level; 40017ab8: 82 00 60 01 inc %g1 _Thread_Dispatch_disable_level = level; 40017abc: c2 24 c0 00 st %g1, [ %l3 ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 40017ac0: d0 06 00 00 ld [ %i0 ], %o0 40017ac4: 40 00 10 c1 call 4001bdc8 <_Thread_Set_state> 40017ac8: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 40017acc: 7f ff ff 07 call 400176e8 <_Timer_server_Reset_interval_system_watchdog> 40017ad0: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 40017ad4: 7f ff ff 19 call 40017738 <_Timer_server_Reset_tod_system_watchdog> 40017ad8: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 40017adc: 40 00 0e 4d call 4001b410 <_Thread_Enable_dispatch> 40017ae0: 01 00 00 00 nop static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 40017ae4: 90 10 00 16 mov %l6, %o0 _Thread_Set_state( ts->thread, STATES_DELAYING ); _Timer_server_Reset_interval_system_watchdog( ts ); _Timer_server_Reset_tod_system_watchdog( ts ); _Thread_Enable_dispatch(); ts->active = true; 40017ae8: e8 2e 20 7c stb %l4, [ %i0 + 0x7c ] static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 40017aec: 40 00 12 5e call 4001c464 <_Watchdog_Remove> 40017af0: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 40017af4: 40 00 12 5c call 4001c464 <_Watchdog_Remove> 40017af8: 90 10 00 15 mov %l5, %o0 40017afc: 30 bf ff 93 b,a 40017948 <_Timer_server_Body+0x58> =============================================================================== 40017788 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 40017788: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 4001778c: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 40017790: 80 a0 60 00 cmp %g1, 0 40017794: 02 80 00 05 be 400177a8 <_Timer_server_Schedule_operation_method+0x20> 40017798: ba 10 00 19 mov %i1, %i5 * 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 ); 4001779c: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 400177a0: 40 00 03 38 call 40018480 <_Chain_Append> 400177a4: 81 e8 00 00 restore * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 400177a8: 03 10 00 f5 sethi %hi(0x4003d400), %g1 400177ac: c4 00 60 70 ld [ %g1 + 0x70 ], %g2 ! 4003d470 <_Thread_Dispatch_disable_level> ++level; 400177b0: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 400177b4: c4 20 60 70 st %g2, [ %g1 + 0x70 ] * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 400177b8: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 400177bc: 80 a0 60 01 cmp %g1, 1 400177c0: 02 80 00 2b be 4001786c <_Timer_server_Schedule_operation_method+0xe4> 400177c4: 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 ) { 400177c8: 02 80 00 04 be 400177d8 <_Timer_server_Schedule_operation_method+0x50> 400177cc: 01 00 00 00 nop if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 400177d0: 40 00 0f 10 call 4001b410 <_Thread_Enable_dispatch> 400177d4: 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 ); 400177d8: 7f ff de 6e call 4000f190 400177dc: 01 00 00 00 nop 400177e0: b8 10 00 08 mov %o0, %i4 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 400177e4: 03 10 00 f4 sethi %hi(0x4003d000), %g1 400177e8: d0 18 63 b8 ldd [ %g1 + 0x3b8 ], %o0 ! 4003d3b8 <_TOD> 400177ec: 94 10 20 00 clr %o2 400177f0: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 400177f4: 40 00 51 cc call 4002bf24 <__divdi3> 400177f8: 96 12 e2 00 or %o3, 0x200, %o3 ! 3b9aca00 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 400177fc: c2 06 20 68 ld [ %i0 + 0x68 ], %g1 last_snapshot = ts->TOD_watchdogs.last_snapshot; 40017800: c4 06 20 74 ld [ %i0 + 0x74 ], %g2 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40017804: 86 06 20 6c add %i0, 0x6c, %g3 if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 40017808: 80 a0 40 03 cmp %g1, %g3 4001780c: 02 80 00 0a be 40017834 <_Timer_server_Schedule_operation_method+0xac> 40017810: 80 a2 40 02 cmp %o1, %g2 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { 40017814: 08 80 00 34 bleu 400178e4 <_Timer_server_Schedule_operation_method+0x15c> 40017818: c8 00 60 10 ld [ %g1 + 0x10 ], %g4 /* * We advanced in time. */ delta = snapshot - last_snapshot; 4001781c: 84 22 40 02 sub %o1, %g2, %g2 if (delta_interval > delta) { 40017820: 80 a1 00 02 cmp %g4, %g2 40017824: 08 80 00 03 bleu 40017830 <_Timer_server_Schedule_operation_method+0xa8><== NEVER TAKEN 40017828: 86 10 20 00 clr %g3 delta_interval -= delta; 4001782c: 86 21 00 02 sub %g4, %g2, %g3 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 40017830: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 40017834: d2 26 20 74 st %o1, [ %i0 + 0x74 ] _ISR_Enable( level ); 40017838: 7f ff de 5a call 4000f1a0 4001783c: 90 10 00 1c mov %i4, %o0 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 40017840: 90 06 20 68 add %i0, 0x68, %o0 40017844: 40 00 12 a9 call 4001c2e8 <_Watchdog_Insert> 40017848: 92 07 60 10 add %i5, 0x10, %o1 if ( !ts->active ) { 4001784c: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 40017850: 80 a0 60 00 cmp %g1, 0 40017854: 12 bf ff df bne 400177d0 <_Timer_server_Schedule_operation_method+0x48> 40017858: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 4001785c: 7f ff ff b7 call 40017738 <_Timer_server_Reset_tod_system_watchdog> 40017860: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 40017864: 40 00 0e eb call 4001b410 <_Thread_Enable_dispatch> 40017868: 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 ); 4001786c: 7f ff de 49 call 4000f190 40017870: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 40017874: 05 10 00 f5 sethi %hi(0x4003d400), %g2 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 40017878: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 4001787c: c4 00 a1 58 ld [ %g2 + 0x158 ], %g2 last_snapshot = ts->Interval_watchdogs.last_snapshot; 40017880: c8 06 20 3c ld [ %i0 + 0x3c ], %g4 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40017884: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 40017888: 80 a0 40 03 cmp %g1, %g3 4001788c: 02 80 00 08 be 400178ac <_Timer_server_Schedule_operation_method+0x124> 40017890: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 40017894: f8 00 60 10 ld [ %g1 + 0x10 ], %i4 if (delta_interval > delta) { 40017898: 80 a1 00 1c cmp %g4, %i4 4001789c: 1a 80 00 03 bcc 400178a8 <_Timer_server_Schedule_operation_method+0x120> 400178a0: 86 10 20 00 clr %g3 delta_interval -= delta; 400178a4: 86 27 00 04 sub %i4, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 400178a8: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 400178ac: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 400178b0: 7f ff de 3c call 4000f1a0 400178b4: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 400178b8: 90 06 20 30 add %i0, 0x30, %o0 400178bc: 40 00 12 8b call 4001c2e8 <_Watchdog_Insert> 400178c0: 92 07 60 10 add %i5, 0x10, %o1 if ( !ts->active ) { 400178c4: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 400178c8: 80 a0 60 00 cmp %g1, 0 400178cc: 12 bf ff c1 bne 400177d0 <_Timer_server_Schedule_operation_method+0x48> 400178d0: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 400178d4: 7f ff ff 85 call 400176e8 <_Timer_server_Reset_interval_system_watchdog> 400178d8: 90 10 00 18 mov %i0, %o0 if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); 400178dc: 40 00 0e cd call 4001b410 <_Thread_Enable_dispatch> 400178e0: 81 e8 00 00 restore } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 400178e4: 84 01 00 02 add %g4, %g2, %g2 delta_interval += delta; 400178e8: 10 bf ff d2 b 40017830 <_Timer_server_Schedule_operation_method+0xa8> 400178ec: 86 20 80 09 sub %g2, %o1, %g3 =============================================================================== 4000c498 <_Timespec_Add_to>: ) { uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; 4000c498: d8 02 00 00 ld [ %o0 ], %o4 uint32_t _Timespec_Add_to( struct timespec *time, const struct timespec *add ) { uint32_t seconds = add->tv_sec; 4000c49c: c4 02 40 00 ld [ %o1 ], %g2 /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; 4000c4a0: c6 02 20 04 ld [ %o0 + 4 ], %g3 4000c4a4: c2 02 60 04 ld [ %o1 + 4 ], %g1 ) { uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; 4000c4a8: 98 03 00 02 add %o4, %g2, %o4 time->tv_nsec += add->tv_nsec; 4000c4ac: 82 00 c0 01 add %g3, %g1, %g1 ) { uint32_t seconds = add->tv_sec; /* Add the basics */ time->tv_sec += add->tv_sec; 4000c4b0: d8 22 00 00 st %o4, [ %o0 ] time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 4000c4b4: 09 0e e6 b2 sethi %hi(0x3b9ac800), %g4 4000c4b8: 88 11 21 ff or %g4, 0x1ff, %g4 ! 3b9ac9ff 4000c4bc: 80 a0 40 04 cmp %g1, %g4 4000c4c0: 08 80 00 0d bleu 4000c4f4 <_Timespec_Add_to+0x5c> 4000c4c4: c2 22 20 04 st %g1, [ %o0 + 4 ] 4000c4c8: 98 03 20 01 inc %o4 time->tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 4000c4cc: 1b 31 19 4d sethi %hi(0xc4653400), %o5 #include #include #include #include uint32_t _Timespec_Add_to( 4000c4d0: 98 23 00 02 sub %o4, %g2, %o4 time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { time->tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 4000c4d4: 9a 13 62 00 or %o5, 0x200, %o5 4000c4d8: 82 00 40 0d add %g1, %o5, %g1 #include #include #include #include uint32_t _Timespec_Add_to( 4000c4dc: 86 03 00 02 add %o4, %g2, %g3 /* Add the basics */ time->tv_sec += add->tv_sec; time->tv_nsec += add->tv_nsec; /* Now adjust it so nanoseconds is in range */ while ( time->tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 4000c4e0: 80 a0 40 04 cmp %g1, %g4 4000c4e4: 18 bf ff fd bgu 4000c4d8 <_Timespec_Add_to+0x40> <== NEVER TAKEN 4000c4e8: 84 00 a0 01 inc %g2 4000c4ec: c2 22 20 04 st %g1, [ %o0 + 4 ] 4000c4f0: c6 22 00 00 st %g3, [ %o0 ] time->tv_sec++; seconds++; } return seconds; } 4000c4f4: 81 c3 e0 08 retl 4000c4f8: 90 10 00 02 mov %g2, %o0 =============================================================================== 4000c230 <_Timestamp64_Divide>: const Timestamp64_Control *_lhs, const Timestamp64_Control *_rhs, uint32_t *_ival_percentage, uint32_t *_fval_percentage ) { 4000c230: 9d e3 bf a0 save %sp, -96, %sp Timestamp64_Control answer; if ( *_rhs == 0 ) { 4000c234: d4 1e 40 00 ldd [ %i1 ], %o2 4000c238: 80 92 80 0b orcc %o2, %o3, %g0 4000c23c: 22 80 00 2f be,a 4000c2f8 <_Timestamp64_Divide+0xc8> <== NEVER TAKEN 4000c240: c0 26 80 00 clr [ %i2 ] <== NOT EXECUTED * This looks odd but gives the results the proper precision. * * TODO: Rounding on the last digit of the fval. */ answer = (*_lhs * 100000) / *_rhs; 4000c244: e0 1e 00 00 ldd [ %i0 ], %l0 4000c248: 83 2c 20 02 sll %l0, 2, %g1 4000c24c: 89 34 60 1e srl %l1, 0x1e, %g4 4000c250: 87 2c 60 02 sll %l1, 2, %g3 4000c254: 84 11 00 01 or %g4, %g1, %g2 4000c258: 83 30 e0 1b srl %g3, 0x1b, %g1 4000c25c: 9b 28 e0 05 sll %g3, 5, %o5 4000c260: 99 28 a0 05 sll %g2, 5, %o4 4000c264: 86 a3 40 03 subcc %o5, %g3, %g3 4000c268: 98 10 40 0c or %g1, %o4, %o4 4000c26c: 84 63 00 02 subx %o4, %g2, %g2 4000c270: 92 80 c0 11 addcc %g3, %l1, %o1 4000c274: 83 32 60 1e srl %o1, 0x1e, %g1 4000c278: 90 40 80 10 addx %g2, %l0, %o0 4000c27c: b3 2a 60 02 sll %o1, 2, %i1 4000c280: b1 2a 20 02 sll %o0, 2, %i0 4000c284: 86 82 40 19 addcc %o1, %i1, %g3 4000c288: b0 10 40 18 or %g1, %i0, %i0 4000c28c: 83 30 e0 1e srl %g3, 0x1e, %g1 4000c290: 84 42 00 18 addx %o0, %i0, %g2 4000c294: bb 28 e0 02 sll %g3, 2, %i5 4000c298: b9 28 a0 02 sll %g2, 2, %i4 4000c29c: 92 80 c0 1d addcc %g3, %i5, %o1 4000c2a0: b8 10 40 1c or %g1, %i4, %i4 4000c2a4: 87 32 60 1b srl %o1, 0x1b, %g3 4000c2a8: 90 40 80 1c addx %g2, %i4, %o0 4000c2ac: 83 2a 60 05 sll %o1, 5, %g1 4000c2b0: 85 2a 20 05 sll %o0, 5, %g2 4000c2b4: 92 10 00 01 mov %g1, %o1 4000c2b8: 40 00 3b 32 call 4001af80 <__divdi3> 4000c2bc: 90 10 c0 02 or %g3, %g2, %o0 *_ival_percentage = answer / 1000; 4000c2c0: 94 10 20 00 clr %o2 * This looks odd but gives the results the proper precision. * * TODO: Rounding on the last digit of the fval. */ answer = (*_lhs * 100000) / *_rhs; 4000c2c4: b8 10 00 08 mov %o0, %i4 4000c2c8: ba 10 00 09 mov %o1, %i5 *_ival_percentage = answer / 1000; 4000c2cc: 40 00 3b 2d call 4001af80 <__divdi3> 4000c2d0: 96 10 23 e8 mov 0x3e8, %o3 *_fval_percentage = answer % 1000; 4000c2d4: 90 10 00 1c mov %i4, %o0 * TODO: Rounding on the last digit of the fval. */ answer = (*_lhs * 100000) / *_rhs; *_ival_percentage = answer / 1000; 4000c2d8: d2 26 80 00 st %o1, [ %i2 ] *_fval_percentage = answer % 1000; 4000c2dc: 94 10 20 00 clr %o2 4000c2e0: 96 10 23 e8 mov 0x3e8, %o3 4000c2e4: 40 00 3c 12 call 4001b32c <__moddi3> 4000c2e8: 92 10 00 1d mov %i5, %o1 4000c2ec: d2 26 c0 00 st %o1, [ %i3 ] 4000c2f0: 81 c7 e0 08 ret 4000c2f4: 81 e8 00 00 restore { Timestamp64_Control answer; if ( *_rhs == 0 ) { *_ival_percentage = 0; *_fval_percentage = 0; 4000c2f8: c0 26 c0 00 clr [ %i3 ] <== NOT EXECUTED return; 4000c2fc: 81 c7 e0 08 ret <== NOT EXECUTED 4000c300: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 4000ab78 <_User_extensions_Handler_initialization>: } } void _User_extensions_Handler_initialization(void) { 4000ab78: 9d e3 bf 98 save %sp, -104, %sp uint32_t number_of_initial_extensions = 4000ab7c: 03 10 00 71 sethi %hi(0x4001c400), %g1 4000ab80: c2 00 60 58 ld [ %g1 + 0x58 ], %g1 ! 4001c458 rtems_configuration_get_number_of_initial_extensions(); if ( number_of_initial_extensions > 0 ) { 4000ab84: 80 a0 60 00 cmp %g1, 0 4000ab88: 02 80 00 0a be 4000abb0 <_User_extensions_Handler_initialization+0x38><== NEVER TAKEN 4000ab8c: 91 28 60 02 sll %g1, 2, %o0 User_extensions_Switch_control *initial_extension_switch_controls = _Workspace_Allocate_or_fatal_error( number_of_initial_extensions * sizeof( *initial_extension_switch_controls ) 4000ab90: 83 28 60 04 sll %g1, 4, %g1 { uint32_t number_of_initial_extensions = rtems_configuration_get_number_of_initial_extensions(); if ( number_of_initial_extensions > 0 ) { User_extensions_Switch_control *initial_extension_switch_controls = 4000ab94: 40 00 01 2c call 4000b044 <_Workspace_Allocate_or_fatal_error> 4000ab98: 90 20 40 08 sub %g1, %o0, %o0 number_of_initial_extensions * sizeof( *initial_extension_switch_controls ) ); User_extensions_Switch_context ctx = { initial_extension_switch_controls }; _User_extensions_Iterate( &ctx, _User_extensions_Switch_visitor ); 4000ab9c: 13 10 00 2a sethi %hi(0x4000a800), %o1 User_extensions_Switch_control *initial_extension_switch_controls = _Workspace_Allocate_or_fatal_error( number_of_initial_extensions * sizeof( *initial_extension_switch_controls ) ); User_extensions_Switch_context ctx = { initial_extension_switch_controls }; 4000aba0: d0 27 bf fc st %o0, [ %fp + -4 ] _User_extensions_Iterate( &ctx, _User_extensions_Switch_visitor ); 4000aba4: 92 12 63 34 or %o1, 0x334, %o1 4000aba8: 7f ff ff c0 call 4000aaa8 <_User_extensions_Iterate> 4000abac: 90 07 bf fc add %fp, -4, %o0 4000abb0: 81 c7 e0 08 ret 4000abb4: 81 e8 00 00 restore =============================================================================== 4000aaa8 <_User_extensions_Iterate>: void _User_extensions_Iterate( void *arg, User_extensions_Visitor visitor ) { 4000aaa8: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing = _Thread_Executing; const User_extensions_Table *callouts_current = 4000aaac: 03 10 00 71 sethi %hi(0x4001c400), %g1 4000aab0: 82 10 60 18 or %g1, 0x18, %g1 ! 4001c418 4000aab4: fa 00 60 44 ld [ %g1 + 0x44 ], %i5 rtems_configuration_get_user_extension_table(); const User_extensions_Table *callouts_end = callouts_current + rtems_configuration_get_number_of_initial_extensions(); 4000aab8: f6 00 60 40 ld [ %g1 + 0x40 ], %i3 void _User_extensions_Iterate( void *arg, User_extensions_Visitor visitor ) { Thread_Control *executing = _Thread_Executing; 4000aabc: 03 10 00 7c sethi %hi(0x4001f000), %g1 const User_extensions_Table *callouts_current = rtems_configuration_get_user_extension_table(); const User_extensions_Table *callouts_end = callouts_current + rtems_configuration_get_number_of_initial_extensions(); 4000aac0: b7 2e e0 05 sll %i3, 5, %i3 ) { Thread_Control *executing = _Thread_Executing; const User_extensions_Table *callouts_current = rtems_configuration_get_user_extension_table(); const User_extensions_Table *callouts_end = 4000aac4: b6 07 40 1b add %i5, %i3, %i3 callouts_current + rtems_configuration_get_number_of_initial_extensions(); const Chain_Node *node; const Chain_Node *tail; while ( callouts_current != callouts_end ) { 4000aac8: 80 a7 40 1b cmp %i5, %i3 4000aacc: 02 80 00 0a be 4000aaf4 <_User_extensions_Iterate+0x4c> <== NEVER TAKEN 4000aad0: f8 00 63 e0 ld [ %g1 + 0x3e0 ], %i4 (*visitor)( executing, arg, callouts_current ); 4000aad4: 94 10 00 1d mov %i5, %o2 4000aad8: 90 10 00 1c mov %i4, %o0 4000aadc: 9f c6 40 00 call %i1 4000aae0: 92 10 00 18 mov %i0, %o1 ++callouts_current; 4000aae4: ba 07 60 20 add %i5, 0x20, %i5 const User_extensions_Table *callouts_end = callouts_current + rtems_configuration_get_number_of_initial_extensions(); const Chain_Node *node; const Chain_Node *tail; while ( callouts_current != callouts_end ) { 4000aae8: 80 a6 c0 1d cmp %i3, %i5 4000aaec: 12 bf ff fb bne 4000aad8 <_User_extensions_Iterate+0x30> 4000aaf0: 94 10 00 1d mov %i5, %o2 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 4000aaf4: 37 10 00 79 sethi %hi(0x4001e400), %i3 4000aaf8: fa 06 e0 80 ld [ %i3 + 0x80 ], %i5 ! 4001e480 <_User_extensions_List> 4000aafc: b6 16 e0 80 or %i3, 0x80, %i3 ++callouts_current; } node = _Chain_Immutable_first( &_User_extensions_List ); tail = _Chain_Immutable_tail( &_User_extensions_List ); while ( node != tail ) { 4000ab00: b6 06 e0 04 add %i3, 4, %i3 4000ab04: 80 a7 40 1b cmp %i5, %i3 4000ab08: 02 80 00 09 be 4000ab2c <_User_extensions_Iterate+0x84> 4000ab0c: 94 07 60 14 add %i5, 0x14, %o2 const User_extensions_Control *extension = (const User_extensions_Control *) node; (*visitor)( executing, arg, &extension->Callouts ); 4000ab10: 90 10 00 1c mov %i4, %o0 4000ab14: 9f c6 40 00 call %i1 4000ab18: 92 10 00 18 mov %i0, %o1 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_next( const Chain_Node *the_node ) { return the_node->next; 4000ab1c: fa 07 40 00 ld [ %i5 ], %i5 ++callouts_current; } node = _Chain_Immutable_first( &_User_extensions_List ); tail = _Chain_Immutable_tail( &_User_extensions_List ); while ( node != tail ) { 4000ab20: 80 a7 40 1b cmp %i5, %i3 4000ab24: 12 bf ff fb bne 4000ab10 <_User_extensions_Iterate+0x68> 4000ab28: 94 07 60 14 add %i5, 0x14, %o2 4000ab2c: 81 c7 e0 08 ret 4000ab30: 81 e8 00 00 restore =============================================================================== 4000c57c <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 4000c57c: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 4000c580: 7f ff da 17 call 40002ddc 4000c584: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 4000c588: 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 ); 4000c58c: b8 06 20 04 add %i0, 4, %i4 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { 4000c590: 80 a0 40 1c cmp %g1, %i4 4000c594: 02 80 00 1f be 4000c610 <_Watchdog_Adjust+0x94> 4000c598: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 4000c59c: 12 80 00 1f bne 4000c618 <_Watchdog_Adjust+0x9c> 4000c5a0: 80 a6 60 01 cmp %i1, 1 case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4000c5a4: 80 a6 a0 00 cmp %i2, 0 4000c5a8: 02 80 00 1a be 4000c610 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000c5ac: 01 00 00 00 nop if ( units < _Watchdog_First( header )->delta_interval ) { 4000c5b0: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000c5b4: 80 a6 80 02 cmp %i2, %g2 4000c5b8: 1a 80 00 0a bcc 4000c5e0 <_Watchdog_Adjust+0x64> <== ALWAYS TAKEN 4000c5bc: b6 10 20 01 mov 1, %i3 _Watchdog_First( header )->delta_interval -= units; 4000c5c0: 10 80 00 1d b 4000c634 <_Watchdog_Adjust+0xb8> <== NOT EXECUTED 4000c5c4: 84 20 80 1a sub %g2, %i2, %g2 <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 4000c5c8: 02 80 00 12 be 4000c610 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000c5cc: 01 00 00 00 nop if ( units < _Watchdog_First( header )->delta_interval ) { 4000c5d0: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000c5d4: 80 a0 80 1a cmp %g2, %i2 4000c5d8: 38 80 00 17 bgu,a 4000c634 <_Watchdog_Adjust+0xb8> 4000c5dc: 84 20 80 1a sub %g2, %i2, %g2 _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; 4000c5e0: f6 20 60 10 st %i3, [ %g1 + 0x10 ] while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; 4000c5e4: b4 26 80 02 sub %i2, %g2, %i2 _Watchdog_First( header )->delta_interval = 1; _ISR_Enable( level ); 4000c5e8: 7f ff da 01 call 40002dec 4000c5ec: 01 00 00 00 nop _Watchdog_Tickle( header ); 4000c5f0: 40 00 00 a8 call 4000c890 <_Watchdog_Tickle> 4000c5f4: 90 10 00 18 mov %i0, %o0 _ISR_Disable( level ); 4000c5f8: 7f ff d9 f9 call 40002ddc 4000c5fc: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 4000c600: c2 06 00 00 ld [ %i0 ], %g1 if ( _Chain_Is_empty( header ) ) 4000c604: 80 a7 00 01 cmp %i4, %g1 4000c608: 12 bf ff f0 bne 4000c5c8 <_Watchdog_Adjust+0x4c> 4000c60c: 80 a6 a0 00 cmp %i2, 0 } break; } } _ISR_Enable( level ); 4000c610: 7f ff d9 f7 call 40002dec 4000c614: 91 e8 00 08 restore %g0, %o0, %o0 * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { 4000c618: 12 bf ff fe bne 4000c610 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 4000c61c: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 4000c620: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4000c624: b4 00 80 1a add %g2, %i2, %i2 4000c628: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } break; } } _ISR_Enable( level ); 4000c62c: 7f ff d9 f0 call 40002dec 4000c630: 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; 4000c634: 10 bf ff f7 b 4000c610 <_Watchdog_Adjust+0x94> 4000c638: c4 20 60 10 st %g2, [ %g1 + 0x10 ] =============================================================================== 4001c238 <_Watchdog_Adjust_to_chain>: Chain_Control *header, Watchdog_Interval units_arg, Chain_Control *to_fire ) { 4001c238: 9d e3 bf a0 save %sp, -96, %sp Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; _ISR_Disable( level ); 4001c23c: 7f ff cb d5 call 4000f190 4001c240: 01 00 00 00 nop 4001c244: c2 06 00 00 ld [ %i0 ], %g1 4001c248: ba 06 20 04 add %i0, 4, %i5 4001c24c: b8 06 a0 04 add %i2, 4, %i4 while ( 1 ) { if ( _Chain_Is_empty( header ) ) { 4001c250: 80 a7 40 01 cmp %i5, %g1 4001c254: 02 80 00 20 be 4001c2d4 <_Watchdog_Adjust_to_chain+0x9c> 4001c258: 01 00 00 00 nop /* * If it is longer than "units" until the first element on the chain * fires, then bump it and quit. */ if ( units < first->delta_interval ) { 4001c25c: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4001c260: 80 a6 40 02 cmp %i1, %g2 4001c264: 2a 80 00 1e bcs,a 4001c2dc <_Watchdog_Adjust_to_chain+0xa4> 4001c268: 84 20 80 19 sub %g2, %i1, %g2 /* * The first set happens in less than units, so take all of them * off the chain and adjust units to reflect this. */ units -= first->delta_interval; 4001c26c: b2 26 40 02 sub %i1, %g2, %i1 first->delta_interval = 0; 4001c270: c0 20 60 10 clr [ %g1 + 0x10 ] { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4001c274: c4 00 60 04 ld [ %g1 + 4 ], %g2 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4001c278: c6 00 40 00 ld [ %g1 ], %g3 previous = the_node->previous; next->previous = previous; 4001c27c: c4 20 e0 04 st %g2, [ %g3 + 4 ] previous->next = next; 4001c280: c6 20 80 00 st %g3, [ %g2 ] Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 4001c284: c4 06 a0 08 ld [ %i2 + 8 ], %g2 the_node->next = tail; 4001c288: f8 20 40 00 st %i4, [ %g1 ] tail->previous = the_node; 4001c28c: c2 26 a0 08 st %g1, [ %i2 + 8 ] old_last->next = the_node; 4001c290: c2 20 80 00 st %g1, [ %g2 ] the_node->previous = old_last; 4001c294: c4 20 60 04 st %g2, [ %g1 + 4 ] while ( 1 ) { _Chain_Extract_unprotected( &first->Node ); _Chain_Append_unprotected( to_fire, &first->Node ); _ISR_Flash( level ); 4001c298: 7f ff cb c2 call 4000f1a0 4001c29c: 01 00 00 00 nop 4001c2a0: 7f ff cb bc call 4000f190 4001c2a4: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 4001c2a8: c2 06 00 00 ld [ %i0 ], %g1 if ( _Chain_Is_empty( header ) ) 4001c2ac: 80 a7 40 01 cmp %i5, %g1 4001c2b0: 02 bf ff e9 be 4001c254 <_Watchdog_Adjust_to_chain+0x1c> 4001c2b4: 01 00 00 00 nop break; first = _Watchdog_First( header ); if ( first->delta_interval != 0 ) 4001c2b8: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4001c2bc: 80 a0 a0 00 cmp %g2, 0 4001c2c0: 22 bf ff ee be,a 4001c278 <_Watchdog_Adjust_to_chain+0x40> 4001c2c4: c4 00 60 04 ld [ %g1 + 4 ], %g2 Watchdog_Control *first; _ISR_Disable( level ); while ( 1 ) { if ( _Chain_Is_empty( header ) ) { 4001c2c8: 80 a7 40 01 cmp %i5, %g1 4001c2cc: 12 bf ff e6 bne 4001c264 <_Watchdog_Adjust_to_chain+0x2c> <== ALWAYS TAKEN 4001c2d0: 80 a6 40 02 cmp %i1, %g2 if ( first->delta_interval != 0 ) break; } } _ISR_Enable( level ); 4001c2d4: 7f ff cb b3 call 4000f1a0 4001c2d8: 91 e8 00 08 restore %g0, %o0, %o0 /* * If it is longer than "units" until the first element on the chain * fires, then bump it and quit. */ if ( units < first->delta_interval ) { first->delta_interval -= units; 4001c2dc: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( first->delta_interval != 0 ) break; } } _ISR_Enable( level ); 4001c2e0: 7f ff cb b0 call 4000f1a0 4001c2e4: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 4000ad34 <_Watchdog_Remove>: #include Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 4000ad34: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 4000ad38: 7f ff dc db call 400020a4 4000ad3c: 01 00 00 00 nop previous_state = the_watchdog->state; 4000ad40: fa 06 20 08 ld [ %i0 + 8 ], %i5 switch ( previous_state ) { 4000ad44: 80 a7 60 01 cmp %i5, 1 4000ad48: 02 80 00 2a be 4000adf0 <_Watchdog_Remove+0xbc> 4000ad4c: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4000ad50: 1a 80 00 09 bcc 4000ad74 <_Watchdog_Remove+0x40> 4000ad54: 80 a7 60 03 cmp %i5, 3 _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000ad58: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4000ad5c: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 ! 4001efa8 <_Watchdog_Ticks_since_boot> 4000ad60: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 4000ad64: 7f ff dc d4 call 400020b4 4000ad68: b0 10 00 1d mov %i5, %i0 return( previous_state ); } 4000ad6c: 81 c7 e0 08 ret 4000ad70: 81 e8 00 00 restore Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; switch ( previous_state ) { 4000ad74: 18 bf ff fa bgu 4000ad5c <_Watchdog_Remove+0x28> <== NEVER TAKEN 4000ad78: 03 10 00 7b sethi %hi(0x4001ec00), %g1 RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_Next( Watchdog_Control *the_watchdog ) { return ( (Watchdog_Control *) the_watchdog->Node.next ); 4000ad7c: c2 06 00 00 ld [ %i0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 4000ad80: c0 26 20 08 clr [ %i0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 4000ad84: c4 00 40 00 ld [ %g1 ], %g2 4000ad88: 80 a0 a0 00 cmp %g2, 0 4000ad8c: 02 80 00 07 be 4000ada8 <_Watchdog_Remove+0x74> 4000ad90: 05 10 00 7b sethi %hi(0x4001ec00), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 4000ad94: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 4000ad98: c4 06 20 10 ld [ %i0 + 0x10 ], %g2 4000ad9c: 84 00 c0 02 add %g3, %g2, %g2 4000ada0: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 4000ada4: 05 10 00 7b sethi %hi(0x4001ec00), %g2 4000ada8: c4 00 a3 a4 ld [ %g2 + 0x3a4 ], %g2 ! 4001efa4 <_Watchdog_Sync_count> 4000adac: 80 a0 a0 00 cmp %g2, 0 4000adb0: 22 80 00 07 be,a 4000adcc <_Watchdog_Remove+0x98> 4000adb4: c4 06 20 04 ld [ %i0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 4000adb8: 05 10 00 7c sethi %hi(0x4001f000), %g2 4000adbc: c6 00 a3 d8 ld [ %g2 + 0x3d8 ], %g3 ! 4001f3d8 <_Per_CPU_Information+0x8> 4000adc0: 05 10 00 7b sethi %hi(0x4001ec00), %g2 4000adc4: c6 20 a3 44 st %g3, [ %g2 + 0x344 ] ! 4001ef44 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 4000adc8: c4 06 20 04 ld [ %i0 + 4 ], %g2 next->previous = previous; 4000adcc: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 4000add0: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 4000add4: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4000add8: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 ! 4001efa8 <_Watchdog_Ticks_since_boot> 4000addc: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 4000ade0: 7f ff dc b5 call 400020b4 4000ade4: b0 10 00 1d mov %i5, %i0 return( previous_state ); } 4000ade8: 81 c7 e0 08 ret 4000adec: 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; 4000adf0: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %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; 4000adf4: 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; 4000adf8: c2 26 20 18 st %g1, [ %i0 + 0x18 ] _ISR_Enable( level ); 4000adfc: 7f ff dc ae call 400020b4 4000ae00: b0 10 00 1d mov %i5, %i0 return( previous_state ); } 4000ae04: 81 c7 e0 08 ret 4000ae08: 81 e8 00 00 restore =============================================================================== 4000bfbc <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 4000bfbc: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 4000bfc0: 7f ff da 85 call 400029d4 4000bfc4: 01 00 00 00 nop 4000bfc8: b6 10 00 08 mov %o0, %i3 printk( "Watchdog Chain: %s %p\n", name, header ); 4000bfcc: 11 10 00 7c sethi %hi(0x4001f000), %o0 4000bfd0: 94 10 00 19 mov %i1, %o2 4000bfd4: 92 10 00 18 mov %i0, %o1 4000bfd8: 7f ff e2 02 call 400047e0 4000bfdc: 90 12 20 40 or %o0, 0x40, %o0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 4000bfe0: fa 06 40 00 ld [ %i1 ], %i5 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000bfe4: b2 06 60 04 add %i1, 4, %i1 if ( !_Chain_Is_empty( header ) ) { 4000bfe8: 80 a7 40 19 cmp %i5, %i1 4000bfec: 02 80 00 0f be 4000c028 <_Watchdog_Report_chain+0x6c> 4000bff0: 11 10 00 7c sethi %hi(0x4001f000), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 4000bff4: 92 10 00 1d mov %i5, %o1 4000bff8: 40 00 00 0f call 4000c034 <_Watchdog_Report> 4000bffc: 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 ) 4000c000: fa 07 40 00 ld [ %i5 ], %i5 Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; 4000c004: 80 a7 40 19 cmp %i5, %i1 4000c008: 12 bf ff fc bne 4000bff8 <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 4000c00c: 92 10 00 1d mov %i5, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 4000c010: 11 10 00 7c sethi %hi(0x4001f000), %o0 4000c014: 92 10 00 18 mov %i0, %o1 4000c018: 7f ff e1 f2 call 400047e0 4000c01c: 90 12 20 58 or %o0, 0x58, %o0 } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); 4000c020: 7f ff da 71 call 400029e4 4000c024: 91 e8 00 1b restore %g0, %i3, %o0 _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); 4000c028: 7f ff e1 ee call 400047e0 4000c02c: 90 12 20 68 or %o0, 0x68, %o0 4000c030: 30 bf ff fc b,a 4000c020 <_Watchdog_Report_chain+0x64> =============================================================================== 4000aeb4 <_Workspace_Handler_initialization>: void _Workspace_Handler_initialization( Heap_Area *areas, size_t area_count, Heap_Initialization_or_extend_handler extend ) { 4000aeb4: 9d e3 bf 98 save %sp, -104, %sp Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize; uintptr_t remaining = rtems_configuration_get_work_space_size(); 4000aeb8: 05 10 00 71 sethi %hi(0x4001c400), %g2 4000aebc: 82 10 a0 18 or %g2, 0x18, %g1 ! 4001c418 4000aec0: c6 08 60 32 ldub [ %g1 + 0x32 ], %g3 4000aec4: f6 00 a0 18 ld [ %g2 + 0x18 ], %i3 4000aec8: 80 a0 e0 00 cmp %g3, 0 4000aecc: 12 80 00 03 bne 4000aed8 <_Workspace_Handler_initialization+0x24> 4000aed0: 84 10 20 00 clr %g2 4000aed4: c4 00 60 04 ld [ %g1 + 4 ], %g2 4000aed8: b6 00 80 1b add %g2, %i3, %i3 bool do_zero = rtems_configuration_get_do_zero_of_workspace(); 4000aedc: c4 08 60 30 ldub [ %g1 + 0x30 ], %g2 bool unified = rtems_configuration_get_unified_work_area(); 4000aee0: c2 08 60 31 ldub [ %g1 + 0x31 ], %g1 Heap_Initialization_or_extend_handler extend ) { Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize; uintptr_t remaining = rtems_configuration_get_work_space_size(); bool do_zero = rtems_configuration_get_do_zero_of_workspace(); 4000aee4: c4 2f bf ff stb %g2, [ %fp + -1 ] bool unified = rtems_configuration_get_unified_work_area(); uintptr_t page_size = CPU_HEAP_ALIGNMENT; uintptr_t overhead = _Heap_Area_overhead( page_size ); size_t i; for (i = 0; i < area_count; ++i) { 4000aee8: 80 a6 60 00 cmp %i1, 0 4000aeec: 02 80 00 3c be 4000afdc <_Workspace_Handler_initialization+0x128><== NEVER TAKEN 4000aef0: c2 2f bf fe stb %g1, [ %fp + -2 ] Heap_Area *areas, size_t area_count, Heap_Initialization_or_extend_handler extend ) { Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize; 4000aef4: 23 10 00 21 sethi %hi(0x40008400), %l1 } else { size = 0; } } space_available = (*init_or_extend)( 4000aef8: 27 10 00 7b sethi %hi(0x4001ec00), %l3 bool unified = rtems_configuration_get_unified_work_area(); uintptr_t page_size = CPU_HEAP_ALIGNMENT; uintptr_t overhead = _Heap_Area_overhead( page_size ); size_t i; for (i = 0; i < area_count; ++i) { 4000aefc: b8 10 20 00 clr %i4 Heap_Area *areas, size_t area_count, Heap_Initialization_or_extend_handler extend ) { Heap_Initialization_or_extend_handler init_or_extend = _Heap_Initialize; 4000af00: a2 14 62 98 or %l1, 0x298, %l1 4000af04: a0 08 a0 ff and %g2, 0xff, %l0 if ( area->size > overhead ) { uintptr_t space_available; uintptr_t size; if ( unified ) { 4000af08: a4 08 60 ff and %g1, 0xff, %l2 } else { size = 0; } } space_available = (*init_or_extend)( 4000af0c: 10 80 00 22 b 4000af94 <_Workspace_Handler_initialization+0xe0> 4000af10: a6 14 e2 d0 or %l3, 0x2d0, %l3 if ( do_zero ) { memset( area->begin, 0, area->size ); } if ( area->size > overhead ) { 4000af14: 80 a7 60 16 cmp %i5, 0x16 4000af18: 28 80 00 1c bleu,a 4000af88 <_Workspace_Handler_initialization+0xd4> 4000af1c: b8 07 20 01 inc %i4 uintptr_t space_available; uintptr_t size; if ( unified ) { 4000af20: 80 a4 a0 00 cmp %l2, 0 4000af24: 32 80 00 0a bne,a 4000af4c <_Workspace_Handler_initialization+0x98> 4000af28: d2 06 00 00 ld [ %i0 ], %o1 size = area->size; } else { if ( remaining > 0 ) { 4000af2c: 80 a6 e0 00 cmp %i3, 0 4000af30: 22 80 00 22 be,a 4000afb8 <_Workspace_Handler_initialization+0x104><== NEVER TAKEN 4000af34: d2 06 00 00 ld [ %i0 ], %o1 <== NOT EXECUTED size = remaining < area->size - overhead ? 4000af38: 82 07 7f ea add %i5, -22, %g1 remaining + overhead : area->size; 4000af3c: 80 a0 40 1b cmp %g1, %i3 4000af40: 38 80 00 02 bgu,a 4000af48 <_Workspace_Handler_initialization+0x94><== ALWAYS TAKEN 4000af44: ba 06 e0 16 add %i3, 0x16, %i5 } else { size = 0; } } space_available = (*init_or_extend)( 4000af48: d2 06 00 00 ld [ %i0 ], %o1 4000af4c: 94 10 00 1d mov %i5, %o2 4000af50: 90 10 00 13 mov %l3, %o0 4000af54: 9f c4 40 00 call %l1 4000af58: 96 10 20 08 mov 8, %o3 area->begin, size, page_size ); area->begin = (char *) area->begin + size; 4000af5c: c2 06 00 00 ld [ %i0 ], %g1 area->size -= size; 4000af60: c4 06 20 04 ld [ %i0 + 4 ], %g2 area->begin, size, page_size ); area->begin = (char *) area->begin + size; 4000af64: 82 00 40 1d add %g1, %i5, %g1 area->size -= size; 4000af68: ba 20 80 1d sub %g2, %i5, %i5 area->begin, size, page_size ); area->begin = (char *) area->begin + size; 4000af6c: c2 26 00 00 st %g1, [ %i0 ] area->size -= size; if ( space_available < remaining ) { 4000af70: 80 a2 00 1b cmp %o0, %i3 4000af74: 1a 80 00 1f bcc 4000aff0 <_Workspace_Handler_initialization+0x13c><== ALWAYS TAKEN 4000af78: fa 26 20 04 st %i5, [ %i0 + 4 ] remaining -= space_available; 4000af7c: b6 26 c0 08 sub %i3, %o0, %i3 <== NOT EXECUTED } else { remaining = 0; } init_or_extend = extend; 4000af80: a2 10 00 1a mov %i2, %l1 <== NOT EXECUTED bool unified = rtems_configuration_get_unified_work_area(); uintptr_t page_size = CPU_HEAP_ALIGNMENT; uintptr_t overhead = _Heap_Area_overhead( page_size ); size_t i; for (i = 0; i < area_count; ++i) { 4000af84: b8 07 20 01 inc %i4 4000af88: 80 a7 00 19 cmp %i4, %i1 4000af8c: 02 80 00 14 be 4000afdc <_Workspace_Handler_initialization+0x128><== ALWAYS TAKEN 4000af90: b0 06 20 08 add %i0, 8, %i0 Heap_Area *area = &areas [i]; if ( do_zero ) { 4000af94: 80 a4 20 00 cmp %l0, 0 4000af98: 22 bf ff df be,a 4000af14 <_Workspace_Handler_initialization+0x60> 4000af9c: fa 06 20 04 ld [ %i0 + 4 ], %i5 memset( area->begin, 0, area->size ); 4000afa0: d0 06 00 00 ld [ %i0 ], %o0 4000afa4: d4 06 20 04 ld [ %i0 + 4 ], %o2 4000afa8: 40 00 14 74 call 40010178 4000afac: 92 10 20 00 clr %o1 } if ( area->size > overhead ) { 4000afb0: 10 bf ff d9 b 4000af14 <_Workspace_Handler_initialization+0x60> 4000afb4: fa 06 20 04 ld [ %i0 + 4 ], %i5 } else { size = 0; } } space_available = (*init_or_extend)( 4000afb8: 90 10 00 13 mov %l3, %o0 <== NOT EXECUTED 4000afbc: 94 10 20 00 clr %o2 <== NOT EXECUTED 4000afc0: 9f c4 40 00 call %l1 <== NOT EXECUTED 4000afc4: 96 10 20 08 mov 8, %o3 <== NOT EXECUTED bool unified = rtems_configuration_get_unified_work_area(); uintptr_t page_size = CPU_HEAP_ALIGNMENT; uintptr_t overhead = _Heap_Area_overhead( page_size ); size_t i; for (i = 0; i < area_count; ++i) { 4000afc8: b8 07 20 01 inc %i4 <== NOT EXECUTED remaining -= space_available; } else { remaining = 0; } init_or_extend = extend; 4000afcc: a2 10 00 1a mov %i2, %l1 <== NOT EXECUTED bool unified = rtems_configuration_get_unified_work_area(); uintptr_t page_size = CPU_HEAP_ALIGNMENT; uintptr_t overhead = _Heap_Area_overhead( page_size ); size_t i; for (i = 0; i < area_count; ++i) { 4000afd0: 80 a7 00 19 cmp %i4, %i1 <== NOT EXECUTED 4000afd4: 12 bf ff f0 bne 4000af94 <_Workspace_Handler_initialization+0xe0><== NOT EXECUTED 4000afd8: b0 06 20 08 add %i0, 8, %i0 <== NOT EXECUTED init_or_extend = extend; } } if ( remaining > 0 ) { 4000afdc: 80 a6 e0 00 cmp %i3, 0 4000afe0: 12 80 00 07 bne 4000affc <_Workspace_Handler_initialization+0x148> 4000afe4: 90 10 20 00 clr %o0 4000afe8: 81 c7 e0 08 ret 4000afec: 81 e8 00 00 restore remaining -= space_available; } else { remaining = 0; } init_or_extend = extend; 4000aff0: a2 10 00 1a mov %i2, %l1 area->size -= size; if ( space_available < remaining ) { remaining -= space_available; } else { remaining = 0; 4000aff4: 10 bf ff e4 b 4000af84 <_Workspace_Handler_initialization+0xd0> 4000aff8: b6 10 20 00 clr %i3 init_or_extend = extend; } } if ( remaining > 0 ) { _Internal_error_Occurred( 4000affc: 92 10 20 01 mov 1, %o1 4000b000: 7f ff f6 43 call 4000890c <_Internal_error_Occurred> 4000b004: 94 10 20 02 mov 2, %o2 =============================================================================== 40006ec0 : */ int adjtime( const struct timeval *delta, struct timeval *olddelta ) { 40006ec0: 9d e3 bf 98 save %sp, -104, %sp long adjustment; /* * Simple validations */ if ( !delta ) 40006ec4: 80 a6 20 00 cmp %i0, 0 40006ec8: 02 80 00 8e be 40007100 40006ecc: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) 40006ed0: c4 06 20 04 ld [ %i0 + 4 ], %g2 40006ed4: 03 00 03 d0 sethi %hi(0xf4000), %g1 40006ed8: 82 10 62 3f or %g1, 0x23f, %g1 ! f423f 40006edc: 80 a0 80 01 cmp %g2, %g1 40006ee0: 18 80 00 88 bgu 40007100 40006ee4: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { 40006ee8: 22 80 00 06 be,a 40006f00 40006eec: c2 06 00 00 ld [ %i0 ], %g1 olddelta->tv_sec = 0; olddelta->tv_usec = 0; 40006ef0: c0 26 60 04 clr [ %i1 + 4 ] 40006ef4: c4 06 20 04 ld [ %i0 + 4 ], %g2 if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { olddelta->tv_sec = 0; 40006ef8: c0 26 40 00 clr [ %i1 ] olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); 40006efc: c2 06 00 00 ld [ %i0 ], %g1 adjustment += delta->tv_usec; /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 40006f00: 07 10 00 5d sethi %hi(0x40017400), %g3 40006f04: c8 00 e1 4c ld [ %g3 + 0x14c ], %g4 ! 4001754c olddelta->tv_sec = 0; olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); 40006f08: bb 28 60 08 sll %g1, 8, %i5 40006f0c: 87 28 60 03 sll %g1, 3, %g3 40006f10: 86 27 40 03 sub %i5, %g3, %g3 40006f14: bb 28 e0 06 sll %g3, 6, %i5 40006f18: 86 27 40 03 sub %i5, %g3, %g3 40006f1c: 82 00 c0 01 add %g3, %g1, %g1 40006f20: 83 28 60 06 sll %g1, 6, %g1 adjustment += delta->tv_usec; 40006f24: 84 00 40 02 add %g1, %g2, %g2 /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 40006f28: 80 a0 80 04 cmp %g2, %g4 40006f2c: 1a 80 00 05 bcc 40006f40 40006f30: 03 10 00 65 sethi %hi(0x40019400), %g1 return 0; 40006f34: 82 10 20 00 clr %g1 /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; } 40006f38: 81 c7 e0 08 ret 40006f3c: 91 e8 00 01 restore %g0, %g1, %o0 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40006f40: c4 00 63 e0 ld [ %g1 + 0x3e0 ], %g2 ++level; 40006f44: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 40006f48: c4 20 63 e0 st %g2, [ %g1 + 0x3e0 ] ) { Timestamp_Control tod_as_timestamp; Timestamp_Control *tod_as_timestamp_ptr; tod_as_timestamp_ptr = 40006f4c: 13 10 00 65 sethi %hi(0x40019400), %o1 40006f50: 90 07 bf f8 add %fp, -8, %o0 40006f54: 40 00 07 1c call 40008bc4 <_TOD_Get_with_nanoseconds> 40006f58: 92 12 63 28 or %o1, 0x328, %o1 40006f5c: f8 1a 00 00 ldd [ %o0 ], %i4 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 40006f60: 94 10 20 00 clr %o2 40006f64: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 40006f68: 90 10 00 1c mov %i4, %o0 40006f6c: 96 12 e2 00 or %o3, 0x200, %o3 40006f70: 40 00 3a 42 call 40015878 <__divdi3> 40006f74: 92 10 00 1d mov %i5, %o1 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 40006f78: f6 06 00 00 ld [ %i0 ], %i3 _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 40006f7c: 94 10 20 00 clr %o2 40006f80: b6 06 c0 09 add %i3, %o1, %i3 40006f84: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 40006f88: 90 10 00 1c mov %i4, %o0 40006f8c: 96 12 e2 00 or %o3, 0x200, %o3 40006f90: 40 00 3b 25 call 40015c24 <__moddi3> 40006f94: 92 10 00 1d mov %i5, %o1 ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 40006f98: c2 06 20 04 ld [ %i0 + 4 ], %g1 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 40006f9c: 09 31 19 4d sethi %hi(0xc4653400), %g4 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 40006fa0: 87 28 60 07 sll %g1, 7, %g3 40006fa4: 85 28 60 02 sll %g1, 2, %g2 40006fa8: 84 20 c0 02 sub %g3, %g2, %g2 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 40006fac: 88 11 22 00 or %g4, 0x200, %g4 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 40006fb0: 82 00 80 01 add %g2, %g1, %g1 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 40006fb4: 07 0e e6 b2 sethi %hi(0x3b9ac800), %g3 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 40006fb8: 83 28 60 03 sll %g1, 3, %g1 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 40006fbc: 86 10 e1 ff or %g3, 0x1ff, %g3 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 40006fc0: 92 02 40 01 add %o1, %g1, %o1 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 40006fc4: 80 a2 40 03 cmp %o1, %g3 40006fc8: 08 80 00 07 bleu 40006fe4 40006fcc: 84 06 e0 01 add %i3, 1, %g2 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; 40006fd0: 92 02 40 04 add %o1, %g4, %o1 ts.tv_sec++; 40006fd4: b6 10 00 02 mov %g2, %i3 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 ) { 40006fd8: 80 a2 40 03 cmp %o1, %g3 40006fdc: 18 bf ff fd bgu 40006fd0 <== NEVER TAKEN 40006fe0: 84 00 a0 01 inc %g2 ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; 40006fe4: 3b 0e e6 b2 sethi %hi(0x3b9ac800), %i5 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) ) { 40006fe8: 07 31 19 4d sethi %hi(0xc4653400), %g3 40006fec: 82 10 00 09 mov %o1, %g1 int _EXFUN(setitimer, (int __which, const struct itimerval *__value, struct itimerval *__ovalue)); #if defined(__rtems__) /* BSD function used by RTEMS code */ int _EXFUN(adjtime,(const struct timeval *, struct timeval *)); 40006ff0: 84 06 ff ff add %i3, -1, %g2 ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; 40006ff4: ba 17 62 00 or %i5, 0x200, %i5 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) ) { 40006ff8: 86 10 e2 00 or %g3, 0x200, %g3 ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; 40006ffc: 82 00 40 1d add %g1, %i5, %g1 ts.tv_sec--; 40007000: 88 10 00 02 mov %g2, %g4 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) ) { 40007004: 80 a0 40 03 cmp %g1, %g3 40007008: 08 bf ff fd bleu 40006ffc 4000700c: 84 00 bf ff add %g2, -1, %g2 const struct timespec *tod_as_timespec ) { Timestamp_Control tod_as_timestamp; _Timestamp_Set( 40007010: 85 39 20 1f sra %g4, 0x1f, %g2 40007014: a6 10 00 01 mov %g1, %l3 40007018: a5 38 60 1f sra %g1, 0x1f, %l2 Timestamp64_Control *_time, Timestamp64_Control _seconds, Timestamp64_Control _nanoseconds ) { *_time = _seconds * 1000000000L + _nanoseconds; 4000701c: 83 28 a0 03 sll %g2, 3, %g1 40007020: 86 10 00 04 mov %g4, %g3 40007024: 89 31 20 1d srl %g4, 0x1d, %g4 40007028: bb 28 e0 03 sll %g3, 3, %i5 4000702c: b8 11 00 01 or %g4, %g1, %i4 40007030: 83 37 60 1b srl %i5, 0x1b, %g1 40007034: a9 2f 20 05 sll %i4, 5, %l4 40007038: ab 2f 60 05 sll %i5, 5, %l5 4000703c: a8 10 40 14 or %g1, %l4, %l4 40007040: ba a5 40 1d subcc %l5, %i5, %i5 40007044: 83 37 60 1a srl %i5, 0x1a, %g1 40007048: b8 65 00 1c subx %l4, %i4, %i4 4000704c: a3 2f 60 06 sll %i5, 6, %l1 40007050: a1 2f 20 06 sll %i4, 6, %l0 40007054: ba a4 40 1d subcc %l1, %i5, %i5 40007058: a0 10 40 10 or %g1, %l0, %l0 4000705c: b8 64 00 1c subx %l0, %i4, %i4 40007060: ae 87 40 03 addcc %i5, %g3, %l7 40007064: 83 35 e0 1e srl %l7, 0x1e, %g1 40007068: ac 47 00 02 addx %i4, %g2, %l6 4000706c: 97 2d e0 02 sll %l7, 2, %o3 40007070: 95 2d a0 02 sll %l6, 2, %o2 40007074: 86 85 c0 0b addcc %l7, %o3, %g3 40007078: 94 10 40 0a or %g1, %o2, %o2 4000707c: 9b 28 e0 02 sll %g3, 2, %o5 40007080: 84 45 80 0a addx %l6, %o2, %g2 40007084: 83 30 e0 1e srl %g3, 0x1e, %g1 40007088: ba 80 c0 0d addcc %g3, %o5, %i5 4000708c: 99 28 a0 02 sll %g2, 2, %o4 40007090: b7 2f 60 02 sll %i5, 2, %i3 40007094: 98 10 40 0c or %g1, %o4, %o4 40007098: 83 37 60 1e srl %i5, 0x1e, %g1 4000709c: b8 40 80 0c addx %g2, %o4, %i4 400070a0: 86 87 40 1b addcc %i5, %i3, %g3 400070a4: b5 2f 20 02 sll %i4, 2, %i2 400070a8: bb 30 e0 17 srl %g3, 0x17, %i5 400070ac: b4 10 40 1a or %g1, %i2, %i2 400070b0: 84 47 00 1a addx %i4, %i2, %g2 400070b4: 83 28 e0 09 sll %g3, 9, %g1 400070b8: 89 28 a0 09 sll %g2, 9, %g4 &tod_as_timestamp, tod_as_timespec->tv_sec, tod_as_timespec->tv_nsec ); _TOD_Set_with_timestamp( &tod_as_timestamp ); 400070bc: 90 07 bf f8 add %fp, -8, %o0 400070c0: 84 17 40 04 or %i5, %g4, %g2 400070c4: ba 84 c0 01 addcc %l3, %g1, %i5 400070c8: b8 44 80 02 addx %l2, %g2, %i4 400070cc: 40 00 06 d9 call 40008c30 <_TOD_Set_with_timestamp> 400070d0: f8 3f bf f8 std %i4, [ %fp + -8 ] ts.tv_sec--; } _TOD_Set( &ts ); _Thread_Enable_dispatch(); 400070d4: 40 00 0d 7e call 4000a6cc <_Thread_Enable_dispatch> 400070d8: 01 00 00 00 nop /* set the user's output */ if ( olddelta ) 400070dc: 80 a6 60 00 cmp %i1, 0 400070e0: 02 bf ff 95 be 40006f34 400070e4: 82 10 20 00 clr %g1 *olddelta = *delta; 400070e8: c4 06 00 00 ld [ %i0 ], %g2 400070ec: c4 26 40 00 st %g2, [ %i1 ] 400070f0: c4 06 20 04 ld [ %i0 + 4 ], %g2 400070f4: c4 26 60 04 st %g2, [ %i1 + 4 ] return 0; } 400070f8: 81 c7 e0 08 ret 400070fc: 91 e8 00 01 restore %g0, %g1, %o0 */ 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 ); 40007100: 40 00 23 b0 call 4000ffc0 <__errno> 40007104: 01 00 00 00 nop 40007108: 84 10 20 16 mov 0x16, %g2 ! 16 4000710c: 82 10 3f ff mov -1, %g1 40007110: 10 bf ff 8a b 40006f38 40007114: c4 22 00 00 st %g2, [ %o0 ] =============================================================================== 400070cc : #include #include #include int aio_cancel(int fildes, struct aiocb *aiocbp) { 400070cc: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 400070d0: 3b 10 00 63 sethi %hi(0x40018c00), %i5 400070d4: 40 00 04 85 call 400082e8 400070d8: 90 17 63 f4 or %i5, 0x3f4, %o0 ! 40018ff4 if (fcntl (fildes, F_GETFD) < 0) { 400070dc: 90 10 00 18 mov %i0, %o0 400070e0: 40 00 1b af call 4000df9c 400070e4: 92 10 20 01 mov 1, %o1 400070e8: 80 a2 20 00 cmp %o0, 0 400070ec: 06 80 00 6c bl 4000729c 400070f0: 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) { 400070f4: 02 80 00 3b be 400071e0 400070f8: 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) { 400070fc: f8 06 40 00 ld [ %i1 ], %i4 40007100: 80 a7 00 18 cmp %i4, %i0 40007104: 12 80 00 2f bne 400071c0 40007108: 90 17 63 f4 or %i5, 0x3f4, %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); 4000710c: 92 10 00 1c mov %i4, %o1 40007110: 11 10 00 64 sethi %hi(0x40019000), %o0 40007114: 94 10 20 00 clr %o2 40007118: 40 00 01 92 call 40007760 4000711c: 90 12 20 3c or %o0, 0x3c, %o0 if (r_chain == NULL) { 40007120: b6 92 20 00 orcc %o0, 0, %i3 40007124: 22 80 00 0f be,a 40007160 40007128: b6 17 63 f4 or %i5, 0x3f4, %i3 return AIO_ALLDONE; } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 4000712c: b8 06 e0 1c add %i3, 0x1c, %i4 40007130: 40 00 04 6e call 400082e8 40007134: 90 10 00 1c mov %i4, %o0 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 40007138: 92 10 00 19 mov %i1, %o1 4000713c: 40 00 01 d2 call 40007884 40007140: 90 06 e0 08 add %i3, 8, %o0 40007144: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&r_chain->mutex); 40007148: 40 00 04 88 call 40008368 4000714c: 90 10 00 1c mov %i4, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007150: 40 00 04 86 call 40008368 40007154: 90 17 63 f4 or %i5, 0x3f4, %o0 return result; } return AIO_ALLDONE; } 40007158: 81 c7 e0 08 ret 4000715c: 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)) { 40007160: c4 06 e0 54 ld [ %i3 + 0x54 ], %g2 40007164: 82 06 e0 58 add %i3, 0x58, %g1 40007168: 80 a0 80 01 cmp %g2, %g1 4000716c: 02 80 00 0f be 400071a8 <== NEVER TAKEN 40007170: 90 06 e0 54 add %i3, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40007174: 92 10 00 1c mov %i4, %o1 40007178: 40 00 01 7a call 40007760 4000717c: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40007180: 80 a2 20 00 cmp %o0, 0 40007184: 02 80 00 0e be 400071bc 40007188: 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); 4000718c: 40 00 01 be call 40007884 40007190: 90 02 20 08 add %o0, 8, %o0 40007194: b0 10 00 08 mov %o0, %i0 pthread_mutex_unlock (&aio_request_queue.mutex); 40007198: 40 00 04 74 call 40008368 4000719c: 90 10 00 1b mov %i3, %o0 return result; 400071a0: 81 c7 e0 08 ret 400071a4: 81 e8 00 00 restore 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); return AIO_ALLDONE; 400071a8: b0 10 20 02 mov 2, %i0 <== NOT EXECUTED AIO_printf ("Request chain not on [WQ]\n"); 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); 400071ac: 40 00 04 6f call 40008368 400071b0: 90 17 63 f4 or %i5, 0x3f4, %o0 return AIO_ALLDONE; 400071b4: 81 c7 e0 08 ret 400071b8: 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); 400071bc: 90 10 00 1b mov %i3, %o0 400071c0: 40 00 04 6a call 40008368 400071c4: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one (EINVAL); 400071c8: 40 00 29 9e call 40011840 <__errno> 400071cc: 01 00 00 00 nop 400071d0: 82 10 20 16 mov 0x16, %g1 ! 16 400071d4: c2 22 00 00 st %g1, [ %o0 ] 400071d8: 81 c7 e0 08 ret 400071dc: 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); 400071e0: 11 10 00 64 sethi %hi(0x40019000), %o0 400071e4: 94 10 20 00 clr %o2 400071e8: 40 00 01 5e call 40007760 400071ec: 90 12 20 3c or %o0, 0x3c, %o0 if (r_chain == NULL) { 400071f0: b8 92 20 00 orcc %o0, 0, %i4 400071f4: 02 80 00 0f be 40007230 400071f8: b6 07 20 1c add %i4, 0x1c, %i3 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 400071fc: 40 00 04 3b call 400082e8 40007200: 90 10 00 1b mov %i3, %o0 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 40007204: 40 00 0b 28 call 40009ea4 <_Chain_Extract> 40007208: 90 10 00 1c mov %i4, %o0 rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 4000720c: 40 00 01 8a call 40007834 40007210: 90 10 00 1c mov %i4, %o0 pthread_mutex_unlock (&r_chain->mutex); 40007214: 40 00 04 55 call 40008368 40007218: 90 10 00 1b mov %i3, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; 4000721c: b0 10 20 00 clr %i0 pthread_mutex_lock (&r_chain->mutex); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_unlock (&aio_request_queue.mutex); 40007220: 40 00 04 52 call 40008368 40007224: 90 17 63 f4 or %i5, 0x3f4, %o0 return AIO_CANCELED; 40007228: 81 c7 e0 08 ret 4000722c: 81 e8 00 00 restore */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 40007230: b8 17 63 f4 or %i5, 0x3f4, %i4 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)) { 40007234: c4 07 20 54 ld [ %i4 + 0x54 ], %g2 40007238: 82 07 20 58 add %i4, 0x58, %g1 4000723c: 80 a0 80 01 cmp %g2, %g1 40007240: 02 bf ff da be 400071a8 <== NEVER TAKEN 40007244: 90 07 20 54 add %i4, 0x54, %o0 r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 40007248: 92 10 00 18 mov %i0, %o1 4000724c: 40 00 01 45 call 40007760 40007250: 94 10 20 00 clr %o2 if (r_chain == NULL) { 40007254: b6 92 20 00 orcc %o0, 0, %i3 40007258: 22 bf ff d5 be,a 400071ac 4000725c: b0 10 20 02 mov 2, %i0 40007260: 40 00 0b 11 call 40009ea4 <_Chain_Extract> 40007264: ba 06 e0 1c add %i3, 0x1c, %i5 } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 40007268: 40 00 01 73 call 40007834 4000726c: 90 10 00 1b mov %i3, %o0 pthread_mutex_destroy (&r_chain->mutex); 40007270: 40 00 03 72 call 40008038 40007274: 90 10 00 1d mov %i5, %o0 pthread_cond_destroy (&r_chain->mutex); 40007278: 40 00 02 94 call 40007cc8 4000727c: 90 10 00 1d mov %i5, %o0 free (r_chain); 40007280: 7f ff f0 1f call 400032fc 40007284: 90 10 00 1b mov %i3, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; 40007288: 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); 4000728c: 40 00 04 37 call 40008368 40007290: 90 10 00 1c mov %i4, %o0 return AIO_CANCELED; 40007294: 81 c7 e0 08 ret 40007298: 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); 4000729c: 40 00 04 33 call 40008368 400072a0: 90 17 63 f4 or %i5, 0x3f4, %o0 rtems_set_errno_and_return_minus_one (EBADF); 400072a4: 40 00 29 67 call 40011840 <__errno> 400072a8: b0 10 3f ff mov -1, %i0 400072ac: 82 10 20 09 mov 9, %g1 400072b0: c2 22 00 00 st %g1, [ %o0 ] 400072b4: 81 c7 e0 08 ret 400072b8: 81 e8 00 00 restore =============================================================================== 400072c4 : int aio_fsync( int op, struct aiocb *aiocbp ) { 400072c4: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; if (op != O_SYNC) 400072c8: 03 00 00 08 sethi %hi(0x2000), %g1 400072cc: 80 a6 00 01 cmp %i0, %g1 400072d0: 12 80 00 14 bne 40007320 400072d4: ba 10 20 16 mov 0x16, %i5 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 400072d8: d0 06 40 00 ld [ %i1 ], %o0 400072dc: 40 00 1b 30 call 4000df9c 400072e0: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 400072e4: 90 0a 20 03 and %o0, 3, %o0 400072e8: 90 02 3f ff add %o0, -1, %o0 400072ec: 80 a2 20 01 cmp %o0, 1 400072f0: 18 80 00 0c bgu 40007320 400072f4: ba 10 20 09 mov 9, %i5 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); 400072f8: 7f ff f1 28 call 40003798 400072fc: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007300: 80 a2 20 00 cmp %o0, 0 40007304: 02 80 00 06 be 4000731c <== NEVER TAKEN 40007308: 82 10 20 03 mov 3, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 4000730c: f2 22 20 14 st %i1, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_SYNC; 40007310: c2 26 60 30 st %g1, [ %i1 + 0x30 ] return rtems_aio_enqueue (req); 40007314: 40 00 01 78 call 400078f4 40007318: 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); 4000731c: ba 10 20 0b mov 0xb, %i5 <== NOT EXECUTED 40007320: 82 10 3f ff mov -1, %g1 40007324: fa 26 60 34 st %i5, [ %i1 + 0x34 ] 40007328: c2 26 60 38 st %g1, [ %i1 + 0x38 ] 4000732c: 40 00 29 45 call 40011840 <__errno> 40007330: b0 10 3f ff mov -1, %i0 40007334: fa 22 00 00 st %i5, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } 40007338: 81 c7 e0 08 ret 4000733c: 81 e8 00 00 restore =============================================================================== 40007ad8 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 40007ad8: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007adc: d0 06 00 00 ld [ %i0 ], %o0 40007ae0: 92 10 20 03 mov 3, %o1 40007ae4: 40 00 19 2e call 4000df9c 40007ae8: ba 10 20 09 mov 9, %i5 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40007aec: 80 8a 20 01 btst 1, %o0 40007af0: 12 80 00 0b bne 40007b1c 40007af4: 82 10 3f ff mov -1, %g1 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 40007af8: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 40007afc: 80 a0 60 00 cmp %g1, 0 40007b00: 12 80 00 06 bne 40007b18 40007b04: ba 10 20 16 mov 0x16, %i5 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007b08: c2 06 20 08 ld [ %i0 + 8 ], %g1 40007b0c: 80 a0 60 00 cmp %g1, 0 40007b10: 16 80 00 0a bge 40007b38 40007b14: 01 00 00 00 nop 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); 40007b18: 82 10 3f ff mov -1, %g1 ! ffffffff 40007b1c: fa 26 20 34 st %i5, [ %i0 + 0x34 ] 40007b20: c2 26 20 38 st %g1, [ %i0 + 0x38 ] 40007b24: 40 00 27 47 call 40011840 <__errno> 40007b28: b0 10 3f ff mov -1, %i0 40007b2c: fa 22 00 00 st %i5, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; return rtems_aio_enqueue (req); } 40007b30: 81 c7 e0 08 ret 40007b34: 81 e8 00 00 restore rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007b38: 7f ff ef 18 call 40003798 40007b3c: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007b40: 80 a2 20 00 cmp %o0, 0 40007b44: 02 80 00 06 be 40007b5c <== NEVER TAKEN 40007b48: 82 10 20 01 mov 1, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 40007b4c: f0 22 20 14 st %i0, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_READ; 40007b50: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 40007b54: 7f ff ff 68 call 400078f4 40007b58: 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); 40007b5c: 10 bf ff ef b 40007b18 <== NOT EXECUTED 40007b60: ba 10 20 0b mov 0xb, %i5 <== NOT EXECUTED =============================================================================== 40007b6c : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 40007b6c: 9d e3 bf a0 save %sp, -96, %sp rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 40007b70: d0 06 00 00 ld [ %i0 ], %o0 40007b74: 40 00 19 0a call 4000df9c 40007b78: 92 10 20 03 mov 3, %o1 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 40007b7c: 90 0a 20 03 and %o0, 3, %o0 40007b80: 90 02 3f ff add %o0, -1, %o0 40007b84: 80 a2 20 01 cmp %o0, 1 40007b88: 18 80 00 0a bgu 40007bb0 40007b8c: ba 10 20 09 mov 9, %i5 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 40007b90: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 40007b94: 80 a0 60 00 cmp %g1, 0 40007b98: 12 80 00 06 bne 40007bb0 40007b9c: ba 10 20 16 mov 0x16, %i5 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) 40007ba0: c2 06 20 08 ld [ %i0 + 8 ], %g1 40007ba4: 80 a0 60 00 cmp %g1, 0 40007ba8: 16 80 00 0a bge 40007bd0 40007bac: 01 00 00 00 nop 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); 40007bb0: 82 10 3f ff mov -1, %g1 ! ffffffff 40007bb4: fa 26 20 34 st %i5, [ %i0 + 0x34 ] 40007bb8: c2 26 20 38 st %g1, [ %i0 + 0x38 ] 40007bbc: 40 00 27 21 call 40011840 <__errno> 40007bc0: b0 10 3f ff mov -1, %i0 40007bc4: fa 22 00 00 st %i5, [ %o0 ] req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; return rtems_aio_enqueue (req); } 40007bc8: 81 c7 e0 08 ret 40007bcc: 81 e8 00 00 restore rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 40007bd0: 7f ff ee f2 call 40003798 40007bd4: 90 10 20 18 mov 0x18, %o0 if (req == NULL) 40007bd8: 80 a2 20 00 cmp %o0, 0 40007bdc: 02 80 00 06 be 40007bf4 <== NEVER TAKEN 40007be0: 82 10 20 02 mov 2, %g1 rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 40007be4: f0 22 20 14 st %i0, [ %o0 + 0x14 ] req->aiocbp->aio_lio_opcode = LIO_WRITE; 40007be8: c2 26 20 30 st %g1, [ %i0 + 0x30 ] return rtems_aio_enqueue (req); 40007bec: 7f ff ff 42 call 400078f4 40007bf0: 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); 40007bf4: 10 bf ff ef b 40007bb0 <== NOT EXECUTED 40007bf8: ba 10 20 0b mov 0xb, %i5 <== NOT EXECUTED =============================================================================== 4000812c : rtems_rbtree_control *chunk_tree, rtems_rbheap_chunk *a, rtems_rbheap_chunk *b ) { if (b != NULL_PAGE && rtems_rbheap_is_chunk_free(b)) { 4000812c: 80 a2 ff f8 cmp %o3, -8 40008130: 02 80 00 23 be 400081bc 40008134: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE bool _Chain_Is_node_off_chain( const Chain_Node *node ) { return (node->next == NULL) && (node->previous == NULL); 40008138: c2 02 c0 00 ld [ %o3 ], %g1 4000813c: 80 a0 60 00 cmp %g1, 0 40008140: 22 80 00 1c be,a 400081b0 40008144: c4 02 e0 04 ld [ %o3 + 4 ], %g2 if (b->begin < a->begin) { 40008148: c6 02 e0 18 ld [ %o3 + 0x18 ], %g3 4000814c: c4 02 a0 18 ld [ %o2 + 0x18 ], %g2 40008150: 80 a0 c0 02 cmp %g3, %g2 40008154: 3a 80 00 07 bcc,a 40008170 40008158: c8 02 a0 1c ld [ %o2 + 0x1c ], %g4 4000815c: 84 10 00 0a mov %o2, %g2 40008160: c2 02 80 00 ld [ %o2 ], %g1 40008164: 94 10 00 0b mov %o3, %o2 40008168: 96 10 00 02 mov %g2, %o3 a = b; b = t; } a->size += b->size; 4000816c: c8 02 a0 1c ld [ %o2 + 0x1c ], %g4 40008170: c6 02 e0 1c ld [ %o3 + 0x1c ], %g3 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 40008174: c4 02 e0 04 ld [ %o3 + 4 ], %g2 40008178: 86 01 00 03 add %g4, %g3, %g3 4000817c: c6 22 a0 1c st %g3, [ %o2 + 0x1c ] next->previous = previous; previous->next = next; 40008180: c2 20 80 00 st %g1, [ %g2 ] Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 40008184: c4 20 60 04 st %g2, [ %g1 + 4 ] ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 40008188: c2 02 00 00 ld [ %o0 ], %g1 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 4000818c: d0 22 e0 04 st %o0, [ %o3 + 4 ] before_node = after_node->next; after_node->next = the_node; 40008190: d6 22 00 00 st %o3, [ %o0 ] the_node->next = before_node; 40008194: c2 22 c0 00 st %g1, [ %o3 ] rtems_chain_extract_unprotected(&b->chain_node); add_to_chain(free_chain, b); _RBTree_Extract_unprotected(chunk_tree, &b->tree_node); 40008198: 90 10 00 09 mov %o1, %o0 before_node->previous = the_node; 4000819c: d6 20 60 04 st %o3, [ %g1 + 4 ] 400081a0: 92 02 e0 08 add %o3, 8, %o1 400081a4: 82 13 c0 00 mov %o7, %g1 400081a8: 40 00 07 13 call 40009df4 <_RBTree_Extract_unprotected> 400081ac: 9e 10 40 00 mov %g1, %o7 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_node_off_chain( const Chain_Node *node ) { return (node->next == NULL) && (node->previous == NULL); 400081b0: 80 a0 a0 00 cmp %g2, 0 400081b4: 32 bf ff e6 bne,a 4000814c <== NEVER TAKEN 400081b8: c6 02 e0 18 ld [ %o3 + 0x18 ], %g3 <== NOT EXECUTED 400081bc: 81 c3 e0 08 retl =============================================================================== 40006d2c : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 40006d2c: 9d e3 bf 98 save %sp, -104, %sp if ( !tp ) 40006d30: 80 a6 60 00 cmp %i1, 0 40006d34: 02 80 00 0a be 40006d5c 40006d38: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40006d3c: 02 80 00 19 be 40006da0 40006d40: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 40006d44: 02 80 00 12 be 40006d8c <== NEVER TAKEN 40006d48: 80 a6 20 02 cmp %i0, 2 return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) { 40006d4c: 02 80 00 10 be 40006d8c 40006d50: 80 a6 20 03 cmp %i0, 3 return 0; } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) 40006d54: 02 80 00 08 be 40006d74 40006d58: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40006d5c: 40 00 25 fa call 40010544 <__errno> 40006d60: b0 10 3f ff mov -1, %i0 ! ffffffff 40006d64: 82 10 20 16 mov 0x16, %g1 40006d68: c2 22 00 00 st %g1, [ %o0 ] return 0; } 40006d6c: 81 c7 e0 08 ret 40006d70: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) rtems_set_errno_and_return_minus_one( ENOSYS ); 40006d74: 40 00 25 f4 call 40010544 <__errno> 40006d78: b0 10 3f ff mov -1, %i0 40006d7c: 82 10 20 58 mov 0x58, %g1 40006d80: c2 22 00 00 st %g1, [ %o0 ] 40006d84: 81 c7 e0 08 ret 40006d88: 81 e8 00 00 restore _TOD_Get(tp); return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { _TOD_Get_uptime_as_timespec( tp ); 40006d8c: 90 10 00 19 mov %i1, %o0 40006d90: 40 00 08 a4 call 40009020 <_TOD_Get_uptime_as_timespec> 40006d94: b0 10 20 00 clr %i0 return 0; 40006d98: 81 c7 e0 08 ret 40006d9c: 81 e8 00 00 restore ) { Timestamp_Control tod_as_timestamp; Timestamp_Control *tod_as_timestamp_ptr; tod_as_timestamp_ptr = 40006da0: 90 07 bf f8 add %fp, -8, %o0 40006da4: 13 10 00 68 sethi %hi(0x4001a000), %o1 40006da8: 40 00 08 8d call 40008fdc <_TOD_Get_with_nanoseconds> 40006dac: 92 12 63 48 or %o1, 0x348, %o1 ! 4001a348 <_TOD> #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } 40006db0: f8 1a 00 00 ldd [ %o0 ], %i4 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 40006db4: 94 10 20 00 clr %o2 40006db8: 90 10 00 1c mov %i4, %o0 40006dbc: 92 10 00 1d mov %i5, %o1 40006dc0: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 40006dc4: 40 00 3e 50 call 40016704 <__divdi3> 40006dc8: 96 12 e2 00 or %o3, 0x200, %o3 ! 3b9aca00 _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 40006dcc: 94 10 20 00 clr %o2 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 40006dd0: d2 26 40 00 st %o1, [ %i1 ] _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 40006dd4: 90 10 00 1c mov %i4, %o0 40006dd8: 92 10 00 1d mov %i5, %o1 40006ddc: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { _TOD_Get(tp); return 0; 40006de0: b0 10 20 00 clr %i0 40006de4: 40 00 3f 33 call 40016ab0 <__moddi3> 40006de8: 96 12 e2 00 or %o3, 0x200, %o3 40006dec: d2 26 60 04 st %o1, [ %i1 + 4 ] 40006df0: 81 c7 e0 08 ret 40006df4: 81 e8 00 00 restore =============================================================================== 40028884 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 40028884: 9d e3 bf 98 save %sp, -104, %sp if ( !tp ) 40028888: 80 a6 60 00 cmp %i1, 0 4002888c: 02 80 00 08 be 400288ac <== NEVER TAKEN 40028890: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 40028894: 02 80 00 0c be 400288c4 40028898: 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_ID ) 4002889c: 02 80 00 49 be 400289c0 400288a0: 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_ID ) 400288a4: 02 80 00 47 be 400289c0 400288a8: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 400288ac: 40 00 4b 2f call 4003b568 <__errno> 400288b0: b0 10 3f ff mov -1, %i0 ! ffffffff 400288b4: 82 10 20 16 mov 0x16, %g1 400288b8: c2 22 00 00 st %g1, [ %o0 ] return 0; } 400288bc: 81 c7 e0 08 ret 400288c0: 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 ) 400288c4: c4 06 40 00 ld [ %i1 ], %g2 400288c8: 03 08 76 b9 sethi %hi(0x21dae400), %g1 400288cc: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 400288d0: 80 a0 80 01 cmp %g2, %g1 400288d4: 08 bf ff f6 bleu 400288ac 400288d8: 03 10 01 a1 sethi %hi(0x40068400), %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 400288dc: c4 00 60 a0 ld [ %g1 + 0xa0 ], %g2 ! 400684a0 <_Thread_Dispatch_disable_level> ++level; 400288e0: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 400288e4: c4 20 60 a0 st %g2, [ %g1 + 0xa0 ] const struct timespec *tod_as_timespec ) { Timestamp_Control tod_as_timestamp; _Timestamp_Set( 400288e8: c6 06 40 00 ld [ %i1 ], %g3 400288ec: e2 06 60 04 ld [ %i1 + 4 ], %l1 400288f0: 85 38 e0 1f sra %g3, 0x1f, %g2 Timestamp64_Control *_time, Timestamp64_Control _seconds, Timestamp64_Control _nanoseconds ) { *_time = _seconds * 1000000000L + _nanoseconds; 400288f4: 83 28 a0 03 sll %g2, 3, %g1 400288f8: bb 28 e0 03 sll %g3, 3, %i5 400288fc: 89 30 e0 1d srl %g3, 0x1d, %g4 40028900: b8 11 00 01 or %g4, %g1, %i4 40028904: 83 37 60 1b srl %i5, 0x1b, %g1 40028908: a5 2f 20 05 sll %i4, 5, %l2 4002890c: a7 2f 60 05 sll %i5, 5, %l3 40028910: a4 10 40 12 or %g1, %l2, %l2 40028914: ba a4 c0 1d subcc %l3, %i5, %i5 40028918: 83 37 60 1a srl %i5, 0x1a, %g1 4002891c: b8 64 80 1c subx %l2, %i4, %i4 40028920: 97 2f 60 06 sll %i5, 6, %o3 40028924: 95 2f 20 06 sll %i4, 6, %o2 40028928: ba a2 c0 1d subcc %o3, %i5, %i5 4002892c: 94 10 40 0a or %g1, %o2, %o2 40028930: b8 62 80 1c subx %o2, %i4, %i4 40028934: aa 87 40 03 addcc %i5, %g3, %l5 40028938: 83 35 60 1e srl %l5, 0x1e, %g1 4002893c: a8 47 00 02 addx %i4, %g2, %l4 40028940: 9b 2d 60 02 sll %l5, 2, %o5 40028944: 99 2d 20 02 sll %l4, 2, %o4 40028948: 86 85 40 0d addcc %l5, %o5, %g3 4002894c: 98 10 40 0c or %g1, %o4, %o4 40028950: b3 28 e0 02 sll %g3, 2, %i1 40028954: 84 45 00 0c addx %l4, %o4, %g2 40028958: 83 30 e0 1e srl %g3, 0x1e, %g1 4002895c: ba 80 c0 19 addcc %g3, %i1, %i5 40028960: b1 28 a0 02 sll %g2, 2, %i0 40028964: b7 2f 60 02 sll %i5, 2, %i3 40028968: b0 10 40 18 or %g1, %i0, %i0 4002896c: 83 37 60 1e srl %i5, 0x1e, %g1 40028970: b8 40 80 18 addx %g2, %i0, %i4 40028974: 86 87 40 1b addcc %i5, %i3, %g3 40028978: b5 2f 20 02 sll %i4, 2, %i2 4002897c: bb 30 e0 17 srl %g3, 0x17, %i5 40028980: b4 10 40 1a or %g1, %i2, %i2 40028984: 84 47 00 1a addx %i4, %i2, %g2 40028988: 83 28 e0 09 sll %g3, 9, %g1 4002898c: 89 28 a0 09 sll %g2, 9, %g4 &tod_as_timestamp, tod_as_timespec->tv_sec, tod_as_timespec->tv_nsec ); _TOD_Set_with_timestamp( &tod_as_timestamp ); 40028990: 90 07 bf f8 add %fp, -8, %o0 40028994: 84 17 40 04 or %i5, %g4, %g2 40028998: ba 84 40 01 addcc %l1, %g1, %i5 const struct timespec *tod_as_timespec ) { Timestamp_Control tod_as_timestamp; _Timestamp_Set( 4002899c: a1 3c 60 1f sra %l1, 0x1f, %l0 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; 400289a0: b0 10 20 00 clr %i0 400289a4: b8 44 00 02 addx %l0, %g2, %i4 &tod_as_timestamp, tod_as_timespec->tv_sec, tod_as_timespec->tv_nsec ); _TOD_Set_with_timestamp( &tod_as_timestamp ); 400289a8: 40 00 04 92 call 40029bf0 <_TOD_Set_with_timestamp> 400289ac: f8 3f bf f8 std %i4, [ %fp + -8 ] if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); 400289b0: 7f ff 83 a7 call 4000984c <_Thread_Enable_dispatch> 400289b4: 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; 400289b8: 81 c7 e0 08 ret 400289bc: 81 e8 00 00 restore else if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) rtems_set_errno_and_return_minus_one( ENOSYS ); 400289c0: 40 00 4a ea call 4003b568 <__errno> 400289c4: b0 10 3f ff mov -1, %i0 400289c8: 82 10 20 58 mov 0x58, %g1 400289cc: c2 22 00 00 st %g1, [ %o0 ] 400289d0: 81 c7 e0 08 ret 400289d4: 81 e8 00 00 restore =============================================================================== 4001b9b8 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 4001b9b8: 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() ) 4001b9bc: 7f ff ff 10 call 4001b5fc 4001b9c0: 01 00 00 00 nop 4001b9c4: 80 a2 00 18 cmp %o0, %i0 4001b9c8: 12 80 00 af bne 4001bc84 4001b9cc: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); /* * Validate the signal passed. */ if ( !sig ) 4001b9d0: 02 80 00 b3 be 4001bc9c 4001b9d4: 82 06 7f ff add %i1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 4001b9d8: 80 a0 60 1f cmp %g1, 0x1f 4001b9dc: 18 80 00 b0 bgu 4001bc9c 4001b9e0: a1 2e 60 02 sll %i1, 2, %l0 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 ) 4001b9e4: 31 10 00 7d sethi %hi(0x4001f400), %i0 4001b9e8: a3 2e 60 04 sll %i1, 4, %l1 4001b9ec: b0 16 20 30 or %i0, 0x30, %i0 4001b9f0: 84 24 40 10 sub %l1, %l0, %g2 4001b9f4: 84 06 00 02 add %i0, %g2, %g2 4001b9f8: c4 00 a0 08 ld [ %g2 + 8 ], %g2 4001b9fc: 80 a0 a0 01 cmp %g2, 1 4001ba00: 02 80 00 9f be 4001bc7c 4001ba04: 80 a6 60 04 cmp %i1, 4 /* * 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 ) ) 4001ba08: 02 80 00 41 be 4001bb0c 4001ba0c: 80 a6 60 08 cmp %i1, 8 4001ba10: 02 80 00 3f be 4001bb0c 4001ba14: 80 a6 60 0b cmp %i1, 0xb 4001ba18: 02 80 00 3d be 4001bb0c 4001ba1c: ba 10 20 01 mov 1, %i5 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 4001ba20: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 4001ba24: fa 27 bf f8 st %i5, [ %fp + -8 ] if ( !value ) { 4001ba28: 80 a6 a0 00 cmp %i2, 0 4001ba2c: 02 80 00 3e be 4001bb24 4001ba30: bb 2f 40 01 sll %i5, %g1, %i5 siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; 4001ba34: c2 06 80 00 ld [ %i2 ], %g1 4001ba38: c2 27 bf fc st %g1, [ %fp + -4 ] * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 4001ba3c: 03 10 00 7b sethi %hi(0x4001ec00), %g1 4001ba40: c4 00 62 c0 ld [ %g1 + 0x2c0 ], %g2 ! 4001eec0 <_Thread_Dispatch_disable_level> ++level; 4001ba44: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 4001ba48: c4 20 62 c0 st %g2, [ %g1 + 0x2c0 ] */ void _POSIX_signals_Manager_Initialization(void); static inline void _POSIX_signals_Add_post_switch_extension(void) { _API_extensions_Add_post_switch( &_POSIX_signals_Post_switch ); 4001ba4c: 11 10 00 79 sethi %hi(0x4001e400), %o0 4001ba50: 7f ff b0 ca call 40007d78 <_API_extensions_Add_post_switch> 4001ba54: 90 12 20 a8 or %o0, 0xa8, %o0 ! 4001e4a8 <_POSIX_signals_Post_switch> /* * 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; 4001ba58: 03 10 00 7c sethi %hi(0x4001f000), %g1 4001ba5c: d0 00 63 e0 ld [ %g1 + 0x3e0 ], %o0 ! 4001f3e0 <_Per_CPU_Information+0x10> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 4001ba60: c2 02 21 50 ld [ %o0 + 0x150 ], %g1 4001ba64: c2 00 60 d0 ld [ %g1 + 0xd0 ], %g1 4001ba68: 80 af 40 01 andncc %i5, %g1, %g0 4001ba6c: 12 80 00 17 bne 4001bac8 4001ba70: 09 10 00 7d sethi %hi(0x4001f400), %g4 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; 4001ba74: c2 01 21 bc ld [ %g4 + 0x1bc ], %g1 ! 4001f5bc <_POSIX_signals_Wait_queue> 4001ba78: 88 11 21 bc or %g4, 0x1bc, %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 ); 4001ba7c: 88 01 20 04 add %g4, 4, %g4 4001ba80: 80 a0 40 04 cmp %g1, %g4 4001ba84: 32 80 00 0d bne,a 4001bab8 4001ba88: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 4001ba8c: 10 80 00 28 b 4001bb2c 4001ba90: 03 10 00 78 sethi %hi(0x4001e000), %g1 /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 4001ba94: c4 00 e0 d0 ld [ %g3 + 0xd0 ], %g2 4001ba98: 80 af 40 02 andncc %i5, %g2, %g0 4001ba9c: 12 80 00 0b bne 4001bac8 4001baa0: 90 10 00 01 mov %g1, %o0 the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { 4001baa4: c2 00 40 00 ld [ %g1 ], %g1 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); 4001baa8: 80 a0 40 04 cmp %g1, %g4 4001baac: 22 80 00 20 be,a 4001bb2c <== ALWAYS TAKEN 4001bab0: 03 10 00 78 sethi %hi(0x4001e000), %g1 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 4001bab4: c4 00 60 30 ld [ %g1 + 0x30 ], %g2 ! 4001e030 <__mprec_tinytens+0x8><== NOT EXECUTED 4001bab8: 80 8f 40 02 btst %i5, %g2 4001babc: 02 bf ff f6 be 4001ba94 4001bac0: c6 00 61 50 ld [ %g1 + 0x150 ], %g3 the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { 4001bac4: 90 10 00 01 mov %g1, %o0 /* * 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 ) ) { 4001bac8: 92 10 00 19 mov %i1, %o1 4001bacc: 40 00 00 8b call 4001bcf8 <_POSIX_signals_Unblock_thread> 4001bad0: 94 07 bf f4 add %fp, -12, %o2 4001bad4: 80 8a 20 ff btst 0xff, %o0 4001bad8: 12 80 00 09 bne 4001bafc 4001badc: 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 ); 4001bae0: 40 00 00 7d call 4001bcd4 <_POSIX_signals_Set_process_signals> 4001bae4: 90 10 00 1d mov %i5, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 4001bae8: a0 24 40 10 sub %l1, %l0, %l0 4001baec: c2 06 00 10 ld [ %i0 + %l0 ], %g1 4001baf0: 80 a0 60 02 cmp %g1, 2 4001baf4: 02 80 00 4f be 4001bc30 4001baf8: 11 10 00 7d sethi %hi(0x4001f400), %o0 /* * 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 ) ) { _Thread_Enable_dispatch(); 4001bafc: 7f ff b8 f3 call 40009ec8 <_Thread_Enable_dispatch> 4001bb00: b0 10 20 00 clr %i0 4001bb04: 81 c7 e0 08 ret 4001bb08: 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 ); 4001bb0c: 40 00 01 13 call 4001bf58 4001bb10: 01 00 00 00 nop 4001bb14: 40 00 00 d2 call 4001be5c 4001bb18: 92 10 00 19 mov %i1, %o1 4001bb1c: 81 c7 e0 08 ret 4001bb20: 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; 4001bb24: 10 bf ff c6 b 4001ba3c 4001bb28: c0 27 bf fc clr [ %fp + -4 ] * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 4001bb2c: f8 08 62 dc ldub [ %g1 + 0x2dc ], %i4 4001bb30: 1b 10 00 7b sethi %hi(0x4001ec00), %o5 4001bb34: b8 07 20 01 inc %i4 4001bb38: 9a 13 62 2c or %o5, 0x22c, %o5 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 4001bb3c: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 4001bb40: 98 03 60 08 add %o5, 8, %o4 */ RTEMS_INLINE_ROUTINE bool _States_Is_interruptible_by_signal ( States_Control the_states ) { return (the_states & STATES_INTERRUPTIBLE_BY_SIGNAL); 4001bb44: 17 04 00 00 sethi %hi(0x10000000), %o3 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 ] ) 4001bb48: c2 03 40 00 ld [ %o5 ], %g1 4001bb4c: 80 a0 60 00 cmp %g1, 0 4001bb50: 22 80 00 31 be,a 4001bc14 <== NEVER TAKEN 4001bb54: 9a 03 60 04 add %o5, 4, %o5 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 4001bb58: c2 00 60 04 ld [ %g1 + 4 ], %g1 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 4001bb5c: f6 10 60 10 lduh [ %g1 + 0x10 ], %i3 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 4001bb60: 80 a6 e0 00 cmp %i3, 0 4001bb64: 02 80 00 2b be 4001bc10 4001bb68: f4 00 60 1c ld [ %g1 + 0x1c ], %i2 4001bb6c: 84 10 20 01 mov 1, %g2 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 4001bb70: 87 28 a0 02 sll %g2, 2, %g3 maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { the_thread = (Thread_Control *) object_table[ index ]; 4001bb74: c6 06 80 03 ld [ %i2 + %g3 ], %g3 if ( !the_thread ) 4001bb78: 80 a0 e0 00 cmp %g3, 0 4001bb7c: 22 80 00 22 be,a 4001bc04 4001bb80: 84 00 a0 01 inc %g2 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 4001bb84: c8 00 e0 14 ld [ %g3 + 0x14 ], %g4 4001bb88: 80 a1 00 1c cmp %g4, %i4 4001bb8c: 38 80 00 1e bgu,a 4001bc04 4001bb90: 84 00 a0 01 inc %g2 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 4001bb94: de 00 e1 50 ld [ %g3 + 0x150 ], %o7 4001bb98: de 03 e0 d0 ld [ %o7 + 0xd0 ], %o7 4001bb9c: 80 af 40 0f andncc %i5, %o7, %g0 4001bba0: 22 80 00 19 be,a 4001bc04 4001bba4: 84 00 a0 01 inc %g2 * * 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 ) { 4001bba8: 80 a1 00 1c cmp %g4, %i4 4001bbac: 2a 80 00 14 bcs,a 4001bbfc 4001bbb0: b8 10 00 04 mov %g4, %i4 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { 4001bbb4: 80 a2 20 00 cmp %o0, 0 4001bbb8: 22 80 00 13 be,a 4001bc04 <== NEVER TAKEN 4001bbbc: 84 00 a0 01 inc %g2 <== NOT EXECUTED 4001bbc0: c2 02 20 10 ld [ %o0 + 0x10 ], %g1 4001bbc4: 80 a0 60 00 cmp %g1, 0 4001bbc8: 22 80 00 0f be,a 4001bc04 <== NEVER TAKEN 4001bbcc: 84 00 a0 01 inc %g2 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 4001bbd0: de 00 e0 10 ld [ %g3 + 0x10 ], %o7 4001bbd4: 80 a3 e0 00 cmp %o7, 0 4001bbd8: 22 80 00 09 be,a 4001bbfc 4001bbdc: b8 10 00 04 mov %g4, %i4 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 4001bbe0: 80 88 40 0b btst %g1, %o3 4001bbe4: 32 80 00 08 bne,a 4001bc04 4001bbe8: 84 00 a0 01 inc %g2 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 4001bbec: 80 8b c0 0b btst %o7, %o3 4001bbf0: 22 80 00 05 be,a 4001bc04 4001bbf4: 84 00 a0 01 inc %g2 */ if ( interested && !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 4001bbf8: b8 10 00 04 mov %g4, %i4 4001bbfc: 90 10 00 03 mov %g3, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 4001bc00: 84 00 a0 01 inc %g2 4001bc04: 80 a6 c0 02 cmp %i3, %g2 4001bc08: 1a bf ff db bcc 4001bb74 4001bc0c: 87 28 a0 02 sll %g2, 2, %g3 4001bc10: 9a 03 60 04 add %o5, 4, %o5 * + 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++) { 4001bc14: 80 a3 40 0c cmp %o5, %o4 4001bc18: 32 bf ff cd bne,a 4001bb4c 4001bc1c: c2 03 40 00 ld [ %o5 ], %g1 } } } } if ( interested ) { 4001bc20: 80 a2 20 00 cmp %o0, 0 4001bc24: 12 bf ff aa bne 4001bacc 4001bc28: 92 10 00 19 mov %i1, %o1 4001bc2c: 30 bf ff ad b,a 4001bae0 */ _POSIX_signals_Set_process_signals( mask ); if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) 4001bc30: 7f ff b0 b7 call 40007f0c <_Chain_Get> 4001bc34: 90 12 21 b0 or %o0, 0x1b0, %o0 _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { 4001bc38: 92 92 20 00 orcc %o0, 0, %o1 4001bc3c: 02 80 00 1e be 4001bcb4 4001bc40: 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 ); 4001bc44: 11 10 00 7d sethi %hi(0x4001f400), %o0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 4001bc48: c2 22 60 08 st %g1, [ %o1 + 8 ] 4001bc4c: c2 07 bf f8 ld [ %fp + -8 ], %g1 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 4001bc50: 90 12 22 28 or %o0, 0x228, %o0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 4001bc54: c2 22 60 0c st %g1, [ %o1 + 0xc ] 4001bc58: c2 07 bf fc ld [ %fp + -4 ], %g1 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 4001bc5c: 90 02 00 10 add %o0, %l0, %o0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 4001bc60: c2 22 60 10 st %g1, [ %o1 + 0x10 ] _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 4001bc64: 7f ff b0 9f call 40007ee0 <_Chain_Append> 4001bc68: b0 10 20 00 clr %i0 /* * 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 ) ) { _Thread_Enable_dispatch(); 4001bc6c: 7f ff b8 97 call 40009ec8 <_Thread_Enable_dispatch> 4001bc70: 01 00 00 00 nop 4001bc74: 81 c7 e0 08 ret 4001bc78: 81 e8 00 00 restore } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 4001bc7c: 81 c7 e0 08 ret 4001bc80: 91 e8 20 00 restore %g0, 0, %o0 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) rtems_set_errno_and_return_minus_one( ESRCH ); 4001bc84: 7f ff ce af call 4000f740 <__errno> 4001bc88: b0 10 3f ff mov -1, %i0 4001bc8c: 82 10 20 03 mov 3, %g1 4001bc90: c2 22 00 00 st %g1, [ %o0 ] 4001bc94: 81 c7 e0 08 ret 4001bc98: 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 ); 4001bc9c: 7f ff ce a9 call 4000f740 <__errno> 4001bca0: b0 10 3f ff mov -1, %i0 4001bca4: 82 10 20 16 mov 0x16, %g1 4001bca8: c2 22 00 00 st %g1, [ %o0 ] 4001bcac: 81 c7 e0 08 ret 4001bcb0: 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(); 4001bcb4: 7f ff b8 85 call 40009ec8 <_Thread_Enable_dispatch> 4001bcb8: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EAGAIN ); 4001bcbc: 7f ff ce a1 call 4000f740 <__errno> 4001bcc0: 01 00 00 00 nop 4001bcc4: 82 10 20 0b mov 0xb, %g1 ! b 4001bcc8: c2 22 00 00 st %g1, [ %o0 ] 4001bccc: 81 c7 e0 08 ret 4001bcd0: 81 e8 00 00 restore =============================================================================== 40007578 : int oflag, ... /* mode_t mode, */ /* struct mq_attr attr */ ) { 40007578: 9d e3 bf 88 save %sp, -120, %sp * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 4000757c: 03 10 00 8e sethi %hi(0x40023800), %g1 40007580: c4 00 60 c0 ld [ %g1 + 0xc0 ], %g2 ! 400238c0 <_Thread_Dispatch_disable_level> size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40007584: f4 27 a0 4c st %i2, [ %fp + 0x4c ] ++level; 40007588: 84 00 a0 01 inc %g2 4000758c: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 40007590: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40007594: fa 27 a0 58 st %i5, [ %fp + 0x58 ] _Thread_Dispatch_disable_level = level; 40007598: c4 20 60 c0 st %g2, [ %g1 + 0xc0 ] Objects_Locations location; size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 4000759c: a2 8e 62 00 andcc %i1, 0x200, %l1 400075a0: 12 80 00 36 bne 40007678 400075a4: a0 10 20 00 clr %l0 */ RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) 400075a8: 39 10 00 8f sethi %hi(0x40023c00), %i4 400075ac: 40 00 0c 21 call 4000a630 <_Objects_Allocate> 400075b0: 90 17 21 90 or %i4, 0x190, %o0 ! 40023d90 <_POSIX_Message_queue_Information_fds> attr = va_arg( arg, struct mq_attr * ); va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { 400075b4: ba 92 20 00 orcc %o0, 0, %i5 400075b8: 02 80 00 39 be 4000769c <== NEVER TAKEN 400075bc: 01 00 00 00 nop _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENFILE ); } the_mq_fd->oflag = oflag; 400075c0: f2 27 60 14 st %i1, [ %i5 + 0x14 ] const char *name, Objects_Id *id, size_t *len ) { return _POSIX_Name_to_id( &_POSIX_Message_queue_Information, name, id, len ); 400075c4: 35 10 00 8f sethi %hi(0x40023c00), %i2 400075c8: 92 10 00 18 mov %i0, %o1 400075cc: 90 16 a0 04 or %i2, 4, %o0 400075d0: 94 07 bf f0 add %fp, -16, %o2 400075d4: 40 00 01 42 call 40007adc <_POSIX_Name_to_id> 400075d8: 96 07 bf fc add %fp, -4, %o3 * 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 ) { 400075dc: b6 92 20 00 orcc %o0, 0, %i3 400075e0: 22 80 00 0f be,a 4000761c 400075e4: 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) ) ) { 400075e8: 80 a6 e0 02 cmp %i3, 2 400075ec: 02 80 00 3f be 400076e8 400075f0: 80 a4 60 00 cmp %l1, 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 ); 400075f4: 90 17 21 90 or %i4, 0x190, %o0 400075f8: 40 00 0d 06 call 4000aa10 <_Objects_Free> 400075fc: 92 10 00 1d mov %i5, %o1 _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); 40007600: 40 00 11 58 call 4000bb60 <_Thread_Enable_dispatch> 40007604: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); 40007608: 40 00 28 15 call 4001165c <__errno> 4000760c: 01 00 00 00 nop 40007610: f6 22 00 00 st %i3, [ %o0 ] 40007614: 81 c7 e0 08 ret 40007618: 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) ) { 4000761c: 80 a6 6a 00 cmp %i1, 0xa00 40007620: 02 80 00 27 be 400076bc 40007624: d2 07 bf f0 ld [ %fp + -16 ], %o1 RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control *_POSIX_Message_queue_Get ( Objects_Id id, Objects_Locations *location ) { return (POSIX_Message_queue_Control *) 40007628: 94 07 bf f8 add %fp, -8, %o2 4000762c: 40 00 0d 5f call 4000aba8 <_Objects_Get> 40007630: 90 16 a0 04 or %i2, 4, %o0 /* * 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; 40007634: c4 02 20 18 ld [ %o0 + 0x18 ], %g2 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( 40007638: c2 17 60 0a lduh [ %i5 + 0xa ], %g1 4000763c: 84 00 a0 01 inc %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007640: b8 17 21 90 or %i4, 0x190, %i4 40007644: c4 22 20 18 st %g2, [ %o0 + 0x18 ] 40007648: c4 07 20 1c ld [ %i4 + 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 ); 4000764c: d0 27 bf f4 st %o0, [ %fp + -12 ] the_mq->open_count += 1; the_mq_fd->Queue = the_mq; 40007650: d0 27 60 10 st %o0, [ %i5 + 0x10 ] 40007654: 83 28 60 02 sll %g1, 2, %g1 40007658: fa 20 80 01 st %i5, [ %g2 + %g1 ] _Objects_Open_string( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 4000765c: 40 00 11 41 call 4000bb60 <_Thread_Enable_dispatch> 40007660: c0 27 60 0c clr [ %i5 + 0xc ] _Thread_Enable_dispatch(); 40007664: 40 00 11 3f call 4000bb60 <_Thread_Enable_dispatch> 40007668: 01 00 00 00 nop return (mqd_t)the_mq_fd->Object.id; 4000766c: f0 07 60 08 ld [ %i5 + 8 ], %i0 40007670: 81 c7 e0 08 ret 40007674: 81 e8 00 00 restore size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40007678: 82 07 a0 4c add %fp, 0x4c, %g1 mode = va_arg( arg, mode_t ); attr = va_arg( arg, struct mq_attr * ); 4000767c: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40007680: c2 27 bf ec st %g1, [ %fp + -20 ] */ RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) 40007684: 39 10 00 8f sethi %hi(0x40023c00), %i4 40007688: 40 00 0b ea call 4000a630 <_Objects_Allocate> 4000768c: 90 17 21 90 or %i4, 0x190, %o0 ! 40023d90 <_POSIX_Message_queue_Information_fds> attr = va_arg( arg, struct mq_attr * ); va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { 40007690: ba 92 20 00 orcc %o0, 0, %i5 40007694: 32 bf ff cc bne,a 400075c4 40007698: f2 27 60 14 st %i1, [ %i5 + 0x14 ] _Thread_Enable_dispatch(); 4000769c: 40 00 11 31 call 4000bb60 <_Thread_Enable_dispatch> 400076a0: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( ENFILE ); 400076a4: 40 00 27 ee call 4001165c <__errno> 400076a8: 01 00 00 00 nop 400076ac: 82 10 20 17 mov 0x17, %g1 ! 17 400076b0: c2 22 00 00 st %g1, [ %o0 ] 400076b4: 81 c7 e0 08 ret 400076b8: 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 ); 400076bc: 90 17 21 90 or %i4, 0x190, %o0 400076c0: 40 00 0c d4 call 4000aa10 <_Objects_Free> 400076c4: 92 10 00 1d mov %i5, %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(); 400076c8: 40 00 11 26 call 4000bb60 <_Thread_Enable_dispatch> 400076cc: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t ); 400076d0: 40 00 27 e3 call 4001165c <__errno> 400076d4: 01 00 00 00 nop 400076d8: 82 10 20 11 mov 0x11, %g1 ! 11 400076dc: c2 22 00 00 st %g1, [ %o0 ] 400076e0: 81 c7 e0 08 ret 400076e4: 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) ) ) { 400076e8: 02 bf ff c4 be 400075f8 400076ec: 90 17 21 90 or %i4, 0x190, %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( 400076f0: d2 07 bf fc ld [ %fp + -4 ], %o1 400076f4: 90 10 00 18 mov %i0, %o0 400076f8: 94 10 20 01 mov 1, %o2 400076fc: 96 10 00 10 mov %l0, %o3 40007700: 40 00 1b a1 call 4000e584 <_POSIX_Message_queue_Create_support> 40007704: 98 07 bf f4 add %fp, -12, %o4 ); /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { 40007708: 80 a2 3f ff cmp %o0, -1 4000770c: 02 80 00 0d be 40007740 40007710: c6 07 bf f4 ld [ %fp + -12 ], %g3 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( 40007714: c2 17 60 0a lduh [ %i5 + 0xa ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007718: b8 17 21 90 or %i4, 0x190, %i4 4000771c: c4 07 20 1c ld [ %i4 + 0x1c ], %g2 _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); return (mqd_t) -1; } the_mq_fd->Queue = the_mq; 40007720: c6 27 60 10 st %g3, [ %i5 + 0x10 ] 40007724: 83 28 60 02 sll %g1, 2, %g1 40007728: fa 20 80 01 st %i5, [ %g2 + %g1 ] &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); 4000772c: 40 00 11 0d call 4000bb60 <_Thread_Enable_dispatch> 40007730: c0 27 60 0c clr [ %i5 + 0xc ] return (mqd_t) the_mq_fd->Object.id; 40007734: f0 07 60 08 ld [ %i5 + 8 ], %i0 } 40007738: 81 c7 e0 08 ret 4000773c: 81 e8 00 00 restore 40007740: 90 17 21 90 or %i4, 0x190, %o0 40007744: 92 10 00 1d mov %i5, %o1 40007748: 40 00 0c b2 call 4000aa10 <_Objects_Free> 4000774c: 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(); 40007750: 40 00 11 04 call 4000bb60 <_Thread_Enable_dispatch> 40007754: 01 00 00 00 nop 40007758: 81 c7 e0 08 ret 4000775c: 81 e8 00 00 restore =============================================================================== 4000be40 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 4000be40: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 4000be44: 80 a0 60 00 cmp %g1, 0 4000be48: 02 80 00 06 be 4000be60 4000be4c: 90 10 20 16 mov 0x16, %o0 4000be50: c4 00 40 00 ld [ %g1 ], %g2 4000be54: 80 a0 a0 00 cmp %g2, 0 4000be58: 12 80 00 04 bne 4000be68 4000be5c: 80 a2 60 04 cmp %o1, 4 return 0; default: return ENOTSUP; } } 4000be60: 81 c3 e0 08 retl 4000be64: 01 00 00 00 nop ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( policy ) { 4000be68: 18 80 00 09 bgu 4000be8c 4000be6c: 84 10 20 01 mov 1, %g2 ! 1 4000be70: 85 28 80 09 sll %g2, %o1, %g2 4000be74: 80 88 a0 17 btst 0x17, %g2 4000be78: 02 80 00 05 be 4000be8c <== NEVER TAKEN 4000be7c: 01 00 00 00 nop case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 4000be80: d2 20 60 14 st %o1, [ %g1 + 0x14 ] return 0; 4000be84: 81 c3 e0 08 retl 4000be88: 90 10 20 00 clr %o0 default: return ENOTSUP; } } 4000be8c: 81 c3 e0 08 retl 4000be90: 90 10 20 86 mov 0x86, %o0 =============================================================================== 400072d4 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 400072d4: 9d e3 bf 90 save %sp, -112, %sp const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 400072d8: 80 a6 20 00 cmp %i0, 0 400072dc: 02 80 00 04 be 400072ec 400072e0: 80 a6 a0 00 cmp %i2, 0 return EINVAL; if ( count == 0 ) 400072e4: 12 80 00 04 bne 400072f4 400072e8: 80 a6 60 00 cmp %i1, 0 * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; _Thread_Enable_dispatch(); return 0; } 400072ec: 81 c7 e0 08 ret 400072f0: 91 e8 20 16 restore %g0, 0x16, %o0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 400072f4: 02 80 00 23 be 40007380 400072f8: 90 07 bf f8 add %fp, -8, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 400072fc: c2 06 40 00 ld [ %i1 ], %g1 40007300: 80 a0 60 00 cmp %g1, 0 40007304: 02 bf ff fa be 400072ec 40007308: 01 00 00 00 nop return EINVAL; switch ( the_attr->process_shared ) { 4000730c: c2 06 60 04 ld [ %i1 + 4 ], %g1 40007310: 80 a0 60 00 cmp %g1, 0 40007314: 12 bf ff f6 bne 400072ec <== NEVER TAKEN 40007318: 03 10 00 60 sethi %hi(0x40018000), %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 4000731c: c4 00 60 f0 ld [ %g1 + 0xf0 ], %g2 ! 400180f0 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 40007320: c0 27 bf f0 clr [ %fp + -16 ] ++level; 40007324: 84 00 a0 01 inc %g2 the_attributes.maximum_count = count; 40007328: f4 27 bf f4 st %i2, [ %fp + -12 ] _Thread_Dispatch_disable_level = level; 4000732c: c4 20 60 f0 st %g2, [ %g1 + 0xf0 ] * This function allocates a barrier control block from * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) 40007330: 39 10 00 61 sethi %hi(0x40018400), %i4 40007334: 40 00 08 ee call 400096ec <_Objects_Allocate> 40007338: 90 17 20 74 or %i4, 0x74, %o0 ! 40018474 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 4000733c: ba 92 20 00 orcc %o0, 0, %i5 40007340: 02 80 00 14 be 40007390 40007344: 90 07 60 10 add %i5, 0x10, %o0 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 40007348: 40 00 06 37 call 40008c24 <_CORE_barrier_Initialize> 4000734c: 92 07 bf f0 add %fp, -16, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007350: c4 17 60 0a lduh [ %i5 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007354: b8 17 20 74 or %i4, 0x74, %i4 40007358: c6 07 20 1c ld [ %i4 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 4000735c: c2 07 60 08 ld [ %i5 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007360: 85 28 a0 02 sll %g2, 2, %g2 40007364: fa 20 c0 02 st %i5, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 40007368: c0 27 60 0c clr [ %i5 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 4000736c: c2 26 00 00 st %g1, [ %i0 ] _Thread_Enable_dispatch(); 40007370: 40 00 0d f4 call 4000ab40 <_Thread_Enable_dispatch> 40007374: b0 10 20 00 clr %i0 40007378: 81 c7 e0 08 ret 4000737c: 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 ); 40007380: 7f ff ff 9c call 400071f0 40007384: b2 07 bf f8 add %fp, -8, %i1 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40007388: 10 bf ff de b 40007300 4000738c: c2 06 40 00 ld [ %i1 ], %g1 _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); 40007390: 40 00 0d ec call 4000ab40 <_Thread_Enable_dispatch> 40007394: b0 10 20 0b mov 0xb, %i0 40007398: 81 c7 e0 08 ret 4000739c: 81 e8 00 00 restore =============================================================================== 40006b68 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 40006b68: 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 ) 40006b6c: 80 a6 20 00 cmp %i0, 0 40006b70: 02 80 00 13 be 40006bbc 40006b74: 03 10 00 61 sethi %hi(0x40018400), %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40006b78: c4 00 62 10 ld [ %g1 + 0x210 ], %g2 ! 40018610 <_Thread_Dispatch_disable_level> ++level; 40006b7c: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 40006b80: c4 20 62 10 st %g2, [ %g1 + 0x210 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 40006b84: 40 00 12 bc call 4000b674 <_Workspace_Allocate> 40006b88: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 40006b8c: 80 a2 20 00 cmp %o0, 0 40006b90: 02 80 00 09 be 40006bb4 <== NEVER TAKEN 40006b94: 03 10 00 62 sethi %hi(0x40018800), %g1 thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 40006b98: c2 00 63 30 ld [ %g1 + 0x330 ], %g1 ! 40018b30 <_Per_CPU_Information+0x10> handler_stack = &thread_support->Cancellation_Handlers; handler->routine = routine; handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); 40006b9c: 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; 40006ba0: c2 00 61 50 ld [ %g1 + 0x150 ], %g1 handler->routine = routine; 40006ba4: f0 22 20 08 st %i0, [ %o0 + 8 ] handler->arg = arg; 40006ba8: f2 22 20 0c st %i1, [ %o0 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 40006bac: 40 00 06 67 call 40008548 <_Chain_Append> 40006bb0: 90 00 60 e4 add %g1, 0xe4, %o0 } _Thread_Enable_dispatch(); 40006bb4: 40 00 0e 33 call 4000a480 <_Thread_Enable_dispatch> 40006bb8: 81 e8 00 00 restore 40006bbc: 81 c7 e0 08 ret 40006bc0: 81 e8 00 00 restore =============================================================================== 40007b08 : */ int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 40007b08: 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; 40007b0c: 80 a6 60 00 cmp %i1, 0 40007b10: 22 80 00 27 be,a 40007bac 40007b14: 33 10 00 5f sethi %hi(0x40017c00), %i1 else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 40007b18: c4 06 60 04 ld [ %i1 + 4 ], %g2 ! 40017c04 40007b1c: 80 a0 a0 01 cmp %g2, 1 40007b20: 02 80 00 06 be 40007b38 <== NEVER TAKEN 40007b24: 82 10 20 16 mov 0x16, %g1 return EINVAL; if ( !the_attr->is_initialized ) 40007b28: c4 06 40 00 ld [ %i1 ], %g2 40007b2c: 80 a0 a0 00 cmp %g2, 0 40007b30: 32 80 00 04 bne,a 40007b40 40007b34: 03 10 00 64 sethi %hi(0x40019000), %g1 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 40007b38: 81 c7 e0 08 ret 40007b3c: 91 e8 00 01 restore %g0, %g1, %o0 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40007b40: c4 00 63 30 ld [ %g1 + 0x330 ], %g2 ++level; 40007b44: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 40007b48: c4 20 63 30 st %g2, [ %g1 + 0x330 ] */ RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) 40007b4c: 39 10 00 65 sethi %hi(0x40019400), %i4 40007b50: 40 00 0a 9e call 4000a5c8 <_Objects_Allocate> 40007b54: 90 17 23 4c or %i4, 0x34c, %o0 ! 4001974c <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 40007b58: ba 92 20 00 orcc %o0, 0, %i5 40007b5c: 02 80 00 16 be 40007bb4 40007b60: 90 07 60 18 add %i5, 0x18, %o0 _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40007b64: c2 06 60 04 ld [ %i1 + 4 ], %g1 the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40007b68: 92 10 20 00 clr %o1 40007b6c: 15 04 00 02 sethi %hi(0x10000800), %o2 40007b70: 96 10 20 74 mov 0x74, %o3 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 40007b74: c2 27 60 10 st %g1, [ %i5 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 40007b78: 40 00 11 c8 call 4000c298 <_Thread_queue_Initialize> 40007b7c: c0 27 60 14 clr [ %i5 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007b80: c4 17 60 0a lduh [ %i5 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007b84: b8 17 23 4c or %i4, 0x34c, %i4 40007b88: c6 07 20 1c ld [ %i4 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007b8c: c2 07 60 08 ld [ %i5 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007b90: 85 28 a0 02 sll %g2, 2, %g2 40007b94: fa 20 c0 02 st %i5, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 40007b98: c0 27 60 0c clr [ %i5 + 0xc ] 0 ); *cond = the_cond->Object.id; _Thread_Enable_dispatch(); 40007b9c: 40 00 0f a0 call 4000ba1c <_Thread_Enable_dispatch> 40007ba0: c2 26 00 00 st %g1, [ %i0 ] return 0; 40007ba4: 10 bf ff e5 b 40007b38 40007ba8: 82 10 20 00 clr %g1 { 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; 40007bac: 10 bf ff db b 40007b18 40007bb0: b2 16 60 e4 or %i1, 0xe4, %i1 _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { _Thread_Enable_dispatch(); 40007bb4: 40 00 0f 9a call 4000ba1c <_Thread_Enable_dispatch> 40007bb8: 01 00 00 00 nop return ENOMEM; 40007bbc: 10 bf ff df b 40007b38 40007bc0: 82 10 20 0c mov 0xc, %g1 ! c =============================================================================== 4000796c : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 4000796c: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 40007970: 80 a0 60 00 cmp %g1, 0 40007974: 02 80 00 06 be 4000798c 40007978: 90 10 20 16 mov 0x16, %o0 4000797c: c4 00 40 00 ld [ %g1 ], %g2 40007980: 80 a0 a0 00 cmp %g2, 0 40007984: 32 80 00 04 bne,a 40007994 <== ALWAYS TAKEN 40007988: c0 20 40 00 clr [ %g1 ] return EINVAL; attr->is_initialized = false; return 0; } 4000798c: 81 c3 e0 08 retl 40007990: 01 00 00 00 nop 40007994: 81 c3 e0 08 retl 40007998: 90 10 20 00 clr %o0 ! 0 =============================================================================== 40007014 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 40007014: 9d e3 bf 58 save %sp, -168, %sp int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 40007018: 80 a6 a0 00 cmp %i2, 0 4000701c: 02 80 00 0a be 40007044 40007020: ba 10 20 0e mov 0xe, %i5 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 40007024: 80 a6 60 00 cmp %i1, 0 40007028: 22 80 00 63 be,a 400071b4 4000702c: 33 10 00 78 sethi %hi(0x4001e000), %i1 if ( !the_attr->is_initialized ) 40007030: c2 06 40 00 ld [ %i1 ], %g1 40007034: 80 a0 60 00 cmp %g1, 0 40007038: 32 80 00 05 bne,a 4000704c 4000703c: c2 06 60 04 ld [ %i1 + 4 ], %g1 schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; break; default: return EINVAL; 40007040: ba 10 20 16 mov 0x16, %i5 */ *thread = the_thread->Object.id; _RTEMS_Unlock_allocator(); return 0; } 40007044: 81 c7 e0 08 ret 40007048: 91 e8 00 1d restore %g0, %i5, %o0 * 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) ) 4000704c: 80 a0 60 00 cmp %g1, 0 40007050: 02 80 00 07 be 4000706c 40007054: 03 10 00 7b sethi %hi(0x4001ec00), %g1 40007058: c4 06 60 08 ld [ %i1 + 8 ], %g2 4000705c: c2 00 62 00 ld [ %g1 + 0x200 ], %g1 40007060: 80 a0 80 01 cmp %g2, %g1 40007064: 0a bf ff f8 bcs 40007044 40007068: ba 10 20 16 mov 0x16, %i5 * 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 ) { 4000706c: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 40007070: 80 a0 60 01 cmp %g1, 1 40007074: 02 80 00 52 be 400071bc 40007078: 80 a0 60 02 cmp %g1, 2 4000707c: 32 bf ff f2 bne,a 40007044 40007080: ba 10 20 16 mov 0x16, %i5 schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 40007084: da 06 60 18 ld [ %i1 + 0x18 ], %o5 40007088: de 06 60 1c ld [ %i1 + 0x1c ], %o7 4000708c: fa 06 60 20 ld [ %i1 + 0x20 ], %i5 40007090: c8 06 60 24 ld [ %i1 + 0x24 ], %g4 40007094: c6 06 60 28 ld [ %i1 + 0x28 ], %g3 40007098: c4 06 60 2c ld [ %i1 + 0x2c ], %g2 4000709c: c2 06 60 30 ld [ %i1 + 0x30 ], %g1 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 400070a0: f8 06 60 14 ld [ %i1 + 0x14 ], %i4 schedparam = the_attr->schedparam; 400070a4: da 27 bf e4 st %o5, [ %fp + -28 ] 400070a8: de 27 bf e8 st %o7, [ %fp + -24 ] 400070ac: fa 27 bf ec st %i5, [ %fp + -20 ] 400070b0: c8 27 bf f0 st %g4, [ %fp + -16 ] 400070b4: c6 27 bf f4 st %g3, [ %fp + -12 ] 400070b8: c4 27 bf f8 st %g2, [ %fp + -8 ] 400070bc: c2 27 bf fc st %g1, [ %fp + -4 ] /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 400070c0: c2 06 60 0c ld [ %i1 + 0xc ], %g1 400070c4: 80 a0 60 00 cmp %g1, 0 400070c8: 12 bf ff df bne 40007044 400070cc: ba 10 20 86 mov 0x86, %i5 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 400070d0: 40 00 19 e7 call 4000d86c <_POSIX_Priority_Is_valid> 400070d4: d0 07 bf e4 ld [ %fp + -28 ], %o0 400070d8: 80 8a 20 ff btst 0xff, %o0 400070dc: 02 bf ff da be 40007044 <== NEVER TAKEN 400070e0: ba 10 20 16 mov 0x16, %i5 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 400070e4: 03 10 00 7b sethi %hi(0x4001ec00), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 400070e8: e0 07 bf e4 ld [ %fp + -28 ], %l0 400070ec: e8 08 61 fc ldub [ %g1 + 0x1fc ], %l4 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 400070f0: 90 10 00 1c mov %i4, %o0 400070f4: 92 07 bf e4 add %fp, -28, %o1 400070f8: 94 07 bf dc add %fp, -36, %o2 400070fc: 40 00 19 e9 call 4000d8a0 <_POSIX_Thread_Translate_sched_param> 40007100: 96 07 bf e0 add %fp, -32, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 40007104: ba 92 20 00 orcc %o0, 0, %i5 40007108: 12 bf ff cf bne 40007044 4000710c: 25 10 00 7e sethi %hi(0x4001f800), %l2 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 40007110: d0 04 a2 30 ld [ %l2 + 0x230 ], %o0 ! 4001fa30 <_RTEMS_Allocator_Mutex> 40007114: 40 00 06 99 call 40008b78 <_API_Mutex_Lock> 40007118: 27 10 00 7e sethi %hi(0x4001f800), %l3 * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 4000711c: 40 00 09 70 call 400096dc <_Objects_Allocate> 40007120: 90 14 e3 b4 or %l3, 0x3b4, %o0 ! 4001fbb4 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 40007124: a2 92 20 00 orcc %o0, 0, %l1 40007128: 02 80 00 1f be 400071a4 4000712c: 05 10 00 7b sethi %hi(0x4001ec00), %g2 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 40007130: 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 ) 40007134: d6 00 a2 00 ld [ %g2 + 0x200 ], %o3 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 40007138: c0 27 bf d4 clr [ %fp + -44 ] 4000713c: 97 2a e0 01 sll %o3, 1, %o3 40007140: 80 a2 c0 01 cmp %o3, %g1 40007144: 1a 80 00 03 bcc 40007150 40007148: d4 06 60 04 ld [ %i1 + 4 ], %o2 4000714c: 96 10 00 01 mov %g1, %o3 40007150: c2 07 bf dc ld [ %fp + -36 ], %g1 40007154: 9a 0d 20 ff and %l4, 0xff, %o5 40007158: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 4000715c: 82 10 20 01 mov 1, %g1 40007160: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40007164: c2 07 bf e0 ld [ %fp + -32 ], %g1 40007168: c0 23 a0 68 clr [ %sp + 0x68 ] 4000716c: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 40007170: 82 07 bf d4 add %fp, -44, %g1 40007174: 90 14 e3 b4 or %l3, 0x3b4, %o0 40007178: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 4000717c: 92 10 00 11 mov %l1, %o1 40007180: 98 10 20 00 clr %o4 40007184: 40 00 0e a2 call 4000ac0c <_Thread_Initialize> 40007188: 9a 23 40 10 sub %o5, %l0, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 4000718c: 80 8a 20 ff btst 0xff, %o0 40007190: 12 80 00 1e bne 40007208 40007194: 11 10 00 7e sethi %hi(0x4001f800), %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 40007198: 92 10 00 11 mov %l1, %o1 4000719c: 40 00 0a 48 call 40009abc <_Objects_Free> 400071a0: 90 12 23 b4 or %o0, 0x3b4, %o0 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 400071a4: d0 04 a2 30 ld [ %l2 + 0x230 ], %o0 400071a8: 40 00 06 89 call 40008bcc <_API_Mutex_Unlock> 400071ac: ba 10 20 0b mov 0xb, %i5 400071b0: 30 bf ff a5 b,a 40007044 int rc; if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 400071b4: 10 bf ff 9f b 40007030 400071b8: b2 16 61 dc or %i1, 0x1dc, %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 ]; 400071bc: 03 10 00 7f sethi %hi(0x4001fc00), %g1 400071c0: c2 00 62 d0 ld [ %g1 + 0x2d0 ], %g1 ! 4001fed0 <_Per_CPU_Information+0x10> 400071c4: c2 00 61 50 ld [ %g1 + 0x150 ], %g1 schedpolicy = api->schedpolicy; schedparam = api->schedparam; 400071c8: d8 00 60 88 ld [ %g1 + 0x88 ], %o4 400071cc: da 00 60 8c ld [ %g1 + 0x8c ], %o5 400071d0: de 00 60 90 ld [ %g1 + 0x90 ], %o7 400071d4: fa 00 60 94 ld [ %g1 + 0x94 ], %i5 400071d8: c8 00 60 98 ld [ %g1 + 0x98 ], %g4 400071dc: c6 00 60 9c ld [ %g1 + 0x9c ], %g3 400071e0: 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; 400071e4: f8 00 60 84 ld [ %g1 + 0x84 ], %i4 schedparam = api->schedparam; 400071e8: d8 27 bf e4 st %o4, [ %fp + -28 ] 400071ec: da 27 bf e8 st %o5, [ %fp + -24 ] 400071f0: de 27 bf ec st %o7, [ %fp + -20 ] 400071f4: fa 27 bf f0 st %i5, [ %fp + -16 ] 400071f8: c8 27 bf f4 st %g4, [ %fp + -12 ] 400071fc: c6 27 bf f8 st %g3, [ %fp + -8 ] break; 40007200: 10 bf ff b0 b 400070c0 40007204: c4 27 bf fc st %g2, [ %fp + -4 ] } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40007208: e0 04 61 50 ld [ %l1 + 0x150 ], %l0 api->Attributes = *the_attr; 4000720c: 92 10 00 19 mov %i1, %o1 40007210: 94 10 20 40 mov 0x40, %o2 40007214: 40 00 25 ed call 400109c8 40007218: 90 10 00 10 mov %l0, %o0 api->detachstate = the_attr->detachstate; 4000721c: c2 06 60 3c ld [ %i1 + 0x3c ], %g1 api->schedpolicy = schedpolicy; api->schedparam = schedparam; 40007220: 92 07 bf e4 add %fp, -28, %o1 40007224: 94 10 20 1c mov 0x1c, %o2 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; 40007228: c2 24 20 40 st %g1, [ %l0 + 0x40 ] api->schedpolicy = schedpolicy; 4000722c: f8 24 20 84 st %i4, [ %l0 + 0x84 ] api->schedparam = schedparam; 40007230: 40 00 25 e6 call 400109c8 40007234: 90 04 20 88 add %l0, 0x88, %o0 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 40007238: 90 10 00 11 mov %l1, %o0 4000723c: 92 10 20 01 mov 1, %o1 40007240: 94 10 00 1a mov %i2, %o2 40007244: 96 10 00 1b mov %i3, %o3 40007248: 40 00 10 d3 call 4000b594 <_Thread_Start> 4000724c: 98 10 20 00 clr %o4 _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 40007250: 80 a7 20 04 cmp %i4, 4 40007254: 02 80 00 07 be 40007270 40007258: 01 00 00 00 nop } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 4000725c: c2 04 60 08 ld [ %l1 + 8 ], %g1 _RTEMS_Unlock_allocator(); 40007260: d0 04 a2 30 ld [ %l2 + 0x230 ], %o0 40007264: 40 00 06 5a call 40008bcc <_API_Mutex_Unlock> 40007268: c2 26 00 00 st %g1, [ %i0 ] 4000726c: 30 bf ff 76 b,a 40007044 return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { _Watchdog_Insert_ticks( 40007270: 40 00 10 f3 call 4000b63c <_Timespec_To_ticks> 40007274: 90 04 20 90 add %l0, 0x90, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007278: 92 04 20 a8 add %l0, 0xa8, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 4000727c: d0 24 20 b4 st %o0, [ %l0 + 0xb4 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40007280: 11 10 00 7e sethi %hi(0x4001f800), %o0 40007284: 40 00 11 a8 call 4000b924 <_Watchdog_Insert> 40007288: 90 12 22 48 or %o0, 0x248, %o0 ! 4001fa48 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 4000728c: 10 bf ff f5 b 40007260 40007290: c2 04 60 08 ld [ %l1 + 8 ], %g1 =============================================================================== 4001be5c : int pthread_kill( pthread_t thread, int sig ) { 4001be5c: 9d e3 bf 98 save %sp, -104, %sp POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) 4001be60: 80 a6 60 00 cmp %i1, 0 4001be64: 02 80 00 31 be 4001bf28 4001be68: b8 06 7f ff add %i1, -1, %i4 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 4001be6c: 80 a7 20 1f cmp %i4, 0x1f 4001be70: 18 80 00 2e bgu 4001bf28 4001be74: 90 10 00 18 mov %i0, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); the_thread = _Thread_Get( thread, &location ); 4001be78: 7f ff b8 20 call 40009ef8 <_Thread_Get> 4001be7c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4001be80: c2 07 bf fc ld [ %fp + -4 ], %g1 4001be84: 80 a0 60 00 cmp %g1, 0 4001be88: 12 80 00 2e bne 4001bf40 <== NEVER TAKEN 4001be8c: ba 10 00 08 mov %o0, %i5 4001be90: 11 10 00 79 sethi %hi(0x4001e400), %o0 4001be94: 7f ff af b9 call 40007d78 <_API_extensions_Add_post_switch> 4001be98: 90 12 20 a8 or %o0, 0xa8, %o0 ! 4001e4a8 <_POSIX_signals_Post_switch> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { 4001be9c: 83 2e 60 02 sll %i1, 2, %g1 4001bea0: 85 2e 60 04 sll %i1, 4, %g2 4001bea4: 84 20 80 01 sub %g2, %g1, %g2 4001bea8: 03 10 00 7d sethi %hi(0x4001f400), %g1 4001beac: 82 10 60 30 or %g1, 0x30, %g1 ! 4001f430 <_POSIX_signals_Vectors> 4001beb0: 82 00 40 02 add %g1, %g2, %g1 4001beb4: c4 00 60 08 ld [ %g1 + 8 ], %g2 4001beb8: 80 a0 a0 01 cmp %g2, 1 4001bebc: 02 80 00 15 be 4001bf10 4001bec0: c2 07 61 50 ld [ %i5 + 0x150 ], %g1 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); 4001bec4: c4 00 60 d4 ld [ %g1 + 0xd4 ], %g2 4001bec8: b6 10 20 01 mov 1, %i3 (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); 4001becc: 90 10 00 1d mov %i5, %o0 4001bed0: b9 2e c0 1c sll %i3, %i4, %i4 4001bed4: 92 10 00 19 mov %i1, %o1 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); 4001bed8: b8 10 80 1c or %g2, %i4, %i4 (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); 4001bedc: 94 10 20 00 clr %o2 4001bee0: 7f ff ff 86 call 4001bcf8 <_POSIX_signals_Unblock_thread> 4001bee4: f8 20 60 d4 st %i4, [ %g1 + 0xd4 ] if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 4001bee8: 03 10 00 7c sethi %hi(0x4001f000), %g1 4001beec: 82 10 63 d0 or %g1, 0x3d0, %g1 ! 4001f3d0 <_Per_CPU_Information> 4001bef0: c4 00 60 08 ld [ %g1 + 8 ], %g2 4001bef4: 80 a0 a0 00 cmp %g2, 0 4001bef8: 02 80 00 06 be 4001bf10 4001befc: 01 00 00 00 nop 4001bf00: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 4001bf04: 80 a7 40 02 cmp %i5, %g2 4001bf08: 02 80 00 06 be 4001bf20 4001bf0c: 01 00 00 00 nop api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { _Thread_Enable_dispatch(); 4001bf10: 7f ff b7 ee call 40009ec8 <_Thread_Enable_dispatch> 4001bf14: b0 10 20 00 clr %i0 ! 0 4001bf18: 81 c7 e0 08 ret 4001bf1c: 81 e8 00 00 restore api->signals_pending |= signo_to_mask( sig ); (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; 4001bf20: f6 28 60 0c stb %i3, [ %g1 + 0xc ] 4001bf24: 30 bf ff fb b,a 4001bf10 if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); 4001bf28: 7f ff ce 06 call 4000f740 <__errno> 4001bf2c: b0 10 3f ff mov -1, %i0 4001bf30: 82 10 20 16 mov 0x16, %g1 4001bf34: c2 22 00 00 st %g1, [ %o0 ] 4001bf38: 81 c7 e0 08 ret 4001bf3c: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); 4001bf40: 7f ff ce 00 call 4000f740 <__errno> <== NOT EXECUTED 4001bf44: b0 10 3f ff mov -1, %i0 <== NOT EXECUTED 4001bf48: 82 10 20 03 mov 3, %g1 <== NOT EXECUTED 4001bf4c: c2 22 00 00 st %g1, [ %o0 ] <== NOT EXECUTED } 4001bf50: 81 c7 e0 08 ret <== NOT EXECUTED 4001bf54: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 40009054 : */ int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 40009054: 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 ); 40009058: 90 10 00 19 mov %i1, %o0 4000905c: 40 00 00 38 call 4000913c <_POSIX_Absolute_timeout_to_ticks> 40009060: 92 07 bf fc add %fp, -4, %o1 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 40009064: d4 07 bf fc ld [ %fp + -4 ], %o2 * * 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 ); 40009068: ba 10 00 08 mov %o0, %i5 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 4000906c: 80 a7 60 03 cmp %i5, 3 40009070: 02 80 00 0c be 400090a0 40009074: 90 10 00 18 mov %i0, %o0 do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 40009078: 7f ff ff bd call 40008f6c <_POSIX_Mutex_Lock_support> 4000907c: 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) ) { 40009080: 80 a2 20 10 cmp %o0, 0x10 40009084: 12 80 00 0a bne 400090ac 40009088: b0 10 00 08 mov %o0, %i0 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 4000908c: 80 a7 60 00 cmp %i5, 0 40009090: 12 80 00 09 bne 400090b4 <== ALWAYS TAKEN 40009094: ba 07 7f ff add %i5, -1, %i5 return EINVAL; 40009098: 81 c7 e0 08 ret <== NOT EXECUTED 4000909c: 91 e8 20 16 restore %g0, 0x16, %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_Mutex_Lock_support( mutex, do_wait, ticks ); 400090a0: 7f ff ff b3 call 40008f6c <_POSIX_Mutex_Lock_support> 400090a4: 92 10 20 01 mov 1, %o1 400090a8: b0 10 00 08 mov %o0, %i0 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } 400090ac: 81 c7 e0 08 ret 400090b0: 81 e8 00 00 restore * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 400090b4: 80 a7 60 01 cmp %i5, 1 400090b8: 18 bf ff fd bgu 400090ac <== NEVER TAKEN 400090bc: 01 00 00 00 nop status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 400090c0: 81 c7 e0 08 ret 400090c4: 91 e8 20 74 restore %g0, 0x74, %o0 =============================================================================== 40006918 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 40006918: 82 10 00 08 mov %o0, %g1 if ( !attr ) 4000691c: 80 a0 60 00 cmp %g1, 0 40006920: 02 80 00 06 be 40006938 40006924: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40006928: c4 00 40 00 ld [ %g1 ], %g2 4000692c: 80 a0 a0 00 cmp %g2, 0 40006930: 12 80 00 04 bne 40006940 40006934: 80 a2 60 00 cmp %o1, 0 if ( !type ) return EINVAL; *type = attr->type; return 0; } 40006938: 81 c3 e0 08 retl 4000693c: 01 00 00 00 nop return EINVAL; if ( !attr->is_initialized ) return EINVAL; if ( !type ) 40006940: 02 bf ff fe be 40006938 <== NEVER TAKEN 40006944: 01 00 00 00 nop return EINVAL; *type = attr->type; 40006948: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 4000694c: 90 10 20 00 clr %o0 } 40006950: 81 c3 e0 08 retl 40006954: c2 22 40 00 st %g1, [ %o1 ] =============================================================================== 40008c20 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 40008c20: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 40008c24: 80 a0 60 00 cmp %g1, 0 40008c28: 02 80 00 06 be 40008c40 40008c2c: 90 10 20 16 mov 0x16, %o0 40008c30: c4 00 40 00 ld [ %g1 ], %g2 40008c34: 80 a0 a0 00 cmp %g2, 0 40008c38: 12 80 00 04 bne 40008c48 40008c3c: 80 a2 60 01 cmp %o1, 1 return 0; default: return EINVAL; } } 40008c40: 81 c3 e0 08 retl 40008c44: 01 00 00 00 nop ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( pshared ) { 40008c48: 18 bf ff fe bgu 40008c40 <== NEVER TAKEN 40008c4c: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40008c50: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; default: return EINVAL; } } 40008c54: 81 c3 e0 08 retl 40008c58: 90 10 20 00 clr %o0 =============================================================================== 400069ac : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 400069ac: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 400069b0: 80 a0 60 00 cmp %g1, 0 400069b4: 02 80 00 06 be 400069cc 400069b8: 90 10 20 16 mov 0x16, %o0 400069bc: c4 00 40 00 ld [ %g1 ], %g2 400069c0: 80 a0 a0 00 cmp %g2, 0 400069c4: 12 80 00 04 bne 400069d4 <== ALWAYS TAKEN 400069c8: 80 a2 60 03 cmp %o1, 3 return 0; default: return EINVAL; } } 400069cc: 81 c3 e0 08 retl 400069d0: 01 00 00 00 nop ) { if ( !attr || !attr->is_initialized ) return EINVAL; switch ( type ) { 400069d4: 18 bf ff fe bgu 400069cc 400069d8: 01 00 00 00 nop case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 400069dc: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; default: return EINVAL; } } 400069e0: 81 c3 e0 08 retl 400069e4: 90 10 20 00 clr %o0 =============================================================================== 40007748 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 40007748: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 4000774c: 80 a6 60 00 cmp %i1, 0 40007750: 12 80 00 05 bne 40007764 40007754: 80 a6 20 00 cmp %i0, 0 return EINVAL; 40007758: 82 10 20 16 mov 0x16, %g1 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 4000775c: 81 c7 e0 08 ret 40007760: 91 e8 00 01 restore %g0, %g1, %o0 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) 40007764: 22 bf ff fe be,a 4000775c 40007768: 82 10 20 16 mov 0x16, %g1 return EINVAL; if ( !once_control->init_executed ) { 4000776c: c4 06 20 04 ld [ %i0 + 4 ], %g2 40007770: 80 a0 a0 00 cmp %g2, 0 40007774: 12 bf ff fa bne 4000775c 40007778: 82 10 20 00 clr %g1 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 4000777c: 90 10 21 00 mov 0x100, %o0 40007780: 92 10 21 00 mov 0x100, %o1 40007784: 40 00 03 21 call 40008408 40007788: 94 07 bf fc add %fp, -4, %o2 if ( !once_control->init_executed ) { 4000778c: c2 06 20 04 ld [ %i0 + 4 ], %g1 40007790: 80 a0 60 00 cmp %g1, 0 40007794: 02 80 00 09 be 400077b8 <== ALWAYS TAKEN 40007798: 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); 4000779c: d0 07 bf fc ld [ %fp + -4 ], %o0 <== NOT EXECUTED 400077a0: 92 10 21 00 mov 0x100, %o1 400077a4: 40 00 03 19 call 40008408 400077a8: 94 07 bf fc add %fp, -4, %o2 } return 0; 400077ac: 82 10 20 00 clr %g1 } 400077b0: 81 c7 e0 08 ret 400077b4: 91 e8 00 01 restore %g0, %g1, %o0 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; 400077b8: c2 26 00 00 st %g1, [ %i0 ] once_control->init_executed = true; (*init_routine)(); 400077bc: 9f c6 40 00 call %i1 400077c0: c2 26 20 04 st %g1, [ %i0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 400077c4: 10 bf ff f7 b 400077a0 400077c8: d0 07 bf fc ld [ %fp + -4 ], %o0 =============================================================================== 40007990 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 40007990: 9d e3 bf 90 save %sp, -112, %sp const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 40007994: 80 a6 20 00 cmp %i0, 0 40007998: 02 80 00 08 be 400079b8 4000799c: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 400079a0: 02 80 00 23 be 40007a2c 400079a4: 90 07 bf f8 add %fp, -8, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 400079a8: c2 06 40 00 ld [ %i1 ], %g1 400079ac: 80 a0 60 00 cmp %g1, 0 400079b0: 32 80 00 04 bne,a 400079c0 <== ALWAYS TAKEN 400079b4: c2 06 60 04 ld [ %i1 + 4 ], %g1 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 400079b8: 81 c7 e0 08 ret 400079bc: 91 e8 20 16 restore %g0, 0x16, %o0 * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) return EINVAL; switch ( the_attr->process_shared ) { 400079c0: 80 a0 60 00 cmp %g1, 0 400079c4: 12 bf ff fd bne 400079b8 <== NEVER TAKEN 400079c8: 03 10 00 8e sethi %hi(0x40023800), %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 400079cc: c4 00 60 c0 ld [ %g1 + 0xc0 ], %g2 ! 400238c0 <_Thread_Dispatch_disable_level> */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 400079d0: c0 27 bf f4 clr [ %fp + -12 ] ++level; 400079d4: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 400079d8: c4 20 60 c0 st %g2, [ %g1 + 0xc0 ] * This function allocates a RWLock control block from * the inactive chain of free RWLock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void ) { return (POSIX_RWLock_Control *) 400079dc: 39 10 00 8e sethi %hi(0x40023800), %i4 400079e0: 40 00 0b 14 call 4000a630 <_Objects_Allocate> 400079e4: 90 17 22 c4 or %i4, 0x2c4, %o0 ! 40023ac4 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 400079e8: ba 92 20 00 orcc %o0, 0, %i5 400079ec: 02 80 00 14 be 40007a3c 400079f0: 90 07 60 10 add %i5, 0x10, %o0 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 400079f4: 40 00 09 5f call 40009f70 <_CORE_RWLock_Initialize> 400079f8: 92 07 bf f4 add %fp, -12, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400079fc: c4 17 60 0a lduh [ %i5 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007a00: b8 17 22 c4 or %i4, 0x2c4, %i4 40007a04: c6 07 20 1c ld [ %i4 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40007a08: c2 07 60 08 ld [ %i5 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 40007a0c: 85 28 a0 02 sll %g2, 2, %g2 40007a10: fa 20 c0 02 st %i5, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 40007a14: c0 27 60 0c clr [ %i5 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 40007a18: c2 26 00 00 st %g1, [ %i0 ] _Thread_Enable_dispatch(); 40007a1c: 40 00 10 51 call 4000bb60 <_Thread_Enable_dispatch> 40007a20: b0 10 20 00 clr %i0 40007a24: 81 c7 e0 08 ret 40007a28: 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 ); 40007a2c: 40 00 01 b6 call 40008104 40007a30: b2 07 bf f8 add %fp, -8, %i1 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 40007a34: 10 bf ff de b 400079ac 40007a38: c2 06 40 00 ld [ %i1 ], %g1 _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { _Thread_Enable_dispatch(); 40007a3c: 40 00 10 49 call 4000bb60 <_Thread_Enable_dispatch> 40007a40: b0 10 20 0b mov 0xb, %i0 40007a44: 81 c7 e0 08 ret 40007a48: 81 e8 00 00 restore =============================================================================== 40007fa0 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40007fa0: 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 ) 40007fa4: 80 a6 20 00 cmp %i0, 0 40007fa8: 02 80 00 25 be 4000803c 40007fac: 92 07 bf fc add %fp, -4, %o1 * * 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 ); 40007fb0: 40 00 1a 80 call 4000e9b0 <_POSIX_Absolute_timeout_to_ticks> 40007fb4: 90 10 00 19 mov %i1, %o0 40007fb8: d2 06 00 00 ld [ %i0 ], %o1 40007fbc: ba 10 00 08 mov %o0, %i5 40007fc0: 94 07 bf f8 add %fp, -8, %o2 40007fc4: 11 10 00 6a sethi %hi(0x4001a800), %o0 40007fc8: 40 00 0b b8 call 4000aea8 <_Objects_Get> 40007fcc: 90 12 21 a4 or %o0, 0x1a4, %o0 ! 4001a9a4 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40007fd0: c2 07 bf f8 ld [ %fp + -8 ], %g1 40007fd4: 80 a0 60 00 cmp %g1, 0 40007fd8: 32 80 00 1a bne,a 40008040 40007fdc: b0 10 20 16 mov 0x16, %i0 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 40007fe0: d2 06 00 00 ld [ %i0 ], %o1 40007fe4: d6 07 bf fc ld [ %fp + -4 ], %o3 * 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 ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 40007fe8: 82 1f 60 03 xor %i5, 3, %g1 the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 40007fec: 90 02 20 10 add %o0, 0x10, %o0 40007ff0: 80 a0 00 01 cmp %g0, %g1 40007ff4: 98 10 20 00 clr %o4 40007ff8: b8 60 3f ff subx %g0, -1, %i4 40007ffc: 40 00 07 f6 call 40009fd4 <_CORE_RWLock_Obtain_for_reading> 40008000: 94 10 00 1c mov %i4, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 40008004: 40 00 0f 60 call 4000bd84 <_Thread_Enable_dispatch> 40008008: 01 00 00 00 nop if ( !do_wait ) { if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 4000800c: 03 10 00 6b sethi %hi(0x4001ac00), %g1 40008010: c2 00 61 00 ld [ %g1 + 0x100 ], %g1 ! 4001ad00 <_Per_CPU_Information+0x10> ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait ) { 40008014: 80 a7 20 00 cmp %i4, 0 40008018: 12 80 00 05 bne 4000802c 4000801c: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 40008020: 80 a2 20 02 cmp %o0, 2 40008024: 02 80 00 09 be 40008048 40008028: 80 a7 60 00 cmp %i5, 0 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 4000802c: 40 00 00 3f call 40008128 <_POSIX_RWLock_Translate_core_RWLock_return_code> 40008030: 01 00 00 00 nop 40008034: 81 c7 e0 08 ret 40008038: 91 e8 00 08 restore %g0, %o0, %o0 #endif case OBJECTS_ERROR: break; } return EINVAL; 4000803c: b0 10 20 16 mov 0x16, %i0 } 40008040: 81 c7 e0 08 ret 40008044: 81 e8 00 00 restore ); _Thread_Enable_dispatch(); if ( !do_wait ) { if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 40008048: 22 bf ff fe be,a 40008040 <== NEVER TAKEN 4000804c: b0 10 20 16 mov 0x16, %i0 <== NOT EXECUTED return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40008050: ba 07 7f ff add %i5, -1, %i5 40008054: 80 a7 60 01 cmp %i5, 1 40008058: 18 bf ff f5 bgu 4000802c <== NEVER TAKEN 4000805c: b0 10 20 74 mov 0x74, %i0 40008060: 30 bf ff f8 b,a 40008040 =============================================================================== 40008064 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 40008064: 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 ) 40008068: 80 a6 20 00 cmp %i0, 0 4000806c: 02 80 00 25 be 40008100 40008070: 92 07 bf fc add %fp, -4, %o1 * * 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 ); 40008074: 40 00 1a 4f call 4000e9b0 <_POSIX_Absolute_timeout_to_ticks> 40008078: 90 10 00 19 mov %i1, %o0 4000807c: d2 06 00 00 ld [ %i0 ], %o1 40008080: ba 10 00 08 mov %o0, %i5 40008084: 94 07 bf f8 add %fp, -8, %o2 40008088: 11 10 00 6a sethi %hi(0x4001a800), %o0 4000808c: 40 00 0b 87 call 4000aea8 <_Objects_Get> 40008090: 90 12 21 a4 or %o0, 0x1a4, %o0 ! 4001a9a4 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 40008094: c2 07 bf f8 ld [ %fp + -8 ], %g1 40008098: 80 a0 60 00 cmp %g1, 0 4000809c: 32 80 00 1a bne,a 40008104 400080a0: b0 10 20 16 mov 0x16, %i0 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 400080a4: d2 06 00 00 ld [ %i0 ], %o1 400080a8: d6 07 bf fc ld [ %fp + -4 ], %o3 * 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 ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 400080ac: 82 1f 60 03 xor %i5, 3, %g1 the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 400080b0: 90 02 20 10 add %o0, 0x10, %o0 400080b4: 80 a0 00 01 cmp %g0, %g1 400080b8: 98 10 20 00 clr %o4 400080bc: b8 60 3f ff subx %g0, -1, %i4 400080c0: 40 00 07 fa call 4000a0a8 <_CORE_RWLock_Obtain_for_writing> 400080c4: 94 10 00 1c mov %i4, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 400080c8: 40 00 0f 2f call 4000bd84 <_Thread_Enable_dispatch> 400080cc: 01 00 00 00 nop if ( !do_wait && (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 400080d0: 03 10 00 6b sethi %hi(0x4001ac00), %g1 400080d4: c2 00 61 00 ld [ %g1 + 0x100 ], %g1 ! 4001ad00 <_Per_CPU_Information+0x10> ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 400080d8: 80 a7 20 00 cmp %i4, 0 400080dc: 12 80 00 05 bne 400080f0 400080e0: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 400080e4: 80 a2 20 02 cmp %o0, 2 400080e8: 02 80 00 09 be 4000810c 400080ec: 80 a7 60 00 cmp %i5, 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( 400080f0: 40 00 00 0e call 40008128 <_POSIX_RWLock_Translate_core_RWLock_return_code> 400080f4: 01 00 00 00 nop 400080f8: 81 c7 e0 08 ret 400080fc: 91 e8 00 08 restore %g0, %o0, %o0 #endif case OBJECTS_ERROR: break; } return EINVAL; 40008100: b0 10 20 16 mov 0x16, %i0 } 40008104: 81 c7 e0 08 ret 40008108: 81 e8 00 00 restore ); _Thread_Enable_dispatch(); if ( !do_wait && (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 4000810c: 22 bf ff fe be,a 40008104 <== NEVER TAKEN 40008110: b0 10 20 16 mov 0x16, %i0 <== NOT EXECUTED return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 40008114: ba 07 7f ff add %i5, -1, %i5 40008118: 80 a7 60 01 cmp %i5, 1 4000811c: 18 bf ff f5 bgu 400080f0 <== NEVER TAKEN 40008120: b0 10 20 74 mov 0x74, %i0 40008124: 30 bf ff f8 b,a 40008104 =============================================================================== 40008940 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 40008940: 82 10 00 08 mov %o0, %g1 if ( !attr ) 40008944: 80 a0 60 00 cmp %g1, 0 40008948: 02 80 00 06 be 40008960 4000894c: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 40008950: c4 00 40 00 ld [ %g1 ], %g2 40008954: 80 a0 a0 00 cmp %g2, 0 40008958: 12 80 00 04 bne 40008968 4000895c: 80 a2 60 01 cmp %o1, 1 return 0; default: return EINVAL; } } 40008960: 81 c3 e0 08 retl 40008964: 01 00 00 00 nop return EINVAL; if ( !attr->is_initialized ) return EINVAL; switch ( pshared ) { 40008968: 18 bf ff fe bgu 40008960 <== NEVER TAKEN 4000896c: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 40008970: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; default: return EINVAL; } } 40008974: 81 c3 e0 08 retl 40008978: 90 10 20 00 clr %o0 =============================================================================== 40009a00 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 40009a00: 9d e3 bf 90 save %sp, -112, %sp int rc; /* * Check all the parameters */ if ( !param ) 40009a04: 80 a6 a0 00 cmp %i2, 0 40009a08: 02 80 00 0a be 40009a30 40009a0c: ba 10 20 16 mov 0x16, %i5 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 40009a10: 90 10 00 19 mov %i1, %o0 40009a14: 92 10 00 1a mov %i2, %o1 40009a18: 94 07 bf f4 add %fp, -12, %o2 40009a1c: 40 00 18 52 call 4000fb64 <_POSIX_Thread_Translate_sched_param> 40009a20: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 40009a24: ba 92 20 00 orcc %o0, 0, %i5 40009a28: 02 80 00 05 be 40009a3c 40009a2c: 90 10 00 18 mov %i0, %o0 case OBJECTS_ERROR: break; } return ESRCH; } 40009a30: b0 10 00 1d mov %i5, %i0 40009a34: 81 c7 e0 08 ret 40009a38: 81 e8 00 00 restore return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); 40009a3c: 40 00 0c b3 call 4000cd08 <_Thread_Get> 40009a40: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40009a44: c2 07 bf fc ld [ %fp + -4 ], %g1 40009a48: 80 a0 60 00 cmp %g1, 0 40009a4c: 12 80 00 2b bne 40009af8 40009a50: b6 10 00 08 mov %o0, %i3 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 40009a54: f8 02 21 50 ld [ %o0 + 0x150 ], %i4 if ( api->schedpolicy == SCHED_SPORADIC ) 40009a58: c2 07 20 84 ld [ %i4 + 0x84 ], %g1 40009a5c: 80 a0 60 04 cmp %g1, 4 40009a60: 02 80 00 35 be 40009b34 40009a64: 01 00 00 00 nop (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; 40009a68: c2 06 80 00 ld [ %i2 ], %g1 the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 40009a6c: 80 a6 60 00 cmp %i1, 0 if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; 40009a70: c2 27 20 88 st %g1, [ %i4 + 0x88 ] 40009a74: c4 06 a0 04 ld [ %i2 + 4 ], %g2 40009a78: c4 27 20 8c st %g2, [ %i4 + 0x8c ] 40009a7c: c4 06 a0 08 ld [ %i2 + 8 ], %g2 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; 40009a80: f2 27 20 84 st %i1, [ %i4 + 0x84 ] api->schedparam = *param; 40009a84: c4 27 20 90 st %g2, [ %i4 + 0x90 ] 40009a88: c4 06 a0 0c ld [ %i2 + 0xc ], %g2 40009a8c: c4 27 20 94 st %g2, [ %i4 + 0x94 ] 40009a90: c4 06 a0 10 ld [ %i2 + 0x10 ], %g2 40009a94: c4 27 20 98 st %g2, [ %i4 + 0x98 ] 40009a98: c4 06 a0 14 ld [ %i2 + 0x14 ], %g2 40009a9c: c4 27 20 9c st %g2, [ %i4 + 0x9c ] 40009aa0: c4 06 a0 18 ld [ %i2 + 0x18 ], %g2 40009aa4: c4 27 20 a0 st %g2, [ %i4 + 0xa0 ] the_thread->budget_algorithm = budget_algorithm; 40009aa8: c4 07 bf f4 ld [ %fp + -12 ], %g2 40009aac: c4 26 e0 78 st %g2, [ %i3 + 0x78 ] the_thread->budget_callout = budget_callout; 40009ab0: c4 07 bf f8 ld [ %fp + -8 ], %g2 switch ( api->schedpolicy ) { 40009ab4: 06 80 00 0e bl 40009aec <== NEVER TAKEN 40009ab8: c4 26 e0 7c st %g2, [ %i3 + 0x7c ] 40009abc: 80 a6 60 02 cmp %i1, 2 40009ac0: 04 80 00 11 ble 40009b04 40009ac4: 07 10 00 6d sethi %hi(0x4001b400), %g3 40009ac8: 80 a6 60 04 cmp %i1, 4 40009acc: 12 80 00 08 bne 40009aec <== NEVER TAKEN 40009ad0: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 40009ad4: c2 27 20 a4 st %g1, [ %i4 + 0xa4 ] _Watchdog_Remove( &api->Sporadic_timer ); 40009ad8: 40 00 10 b0 call 4000dd98 <_Watchdog_Remove> 40009adc: 90 07 20 a8 add %i4, 0xa8, %o0 _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 40009ae0: 90 10 20 00 clr %o0 40009ae4: 7f ff ff 7b call 400098d0 <_POSIX_Threads_Sporadic_budget_TSR> 40009ae8: 92 10 00 1b mov %i3, %o1 break; } _Thread_Enable_dispatch(); 40009aec: 40 00 0c 7b call 4000ccd8 <_Thread_Enable_dispatch> 40009af0: b0 10 00 1d mov %i5, %i0 40009af4: 30 bf ff d0 b,a 40009a34 #endif case OBJECTS_ERROR: break; } return ESRCH; 40009af8: ba 10 20 03 mov 3, %i5 } 40009afc: 81 c7 e0 08 ret 40009b00: 91 e8 00 1d restore %g0, %i5, %o0 40009b04: d2 08 e0 5c ldub [ %g3 + 0x5c ], %o1 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 40009b08: 05 10 00 6f sethi %hi(0x4001bc00), %g2 40009b0c: c4 00 a3 d0 ld [ %g2 + 0x3d0 ], %g2 ! 4001bfd0 <_Thread_Ticks_per_timeslice> 40009b10: 92 22 40 01 sub %o1, %g1, %o1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40009b14: 90 10 00 1b mov %i3, %o0 40009b18: 94 10 20 01 mov 1, %o2 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 40009b1c: c4 26 e0 74 st %g2, [ %i3 + 0x74 ] the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 40009b20: 40 00 0b 34 call 4000c7f0 <_Thread_Change_priority> 40009b24: d2 26 e0 18 st %o1, [ %i3 + 0x18 ] _Watchdog_Remove( &api->Sporadic_timer ); _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); break; } _Thread_Enable_dispatch(); 40009b28: 40 00 0c 6c call 4000ccd8 <_Thread_Enable_dispatch> 40009b2c: b0 10 00 1d mov %i5, %i0 40009b30: 30 bf ff c1 b,a 40009a34 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); 40009b34: 40 00 10 99 call 4000dd98 <_Watchdog_Remove> 40009b38: 90 07 20 a8 add %i4, 0xa8, %o0 api->schedpolicy = policy; api->schedparam = *param; 40009b3c: 10 bf ff cc b 40009a6c 40009b40: c2 06 80 00 ld [ %i2 ], %g1 =============================================================================== 40007398 : /* * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 40007398: 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() ) 4000739c: 3b 10 00 62 sethi %hi(0x40018800), %i5 400073a0: ba 17 63 20 or %i5, 0x320, %i5 ! 40018b20 <_Per_CPU_Information> 400073a4: c2 07 60 08 ld [ %i5 + 8 ], %g1 400073a8: 80 a0 60 00 cmp %g1, 0 400073ac: 12 80 00 16 bne 40007404 <== NEVER TAKEN 400073b0: 03 10 00 61 sethi %hi(0x40018400), %g1 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 400073b4: c4 07 60 10 ld [ %i5 + 0x10 ], %g2 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 400073b8: c6 00 62 10 ld [ %g1 + 0x210 ], %g3 400073bc: c4 00 a1 50 ld [ %g2 + 0x150 ], %g2 ++level; 400073c0: 86 00 e0 01 inc %g3 _Thread_Dispatch_disable_level = level; 400073c4: c6 20 62 10 st %g3, [ %g1 + 0x210 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 400073c8: c2 00 a0 d8 ld [ %g2 + 0xd8 ], %g1 400073cc: 80 a0 60 00 cmp %g1, 0 400073d0: 12 80 00 0b bne 400073fc <== NEVER TAKEN 400073d4: 01 00 00 00 nop 400073d8: c2 00 a0 e0 ld [ %g2 + 0xe0 ], %g1 400073dc: 80 a0 60 00 cmp %g1, 0 400073e0: 02 80 00 07 be 400073fc 400073e4: 01 00 00 00 nop thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 400073e8: 40 00 0c 26 call 4000a480 <_Thread_Enable_dispatch> 400073ec: b2 10 3f ff mov -1, %i1 ! ffffffff if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 400073f0: f0 07 60 10 ld [ %i5 + 0x10 ], %i0 400073f4: 40 00 17 ef call 4000d3b0 <_POSIX_Thread_Exit> 400073f8: 81 e8 00 00 restore _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 400073fc: 40 00 0c 21 call 4000a480 <_Thread_Enable_dispatch> 40007400: 81 e8 00 00 restore 40007404: 81 c7 e0 08 ret <== NOT EXECUTED 40007408: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 400078f4 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 400078f4: 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); 400078f8: 39 10 00 63 sethi %hi(0x40018c00), %i4 400078fc: 40 00 02 7b call 400082e8 40007900: 90 17 23 f4 or %i4, 0x3f4, %o0 ! 40018ff4 if (result != 0) { 40007904: b6 92 20 00 orcc %o0, 0, %i3 40007908: 12 80 00 31 bne 400079cc <== NEVER TAKEN 4000790c: 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); 40007910: 40 00 04 b6 call 40008be8 40007914: b2 17 23 f4 or %i4, 0x3f4, %i1 40007918: 92 07 bf e0 add %fp, -32, %o1 4000791c: 40 00 03 a8 call 400087bc 40007920: 94 07 bf e4 add %fp, -28, %o2 req->caller_thread = pthread_self (); 40007924: 40 00 04 b1 call 40008be8 40007928: 01 00 00 00 nop req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 4000792c: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 req->policy = policy; 40007930: c6 07 bf e0 ld [ %fp + -32 ], %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; 40007934: c4 00 60 18 ld [ %g1 + 0x18 ], %g2 req->policy = policy; 40007938: 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; 4000793c: c6 07 bf e4 ld [ %fp + -28 ], %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 (); 40007940: d0 26 20 10 st %o0, [ %i0 + 0x10 ] req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 40007944: 84 20 c0 02 sub %g3, %g2, %g2 40007948: 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) && 4000794c: c4 06 60 68 ld [ %i1 + 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; 40007950: 86 10 20 77 mov 0x77, %g3 req->aiocbp->return_value = 0; 40007954: c0 20 60 38 clr [ %g1 + 0x38 ] 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; 40007958: c6 20 60 34 st %g3, [ %g1 + 0x34 ] req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 4000795c: 80 a0 a0 00 cmp %g2, 0 40007960: 12 80 00 06 bne 40007978 <== NEVER TAKEN 40007964: d2 00 40 00 ld [ %g1 ], %o1 40007968: c4 06 60 64 ld [ %i1 + 0x64 ], %g2 4000796c: 80 a0 a0 04 cmp %g2, 4 40007970: 24 80 00 1b ble,a 400079dc 40007974: 90 06 60 48 add %i1, 0x48, %o0 else { /* the maximum number of threads has been already created even though some of them might be idle. The request belongs to one of the active fd chain */ r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 40007978: 94 10 20 00 clr %o2 4000797c: 11 10 00 64 sethi %hi(0x40019000), %o0 40007980: 7f ff ff 78 call 40007760 40007984: 90 12 20 3c or %o0, 0x3c, %o0 ! 4001903c req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 40007988: b4 92 20 00 orcc %o0, 0, %i2 4000798c: 22 80 00 31 be,a 40007a50 40007990: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 { pthread_mutex_lock (&r_chain->mutex); 40007994: b2 06 a0 1c add %i2, 0x1c, %i1 40007998: 40 00 02 54 call 400082e8 4000799c: 90 10 00 19 mov %i1, %o0 rtems_aio_insert_prio (&r_chain->perfd, req); 400079a0: 90 06 a0 08 add %i2, 8, %o0 400079a4: 7f ff ff 12 call 400075ec 400079a8: 92 10 00 18 mov %i0, %o1 pthread_cond_signal (&r_chain->cond); 400079ac: 40 00 01 2c call 40007e5c 400079b0: 90 06 a0 20 add %i2, 0x20, %o0 pthread_mutex_unlock (&r_chain->mutex); 400079b4: 40 00 02 6d call 40008368 400079b8: 90 10 00 19 mov %i1, %o0 if (aio_request_queue.idle_threads > 0) pthread_cond_signal (&aio_request_queue.new_req); } } pthread_mutex_unlock (&aio_request_queue.mutex); 400079bc: 40 00 02 6b call 40008368 400079c0: 90 17 23 f4 or %i4, 0x3f4, %o0 return 0; } 400079c4: 81 c7 e0 08 ret 400079c8: 91 e8 00 1b restore %g0, %i3, %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); 400079cc: 7f ff ee 4c call 400032fc <== NOT EXECUTED 400079d0: b0 10 00 1b mov %i3, %i0 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); return 0; } 400079d4: 81 c7 e0 08 ret <== NOT EXECUTED 400079d8: 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); 400079dc: 7f ff ff 61 call 40007760 400079e0: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 400079e4: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 400079e8: 80 a0 60 01 cmp %g1, 1 400079ec: 12 bf ff ea bne 40007994 400079f0: b4 10 00 08 mov %o0, %i2 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); 400079f4: 90 02 20 08 add %o0, 8, %o0 400079f8: 40 00 09 44 call 40009f08 <_Chain_Insert> 400079fc: 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); 40007a00: 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; 40007a04: c0 26 a0 18 clr [ %i2 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40007a08: 40 00 01 df call 40008184 40007a0c: 90 06 a0 1c add %i2, 0x1c, %o0 pthread_cond_init (&r_chain->cond, NULL); 40007a10: 92 10 20 00 clr %o1 40007a14: 40 00 00 e3 call 40007da0 40007a18: 90 06 a0 20 add %i2, 0x20, %o0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 40007a1c: 90 07 bf dc add %fp, -36, %o0 40007a20: 92 06 60 08 add %i1, 8, %o1 40007a24: 96 10 00 1a mov %i2, %o3 40007a28: 15 10 00 1c sethi %hi(0x40007000), %o2 40007a2c: 40 00 02 c4 call 4000853c 40007a30: 94 12 a3 40 or %o2, 0x340, %o2 ! 40007340 rtems_aio_handle, (void *) r_chain); if (result != 0) { 40007a34: 82 92 20 00 orcc %o0, 0, %g1 40007a38: 12 80 00 25 bne 40007acc <== NEVER TAKEN 40007a3c: 90 10 00 19 mov %i1, %o0 pthread_mutex_unlock (&aio_request_queue.mutex); return result; } ++aio_request_queue.active_threads; 40007a40: c2 06 60 64 ld [ %i1 + 0x64 ], %g1 40007a44: 82 00 60 01 inc %g1 40007a48: 10 bf ff dd b 400079bc 40007a4c: c2 26 60 64 st %g1, [ %i1 + 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); 40007a50: 11 10 00 64 sethi %hi(0x40019000), %o0 40007a54: d2 00 40 00 ld [ %g1 ], %o1 40007a58: 90 12 20 48 or %o0, 0x48, %o0 40007a5c: 7f ff ff 41 call 40007760 40007a60: 94 10 20 01 mov 1, %o2 if (r_chain->new_fd == 1) { 40007a64: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 40007a68: b4 10 00 08 mov %o0, %i2 40007a6c: 92 10 00 18 mov %i0, %o1 if (r_chain->new_fd == 1) { 40007a70: 80 a0 60 01 cmp %g1, 1 40007a74: 02 80 00 0b be 40007aa0 40007a78: 90 02 20 08 add %o0, 8, %o0 r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); pthread_cond_init (&r_chain->cond, NULL); } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); 40007a7c: 7f ff fe dc call 400075ec 40007a80: 01 00 00 00 nop if (aio_request_queue.idle_threads > 0) 40007a84: c2 06 60 68 ld [ %i1 + 0x68 ], %g1 40007a88: 80 a0 60 00 cmp %g1, 0 40007a8c: 04 bf ff cc ble 400079bc <== ALWAYS TAKEN 40007a90: 01 00 00 00 nop pthread_cond_signal (&aio_request_queue.new_req); 40007a94: 40 00 00 f2 call 40007e5c <== NOT EXECUTED 40007a98: 90 06 60 04 add %i1, 4, %o0 <== NOT EXECUTED 40007a9c: 30 bf ff c8 b,a 400079bc <== NOT EXECUTED 40007aa0: 40 00 09 1a call 40009f08 <_Chain_Insert> 40007aa4: 01 00 00 00 nop /* 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); 40007aa8: 90 06 a0 1c add %i2, 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; 40007aac: c0 26 a0 18 clr [ %i2 + 0x18 ] pthread_mutex_init (&r_chain->mutex, NULL); 40007ab0: 40 00 01 b5 call 40008184 40007ab4: 92 10 20 00 clr %o1 pthread_cond_init (&r_chain->cond, NULL); 40007ab8: 90 06 a0 20 add %i2, 0x20, %o0 40007abc: 40 00 00 b9 call 40007da0 40007ac0: 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) 40007ac4: 10 bf ff f1 b 40007a88 40007ac8: c2 06 60 68 ld [ %i1 + 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); 40007acc: 40 00 02 27 call 40008368 <== NOT EXECUTED 40007ad0: b6 10 00 01 mov %g1, %i3 <== NOT EXECUTED 40007ad4: 30 bf ff bc b,a 400079c4 <== NOT EXECUTED =============================================================================== 40007340 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 40007340: 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); 40007344: 35 10 00 63 sethi %hi(0x40018c00), %i2 40007348: b6 06 20 1c add %i0, 0x1c, %i3 4000734c: b4 16 a3 f4 or %i2, 0x3f4, %i2 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 40007350: a0 10 00 1a mov %i2, %l0 40007354: a2 10 00 1a mov %i2, %l1 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)) { 40007358: a4 06 a0 58 add %i2, 0x58, %l2 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 && 4000735c: b2 06 a0 4c add %i2, 0x4c, %i1 /* 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); 40007360: 40 00 03 e2 call 400082e8 40007364: 90 10 00 1b mov %i3, %o0 if (result != 0) 40007368: 80 a2 20 00 cmp %o0, 0 4000736c: 12 80 00 2b bne 40007418 <== NEVER TAKEN 40007370: 01 00 00 00 nop 40007374: fa 06 20 08 ld [ %i0 + 8 ], %i5 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 40007378: 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)) { 4000737c: 80 a7 40 01 cmp %i5, %g1 40007380: 02 80 00 41 be 40007484 40007384: 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); 40007388: 40 00 06 18 call 40008be8 4000738c: 01 00 00 00 nop 40007390: 92 07 bf d8 add %fp, -40, %o1 40007394: 40 00 05 0a call 400087bc 40007398: 94 07 bf e4 add %fp, -28, %o2 param.sched_priority = req->priority; 4000739c: c2 07 60 0c ld [ %i5 + 0xc ], %g1 pthread_setschedparam (pthread_self(), req->policy, ¶m); 400073a0: 40 00 06 12 call 40008be8 400073a4: c2 27 bf e4 st %g1, [ %fp + -28 ] 400073a8: d2 07 60 08 ld [ %i5 + 8 ], %o1 400073ac: 40 00 06 13 call 40008bf8 400073b0: 94 07 bf e4 add %fp, -28, %o2 400073b4: 40 00 0a bc call 40009ea4 <_Chain_Extract> 400073b8: 90 10 00 1d mov %i5, %o0 rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 400073bc: 40 00 03 eb call 40008368 400073c0: 90 10 00 1b mov %i3, %o0 switch (req->aiocbp->aio_lio_opcode) { 400073c4: f8 07 60 14 ld [ %i5 + 0x14 ], %i4 400073c8: c2 07 20 30 ld [ %i4 + 0x30 ], %g1 400073cc: 80 a0 60 02 cmp %g1, 2 400073d0: 22 80 00 25 be,a 40007464 400073d4: c4 1f 20 08 ldd [ %i4 + 8 ], %g2 400073d8: 80 a0 60 03 cmp %g1, 3 400073dc: 02 80 00 1e be 40007454 <== NEVER TAKEN 400073e0: 01 00 00 00 nop 400073e4: 80 a0 60 01 cmp %g1, 1 400073e8: 22 80 00 0e be,a 40007420 <== ALWAYS TAKEN 400073ec: c4 1f 20 08 ldd [ %i4 + 8 ], %g2 default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 400073f0: 82 10 3f ff mov -1, %g1 <== NOT EXECUTED req->aiocbp->error_code = errno; 400073f4: 40 00 29 13 call 40011840 <__errno> <== NOT EXECUTED 400073f8: c2 27 20 38 st %g1, [ %i4 + 0x38 ] <== NOT EXECUTED 400073fc: 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); 40007400: 90 10 00 1b mov %i3, %o0 <== NOT EXECUTED 40007404: 40 00 03 b9 call 400082e8 <== NOT EXECUTED 40007408: c2 27 20 34 st %g1, [ %i4 + 0x34 ] <== NOT EXECUTED if (result != 0) 4000740c: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40007410: 22 bf ff da be,a 40007378 <== NOT EXECUTED 40007414: fa 06 20 08 ld [ %i0 + 8 ], %i5 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } 40007418: 81 c7 e0 08 ret 4000741c: 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, 40007420: d0 07 00 00 ld [ %i4 ], %o0 40007424: d2 07 20 10 ld [ %i4 + 0x10 ], %o1 40007428: d4 07 20 14 ld [ %i4 + 0x14 ], %o2 4000742c: 96 10 00 02 mov %g2, %o3 40007430: 40 00 2b f0 call 400123f0 40007434: 98 10 00 03 mov %g3, %o4 break; default: result = -1; } if (result == -1) { 40007438: 80 a2 3f ff cmp %o0, -1 4000743c: 22 bf ff ed be,a 400073f0 <== NEVER TAKEN 40007440: f8 07 60 14 ld [ %i5 + 0x14 ], %i4 <== NOT EXECUTED req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; 40007444: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 40007448: d0 20 60 38 st %o0, [ %g1 + 0x38 ] req->aiocbp->error_code = 0; 4000744c: 10 bf ff c5 b 40007360 40007450: 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); 40007454: 40 00 1b 79 call 4000e238 <== NOT EXECUTED 40007458: d0 07 00 00 ld [ %i4 ], %o0 <== NOT EXECUTED break; 4000745c: 10 bf ff f8 b 4000743c <== NOT EXECUTED 40007460: 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, 40007464: d0 07 00 00 ld [ %i4 ], %o0 40007468: d2 07 20 10 ld [ %i4 + 0x10 ], %o1 4000746c: d4 07 20 14 ld [ %i4 + 0x14 ], %o2 40007470: 96 10 00 02 mov %g2, %o3 40007474: 40 00 2c 1d call 400124e8 40007478: 98 10 00 03 mov %g3, %o4 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 4000747c: 10 bf ff f0 b 4000743c 40007480: 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); 40007484: 40 00 03 b9 call 40008368 40007488: 90 10 00 1b mov %i3, %o0 pthread_mutex_lock (&aio_request_queue.mutex); 4000748c: 40 00 03 97 call 400082e8 40007490: 90 10 00 1a mov %i2, %o0 if (rtems_chain_is_empty (chain)) 40007494: c2 06 20 08 ld [ %i0 + 8 ], %g1 40007498: 80 a7 40 01 cmp %i5, %g1 4000749c: 02 80 00 05 be 400074b0 <== ALWAYS TAKEN 400074a0: 92 07 bf dc add %fp, -36, %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); 400074a4: 40 00 03 b1 call 40008368 400074a8: 90 10 00 1a mov %i2, %o0 400074ac: 30 bf ff ad b,a 40007360 pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 400074b0: 40 00 01 d3 call 40007bfc 400074b4: 90 10 20 01 mov 1, %o0 timeout.tv_sec += 3; 400074b8: c2 07 bf dc ld [ %fp + -36 ], %g1 timeout.tv_nsec = 0; 400074bc: c0 27 bf e0 clr [ %fp + -32 ] pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 400074c0: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 400074c4: ba 06 20 20 add %i0, 0x20, %i5 pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 400074c8: c2 27 bf dc st %g1, [ %fp + -36 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 400074cc: 90 10 00 1d mov %i5, %o0 400074d0: 92 10 00 10 mov %l0, %o1 400074d4: 40 00 02 7e call 40007ecc 400074d8: 94 07 bf dc add %fp, -36, %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) { 400074dc: 80 a2 20 74 cmp %o0, 0x74 400074e0: 12 bf ff f1 bne 400074a4 <== NEVER TAKEN 400074e4: 01 00 00 00 nop 400074e8: 40 00 0a 6f call 40009ea4 <_Chain_Extract> 400074ec: 90 10 00 18 mov %i0, %o0 rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 400074f0: 40 00 02 d2 call 40008038 400074f4: 90 10 00 1b mov %i3, %o0 pthread_cond_destroy (&r_chain->cond); 400074f8: 40 00 01 f4 call 40007cc8 400074fc: 90 10 00 1d mov %i5, %o0 free (r_chain); 40007500: 7f ff ef 7f call 400032fc 40007504: 90 10 00 18 mov %i0, %o0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 40007508: f0 06 a0 54 ld [ %i2 + 0x54 ], %i0 /* 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)) { 4000750c: 80 a6 00 12 cmp %i0, %l2 40007510: 22 80 00 1d be,a 40007584 40007514: c4 06 a0 68 ld [ %i2 + 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; 40007518: c4 04 60 68 ld [ %l1 + 0x68 ], %g2 ++aio_request_queue.active_threads; 4000751c: c2 04 60 64 ld [ %l1 + 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; 40007520: 84 00 bf ff add %g2, -1, %g2 ++aio_request_queue.active_threads; 40007524: 82 00 60 01 inc %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; 40007528: c4 24 60 68 st %g2, [ %l1 + 0x68 ] ++aio_request_queue.active_threads; 4000752c: c2 24 60 64 st %g1, [ %l1 + 0x64 ] 40007530: 40 00 0a 5d call 40009ea4 <_Chain_Extract> 40007534: 90 10 00 18 mov %i0, %o0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; 40007538: c2 04 60 48 ld [ %l1 + 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 && 4000753c: c6 06 20 14 ld [ %i0 + 0x14 ], %g3 40007540: c4 00 60 14 ld [ %g1 + 0x14 ], %g2 40007544: 80 a0 c0 02 cmp %g3, %g2 40007548: 14 80 00 08 bg 40007568 <== ALWAYS TAKEN 4000754c: 80 a0 40 19 cmp %g1, %i1 RTEMS_INLINE_ROUTINE void rtems_chain_insert( rtems_chain_node *after_node, rtems_chain_node *the_node ) { _Chain_Insert( after_node, the_node ); 40007550: 10 80 00 09 b 40007574 <== NOT EXECUTED 40007554: d0 00 60 04 ld [ %g1 + 4 ], %o0 <== NOT EXECUTED 40007558: c4 00 60 14 ld [ %g1 + 0x14 ], %g2 4000755c: 80 a0 80 03 cmp %g2, %g3 40007560: 16 80 00 04 bge 40007570 40007564: 80 a0 40 19 cmp %g1, %i1 40007568: 32 bf ff fc bne,a 40007558 <== ALWAYS TAKEN 4000756c: c2 00 40 00 ld [ %g1 ], %g1 40007570: d0 00 60 04 ld [ %g1 + 4 ], %o0 40007574: 92 10 00 18 mov %i0, %o1 40007578: 40 00 0a 64 call 40009f08 <_Chain_Insert> 4000757c: b6 06 20 1c add %i0, 0x1c, %i3 40007580: 30 bf ff c9 b,a 400074a4 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; 40007584: c2 06 a0 64 ld [ %i2 + 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; 40007588: 84 00 a0 01 inc %g2 --aio_request_queue.active_threads; 4000758c: 82 00 7f ff add %g1, -1, %g1 clock_gettime (CLOCK_REALTIME, &timeout); 40007590: 92 07 bf dc add %fp, -36, %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; 40007594: c4 26 a0 68 st %g2, [ %i2 + 0x68 ] --aio_request_queue.active_threads; 40007598: c2 26 a0 64 st %g1, [ %i2 + 0x64 ] clock_gettime (CLOCK_REALTIME, &timeout); 4000759c: 40 00 01 98 call 40007bfc 400075a0: 90 10 20 01 mov 1, %o0 timeout.tv_sec += 3; 400075a4: c2 07 bf dc ld [ %fp + -36 ], %g1 timeout.tv_nsec = 0; 400075a8: c0 27 bf e0 clr [ %fp + -32 ] 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; 400075ac: 82 00 60 03 add %g1, 3, %g1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 400075b0: 90 06 a0 04 add %i2, 4, %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; 400075b4: c2 27 bf dc st %g1, [ %fp + -36 ] timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 400075b8: 92 10 00 1a mov %i2, %o1 400075bc: 40 00 02 44 call 40007ecc 400075c0: 94 07 bf dc add %fp, -36, %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) { 400075c4: 80 a2 20 74 cmp %o0, 0x74 400075c8: 22 80 00 04 be,a 400075d8 <== ALWAYS TAKEN 400075cc: c2 06 a0 68 ld [ %i2 + 0x68 ], %g1 400075d0: 10 bf ff d2 b 40007518 <== NOT EXECUTED 400075d4: f0 06 a0 54 ld [ %i2 + 0x54 ], %i0 <== NOT EXECUTED AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; pthread_mutex_unlock (&aio_request_queue.mutex); 400075d8: 90 10 00 1a mov %i2, %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; 400075dc: 82 00 7f ff add %g1, -1, %g1 pthread_mutex_unlock (&aio_request_queue.mutex); 400075e0: 40 00 03 62 call 40008368 400075e4: c2 26 a0 68 st %g1, [ %i2 + 0x68 ] 400075e8: 30 bf ff 8c b,a 40007418 =============================================================================== 40007658 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 40007658: 9d e3 bf a0 save %sp, -96, %sp int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 4000765c: 3b 10 00 63 sethi %hi(0x40018c00), %i5 40007660: 40 00 03 9c call 400084d0 40007664: 90 17 63 fc or %i5, 0x3fc, %o0 ! 40018ffc if (result != 0) 40007668: b0 92 20 00 orcc %o0, 0, %i0 4000766c: 12 80 00 23 bne 400076f8 <== NEVER TAKEN 40007670: 90 17 63 fc or %i5, 0x3fc, %o0 return result; result = 40007674: 40 00 03 a3 call 40008500 40007678: 92 10 20 00 clr %o1 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 4000767c: 80 a2 20 00 cmp %o0, 0 40007680: 12 80 00 20 bne 40007700 <== NEVER TAKEN 40007684: 39 10 00 63 sethi %hi(0x40018c00), %i4 pthread_attr_destroy (&aio_request_queue.attr); result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 40007688: 92 10 20 00 clr %o1 4000768c: 40 00 02 be call 40008184 40007690: 90 17 23 f4 or %i4, 0x3f4, %o0 if (result != 0) 40007694: 80 a2 20 00 cmp %o0, 0 40007698: 12 80 00 23 bne 40007724 <== NEVER TAKEN 4000769c: 92 10 20 00 clr %o1 pthread_attr_destroy (&aio_request_queue.attr); result = pthread_cond_init (&aio_request_queue.new_req, NULL); 400076a0: 11 10 00 63 sethi %hi(0x40018c00), %o0 400076a4: 40 00 01 bf call 40007da0 400076a8: 90 12 23 f8 or %o0, 0x3f8, %o0 ! 40018ff8 if (result != 0) { 400076ac: b0 92 20 00 orcc %o0, 0, %i0 400076b0: 12 80 00 26 bne 40007748 <== NEVER TAKEN 400076b4: 01 00 00 00 nop ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400076b8: 82 17 23 f4 or %i4, 0x3f4, %g1 head->previous = NULL; tail->previous = head; 400076bc: 84 00 60 54 add %g1, 0x54, %g2 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400076c0: ba 00 60 4c add %g1, 0x4c, %i5 head->previous = NULL; tail->previous = head; 400076c4: 88 00 60 48 add %g1, 0x48, %g4 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400076c8: 86 00 60 58 add %g1, 0x58, %g3 head->previous = NULL; tail->previous = head; 400076cc: c4 20 60 5c st %g2, [ %g1 + 0x5c ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400076d0: fa 20 60 48 st %i5, [ %g1 + 0x48 ] head->previous = NULL; 400076d4: c0 20 60 4c clr [ %g1 + 0x4c ] tail->previous = head; 400076d8: c8 20 60 50 st %g4, [ %g1 + 0x50 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 400076dc: c6 20 60 54 st %g3, [ %g1 + 0x54 ] head->previous = NULL; 400076e0: c0 20 60 58 clr [ %g1 + 0x58 ] } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; 400076e4: c0 20 60 64 clr [ %g1 + 0x64 ] aio_request_queue.idle_threads = 0; 400076e8: c0 20 60 68 clr [ %g1 + 0x68 ] aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 400076ec: 05 00 00 2c sethi %hi(0xb000), %g2 400076f0: 84 10 a0 0b or %g2, 0xb, %g2 ! b00b 400076f4: c4 20 60 60 st %g2, [ %g1 + 0x60 ] return result; } 400076f8: 81 c7 e0 08 ret 400076fc: 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); 40007700: 40 00 03 68 call 400084a0 <== NOT EXECUTED 40007704: 90 17 63 fc or %i5, 0x3fc, %o0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 40007708: 39 10 00 63 sethi %hi(0x40018c00), %i4 <== NOT EXECUTED 4000770c: 92 10 20 00 clr %o1 <== NOT EXECUTED 40007710: 40 00 02 9d call 40008184 <== NOT EXECUTED 40007714: 90 17 23 f4 or %i4, 0x3f4, %o0 <== NOT EXECUTED if (result != 0) 40007718: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 4000771c: 02 bf ff e1 be 400076a0 <== NOT EXECUTED 40007720: 92 10 20 00 clr %o1 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40007724: 40 00 03 5f call 400084a0 <== NOT EXECUTED 40007728: 90 17 63 fc or %i5, 0x3fc, %o0 <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 4000772c: 92 10 20 00 clr %o1 <== NOT EXECUTED 40007730: 11 10 00 63 sethi %hi(0x40018c00), %o0 <== NOT EXECUTED 40007734: 40 00 01 9b call 40007da0 <== NOT EXECUTED 40007738: 90 12 23 f8 or %o0, 0x3f8, %o0 ! 40018ff8 <== NOT EXECUTED if (result != 0) { 4000773c: b0 92 20 00 orcc %o0, 0, %i0 <== NOT EXECUTED 40007740: 22 bf ff df be,a 400076bc <== NOT EXECUTED 40007744: 82 17 23 f4 or %i4, 0x3f4, %g1 <== NOT EXECUTED pthread_mutex_destroy (&aio_request_queue.mutex); 40007748: 40 00 02 3c call 40008038 <== NOT EXECUTED 4000774c: 90 17 23 f4 or %i4, 0x3f4, %o0 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 40007750: 40 00 03 54 call 400084a0 <== NOT EXECUTED 40007754: 90 17 63 fc or %i5, 0x3fc, %o0 <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40007758: 10 bf ff d9 b 400076bc <== NOT EXECUTED 4000775c: 82 17 23 f4 or %i4, 0x3f4, %g1 <== NOT EXECUTED =============================================================================== 400075ec : 400075ec: c2 02 00 00 ld [ %o0 ], %g1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 400075f0: 88 02 20 04 add %o0, 4, %g4 rtems_chain_node *node; AIO_printf ("FD exists \n"); node = rtems_chain_first (chain); if (rtems_chain_is_empty (chain)) { 400075f4: 80 a0 40 04 cmp %g1, %g4 400075f8: 02 80 00 15 be 4000764c <== NEVER TAKEN 400075fc: 9a 10 00 09 mov %o1, %o5 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 && 40007600: c6 02 60 14 ld [ %o1 + 0x14 ], %g3 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; 40007604: c4 00 60 14 ld [ %g1 + 0x14 ], %g2 while (req->aiocbp->aio_reqprio > prio && 40007608: c6 00 e0 18 ld [ %g3 + 0x18 ], %g3 4000760c: c4 00 a0 18 ld [ %g2 + 0x18 ], %g2 40007610: 80 a0 80 03 cmp %g2, %g3 40007614: 26 80 00 07 bl,a 40007630 <== NEVER TAKEN 40007618: c2 00 40 00 ld [ %g1 ], %g1 <== NOT EXECUTED 4000761c: 10 80 00 0b b 40007648 40007620: d0 00 60 04 ld [ %g1 + 4 ], %o0 40007624: 22 80 00 09 be,a 40007648 <== NOT EXECUTED 40007628: d0 00 60 04 ld [ %g1 + 4 ], %o0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Next( Chain_Node *the_node ) { return the_node->next; 4000762c: c2 00 40 00 ld [ %g1 ], %g1 <== NOT EXECUTED !rtems_chain_is_tail (chain, node)) { node = rtems_chain_next (node); prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 40007630: c4 00 60 14 ld [ %g1 + 0x14 ], %g2 <== 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 && 40007634: c4 00 a0 18 ld [ %g2 + 0x18 ], %g2 <== NOT EXECUTED 40007638: 80 a0 80 03 cmp %g2, %g3 <== NOT EXECUTED 4000763c: 06 bf ff fa bl 40007624 <== NOT EXECUTED 40007640: 80 a1 00 01 cmp %g4, %g1 <== NOT EXECUTED 40007644: d0 00 60 04 ld [ %g1 + 4 ], %o0 <== NOT EXECUTED 40007648: 92 10 00 0d mov %o5, %o1 4000764c: 82 13 c0 00 mov %o7, %g1 40007650: 40 00 0a 2e call 40009f08 <_Chain_Insert> 40007654: 9e 10 40 00 mov %g1, %o7 =============================================================================== 40007834 : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { 40007834: 9d e3 bf a0 save %sp, -96, %sp */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; 40007838: fa 06 20 08 ld [ %i0 + 8 ], %i5 RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( const Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Immutable_tail( the_chain )); 4000783c: 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)) 40007840: 80 a7 40 18 cmp %i5, %i0 40007844: 02 80 00 0e be 4000787c <== NEVER TAKEN 40007848: b6 10 20 8c mov 0x8c, %i3 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 4000784c: 40 00 09 96 call 40009ea4 <_Chain_Extract> 40007850: 90 10 00 1d mov %i5, %o0 { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; 40007854: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Next( Chain_Node *the_node ) { return the_node->next; 40007858: f8 07 40 00 ld [ %i5 ], %i4 req->aiocbp->return_value = -1; 4000785c: 84 10 3f ff mov -1, %g2 free (req); 40007860: 90 10 00 1d mov %i5, %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; 40007864: f6 20 60 34 st %i3, [ %g1 + 0x34 ] req->aiocbp->return_value = -1; free (req); 40007868: 7f ff ee a5 call 400032fc 4000786c: c4 20 60 38 st %g2, [ %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)) 40007870: 80 a7 00 18 cmp %i4, %i0 40007874: 12 bf ff f6 bne 4000784c 40007878: ba 10 00 1c mov %i4, %i5 4000787c: 81 c7 e0 08 ret 40007880: 81 e8 00 00 restore =============================================================================== 40007884 : * 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) { 40007884: 9d e3 bf a0 save %sp, -96, %sp */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; 40007888: fa 06 00 00 ld [ %i0 ], %i5 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 4000788c: 84 06 20 04 add %i0, 4, %g2 if (rtems_chain_is_empty (chain)) 40007890: 80 a7 40 02 cmp %i5, %g2 40007894: 12 80 00 06 bne 400078ac 40007898: b0 10 20 02 mov 2, %i0 4000789c: 30 80 00 12 b,a 400078e4 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) { 400078a0: 80 a0 80 1d cmp %g2, %i5 <== NOT EXECUTED 400078a4: 02 80 00 12 be 400078ec <== NOT EXECUTED 400078a8: 01 00 00 00 nop <== NOT EXECUTED 400078ac: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 400078b0: 80 a0 40 19 cmp %g1, %i1 400078b4: 32 bf ff fb bne,a 400078a0 <== NEVER TAKEN 400078b8: fa 07 40 00 ld [ %i5 ], %i5 <== NOT EXECUTED 400078bc: 40 00 09 7a call 40009ea4 <_Chain_Extract> 400078c0: 90 10 00 1d mov %i5, %o0 if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 400078c4: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 current->aiocbp->return_value = -1; 400078c8: 84 10 3f ff mov -1, %g2 400078cc: c4 20 60 38 st %g2, [ %g1 + 0x38 ] if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 400078d0: 84 10 20 8c mov 0x8c, %g2 current->aiocbp->return_value = -1; free (current); 400078d4: 90 10 00 1d mov %i5, %o0 if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 400078d8: c4 20 60 34 st %g2, [ %g1 + 0x34 ] current->aiocbp->return_value = -1; free (current); 400078dc: 7f ff ee 88 call 400032fc 400078e0: b0 10 20 00 clr %i0 } return AIO_CANCELED; } 400078e4: 81 c7 e0 08 ret 400078e8: 81 e8 00 00 restore node = rtems_chain_next (node); current = (rtems_aio_request *) node; } if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; 400078ec: 81 c7 e0 08 ret <== NOT EXECUTED 400078f0: 91 e8 20 01 restore %g0, 1, %o0 <== NOT EXECUTED =============================================================================== 40007d10 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 40007d10: 9d e3 bf 98 save %sp, -104, %sp */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); 40007d14: 40 00 01 a1 call 40008398 <_Chain_Get> 40007d18: 90 10 00 18 mov %i0, %o0 while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( 40007d1c: 92 10 20 00 clr %o1 40007d20: ba 10 00 08 mov %o0, %i5 40007d24: 94 10 00 1a mov %i2, %o2 40007d28: 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 40007d2c: 80 a7 60 00 cmp %i5, 0 40007d30: 12 80 00 0a bne 40007d58 40007d34: 96 07 bf fc add %fp, -4, %o3 ) { rtems_event_set out; sc = rtems_event_receive( 40007d38: 7f ff fc df call 400070b4 40007d3c: 01 00 00 00 nop ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 40007d40: 80 a2 20 00 cmp %o0, 0 40007d44: 02 bf ff f4 be 40007d14 <== NEVER TAKEN 40007d48: 01 00 00 00 nop timeout, &out ); } *node_ptr = node; 40007d4c: fa 26 c0 00 st %i5, [ %i3 ] return sc; } 40007d50: 81 c7 e0 08 ret 40007d54: 91 e8 00 08 restore %g0, %o0, %o0 rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 40007d58: 90 10 20 00 clr %o0 timeout, &out ); } *node_ptr = node; 40007d5c: fa 26 c0 00 st %i5, [ %i3 ] return sc; } 40007d60: 81 c7 e0 08 ret 40007d64: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 400112b0 : rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { 400112b0: 9d e3 bf 98 save %sp, -104, %sp rtems_status_code sc; if ( event_out != NULL ) { 400112b4: 80 a6 e0 00 cmp %i3, 0 400112b8: 02 80 00 0a be 400112e0 <== NEVER TAKEN 400112bc: 82 10 20 09 mov 9, %g1 Thread_Control *executing = _Thread_Executing; 400112c0: 03 10 00 6d sethi %hi(0x4001b400), %g1 400112c4: fa 00 63 f0 ld [ %g1 + 0x3f0 ], %i5 ! 4001b7f0 <_Per_CPU_Information+0x10> RTEMS_API_Control *api = executing->API_Extensions[ THREAD_API_RTEMS ]; Event_Control *event = &api->System_event; if ( !_Event_sets_Is_empty( event_in ) ) { 400112c8: 80 a6 20 00 cmp %i0, 0 400112cc: 12 80 00 07 bne 400112e8 <== ALWAYS TAKEN 400112d0: da 07 61 4c ld [ %i5 + 0x14c ], %o5 ); _Thread_Enable_dispatch(); sc = executing->Wait.return_code; } else { *event_out = event->pending_events; 400112d4: c4 03 60 04 ld [ %o5 + 4 ], %g2 <== NOT EXECUTED sc = RTEMS_SUCCESSFUL; 400112d8: 82 10 20 00 clr %g1 <== NOT EXECUTED ); _Thread_Enable_dispatch(); sc = executing->Wait.return_code; } else { *event_out = event->pending_events; 400112dc: c4 26 c0 00 st %g2, [ %i3 ] <== NOT EXECUTED } else { sc = RTEMS_INVALID_ADDRESS; } return sc; } 400112e0: 81 c7 e0 08 ret <== NOT EXECUTED 400112e4: 91 e8 00 01 restore %g0, %g1, %o0 <== NOT EXECUTED * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 400112e8: 03 10 00 6c sethi %hi(0x4001b000), %g1 400112ec: c4 00 62 d0 ld [ %g1 + 0x2d0 ], %g2 ! 4001b2d0 <_Thread_Dispatch_disable_level> ++level; 400112f0: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 400112f4: c4 20 62 d0 st %g2, [ %g1 + 0x2d0 ] RTEMS_API_Control *api = executing->API_Extensions[ THREAD_API_RTEMS ]; Event_Control *event = &api->System_event; if ( !_Event_sets_Is_empty( event_in ) ) { _Thread_Disable_dispatch(); _Event_Seize( 400112f8: 03 00 01 00 sethi %hi(0x40000), %g1 400112fc: 90 10 00 18 mov %i0, %o0 40011300: 92 10 00 19 mov %i1, %o1 40011304: 94 10 00 1a mov %i2, %o2 40011308: 96 10 00 1b mov %i3, %o3 4001130c: 98 10 00 1d mov %i5, %o4 40011310: 9a 03 60 04 add %o5, 4, %o5 40011314: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 40011318: 03 10 00 6e sethi %hi(0x4001b800), %g1 4001131c: 82 10 63 e0 or %g1, 0x3e0, %g1 ! 4001bbe0 <_System_event_Sync_state> 40011320: 7f ff db 4f call 4000805c <_Event_Seize> 40011324: c2 23 a0 5c st %g1, [ %sp + 0x5c ] executing, event, &_System_event_Sync_state, STATES_WAITING_FOR_SYSTEM_EVENT ); _Thread_Enable_dispatch(); 40011328: 7f ff e7 5e call 4000b0a0 <_Thread_Enable_dispatch> 4001132c: 01 00 00 00 nop sc = executing->Wait.return_code; 40011330: c2 07 60 34 ld [ %i5 + 0x34 ], %g1 } else { sc = RTEMS_INVALID_ADDRESS; } return sc; } 40011334: 81 c7 e0 08 ret 40011338: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 40007574 : rtems_status_code rtems_event_system_send( rtems_id id, rtems_event_set event_in ) { 40007574: 9d e3 bf 98 save %sp, -104, %sp rtems_status_code sc; Thread_Control *thread; Objects_Locations location; RTEMS_API_Control *api; thread = _Thread_Get( id, &location ); 40007578: 90 10 00 18 mov %i0, %o0 4000757c: 40 00 0a 5f call 40009ef8 <_Thread_Get> 40007580: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 40007584: c2 07 bf fc ld [ %fp + -4 ], %g1 40007588: 80 a0 60 00 cmp %g1, 0 4000758c: 12 80 00 0d bne 400075c0 <== NEVER TAKEN 40007590: 92 10 00 19 mov %i1, %o1 case OBJECTS_LOCAL: api = thread->API_Extensions[ THREAD_API_RTEMS ]; _Event_Surrender( 40007594: d4 02 21 4c ld [ %o0 + 0x14c ], %o2 40007598: 94 02 a0 04 add %o2, 4, %o2 4000759c: 19 00 01 00 sethi %hi(0x40000), %o4 400075a0: 17 10 00 7d sethi %hi(0x4001f400), %o3 400075a4: 96 12 e3 d0 or %o3, 0x3d0, %o3 ! 4001f7d0 <_System_event_Sync_state> 400075a8: 7f ff fe 54 call 40006ef8 <_Event_Surrender> 400075ac: b0 10 20 00 clr %i0 event_in, &api->System_event, &_System_event_Sync_state, STATES_WAITING_FOR_SYSTEM_EVENT ); _Thread_Enable_dispatch(); 400075b0: 40 00 0a 46 call 40009ec8 <_Thread_Enable_dispatch> 400075b4: 01 00 00 00 nop sc = RTEMS_SUCCESSFUL; break; 400075b8: 81 c7 e0 08 ret 400075bc: 81 e8 00 00 restore sc = RTEMS_INVALID_ID; break; } return sc; } 400075c0: 81 c7 e0 08 ret <== NOT EXECUTED 400075c4: 91 e8 20 04 restore %g0, 4, %o0 <== NOT EXECUTED =============================================================================== 40008e6c : 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 ) { 40008e6c: 9d e3 bf a0 save %sp, -96, %sp rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) 40008e70: 03 10 00 6d sethi %hi(0x4001b400), %g1 40008e74: c4 00 63 e8 ld [ %g1 + 0x3e8 ], %g2 ! 4001b7e8 <_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 ) { 40008e78: ba 10 00 18 mov %i0, %i5 rtems_device_major_number major_limit = _IO_Number_of_drivers; 40008e7c: 03 10 00 6f sethi %hi(0x4001bc00), %g1 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 ) { 40008e80: 86 10 00 19 mov %i1, %g3 rtems_device_major_number major_limit = _IO_Number_of_drivers; 40008e84: c8 00 60 28 ld [ %g1 + 0x28 ], %g4 if ( rtems_interrupt_is_in_progress() ) 40008e88: 80 a0 a0 00 cmp %g2, 0 40008e8c: 12 80 00 1f bne 40008f08 40008e90: b0 10 20 12 mov 0x12, %i0 return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) 40008e94: 80 a6 a0 00 cmp %i2, 0 40008e98: 02 80 00 21 be 40008f1c 40008e9c: 80 a6 60 00 cmp %i1, 0 return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) 40008ea0: 02 80 00 1f be 40008f1c 40008ea4: 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; 40008ea8: c4 06 40 00 ld [ %i1 ], %g2 40008eac: 80 a0 a0 00 cmp %g2, 0 40008eb0: 22 80 00 18 be,a 40008f10 40008eb4: 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 ) 40008eb8: 80 a1 00 1d cmp %g4, %i5 40008ebc: 08 80 00 13 bleu 40008f08 40008ec0: b0 10 20 0a mov 0xa, %i0 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40008ec4: 05 10 00 6c sethi %hi(0x4001b000), %g2 40008ec8: c8 00 a2 d0 ld [ %g2 + 0x2d0 ], %g4 ! 4001b2d0 <_Thread_Dispatch_disable_level> ++level; 40008ecc: 88 01 20 01 inc %g4 _Thread_Dispatch_disable_level = level; 40008ed0: c8 20 a2 d0 st %g4, [ %g2 + 0x2d0 ] return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { 40008ed4: 80 a7 60 00 cmp %i5, 0 40008ed8: 02 80 00 13 be 40008f24 40008edc: 39 10 00 6f sethi %hi(0x4001bc00), %i4 _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; 40008ee0: c8 07 20 2c ld [ %i4 + 0x2c ], %g4 ! 4001bc2c <_IO_Driver_address_table> 40008ee4: 85 2f 60 03 sll %i5, 3, %g2 40008ee8: b7 2f 60 05 sll %i5, 5, %i3 40008eec: 82 26 c0 02 sub %i3, %g2, %g1 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; 40008ef0: f2 01 00 01 ld [ %g4 + %g1 ], %i1 40008ef4: 80 a6 60 00 cmp %i1, 0 40008ef8: 02 80 00 3a be 40008fe0 40008efc: 82 01 00 01 add %g4, %g1, %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(); 40008f00: 40 00 08 68 call 4000b0a0 <_Thread_Enable_dispatch> 40008f04: b0 10 20 0c mov 0xc, %i0 return RTEMS_RESOURCE_IN_USE; 40008f08: 81 c7 e0 08 ret 40008f0c: 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; 40008f10: 80 a0 a0 00 cmp %g2, 0 40008f14: 12 bf ff ea bne 40008ebc 40008f18: 80 a1 00 1d cmp %g4, %i5 if ( driver_table == NULL ) return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; 40008f1c: 81 c7 e0 08 ret 40008f20: 91 e8 20 09 restore %g0, 9, %o0 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; 40008f24: c8 00 60 28 ld [ %g1 + 0x28 ], %g4 rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { 40008f28: 80 a1 20 00 cmp %g4, 0 40008f2c: 02 80 00 33 be 40008ff8 <== NEVER TAKEN 40008f30: c2 07 20 2c ld [ %i4 + 0x2c ], %g1 40008f34: 30 80 00 04 b,a 40008f44 40008f38: 80 a7 40 04 cmp %i5, %g4 40008f3c: 02 80 00 24 be 40008fcc 40008f40: 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; 40008f44: c4 00 40 00 ld [ %g1 ], %g2 40008f48: 80 a0 a0 00 cmp %g2, 0 40008f4c: 32 bf ff fb bne,a 40008f38 40008f50: ba 07 60 01 inc %i5 40008f54: c4 00 60 04 ld [ %g1 + 4 ], %g2 40008f58: 80 a0 a0 00 cmp %g2, 0 40008f5c: 32 bf ff f7 bne,a 40008f38 40008f60: ba 07 60 01 inc %i5 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 40008f64: fa 26 80 00 st %i5, [ %i2 ] 40008f68: 85 2f 60 03 sll %i5, 3, %g2 if ( m != n ) 40008f6c: 80 a1 00 1d cmp %g4, %i5 40008f70: 02 80 00 18 be 40008fd0 <== NEVER TAKEN 40008f74: b7 2f 60 05 sll %i5, 5, %i3 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40008f78: c8 00 c0 00 ld [ %g3 ], %g4 40008f7c: c2 07 20 2c ld [ %i4 + 0x2c ], %g1 40008f80: 84 26 c0 02 sub %i3, %g2, %g2 40008f84: c8 20 40 02 st %g4, [ %g1 + %g2 ] 40008f88: c8 00 e0 04 ld [ %g3 + 4 ], %g4 40008f8c: 82 00 40 02 add %g1, %g2, %g1 40008f90: c8 20 60 04 st %g4, [ %g1 + 4 ] 40008f94: c4 00 e0 08 ld [ %g3 + 8 ], %g2 _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 40008f98: b2 10 20 00 clr %i1 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40008f9c: c4 20 60 08 st %g2, [ %g1 + 8 ] 40008fa0: c4 00 e0 0c ld [ %g3 + 0xc ], %g2 _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 40008fa4: b4 10 20 00 clr %i2 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40008fa8: c4 20 60 0c st %g2, [ %g1 + 0xc ] 40008fac: c4 00 e0 10 ld [ %g3 + 0x10 ], %g2 _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); 40008fb0: b0 10 00 1d mov %i5, %i0 } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; 40008fb4: c4 20 60 10 st %g2, [ %g1 + 0x10 ] 40008fb8: c4 00 e0 14 ld [ %g3 + 0x14 ], %g2 _Thread_Enable_dispatch(); 40008fbc: 40 00 08 39 call 4000b0a0 <_Thread_Enable_dispatch> 40008fc0: c4 20 60 14 st %g2, [ %g1 + 0x14 ] return rtems_io_initialize( major, 0, NULL ); 40008fc4: 40 00 21 e9 call 40011768 40008fc8: 81 e8 00 00 restore if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 40008fcc: fa 26 80 00 st %i5, [ %i2 ] if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); 40008fd0: 40 00 08 34 call 4000b0a0 <_Thread_Enable_dispatch> 40008fd4: b0 10 20 05 mov 5, %i0 return sc; 40008fd8: 81 c7 e0 08 ret 40008fdc: 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; 40008fe0: c2 00 60 04 ld [ %g1 + 4 ], %g1 40008fe4: 80 a0 60 00 cmp %g1, 0 40008fe8: 12 bf ff c6 bne 40008f00 40008fec: 01 00 00 00 nop if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; 40008ff0: 10 bf ff e2 b 40008f78 40008ff4: fa 26 80 00 st %i5, [ %i2 ] if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; 40008ff8: 10 bf ff f6 b 40008fd0 <== NOT EXECUTED 40008ffc: c0 26 80 00 clr [ %i2 ] <== NOT EXECUTED =============================================================================== 4000a160 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 4000a160: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 4000a164: 80 a6 20 00 cmp %i0, 0 4000a168: 02 80 00 20 be 4000a1e8 <== NEVER TAKEN 4000a16c: 37 10 00 86 sethi %hi(0x40021800), %i3 4000a170: b6 16 e2 58 or %i3, 0x258, %i3 ! 40021a58 <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 4000a174: b4 06 e0 0c add %i3, 0xc, %i2 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; 4000a178: c2 06 c0 00 ld [ %i3 ], %g1 4000a17c: f8 00 60 04 ld [ %g1 + 4 ], %i4 if ( !information ) 4000a180: 80 a7 20 00 cmp %i4, 0 4000a184: 22 80 00 16 be,a 4000a1dc 4000a188: b6 06 e0 04 add %i3, 4, %i3 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 4000a18c: c2 17 20 10 lduh [ %i4 + 0x10 ], %g1 4000a190: 86 90 60 00 orcc %g1, 0, %g3 4000a194: 22 80 00 12 be,a 4000a1dc 4000a198: b6 06 e0 04 add %i3, 4, %i3 4000a19c: ba 10 20 01 mov 1, %i5 the_thread = (Thread_Control *)information->local_table[ i ]; 4000a1a0: c4 07 20 1c ld [ %i4 + 0x1c ], %g2 4000a1a4: 83 2f 60 02 sll %i5, 2, %g1 4000a1a8: c2 00 80 01 ld [ %g2 + %g1 ], %g1 if ( !the_thread ) 4000a1ac: 90 90 60 00 orcc %g1, 0, %o0 4000a1b0: 02 80 00 05 be 4000a1c4 <== NEVER TAKEN 4000a1b4: ba 07 60 01 inc %i5 continue; (*routine)(the_thread); 4000a1b8: 9f c6 00 00 call %i0 4000a1bc: 01 00 00 00 nop 4000a1c0: c6 17 20 10 lduh [ %i4 + 0x10 ], %g3 information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 4000a1c4: 83 28 e0 10 sll %g3, 0x10, %g1 4000a1c8: 83 30 60 10 srl %g1, 0x10, %g1 4000a1cc: 80 a0 40 1d cmp %g1, %i5 4000a1d0: 3a bf ff f5 bcc,a 4000a1a4 4000a1d4: c4 07 20 1c ld [ %i4 + 0x1c ], %g2 4000a1d8: b6 06 e0 04 add %i3, 4, %i3 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 4000a1dc: 80 a6 c0 1a cmp %i3, %i2 4000a1e0: 32 bf ff e7 bne,a 4000a17c 4000a1e4: c2 06 c0 00 ld [ %i3 ], %g1 4000a1e8: 81 c7 e0 08 ret 4000a1ec: 81 e8 00 00 restore =============================================================================== 40008d68 : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { 40008d68: 9d e3 bf a0 save %sp, -96, %sp int i; /* * Validate parameters and look up information structure. */ if ( !info ) 40008d6c: 80 a6 a0 00 cmp %i2, 0 40008d70: 02 80 00 21 be 40008df4 40008d74: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); 40008d78: 93 2e 60 10 sll %i1, 0x10, %o1 40008d7c: 90 10 00 18 mov %i0, %o0 40008d80: 40 00 07 cc call 4000acb0 <_Objects_Get_information> 40008d84: 93 32 60 10 srl %o1, 0x10, %o1 if ( !obj_info ) 40008d88: 80 a2 20 00 cmp %o0, 0 40008d8c: 02 80 00 1a be 40008df4 40008d90: 82 10 20 0a mov 0xa, %g1 * Return information about this object class to the user. */ 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; 40008d94: 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; 40008d98: c6 02 20 08 ld [ %o0 + 8 ], %g3 info->maximum_id = obj_info->maximum_id; 40008d9c: c4 02 20 0c ld [ %o0 + 0xc ], %g2 info->auto_extend = obj_info->auto_extend; 40008da0: c2 0a 20 12 ldub [ %o0 + 0x12 ], %g1 return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; 40008da4: c6 26 80 00 st %g3, [ %i2 ] info->maximum_id = obj_info->maximum_id; 40008da8: c4 26 a0 04 st %g2, [ %i2 + 4 ] info->auto_extend = obj_info->auto_extend; 40008dac: c2 2e a0 0c stb %g1, [ %i2 + 0xc ] info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) 40008db0: 80 a1 20 00 cmp %g4, 0 40008db4: 02 80 00 12 be 40008dfc <== NEVER TAKEN 40008db8: c8 26 a0 08 st %g4, [ %i2 + 8 ] 40008dbc: fa 02 20 1c ld [ %o0 + 0x1c ], %i5 40008dc0: 86 10 20 01 mov 1, %g3 40008dc4: 82 10 20 01 mov 1, %g1 40008dc8: 84 10 20 00 clr %g2 if ( !obj_info->local_table[i] ) 40008dcc: 87 28 e0 02 sll %g3, 2, %g3 40008dd0: c6 07 40 03 ld [ %i5 + %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++ ) 40008dd4: 82 00 60 01 inc %g1 if ( !obj_info->local_table[i] ) unallocated++; 40008dd8: 80 a0 00 03 cmp %g0, %g3 40008ddc: 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++ ) 40008de0: 80 a1 00 01 cmp %g4, %g1 40008de4: 1a bf ff fa bcc 40008dcc 40008de8: 86 10 00 01 mov %g1, %g3 if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; 40008dec: c4 26 a0 10 st %g2, [ %i2 + 0x10 ] return RTEMS_SUCCESSFUL; 40008df0: 82 10 20 00 clr %g1 } 40008df4: 81 c7 e0 08 ret 40008df8: 91 e8 00 01 restore %g0, %g1, %o0 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++ ) 40008dfc: 84 10 20 00 clr %g2 <== NOT EXECUTED if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; return RTEMS_SUCCESSFUL; 40008e00: 82 10 20 00 clr %g1 <== NOT EXECUTED for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; 40008e04: 10 bf ff fc b 40008df4 <== NOT EXECUTED 40008e08: c4 26 a0 10 st %g2, [ %i2 + 0x10 ] <== NOT EXECUTED =============================================================================== 40008804 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 40008804: 9d e3 bf a0 save %sp, -96, %sp register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 40008808: 80 a6 20 00 cmp %i0, 0 4000880c: 12 80 00 04 bne 4000881c 40008810: 82 10 20 03 mov 3, %g1 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 40008814: 81 c7 e0 08 ret 40008818: 91 e8 00 01 restore %g0, %g1, %o0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !starting_address ) 4000881c: 80 a6 60 00 cmp %i1, 0 40008820: 02 bf ff fd be 40008814 40008824: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; if ( !id ) 40008828: 80 a7 60 00 cmp %i5, 0 4000882c: 02 bf ff fa be 40008814 <== NEVER TAKEN 40008830: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 40008834: 02 bf ff f8 be 40008814 40008838: 82 10 20 08 mov 8, %g1 4000883c: 80 a6 a0 00 cmp %i2, 0 40008840: 02 bf ff f5 be 40008814 40008844: 80 a6 80 1b cmp %i2, %i3 40008848: 0a bf ff f3 bcs 40008814 4000884c: 80 8e e0 07 btst 7, %i3 40008850: 12 bf ff f1 bne 40008814 40008854: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 40008858: 12 bf ff ef bne 40008814 4000885c: 82 10 20 09 mov 9, %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40008860: 03 10 00 8e sethi %hi(0x40023800), %g1 40008864: c4 00 60 c0 ld [ %g1 + 0xc0 ], %g2 ! 400238c0 <_Thread_Dispatch_disable_level> ++level; 40008868: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 4000886c: c4 20 60 c0 st %g2, [ %g1 + 0xc0 ] * 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 ); 40008870: 23 10 00 8d sethi %hi(0x40023400), %l1 40008874: 40 00 07 6f call 4000a630 <_Objects_Allocate> 40008878: 90 14 62 bc or %l1, 0x2bc, %o0 ! 400236bc <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 4000887c: a0 92 20 00 orcc %o0, 0, %l0 40008880: 02 80 00 1a be 400088e8 40008884: 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; 40008888: f8 24 20 1c st %i4, [ %l0 + 0x1c ] _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 4000888c: f2 24 20 10 st %i1, [ %l0 + 0x10 ] the_partition->length = length; 40008890: f4 24 20 14 st %i2, [ %l0 + 0x14 ] the_partition->buffer_size = buffer_size; 40008894: f6 24 20 18 st %i3, [ %l0 + 0x18 ] the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; 40008898: c0 24 20 20 clr [ %l0 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 4000889c: 40 00 47 d1 call 4001a7e0 <.udiv> 400088a0: 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, 400088a4: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 400088a8: 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, 400088ac: 96 10 00 1b mov %i3, %o3 400088b0: b8 04 20 24 add %l0, 0x24, %i4 400088b4: 40 00 04 a5 call 40009b48 <_Chain_Initialize> 400088b8: 90 10 00 1c mov %i4, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 400088bc: c4 14 20 0a lduh [ %l0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400088c0: a2 14 62 bc or %l1, 0x2bc, %l1 400088c4: c6 04 60 1c ld [ %l1 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 400088c8: c2 04 20 08 ld [ %l0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400088cc: 85 28 a0 02 sll %g2, 2, %g2 400088d0: e0 20 c0 02 st %l0, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 400088d4: f0 24 20 0c st %i0, [ %l0 + 0xc ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 400088d8: 40 00 0c a2 call 4000bb60 <_Thread_Enable_dispatch> 400088dc: c2 27 40 00 st %g1, [ %i5 ] return RTEMS_SUCCESSFUL; 400088e0: 10 bf ff cd b 40008814 400088e4: 82 10 20 00 clr %g1 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); 400088e8: 40 00 0c 9e call 4000bb60 <_Thread_Enable_dispatch> 400088ec: 01 00 00 00 nop return RTEMS_TOO_MANY; 400088f0: 10 bf ff c9 b 40008814 400088f4: 82 10 20 05 mov 5, %g1 ! 5 =============================================================================== 40014fdc : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { 40014fdc: 9d e3 bf 98 save %sp, -104, %sp RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get ( Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) 40014fe0: 11 10 00 f4 sethi %hi(0x4003d000), %o0 40014fe4: 92 10 00 18 mov %i0, %o1 40014fe8: 90 12 22 64 or %o0, 0x264, %o0 40014fec: 40 00 15 26 call 4001a484 <_Objects_Get> 40014ff0: 94 07 bf fc add %fp, -4, %o2 register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { 40014ff4: c2 07 bf fc ld [ %fp + -4 ], %g1 40014ff8: 80 a0 60 00 cmp %g1, 0 40014ffc: 12 80 00 19 bne 40015060 40015000: ba 10 00 08 mov %o0, %i5 ) { void *starting; void *ending; starting = the_partition->starting_address; 40015004: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 40015008: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 4001500c: 82 02 00 01 add %o0, %g1, %g1 ending = _Addresses_Add_offset( starting, the_partition->length ); return ( _Addresses_Is_in_range( the_buffer, starting, ending ) && 40015010: 80 a6 40 01 cmp %i1, %g1 40015014: 18 80 00 15 bgu 40015068 <== NEVER TAKEN 40015018: 80 a6 40 08 cmp %i1, %o0 4001501c: 0a 80 00 13 bcs 40015068 40015020: 01 00 00 00 nop offset = (uint32_t) _Addresses_Subtract( the_buffer, the_partition->starting_address ); return ((offset % the_partition->buffer_size) == 0); 40015024: d2 07 60 18 ld [ %i5 + 0x18 ], %o1 40015028: 40 00 5a e1 call 4002bbac <.urem> 4001502c: 90 26 40 08 sub %i1, %o0, %o0 starting = the_partition->starting_address; ending = _Addresses_Add_offset( starting, the_partition->length ); return ( _Addresses_Is_in_range( the_buffer, starting, ending ) && 40015030: 80 a2 20 00 cmp %o0, 0 40015034: 12 80 00 0d bne 40015068 40015038: 90 07 60 24 add %i5, 0x24, %o0 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); 4001503c: 40 00 0d 11 call 40018480 <_Chain_Append> 40015040: 92 10 00 19 mov %i1, %o1 case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; 40015044: c2 07 60 20 ld [ %i5 + 0x20 ], %g1 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 40015048: b0 10 20 00 clr %i0 switch ( location ) { case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; 4001504c: 82 00 7f ff add %g1, -1, %g1 _Thread_Enable_dispatch(); 40015050: 40 00 18 f0 call 4001b410 <_Thread_Enable_dispatch> 40015054: c2 27 60 20 st %g1, [ %i5 + 0x20 ] 40015058: 81 c7 e0 08 ret 4001505c: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 40015060: 81 c7 e0 08 ret 40015064: 91 e8 20 04 restore %g0, 4, %o0 _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); 40015068: 40 00 18 ea call 4001b410 <_Thread_Enable_dispatch> 4001506c: b0 10 20 09 mov 9, %i0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40015070: 81 c7 e0 08 ret 40015074: 81 e8 00 00 restore =============================================================================== 40037900 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 40037900: 9d e3 bf 98 save %sp, -104, %sp 40037904: 11 10 01 a3 sethi %hi(0x40068c00), %o0 40037908: 92 10 00 18 mov %i0, %o1 4003790c: 90 12 23 78 or %o0, 0x378, %o0 40037910: 7f ff 44 18 call 40008970 <_Objects_Get> 40037914: 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 ) { 40037918: c2 07 bf fc ld [ %fp + -4 ], %g1 4003791c: 80 a0 60 00 cmp %g1, 0 40037920: 12 80 00 0d bne 40037954 40037924: ba 10 00 08 mov %o0, %i5 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 40037928: 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 ); 4003792c: 39 10 01 a2 sethi %hi(0x40068800), %i4 40037930: b8 17 21 b0 or %i4, 0x1b0, %i4 ! 400689b0 <_Per_CPU_Information> 40037934: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 40037938: 80 a0 80 01 cmp %g2, %g1 4003793c: 02 80 00 08 be 4003795c 40037940: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 40037944: 7f ff 47 c2 call 4000984c <_Thread_Enable_dispatch> 40037948: b0 10 20 17 mov 0x17, %i0 4003794c: 81 c7 e0 08 ret 40037950: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40037954: 81 c7 e0 08 ret 40037958: 91 e8 20 04 restore %g0, 4, %o0 if ( !_Thread_Is_executing( the_period->owner ) ) { _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { 4003795c: 12 80 00 0e bne 40037994 40037960: 01 00 00 00 nop switch ( the_period->state ) { 40037964: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 40037968: 80 a0 60 04 cmp %g1, 4 4003796c: 18 80 00 06 bgu 40037984 <== NEVER TAKEN 40037970: b0 10 20 00 clr %i0 40037974: 83 28 60 02 sll %g1, 2, %g1 40037978: 05 10 01 88 sethi %hi(0x40062000), %g2 4003797c: 84 10 a3 50 or %g2, 0x350, %g2 ! 40062350 40037980: f0 00 80 01 ld [ %g2 + %g1 ], %i0 id, NULL ); _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 40037984: 7f ff 47 b2 call 4000984c <_Thread_Enable_dispatch> 40037988: 01 00 00 00 nop 4003798c: 81 c7 e0 08 ret 40037990: 81 e8 00 00 restore } _Thread_Enable_dispatch(); return( return_value ); } _ISR_Disable( level ); 40037994: 7f ff 29 38 call 40001e74 40037998: 01 00 00 00 nop 4003799c: b4 10 00 08 mov %o0, %i2 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 400379a0: f6 07 60 38 ld [ %i5 + 0x38 ], %i3 400379a4: 80 a6 e0 00 cmp %i3, 0 400379a8: 02 80 00 1c be 40037a18 400379ac: 80 a6 e0 02 cmp %i3, 2 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 400379b0: 02 80 00 2e be 40037a68 400379b4: 80 a6 e0 04 cmp %i3, 4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 400379b8: 12 bf ff e5 bne 4003794c <== NEVER TAKEN 400379bc: b0 10 20 04 mov 4, %i0 /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 400379c0: 7f ff ff 5e call 40037738 <_Rate_monotonic_Update_statistics> 400379c4: 90 10 00 1d mov %i5, %o0 _ISR_Enable( level ); 400379c8: 7f ff 29 2f call 40001e84 400379cc: 90 10 00 1a mov %i2, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 400379d0: 82 10 20 02 mov 2, %g1 400379d4: 92 07 60 10 add %i5, 0x10, %o1 400379d8: c2 27 60 38 st %g1, [ %i5 + 0x38 ] the_period->next_length = length; 400379dc: f2 27 60 3c st %i1, [ %i5 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 400379e0: f2 27 60 1c st %i1, [ %i5 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 400379e4: 11 10 01 a1 sethi %hi(0x40068400), %o0 400379e8: 7f ff 4a d5 call 4000a53c <_Watchdog_Insert> 400379ec: 90 12 21 38 or %o0, 0x138, %o0 ! 40068538 <_Watchdog_Ticks_chain> 400379f0: d0 07 60 40 ld [ %i5 + 0x40 ], %o0 400379f4: d2 07 60 3c ld [ %i5 + 0x3c ], %o1 400379f8: 03 10 01 90 sethi %hi(0x40064000), %g1 400379fc: c2 00 62 14 ld [ %g1 + 0x214 ], %g1 ! 40064214 <_Scheduler+0x34> 40037a00: 9f c0 40 00 call %g1 40037a04: b0 10 20 06 mov 6, %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Scheduler_Release_job(the_period->owner, the_period->next_length); _Thread_Enable_dispatch(); 40037a08: 7f ff 47 91 call 4000984c <_Thread_Enable_dispatch> 40037a0c: 01 00 00 00 nop 40037a10: 81 c7 e0 08 ret 40037a14: 81 e8 00 00 restore return( return_value ); } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { _ISR_Enable( level ); 40037a18: 7f ff 29 1b call 40001e84 40037a1c: 01 00 00 00 nop the_period->next_length = length; /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 40037a20: 90 10 00 1d mov %i5, %o0 40037a24: 7f ff ff 94 call 40037874 <_Rate_monotonic_Initiate_statistics> 40037a28: f2 27 60 3c st %i1, [ %i5 + 0x3c ] the_period->state = RATE_MONOTONIC_ACTIVE; 40037a2c: 82 10 20 02 mov 2, %g1 40037a30: c2 27 60 38 st %g1, [ %i5 + 0x38 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40037a34: 03 10 00 de sethi %hi(0x40037800), %g1 40037a38: 82 10 62 dc or %g1, 0x2dc, %g1 ! 40037adc <_Rate_monotonic_Timeout> the_watchdog->id = id; 40037a3c: f0 27 60 30 st %i0, [ %i5 + 0x30 ] ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40037a40: 92 07 60 10 add %i5, 0x10, %o1 40037a44: 11 10 01 a1 sethi %hi(0x40068400), %o0 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40037a48: c0 27 60 18 clr [ %i5 + 0x18 ] ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40037a4c: 90 12 21 38 or %o0, 0x138, %o0 ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 40037a50: c0 27 60 34 clr [ %i5 + 0x34 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40037a54: c2 27 60 2c st %g1, [ %i5 + 0x2c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40037a58: f2 27 60 1c st %i1, [ %i5 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40037a5c: 7f ff 4a b8 call 4000a53c <_Watchdog_Insert> 40037a60: b0 10 20 00 clr %i0 40037a64: 30 bf ff c8 b,a 40037984 if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 40037a68: 7f ff ff 34 call 40037738 <_Rate_monotonic_Update_statistics> 40037a6c: 90 10 00 1d mov %i5, %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; 40037a70: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 40037a74: f2 27 60 3c st %i1, [ %i5 + 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; 40037a78: c2 27 60 38 st %g1, [ %i5 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 40037a7c: 7f ff 29 02 call 40001e84 40037a80: 90 10 00 1a mov %i2, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 40037a84: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 40037a88: c4 07 60 08 ld [ %i5 + 8 ], %g2 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 40037a8c: 90 10 00 01 mov %g1, %o0 40037a90: 13 00 00 10 sethi %hi(0x4000), %o1 40037a94: 7f ff 49 be call 4000a18c <_Thread_Set_state> 40037a98: c4 20 60 20 st %g2, [ %g1 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 40037a9c: 7f ff 28 f6 call 40001e74 40037aa0: 01 00 00 00 nop local_state = the_period->state; 40037aa4: f4 07 60 38 ld [ %i5 + 0x38 ], %i2 the_period->state = RATE_MONOTONIC_ACTIVE; 40037aa8: f6 27 60 38 st %i3, [ %i5 + 0x38 ] _ISR_Enable( level ); 40037aac: 7f ff 28 f6 call 40001e84 40037ab0: 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 ) 40037ab4: 80 a6 a0 03 cmp %i2, 3 40037ab8: 22 80 00 06 be,a 40037ad0 40037abc: d0 07 20 10 ld [ %i4 + 0x10 ], %o0 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); 40037ac0: 7f ff 47 63 call 4000984c <_Thread_Enable_dispatch> 40037ac4: b0 10 20 00 clr %i0 40037ac8: 81 c7 e0 08 ret 40037acc: 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 ); 40037ad0: 7f ff 46 72 call 40009498 <_Thread_Clear_state> 40037ad4: 13 00 00 10 sethi %hi(0x4000), %o1 40037ad8: 30 bf ff fa b,a 40037ac0 =============================================================================== 40029380 : void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 40029380: 9d e3 bf 38 save %sp, -200, %sp rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) 40029384: 80 a6 60 00 cmp %i1, 0 40029388: 02 80 00 48 be 400294a8 <== NEVER TAKEN 4002938c: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 40029390: 13 10 01 7d sethi %hi(0x4005f400), %o1 40029394: 9f c6 40 00 call %i1 40029398: 92 12 62 30 or %o1, 0x230, %o1 ! 4005f630 <_TOD_Days_per_month+0x68> #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 4002939c: 90 10 00 18 mov %i0, %o0 400293a0: 13 10 01 7d sethi %hi(0x4005f400), %o1 400293a4: 9f c6 40 00 call %i1 400293a8: 92 12 62 50 or %o1, 0x250, %o1 ! 4005f650 <_TOD_Days_per_month+0x88> (*print)( context, "--- Wall times are in seconds ---\n" ); 400293ac: 90 10 00 18 mov %i0, %o0 400293b0: 13 10 01 7d sethi %hi(0x4005f400), %o1 400293b4: 9f c6 40 00 call %i1 400293b8: 92 12 62 78 or %o1, 0x278, %o1 ! 4005f678 <_TOD_Days_per_month+0xb0> Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 400293bc: 90 10 00 18 mov %i0, %o0 400293c0: 13 10 01 7d sethi %hi(0x4005f400), %o1 400293c4: 9f c6 40 00 call %i1 400293c8: 92 12 62 a0 or %o1, 0x2a0, %o1 ! 4005f6a0 <_TOD_Days_per_month+0xd8> #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 400293cc: 90 10 00 18 mov %i0, %o0 400293d0: 13 10 01 7d sethi %hi(0x4005f400), %o1 400293d4: 9f c6 40 00 call %i1 400293d8: 92 12 62 f0 or %o1, 0x2f0, %o1 ! 4005f6f0 <_TOD_Days_per_month+0x128> /* * 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 ; 400293dc: 39 10 01 a3 sethi %hi(0x40068c00), %i4 400293e0: b8 17 23 78 or %i4, 0x378, %i4 ! 40068f78 <_Rate_monotonic_Information> 400293e4: fa 07 20 08 ld [ %i4 + 8 ], %i5 400293e8: c2 07 20 0c ld [ %i4 + 0xc ], %g1 400293ec: 80 a7 40 01 cmp %i5, %g1 400293f0: 18 80 00 2e bgu 400294a8 <== NEVER TAKEN 400293f4: 35 10 01 7d sethi %hi(0x4005f400), %i2 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, 400293f8: 27 10 01 7d sethi %hi(0x4005f400), %l3 struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, 400293fc: 25 10 01 7d sethi %hi(0x4005f400), %l2 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 40029400: 37 10 01 83 sethi %hi(0x40060c00), %i3 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, 40029404: b4 16 a3 40 or %i2, 0x340, %i2 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, 40029408: a6 14 e3 58 or %l3, 0x358, %l3 struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, 4002940c: a4 14 a3 78 or %l2, 0x378, %l2 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 40029410: 10 80 00 06 b 40029428 40029414: b6 16 e0 00 mov %i3, %i3 * 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++ ) { 40029418: ba 07 60 01 inc %i5 /* * 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 ; 4002941c: 80 a0 40 1d cmp %g1, %i5 40029420: 0a 80 00 22 bcs 400294a8 40029424: 01 00 00 00 nop id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 40029428: 90 10 00 1d mov %i5, %o0 4002942c: 40 00 37 df call 400373a8 40029430: 92 07 bf c8 add %fp, -56, %o1 if ( status != RTEMS_SUCCESSFUL ) 40029434: 80 a2 20 00 cmp %o0, 0 40029438: 32 bf ff f8 bne,a 40029418 4002943c: c2 07 20 0c ld [ %i4 + 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 ); 40029440: 92 07 bf b0 add %fp, -80, %o1 40029444: 40 00 38 4b call 40037570 40029448: 90 10 00 1d mov %i5, %o0 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 4002944c: d0 07 bf b0 ld [ %fp + -80 ], %o0 40029450: 94 07 bf a0 add %fp, -96, %o2 40029454: 7f ff 97 6e call 4000f20c 40029458: 92 10 20 05 mov 5, %o1 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 4002945c: d8 1f bf c8 ldd [ %fp + -56 ], %o4 40029460: 92 10 00 1a mov %i2, %o1 40029464: 94 10 00 1d mov %i5, %o2 40029468: 90 10 00 18 mov %i0, %o0 4002946c: 9f c6 40 00 call %i1 40029470: 96 07 bf a0 add %fp, -96, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 40029474: c2 07 bf c8 ld [ %fp + -56 ], %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 ); 40029478: 94 07 bf a8 add %fp, -88, %o2 4002947c: 90 07 bf e0 add %fp, -32, %o0 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 40029480: 80 a0 60 00 cmp %g1, 0 40029484: 12 80 00 0b bne 400294b0 40029488: 92 10 00 1b mov %i3, %o1 (*print)( context, "\n" ); 4002948c: 9f c6 40 00 call %i1 40029490: 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 ; 40029494: c2 07 20 0c ld [ %i4 + 0xc ], %g1 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 40029498: ba 07 60 01 inc %i5 /* * 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 ; 4002949c: 80 a0 40 1d cmp %g1, %i5 400294a0: 1a bf ff e3 bcc 4002942c <== ALWAYS TAKEN 400294a4: 90 10 00 1d mov %i5, %o0 400294a8: 81 c7 e0 08 ret 400294ac: 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 ); 400294b0: 40 00 03 5e call 4002a228 <_Timespec_Divide_by_integer> 400294b4: 92 10 00 01 mov %g1, %o1 (*print)( context, 400294b8: d0 07 bf d4 ld [ %fp + -44 ], %o0 400294bc: 40 00 ae e2 call 40055044 <.div> 400294c0: 92 10 23 e8 mov 0x3e8, %o1 400294c4: aa 10 00 08 mov %o0, %l5 400294c8: d0 07 bf dc ld [ %fp + -36 ], %o0 400294cc: 40 00 ae de call 40055044 <.div> 400294d0: 92 10 23 e8 mov 0x3e8, %o1 400294d4: c2 07 bf a8 ld [ %fp + -88 ], %g1 400294d8: a2 10 00 08 mov %o0, %l1 400294dc: d0 07 bf ac ld [ %fp + -84 ], %o0 400294e0: e0 07 bf d0 ld [ %fp + -48 ], %l0 400294e4: e8 07 bf d8 ld [ %fp + -40 ], %l4 400294e8: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 400294ec: 40 00 ae d6 call 40055044 <.div> 400294f0: 92 10 23 e8 mov 0x3e8, %o1 400294f4: 96 10 00 15 mov %l5, %o3 400294f8: 98 10 00 14 mov %l4, %o4 400294fc: 9a 10 00 11 mov %l1, %o5 40029500: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40029504: 92 10 00 13 mov %l3, %o1 40029508: 94 10 00 10 mov %l0, %o2 4002950c: 9f c6 40 00 call %i1 40029510: 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); 40029514: d2 07 bf c8 ld [ %fp + -56 ], %o1 40029518: 94 07 bf a8 add %fp, -88, %o2 4002951c: 40 00 03 43 call 4002a228 <_Timespec_Divide_by_integer> 40029520: 90 07 bf f8 add %fp, -8, %o0 (*print)( context, 40029524: d0 07 bf ec ld [ %fp + -20 ], %o0 40029528: 40 00 ae c7 call 40055044 <.div> 4002952c: 92 10 23 e8 mov 0x3e8, %o1 40029530: a8 10 00 08 mov %o0, %l4 40029534: d0 07 bf f4 ld [ %fp + -12 ], %o0 40029538: 40 00 ae c3 call 40055044 <.div> 4002953c: 92 10 23 e8 mov 0x3e8, %o1 40029540: c2 07 bf a8 ld [ %fp + -88 ], %g1 40029544: a0 10 00 08 mov %o0, %l0 40029548: d0 07 bf ac ld [ %fp + -84 ], %o0 4002954c: ea 07 bf e8 ld [ %fp + -24 ], %l5 40029550: e2 07 bf f0 ld [ %fp + -16 ], %l1 40029554: 92 10 23 e8 mov 0x3e8, %o1 40029558: 40 00 ae bb call 40055044 <.div> 4002955c: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 40029560: 92 10 00 12 mov %l2, %o1 40029564: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 40029568: 94 10 00 15 mov %l5, %o2 4002956c: 90 10 00 18 mov %i0, %o0 40029570: 96 10 00 14 mov %l4, %o3 40029574: 98 10 00 11 mov %l1, %o4 40029578: 9f c6 40 00 call %i1 4002957c: 9a 10 00 10 mov %l0, %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 ; 40029580: 10 bf ff a6 b 40029418 40029584: c2 07 20 0c ld [ %i4 + 0xc ], %g1 =============================================================================== 400295a0 : /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { 400295a0: 9d e3 bf a0 save %sp, -96, %sp * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 400295a4: 03 10 01 a1 sethi %hi(0x40068400), %g1 400295a8: c4 00 60 a0 ld [ %g1 + 0xa0 ], %g2 ! 400684a0 <_Thread_Dispatch_disable_level> ++level; 400295ac: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 400295b0: c4 20 60 a0 st %g2, [ %g1 + 0xa0 ] /* * 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 ; 400295b4: 39 10 01 a3 sethi %hi(0x40068c00), %i4 400295b8: b8 17 23 78 or %i4, 0x378, %i4 ! 40068f78 <_Rate_monotonic_Information> 400295bc: fa 07 20 08 ld [ %i4 + 8 ], %i5 400295c0: c2 07 20 0c ld [ %i4 + 0xc ], %g1 400295c4: 80 a7 40 01 cmp %i5, %g1 400295c8: 18 80 00 09 bgu 400295ec <== NEVER TAKEN 400295cc: 01 00 00 00 nop id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); 400295d0: 40 00 00 09 call 400295f4 400295d4: 90 10 00 1d mov %i5, %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 ; 400295d8: c2 07 20 0c ld [ %i4 + 0xc ], %g1 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 400295dc: ba 07 60 01 inc %i5 /* * 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 ; 400295e0: 80 a0 40 1d cmp %g1, %i5 400295e4: 1a bf ff fb bcc 400295d0 400295e8: 01 00 00 00 nop } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); 400295ec: 7f ff 80 98 call 4000984c <_Thread_Enable_dispatch> 400295f0: 81 e8 00 00 restore =============================================================================== 400082f4 : return big_enough; } void *rtems_rbheap_allocate(rtems_rbheap_control *control, size_t size) { 400082f4: 9d e3 bf a0 save %sp, -96, %sp void *ptr = NULL; rtems_chain_control *free_chain = &control->free_chunk_chain; rtems_rbtree_control *chunk_tree = &control->chunk_tree; uintptr_t alignment = control->alignment; 400082f8: fa 06 20 30 ld [ %i0 + 0x30 ], %i5 #include static uintptr_t align_up(uintptr_t alignment, uintptr_t value) { uintptr_t excess = value % alignment; 400082fc: 90 10 00 19 mov %i1, %o0 40008300: 40 00 2f 87 call 4001411c <.urem> 40008304: 92 10 00 1d mov %i5, %o1 if (excess > 0) { 40008308: 80 a2 20 00 cmp %o0, 0 4000830c: 02 80 00 26 be 400083a4 <== ALWAYS TAKEN 40008310: b6 10 00 19 mov %i1, %i3 value += alignment - excess; 40008314: ba 06 40 1d add %i1, %i5, %i5 <== NOT EXECUTED 40008318: b6 27 40 08 sub %i5, %o0, %i3 <== NOT EXECUTED 4000831c: 80 a6 c0 19 cmp %i3, %i1 <== NOT EXECUTED 40008320: 82 60 3f ff subx %g0, -1, %g1 <== NOT EXECUTED rtems_chain_control *free_chain = &control->free_chunk_chain; rtems_rbtree_control *chunk_tree = &control->chunk_tree; uintptr_t alignment = control->alignment; uintptr_t aligned_size = align_up(alignment, size); if (size > 0 && size <= aligned_size) { 40008324: 80 88 60 ff btst 0xff, %g1 40008328: 02 80 00 1d be 4000839c <== NEVER TAKEN 4000832c: 80 a6 60 00 cmp %i1, 0 40008330: 02 80 00 1b be 4000839c 40008334: 82 06 20 04 add %i0, 4, %g1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; 40008338: fa 06 00 00 ld [ %i0 ], %i5 { rtems_chain_node *current = rtems_chain_first(free_chain); const rtems_chain_node *tail = rtems_chain_tail(free_chain); rtems_rbheap_chunk *big_enough = NULL; while (current != tail && big_enough == NULL) { 4000833c: 80 a7 40 01 cmp %i5, %g1 40008340: 02 80 00 17 be 4000839c 40008344: 01 00 00 00 nop rtems_rbheap_chunk *free_chunk = (rtems_rbheap_chunk *) current; if (free_chunk->size >= size) { 40008348: f8 07 60 1c ld [ %i5 + 0x1c ], %i4 4000834c: 80 a6 c0 1c cmp %i3, %i4 40008350: 38 80 00 10 bgu,a 40008390 40008354: fa 07 40 00 ld [ %i5 ], %i5 uintptr_t aligned_size = align_up(alignment, size); if (size > 0 && size <= aligned_size) { rtems_rbheap_chunk *free_chunk = search_free_chunk(free_chain, aligned_size); if (free_chunk != NULL) { 40008358: 80 a7 60 00 cmp %i5, 0 4000835c: 02 80 00 10 be 4000839c <== NEVER TAKEN 40008360: 80 a7 00 1b cmp %i4, %i3 uintptr_t free_size = free_chunk->size; if (free_size > aligned_size) { 40008364: 18 80 00 12 bgu 400083ac 40008368: 01 00 00 00 nop ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 4000836c: c4 07 40 00 ld [ %i5 ], %g2 previous = the_node->previous; 40008370: c2 07 60 04 ld [ %i5 + 4 ], %g1 ptr = (void *) new_chunk->begin; } } else { rtems_chain_extract_unprotected(&free_chunk->chain_node); rtems_chain_set_off_chain(&free_chunk->chain_node); ptr = (void *) free_chunk->begin; 40008374: f0 07 60 18 ld [ %i5 + 0x18 ], %i0 next->previous = previous; 40008378: c2 20 a0 04 st %g1, [ %g2 + 4 ] previous->next = next; 4000837c: c4 20 40 00 st %g2, [ %g1 ] */ RTEMS_INLINE_ROUTINE void _Chain_Set_off_chain( Chain_Node *node ) { node->next = node->previous = NULL; 40008380: c0 27 60 04 clr [ %i5 + 4 ] 40008384: c0 27 40 00 clr [ %i5 ] } } } return ptr; } 40008388: 81 c7 e0 08 ret 4000838c: 81 e8 00 00 restore { rtems_chain_node *current = rtems_chain_first(free_chain); const rtems_chain_node *tail = rtems_chain_tail(free_chain); rtems_rbheap_chunk *big_enough = NULL; while (current != tail && big_enough == NULL) { 40008390: 80 a0 40 1d cmp %g1, %i5 40008394: 32 bf ff ee bne,a 4000834c <== NEVER TAKEN 40008398: f8 07 60 1c ld [ %i5 + 0x1c ], %i4 <== NOT EXECUTED return big_enough; } void *rtems_rbheap_allocate(rtems_rbheap_control *control, size_t size) { void *ptr = NULL; 4000839c: 81 c7 e0 08 ret 400083a0: 91 e8 20 00 restore %g0, 0, %o0 static uintptr_t align_up(uintptr_t alignment, uintptr_t value) { uintptr_t excess = value % alignment; if (excess > 0) { 400083a4: 10 bf ff e0 b 40008324 400083a8: 82 10 20 01 mov 1, %g1 if (free_chunk != NULL) { uintptr_t free_size = free_chunk->size; if (free_size > aligned_size) { rtems_rbheap_chunk *new_chunk = get_chunk(control); 400083ac: 7f ff ff 46 call 400080c4 400083b0: 90 10 00 18 mov %i0, %o0 if (new_chunk != NULL) { 400083b4: b4 92 20 00 orcc %o0, 0, %i2 400083b8: 02 bf ff f9 be 4000839c <== NEVER TAKEN 400083bc: b8 27 00 1b sub %i4, %i3, %i4 uintptr_t new_free_size = free_size - aligned_size; free_chunk->size = new_free_size; new_chunk->begin = free_chunk->begin + new_free_size; 400083c0: c2 07 60 18 ld [ %i5 + 0x18 ], %g1 rtems_rbheap_chunk *new_chunk = get_chunk(control); if (new_chunk != NULL) { uintptr_t new_free_size = free_size - aligned_size; free_chunk->size = new_free_size; 400083c4: f8 27 60 1c st %i4, [ %i5 + 0x1c ] new_chunk->begin = free_chunk->begin + new_free_size; new_chunk->size = aligned_size; 400083c8: f6 26 a0 1c st %i3, [ %i2 + 0x1c ] if (new_chunk != NULL) { uintptr_t new_free_size = free_size - aligned_size; free_chunk->size = new_free_size; new_chunk->begin = free_chunk->begin + new_free_size; 400083cc: b8 07 00 01 add %i4, %g1, %i4 400083d0: c0 26 a0 04 clr [ %i2 + 4 ] 400083d4: f8 26 a0 18 st %i4, [ %i2 + 0x18 ] 400083d8: c0 26 80 00 clr [ %i2 ] static void insert_into_tree( rtems_rbtree_control *tree, rtems_rbheap_chunk *chunk ) { _RBTree_Insert_unprotected(tree, &chunk->tree_node); 400083dc: 90 06 20 18 add %i0, 0x18, %o0 400083e0: 40 00 06 fd call 40009fd4 <_RBTree_Insert_unprotected> 400083e4: 92 06 a0 08 add %i2, 8, %o1 free_chunk->size = new_free_size; new_chunk->begin = free_chunk->begin + new_free_size; new_chunk->size = aligned_size; rtems_chain_set_off_chain(&new_chunk->chain_node); insert_into_tree(chunk_tree, new_chunk); ptr = (void *) new_chunk->begin; 400083e8: f0 06 a0 18 ld [ %i2 + 0x18 ], %i0 400083ec: 81 c7 e0 08 ret 400083f0: 81 e8 00 00 restore =============================================================================== 40008538 : /* Do nothing */ } void rtems_rbheap_extend_descriptors_with_malloc(rtems_rbheap_control *control) { 40008538: 9d e3 bf a0 save %sp, -96, %sp <== NOT EXECUTED rtems_rbheap_chunk *chunk = malloc(sizeof(*chunk)); 4000853c: 7f ff ec de call 400038b4 <== NOT EXECUTED 40008540: 90 10 20 20 mov 0x20, %o0 <== NOT EXECUTED if (chunk != NULL) { 40008544: 80 a2 20 00 cmp %o0, 0 <== NOT EXECUTED 40008548: 02 80 00 07 be 40008564 <== NOT EXECUTED 4000854c: 84 06 20 0c add %i0, 0xc, %g2 <== NOT EXECUTED ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 40008550: c2 06 20 0c ld [ %i0 + 0xc ], %g1 <== NOT EXECUTED after_node->next = the_node; 40008554: d0 26 20 0c st %o0, [ %i0 + 0xc ] <== NOT EXECUTED Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 40008558: c4 22 20 04 st %g2, [ %o0 + 4 ] <== NOT EXECUTED before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; 4000855c: c2 22 00 00 st %g1, [ %o0 ] <== NOT EXECUTED before_node->previous = the_node; 40008560: d0 20 60 04 st %o0, [ %g1 + 4 ] <== NOT EXECUTED 40008564: 81 c7 e0 08 ret <== NOT EXECUTED 40008568: 81 e8 00 00 restore <== NOT EXECUTED =============================================================================== 400083f4 : _RBTree_Extract_unprotected(chunk_tree, &b->tree_node); } } rtems_status_code rtems_rbheap_free(rtems_rbheap_control *control, void *ptr) { 400083f4: 9d e3 bf 80 save %sp, -128, %sp 400083f8: b4 10 00 18 mov %i0, %i2 rtems_status_code sc = RTEMS_SUCCESSFUL; if (ptr != NULL) { 400083fc: 80 a6 60 00 cmp %i1, 0 40008400: 02 80 00 2a be 400084a8 40008404: b0 10 20 00 clr %i0 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Find_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { RBTree_Node* iter_node = the_rbtree->root; 40008408: fa 06 a0 1c ld [ %i2 + 0x1c ], %i5 #define NULL_PAGE rtems_rbheap_chunk_of_node(NULL) static rtems_rbheap_chunk *find(rtems_rbtree_control *chunk_tree, uintptr_t key) { rtems_rbheap_chunk chunk = { .begin = key }; 4000840c: c0 27 bf fc clr [ %fp + -4 ] 40008410: c0 27 bf e0 clr [ %fp + -32 ] 40008414: c0 27 bf e4 clr [ %fp + -28 ] 40008418: c0 27 bf e8 clr [ %fp + -24 ] 4000841c: c0 27 bf ec clr [ %fp + -20 ] 40008420: c0 27 bf f0 clr [ %fp + -16 ] 40008424: c0 27 bf f4 clr [ %fp + -12 ] 40008428: f2 27 bf f8 st %i1, [ %fp + -8 ] RBTree_Node* found = NULL; int compare_result; while (iter_node) { 4000842c: 80 a7 60 00 cmp %i5, 0 40008430: 02 80 00 3e be 40008528 <== NEVER TAKEN 40008434: b8 06 a0 18 add %i2, 0x18, %i4 40008438: b6 10 20 00 clr %i3 compare_result = the_rbtree->compare_function(the_node, iter_node); 4000843c: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 40008440: 92 10 00 1d mov %i5, %o1 40008444: 9f c0 40 00 call %g1 40008448: 90 07 bf e8 add %fp, -24, %o0 RTEMS_INLINE_ROUTINE bool _RBTree_Is_greater( int compare_result ) { return compare_result > 0; 4000844c: 83 3a 20 1f sra %o0, 0x1f, %g1 RBTree_Node* iter_node = the_rbtree->root; RBTree_Node* found = NULL; int compare_result; while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); if ( _RBTree_Is_equal( compare_result ) ) { 40008450: 80 a2 20 00 cmp %o0, 0 RTEMS_INLINE_ROUTINE bool _RBTree_Is_greater( int compare_result ) { return compare_result > 0; 40008454: 82 20 40 08 sub %g1, %o0, %g1 40008458: 83 30 60 1f srl %g1, 0x1f, %g1 break; } RBTree_Direction dir = (RBTree_Direction) _RBTree_Is_greater( compare_result ); iter_node = iter_node->child[dir]; 4000845c: 83 28 60 02 sll %g1, 2, %g1 RBTree_Node* iter_node = the_rbtree->root; RBTree_Node* found = NULL; int compare_result; while (iter_node) { compare_result = the_rbtree->compare_function(the_node, iter_node); if ( _RBTree_Is_equal( compare_result ) ) { 40008460: 12 80 00 06 bne 40008478 40008464: 82 07 40 01 add %i5, %g1, %g1 found = iter_node; if ( the_rbtree->is_unique ) 40008468: c4 0f 20 14 ldub [ %i4 + 0x14 ], %g2 4000846c: 80 a0 a0 00 cmp %g2, 0 40008470: 12 80 00 10 bne 400084b0 <== ALWAYS TAKEN 40008474: b6 10 00 1d mov %i5, %i3 break; } RBTree_Direction dir = (RBTree_Direction) _RBTree_Is_greater( compare_result ); iter_node = iter_node->child[dir]; 40008478: fa 00 60 04 ld [ %g1 + 4 ], %i5 ) { RBTree_Node* iter_node = the_rbtree->root; RBTree_Node* found = NULL; int compare_result; while (iter_node) { 4000847c: 80 a7 60 00 cmp %i5, 0 40008480: 32 bf ff f0 bne,a 40008440 40008484: c2 07 20 10 ld [ %i4 + 0x10 ], %g1 return rtems_rbheap_chunk_of_node( 40008488: ba 06 ff f8 add %i3, -8, %i5 if (ptr != NULL) { rtems_chain_control *free_chain = &control->free_chunk_chain; rtems_rbtree_control *chunk_tree = &control->chunk_tree; rtems_rbheap_chunk *chunk = find(chunk_tree, (uintptr_t) ptr); if (chunk != NULL_PAGE) { 4000848c: 80 a7 7f f8 cmp %i5, -8 40008490: 02 80 00 06 be 400084a8 40008494: b0 10 20 04 mov 4, %i0 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_node_off_chain( const Chain_Node *node ) { return (node->next == NULL) && (node->previous == NULL); 40008498: c2 06 ff f8 ld [ %i3 + -8 ], %g1 4000849c: 80 a0 60 00 cmp %g1, 0 400084a0: 02 80 00 06 be 400084b8 400084a4: b0 10 20 0e mov 0xe, %i0 sc = RTEMS_INVALID_ID; } } return sc; } 400084a8: 81 c7 e0 08 ret 400084ac: 81 e8 00 00 restore static rtems_rbheap_chunk *find(rtems_rbtree_control *chunk_tree, uintptr_t key) { rtems_rbheap_chunk chunk = { .begin = key }; return rtems_rbheap_chunk_of_node( 400084b0: 10 bf ff f7 b 4000848c 400084b4: ba 06 ff f8 add %i3, -8, %i5 400084b8: c2 06 ff fc ld [ %i3 + -4 ], %g1 400084bc: 80 a0 60 00 cmp %g1, 0 400084c0: 12 bf ff fa bne 400084a8 <== NEVER TAKEN 400084c4: 92 10 20 00 clr %o1 static rtems_rbheap_chunk *get_next( const rtems_rbheap_chunk *chunk, RBTree_Direction dir ) { return rtems_rbheap_chunk_of_node( 400084c8: 40 00 07 92 call 4000a310 <_RBTree_Next_unprotected> 400084cc: 90 10 00 1b mov %i3, %o0 400084d0: 92 10 20 01 mov 1, %o1 400084d4: b2 10 00 08 mov %o0, %i1 400084d8: 40 00 07 8e call 4000a310 <_RBTree_Next_unprotected> 400084dc: 90 10 00 1b mov %i3, %o0 if (chunk != NULL_PAGE) { if (!rtems_rbheap_is_chunk_free(chunk)) { rtems_rbheap_chunk *pred = get_next(chunk, RBT_LEFT); rtems_rbheap_chunk *succ = get_next(chunk, RBT_RIGHT); check_and_merge(free_chain, chunk_tree, chunk, succ); 400084e0: 92 10 00 1c mov %i4, %o1 static rtems_rbheap_chunk *get_next( const rtems_rbheap_chunk *chunk, RBTree_Direction dir ) { return rtems_rbheap_chunk_of_node( 400084e4: 96 02 3f f8 add %o0, -8, %o3 if (chunk != NULL_PAGE) { if (!rtems_rbheap_is_chunk_free(chunk)) { rtems_rbheap_chunk *pred = get_next(chunk, RBT_LEFT); rtems_rbheap_chunk *succ = get_next(chunk, RBT_RIGHT); check_and_merge(free_chain, chunk_tree, chunk, succ); 400084e8: 94 10 00 1d mov %i5, %o2 400084ec: 7f ff ff 10 call 4000812c 400084f0: 90 10 00 1a mov %i2, %o0 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 400084f4: c2 06 80 00 ld [ %i2 ], %g1 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 400084f8: f4 26 ff fc st %i2, [ %i3 + -4 ] before_node = after_node->next; after_node->next = the_node; 400084fc: fa 26 80 00 st %i5, [ %i2 ] the_node->next = before_node; 40008500: c2 26 ff f8 st %g1, [ %i3 + -8 ] before_node->previous = the_node; 40008504: fa 20 60 04 st %i5, [ %g1 + 4 ] add_to_chain(free_chain, chunk); check_and_merge(free_chain, chunk_tree, chunk, pred); 40008508: 90 10 00 1a mov %i2, %o0 4000850c: 92 10 00 1c mov %i4, %o1 40008510: 94 10 00 1d mov %i5, %o2 40008514: 96 06 7f f8 add %i1, -8, %o3 40008518: 7f ff ff 05 call 4000812c 4000851c: b0 10 20 00 clr %i0 40008520: 81 c7 e0 08 ret 40008524: 81 e8 00 00 restore sc = RTEMS_INVALID_ID; } } return sc; } 40008528: 81 c7 e0 08 ret <== NOT EXECUTED 4000852c: 91 e8 20 04 restore %g0, 4, %o0 <== NOT EXECUTED =============================================================================== 400081c4 : uintptr_t area_size, uintptr_t alignment, rtems_rbheap_extend_descriptors extend_descriptors, void *handler_arg ) { 400081c4: 9d e3 bf a0 save %sp, -96, %sp rtems_status_code sc = RTEMS_SUCCESSFUL; if (alignment > 0) { 400081c8: 80 a6 e0 00 cmp %i3, 0 400081cc: 12 80 00 04 bne 400081dc 400081d0: 82 10 20 0a mov 0xa, %g1 } else { sc = RTEMS_INVALID_NUMBER; } return sc; } 400081d4: 81 c7 e0 08 ret 400081d8: 91 e8 00 01 restore %g0, %g1, %o0 #include static uintptr_t align_up(uintptr_t alignment, uintptr_t value) { uintptr_t excess = value % alignment; 400081dc: 90 10 00 19 mov %i1, %o0 400081e0: 92 10 00 1b mov %i3, %o1 400081e4: 40 00 2f ce call 4001411c <.urem> 400081e8: b4 06 40 1a add %i1, %i2, %i2 if (excess > 0) { 400081ec: 80 a2 20 00 cmp %o0, 0 400081f0: 32 80 00 09 bne,a 40008214 400081f4: a0 06 40 1b add %i1, %i3, %l0 400081f8: 82 10 20 01 mov 1, %g1 uintptr_t begin = (uintptr_t) area_begin; uintptr_t end = begin + area_size; uintptr_t aligned_begin = align_up(alignment, begin); uintptr_t aligned_end = align_down(alignment, end); if (begin < end && begin <= aligned_begin && aligned_begin < aligned_end) { 400081fc: 80 88 60 ff btst 0xff, %g1 40008200: 12 80 00 0b bne 4000822c <== ALWAYS TAKEN 40008204: a0 10 00 19 mov %i1, %l0 insert_into_tree(chunk_tree, first); } else { sc = RTEMS_NO_MEMORY; } } else { sc = RTEMS_INVALID_ADDRESS; 40008208: 82 10 20 09 mov 9, %g1 <== NOT EXECUTED } else { sc = RTEMS_INVALID_NUMBER; } return sc; } 4000820c: 81 c7 e0 08 ret 40008210: 91 e8 00 01 restore %g0, %g1, %o0 static uintptr_t align_up(uintptr_t alignment, uintptr_t value) { uintptr_t excess = value % alignment; if (excess > 0) { value += alignment - excess; 40008214: a0 24 00 08 sub %l0, %o0, %l0 40008218: 80 a4 00 19 cmp %l0, %i1 4000821c: 82 60 3f ff subx %g0, -1, %g1 uintptr_t begin = (uintptr_t) area_begin; uintptr_t end = begin + area_size; uintptr_t aligned_begin = align_up(alignment, begin); uintptr_t aligned_end = align_down(alignment, end); if (begin < end && begin <= aligned_begin && aligned_begin < aligned_end) { 40008220: 80 88 60 ff btst 0xff, %g1 40008224: 02 bf ff fa be 4000820c 40008228: 82 10 20 09 mov 9, %g1 4000822c: 80 a6 40 1a cmp %i1, %i2 40008230: 1a bf ff f7 bcc 4000820c 40008234: 82 10 20 09 mov 9, %g1 return value; } static uintptr_t align_down(uintptr_t alignment, uintptr_t value) { uintptr_t excess = value % alignment; 40008238: 90 10 00 1a mov %i2, %o0 4000823c: 40 00 2f b8 call 4001411c <.urem> 40008240: 92 10 00 1b mov %i3, %o1 return value - excess; 40008244: b4 26 80 08 sub %i2, %o0, %i2 uintptr_t begin = (uintptr_t) area_begin; uintptr_t end = begin + area_size; uintptr_t aligned_begin = align_up(alignment, begin); uintptr_t aligned_end = align_down(alignment, end); if (begin < end && begin <= aligned_begin && aligned_begin < aligned_end) { 40008248: 80 a4 00 1a cmp %l0, %i2 4000824c: 1a bf ff e2 bcc 400081d4 40008250: 82 10 20 09 mov 9, %g1 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 ); 40008254: 82 06 20 04 add %i0, 4, %g1 head->next = tail; 40008258: c2 26 00 00 st %g1, [ %i0 ] 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 ); 4000825c: 82 06 20 0c add %i0, 0xc, %g1 head->next = tail; head->previous = NULL; tail->previous = head; 40008260: c2 26 20 14 st %g1, [ %i0 + 0x14 ] the_rbtree->permanent_null = NULL; the_rbtree->root = NULL; the_rbtree->first[0] = NULL; the_rbtree->first[1] = NULL; the_rbtree->compare_function = compare_function; the_rbtree->is_unique = is_unique; 40008264: 82 10 20 01 mov 1, %g1 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 ); 40008268: 84 06 20 10 add %i0, 0x10, %g2 4000826c: c2 2e 20 2c stb %g1, [ %i0 + 0x2c ] { the_rbtree->permanent_null = NULL; the_rbtree->root = NULL; the_rbtree->first[0] = NULL; the_rbtree->first[1] = NULL; the_rbtree->compare_function = compare_function; 40008270: 03 10 00 20 sethi %hi(0x40008000), %g1 40008274: 82 10 60 b4 or %g1, 0xb4, %g1 ! 400080b4 head->next = tail; head->previous = NULL; 40008278: c0 26 20 04 clr [ %i0 + 4 ] 4000827c: c2 26 20 28 st %g1, [ %i0 + 0x28 ] tail->previous = head; 40008280: f0 26 20 08 st %i0, [ %i0 + 8 ] { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 40008284: c0 26 20 10 clr [ %i0 + 0x10 ] ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 40008288: c4 26 20 0c st %g2, [ %i0 + 0xc ] RBTree_Control *the_rbtree, RBTree_Compare_function compare_function, bool is_unique ) { the_rbtree->permanent_null = NULL; 4000828c: c0 26 20 18 clr [ %i0 + 0x18 ] the_rbtree->root = NULL; 40008290: c0 26 20 1c clr [ %i0 + 0x1c ] the_rbtree->first[0] = NULL; 40008294: c0 26 20 20 clr [ %i0 + 0x20 ] the_rbtree->first[1] = NULL; 40008298: c0 26 20 24 clr [ %i0 + 0x24 ] rtems_rbheap_chunk *first = NULL; rtems_chain_initialize_empty(free_chain); rtems_chain_initialize_empty(&control->spare_descriptor_chain); rtems_rbtree_initialize_empty(chunk_tree, chunk_compare, true); control->alignment = alignment; 4000829c: f6 26 20 30 st %i3, [ %i0 + 0x30 ] control->handler_arg = handler_arg; 400082a0: fa 26 20 38 st %i5, [ %i0 + 0x38 ] control->extend_descriptors = extend_descriptors; 400082a4: f8 26 20 34 st %i4, [ %i0 + 0x34 ] first = get_chunk(control); 400082a8: 7f ff ff 87 call 400080c4 400082ac: 90 10 00 18 mov %i0, %o0 first->begin = aligned_begin; first->size = aligned_end - aligned_begin; add_to_chain(free_chain, first); insert_into_tree(chunk_tree, first); } else { sc = RTEMS_NO_MEMORY; 400082b0: 82 10 20 1a mov 0x1a, %g1 control->alignment = alignment; control->handler_arg = handler_arg; control->extend_descriptors = extend_descriptors; first = get_chunk(control); if (first != NULL) { 400082b4: 80 a2 20 00 cmp %o0, 0 400082b8: 02 bf ff c7 be 400081d4 400082bc: 92 10 00 08 mov %o0, %o1 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 400082c0: c2 06 00 00 ld [ %i0 ], %g1 first->begin = aligned_begin; first->size = aligned_end - aligned_begin; 400082c4: b4 26 80 10 sub %i2, %l0, %i2 control->handler_arg = handler_arg; control->extend_descriptors = extend_descriptors; first = get_chunk(control); if (first != NULL) { first->begin = aligned_begin; 400082c8: e0 22 20 18 st %l0, [ %o0 + 0x18 ] first->size = aligned_end - aligned_begin; 400082cc: f4 22 20 1c st %i2, [ %o0 + 0x1c ] Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 400082d0: f0 22 20 04 st %i0, [ %o0 + 4 ] before_node = after_node->next; after_node->next = the_node; 400082d4: d0 26 00 00 st %o0, [ %i0 ] the_node->next = before_node; 400082d8: c2 22 00 00 st %g1, [ %o0 ] before_node->previous = the_node; 400082dc: d0 20 60 04 st %o0, [ %g1 + 4 ] static void insert_into_tree( rtems_rbtree_control *tree, rtems_rbheap_chunk *chunk ) { _RBTree_Insert_unprotected(tree, &chunk->tree_node); 400082e0: 92 02 60 08 add %o1, 8, %o1 400082e4: 40 00 07 3c call 40009fd4 <_RBTree_Insert_unprotected> 400082e8: 90 06 20 18 add %i0, 0x18, %o0 uintptr_t alignment, rtems_rbheap_extend_descriptors extend_descriptors, void *handler_arg ) { rtems_status_code sc = RTEMS_SUCCESSFUL; 400082ec: 10 bf ff ba b 400081d4 400082f0: 82 10 20 00 clr %g1 =============================================================================== 40016590 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 40016590: 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 ) 40016594: 80 a6 60 00 cmp %i1, 0 40016598: 12 80 00 04 bne 400165a8 4001659c: 82 10 20 0a mov 0xa, %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400165a0: 81 c7 e0 08 ret 400165a4: 91 e8 00 01 restore %g0, %g1, %o0 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 400165a8: 90 10 00 18 mov %i0, %o0 400165ac: 40 00 13 a5 call 4001b440 <_Thread_Get> 400165b0: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 400165b4: c2 07 bf fc ld [ %fp + -4 ], %g1 400165b8: 80 a0 60 00 cmp %g1, 0 400165bc: 12 80 00 20 bne 4001663c 400165c0: b8 10 00 08 mov %o0, %i4 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 400165c4: fa 02 21 4c ld [ %o0 + 0x14c ], %i5 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 400165c8: c2 07 60 0c ld [ %i5 + 0xc ], %g1 400165cc: 80 a0 60 00 cmp %g1, 0 400165d0: 02 80 00 1e be 40016648 400165d4: 01 00 00 00 nop if ( asr->is_enabled ) { 400165d8: c2 0f 60 08 ldub [ %i5 + 8 ], %g1 400165dc: 80 a0 60 00 cmp %g1, 0 400165e0: 02 80 00 1e be 40016658 400165e4: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 400165e8: 7f ff e2 ea call 4000f190 400165ec: 01 00 00 00 nop *signal_set |= signals; 400165f0: c2 07 60 14 ld [ %i5 + 0x14 ], %g1 400165f4: b2 10 40 19 or %g1, %i1, %i1 400165f8: f2 27 60 14 st %i1, [ %i5 + 0x14 ] _ISR_Enable( _level ); 400165fc: 7f ff e2 e9 call 4000f1a0 40016600: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 40016604: 03 10 00 f6 sethi %hi(0x4003d800), %g1 40016608: 82 10 61 90 or %g1, 0x190, %g1 ! 4003d990 <_Per_CPU_Information> 4001660c: c4 00 60 08 ld [ %g1 + 8 ], %g2 40016610: 80 a0 a0 00 cmp %g2, 0 40016614: 02 80 00 06 be 4001662c 40016618: 01 00 00 00 nop 4001661c: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 40016620: 80 a7 00 02 cmp %i4, %g2 40016624: 02 80 00 15 be 40016678 <== ALWAYS TAKEN 40016628: 84 10 20 01 mov 1, %g2 _Thread_Dispatch_necessary = true; } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 4001662c: 40 00 13 79 call 4001b410 <_Thread_Enable_dispatch> 40016630: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 40016634: 10 bf ff db b 400165a0 40016638: 82 10 20 00 clr %g1 ! 0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 4001663c: 82 10 20 04 mov 4, %g1 } 40016640: 81 c7 e0 08 ret 40016644: 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(); 40016648: 40 00 13 72 call 4001b410 <_Thread_Enable_dispatch> 4001664c: 01 00 00 00 nop return RTEMS_NOT_DEFINED; 40016650: 10 bf ff d4 b 400165a0 40016654: 82 10 20 0b mov 0xb, %g1 ! b rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 40016658: 7f ff e2 ce call 4000f190 4001665c: 01 00 00 00 nop *signal_set |= signals; 40016660: c2 07 60 18 ld [ %i5 + 0x18 ], %g1 40016664: b2 10 40 19 or %g1, %i1, %i1 40016668: f2 27 60 18 st %i1, [ %i5 + 0x18 ] _ISR_Enable( _level ); 4001666c: 7f ff e2 cd call 4000f1a0 40016670: 01 00 00 00 nop 40016674: 30 bf ff ee b,a 4001662c if ( ! _ASR_Is_null_handler( asr->handler ) ) { if ( asr->is_enabled ) { _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; 40016678: c4 28 60 0c stb %g2, [ %g1 + 0xc ] 4001667c: 30 bf ff ec b,a 4001662c =============================================================================== 4001133c : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 4001133c: 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 ) 40011340: 80 a6 a0 00 cmp %i2, 0 40011344: 02 80 00 3b be 40011430 40011348: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 4001134c: 21 10 00 6d sethi %hi(0x4001b400), %l0 40011350: a0 14 23 e0 or %l0, 0x3e0, %l0 ! 4001b7e0 <_Per_CPU_Information> 40011354: fa 04 20 10 ld [ %l0 + 0x10 ], %i5 api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 40011358: c4 0f 60 70 ldub [ %i5 + 0x70 ], %g2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4001135c: c2 07 60 78 ld [ %i5 + 0x78 ], %g1 executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 40011360: 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 ]; 40011364: f8 07 61 4c ld [ %i5 + 0x14c ], %i4 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 40011368: b6 60 3f ff subx %g0, -1, %i3 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 4001136c: 80 a0 60 00 cmp %g1, 0 40011370: 12 80 00 40 bne 40011470 40011374: b7 2e e0 08 sll %i3, 8, %i3 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 40011378: c2 0f 20 08 ldub [ %i4 + 8 ], %g1 4001137c: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 40011380: 7f ff eb e1 call 4000c304 <_CPU_ISR_Get_level> 40011384: a2 60 3f ff subx %g0, -1, %l1 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; 40011388: a3 2c 60 0a sll %l1, 0xa, %l1 4001138c: 90 14 40 08 or %l1, %o0, %o0 old_mode |= _ISR_Get_level(); 40011390: b6 12 00 1b or %o0, %i3, %i3 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 40011394: 80 8e 61 00 btst 0x100, %i1 40011398: 02 80 00 06 be 400113b0 4001139c: f6 26 80 00 st %i3, [ %i2 ] */ RTEMS_INLINE_ROUTINE bool _Modes_Is_preempt ( Modes_Control mode_set ) { return (mode_set & RTEMS_PREEMPT_MASK) == RTEMS_PREEMPT; 400113a0: 83 36 20 08 srl %i0, 8, %g1 400113a4: 82 18 60 01 xor %g1, 1, %g1 400113a8: 82 08 60 01 and %g1, 1, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 400113ac: c2 2f 60 70 stb %g1, [ %i5 + 0x70 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 400113b0: 80 8e 62 00 btst 0x200, %i1 400113b4: 12 80 00 21 bne 40011438 400113b8: 80 8e 22 00 btst 0x200, %i0 } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 400113bc: 80 8e 60 0f btst 0xf, %i1 400113c0: 12 80 00 27 bne 4001145c 400113c4: 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 ) { 400113c8: 80 8e 64 00 btst 0x400, %i1 400113cc: 02 80 00 14 be 4001141c 400113d0: 86 10 20 00 clr %g3 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 400113d4: c2 0f 20 08 ldub [ %i4 + 8 ], %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; 400113d8: b1 36 20 0a srl %i0, 0xa, %i0 400113dc: b0 1e 20 01 xor %i0, 1, %i0 400113e0: b0 0e 20 01 and %i0, 1, %i0 if ( is_asr_enabled != asr->is_enabled ) { 400113e4: 80 a6 00 01 cmp %i0, %g1 400113e8: 22 80 00 0e be,a 40011420 400113ec: 03 10 00 6d sethi %hi(0x4001b400), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 400113f0: 7f ff c5 17 call 4000284c 400113f4: f0 2f 20 08 stb %i0, [ %i4 + 8 ] _signals = information->signals_pending; 400113f8: c4 07 20 18 ld [ %i4 + 0x18 ], %g2 information->signals_pending = information->signals_posted; 400113fc: c2 07 20 14 ld [ %i4 + 0x14 ], %g1 information->signals_posted = _signals; 40011400: c4 27 20 14 st %g2, [ %i4 + 0x14 ] rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; 40011404: c2 27 20 18 st %g1, [ %i4 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 40011408: 7f ff c5 15 call 4000285c 4001140c: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 40011410: c2 07 20 14 ld [ %i4 + 0x14 ], %g1 40011414: 80 a0 00 01 cmp %g0, %g1 40011418: 86 40 20 00 addx %g0, 0, %g3 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 4001141c: 03 10 00 6d sethi %hi(0x4001b400), %g1 40011420: c4 00 63 d8 ld [ %g1 + 0x3d8 ], %g2 ! 4001b7d8 <_System_state_Current> 40011424: 80 a0 a0 03 cmp %g2, 3 40011428: 02 80 00 1f be 400114a4 4001142c: 82 10 20 00 clr %g1 if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; } 40011430: 81 c7 e0 08 ret 40011434: 91 e8 00 01 restore %g0, %g1, %o0 */ 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) ) { 40011438: 22 bf ff e1 be,a 400113bc 4001143c: c0 27 60 78 clr [ %i5 + 0x78 ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 40011440: 03 10 00 6c sethi %hi(0x4001b000), %g1 40011444: c2 00 62 30 ld [ %g1 + 0x230 ], %g1 ! 4001b230 <_Thread_Ticks_per_timeslice> } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 40011448: 80 8e 60 0f btst 0xf, %i1 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; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 4001144c: c2 27 60 74 st %g1, [ %i5 + 0x74 ] 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; 40011450: 82 10 20 01 mov 1, %g1 } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 40011454: 02 bf ff dd be 400113c8 40011458: c2 27 60 78 st %g1, [ %i5 + 0x78 ] */ RTEMS_INLINE_ROUTINE ISR_Level _Modes_Get_interrupt_level ( Modes_Control mode_set ) { return ( mode_set & RTEMS_INTERRUPT_MASK ); 4001145c: 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 ) ); 40011460: 7f ff c4 ff call 4000285c 40011464: 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 ) { 40011468: 10 bf ff d9 b 400113cc 4001146c: 80 8e 64 00 btst 0x400, %i1 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; 40011470: c2 0f 20 08 ldub [ %i4 + 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; 40011474: b6 16 e2 00 or %i3, 0x200, %i3 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 40011478: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 4001147c: 7f ff eb a2 call 4000c304 <_CPU_ISR_Get_level> 40011480: a2 60 3f ff subx %g0, -1, %l1 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; 40011484: a3 2c 60 0a sll %l1, 0xa, %l1 40011488: 90 14 40 08 or %l1, %o0, %o0 old_mode |= _ISR_Get_level(); 4001148c: b6 12 00 1b or %o0, %i3, %i3 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 40011490: 80 8e 61 00 btst 0x100, %i1 40011494: 02 bf ff c7 be 400113b0 40011498: f6 26 80 00 st %i3, [ %i2 ] */ RTEMS_INLINE_ROUTINE bool _Modes_Is_preempt ( Modes_Control mode_set ) { return (mode_set & RTEMS_PREEMPT_MASK) == RTEMS_PREEMPT; 4001149c: 10 bf ff c2 b 400113a4 400114a0: 83 36 20 08 srl %i0, 8, %g1 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || 400114a4: 80 88 e0 ff btst 0xff, %g3 400114a8: 12 80 00 0a bne 400114d0 400114ac: c4 04 20 10 ld [ %l0 + 0x10 ], %g2 400114b0: c6 04 20 14 ld [ %l0 + 0x14 ], %g3 400114b4: 80 a0 80 03 cmp %g2, %g3 400114b8: 02 bf ff de be 40011430 400114bc: 01 00 00 00 nop (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 400114c0: c4 08 a0 70 ldub [ %g2 + 0x70 ], %g2 400114c4: 80 a0 a0 00 cmp %g2, 0 400114c8: 02 bf ff da be 40011430 <== NEVER TAKEN 400114cc: 01 00 00 00 nop _Thread_Dispatch_necessary = true; 400114d0: 82 10 20 01 mov 1, %g1 ! 1 400114d4: c2 2c 20 0c stb %g1, [ %l0 + 0xc ] } } if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 400114d8: 40 00 02 95 call 40011f2c <_Thread_Dispatch> 400114dc: 01 00 00 00 nop } return RTEMS_SUCCESSFUL; 400114e0: 82 10 20 00 clr %g1 ! 0 } 400114e4: 81 c7 e0 08 ret 400114e8: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 4000bd44 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 4000bd44: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 4000bd48: 80 a6 60 00 cmp %i1, 0 4000bd4c: 02 80 00 08 be 4000bd6c 4000bd50: 80 a6 a0 00 cmp %i2, 0 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 ) ); 4000bd54: 03 10 00 6a sethi %hi(0x4001a800), %g1 4000bd58: c4 08 61 9c ldub [ %g1 + 0x19c ], %g2 ! 4001a99c */ RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && 4000bd5c: 80 a6 40 02 cmp %i1, %g2 4000bd60: 18 80 00 1e bgu 4000bdd8 4000bd64: 82 10 20 13 mov 0x13, %g1 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 4000bd68: 80 a6 a0 00 cmp %i2, 0 4000bd6c: 02 80 00 1b be 4000bdd8 4000bd70: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 4000bd74: 90 10 00 18 mov %i0, %o0 4000bd78: 40 00 0a 22 call 4000e600 <_Thread_Get> 4000bd7c: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 4000bd80: c2 07 bf fc ld [ %fp + -4 ], %g1 4000bd84: 80 a0 60 00 cmp %g1, 0 4000bd88: 12 80 00 16 bne 4000bde0 4000bd8c: 82 10 20 04 mov 4, %g1 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 4000bd90: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 4000bd94: 80 a6 60 00 cmp %i1, 0 4000bd98: 02 80 00 0d be 4000bdcc 4000bd9c: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 4000bda0: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 4000bda4: 80 a0 60 00 cmp %g1, 0 4000bda8: 02 80 00 06 be 4000bdc0 4000bdac: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 4000bdb0: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 4000bdb4: 80 a6 40 01 cmp %i1, %g1 4000bdb8: 1a 80 00 05 bcc 4000bdcc <== ALWAYS TAKEN 4000bdbc: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 4000bdc0: 92 10 00 19 mov %i1, %o1 4000bdc4: 40 00 08 c9 call 4000e0e8 <_Thread_Change_priority> 4000bdc8: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 4000bdcc: 40 00 0a 01 call 4000e5d0 <_Thread_Enable_dispatch> 4000bdd0: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 4000bdd4: 82 10 20 00 clr %g1 ! 0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4000bdd8: 81 c7 e0 08 ret 4000bddc: 91 e8 00 01 restore %g0, %g1, %o0 4000bde0: 81 c7 e0 08 ret 4000bde4: 91 e8 00 01 restore %g0, %g1, %o0 =============================================================================== 40006148 : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { 40006148: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) 4000614c: 80 a6 60 00 cmp %i1, 0 40006150: 02 80 00 1e be 400061c8 40006154: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); 40006158: 90 10 00 18 mov %i0, %o0 4000615c: 40 00 08 b1 call 40008420 <_Thread_Get> 40006160: 92 07 bf fc add %fp, -4, %o1 switch (location) { 40006164: c2 07 bf fc ld [ %fp + -4 ], %g1 40006168: 80 a0 60 00 cmp %g1, 0 4000616c: 12 80 00 19 bne 400061d0 40006170: 82 10 20 04 mov 4, %g1 case OBJECTS_LOCAL: tvp = the_thread->task_variables; 40006174: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 while (tvp) { 40006178: 80 a0 60 00 cmp %g1, 0 4000617c: 02 80 00 10 be 400061bc 40006180: 01 00 00 00 nop if (tvp->ptr == ptr) { 40006184: c4 00 60 04 ld [ %g1 + 4 ], %g2 40006188: 80 a0 80 19 cmp %g2, %i1 4000618c: 32 80 00 09 bne,a 400061b0 40006190: d2 00 40 00 ld [ %g1 ], %o1 if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 40006194: 10 80 00 18 b 400061f4 40006198: c4 00 40 00 ld [ %g1 ], %g2 switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { 4000619c: 80 a0 80 19 cmp %g2, %i1 400061a0: 22 80 00 0e be,a 400061d8 400061a4: c4 02 40 00 ld [ %o1 ], %g2 400061a8: 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; 400061ac: 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) { 400061b0: 80 a2 60 00 cmp %o1, 0 400061b4: 32 bf ff fa bne,a 4000619c <== ALWAYS TAKEN 400061b8: c4 02 60 04 ld [ %o1 + 4 ], %g2 return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 400061bc: 40 00 08 8d call 400083f0 <_Thread_Enable_dispatch> 400061c0: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; 400061c4: 82 10 20 09 mov 9, %g1 ! 9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400061c8: 81 c7 e0 08 ret 400061cc: 91 e8 00 01 restore %g0, %g1, %o0 400061d0: 81 c7 e0 08 ret 400061d4: 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; 400061d8: 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 ); 400061dc: 40 00 00 2e call 40006294 <_RTEMS_Tasks_Invoke_task_variable_dtor> 400061e0: 01 00 00 00 nop _Thread_Enable_dispatch(); 400061e4: 40 00 08 83 call 400083f0 <_Thread_Enable_dispatch> 400061e8: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 400061ec: 10 bf ff f7 b 400061c8 400061f0: 82 10 20 00 clr %g1 ! 0 while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; 400061f4: 92 10 00 01 mov %g1, %o1 400061f8: 10 bf ff f9 b 400061dc 400061fc: c4 22 21 58 st %g2, [ %o0 + 0x158 ] =============================================================================== 40006200 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { 40006200: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) 40006204: 80 a6 60 00 cmp %i1, 0 40006208: 02 80 00 1b be 40006274 4000620c: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; if ( !result ) 40006210: 80 a6 a0 00 cmp %i2, 0 40006214: 02 80 00 18 be 40006274 40006218: 90 10 00 18 mov %i0, %o0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); 4000621c: 40 00 08 81 call 40008420 <_Thread_Get> 40006220: 92 07 bf fc add %fp, -4, %o1 switch (location) { 40006224: c2 07 bf fc ld [ %fp + -4 ], %g1 40006228: 80 a0 60 00 cmp %g1, 0 4000622c: 12 80 00 14 bne 4000627c 40006230: 82 10 20 04 mov 4, %g1 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; 40006234: c2 02 21 58 ld [ %o0 + 0x158 ], %g1 while (tvp) { 40006238: 80 a0 60 00 cmp %g1, 0 4000623c: 32 80 00 07 bne,a 40006258 40006240: c4 00 60 04 ld [ %g1 + 4 ], %g2 40006244: 30 80 00 10 b,a 40006284 40006248: 80 a0 60 00 cmp %g1, 0 4000624c: 02 80 00 0e be 40006284 <== NEVER TAKEN 40006250: 01 00 00 00 nop if (tvp->ptr == ptr) { 40006254: c4 00 60 04 ld [ %g1 + 4 ], %g2 40006258: 80 a0 80 19 cmp %g2, %i1 4000625c: 32 bf ff fb bne,a 40006248 40006260: 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; 40006264: c2 00 60 0c ld [ %g1 + 0xc ], %g1 _Thread_Enable_dispatch(); 40006268: 40 00 08 62 call 400083f0 <_Thread_Enable_dispatch> 4000626c: c2 26 80 00 st %g1, [ %i2 ] return RTEMS_SUCCESSFUL; 40006270: 82 10 20 00 clr %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40006274: 81 c7 e0 08 ret 40006278: 91 e8 00 01 restore %g0, %g1, %o0 4000627c: 81 c7 e0 08 ret 40006280: 91 e8 00 01 restore %g0, %g1, %o0 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); 40006284: 40 00 08 5b call 400083f0 <_Thread_Enable_dispatch> 40006288: 01 00 00 00 nop return RTEMS_INVALID_ADDRESS; 4000628c: 10 bf ff fa b 40006274 40006290: 82 10 20 09 mov 9, %g1 ! 9 =============================================================================== 4001707c : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 4001707c: 9d e3 bf 98 save %sp, -104, %sp RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Get ( Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) 40017080: 11 10 00 f7 sethi %hi(0x4003dc00), %o0 40017084: 92 10 00 18 mov %i0, %o1 40017088: 90 12 21 d8 or %o0, 0x1d8, %o0 4001708c: 40 00 0c fe call 4001a484 <_Objects_Get> 40017090: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40017094: c2 07 bf fc ld [ %fp + -4 ], %g1 40017098: 80 a0 60 00 cmp %g1, 0 4001709c: 12 80 00 0c bne 400170cc 400170a0: 01 00 00 00 nop case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 400170a4: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 400170a8: 80 a0 60 04 cmp %g1, 4 400170ac: 02 80 00 04 be 400170bc <== NEVER TAKEN 400170b0: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 400170b4: 40 00 14 ec call 4001c464 <_Watchdog_Remove> 400170b8: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 400170bc: 40 00 10 d5 call 4001b410 <_Thread_Enable_dispatch> 400170c0: b0 10 20 00 clr %i0 400170c4: 81 c7 e0 08 ret 400170c8: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 400170cc: 81 c7 e0 08 ret 400170d0: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 400175d4 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 400175d4: 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; 400175d8: 03 10 00 f7 sethi %hi(0x4003dc00), %g1 400175dc: fa 00 62 18 ld [ %g1 + 0x218 ], %i5 ! 4003de18 <_Timer_server> if ( !timer_server ) 400175e0: 80 a7 60 00 cmp %i5, 0 400175e4: 02 80 00 08 be 40017604 400175e8: 82 10 20 0e mov 0xe, %g1 return RTEMS_INCORRECT_STATE; if ( !_TOD.is_set ) 400175ec: 39 10 00 f4 sethi %hi(0x4003d000), %i4 400175f0: 82 17 23 b8 or %i4, 0x3b8, %g1 ! 4003d3b8 <_TOD> 400175f4: c4 08 60 14 ldub [ %g1 + 0x14 ], %g2 400175f8: 80 a0 a0 00 cmp %g2, 0 400175fc: 12 80 00 04 bne 4001760c <== ALWAYS TAKEN 40017600: 82 10 20 0b mov 0xb, %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 40017604: 81 c7 e0 08 ret 40017608: 91 e8 00 01 restore %g0, %g1, %o0 return RTEMS_INCORRECT_STATE; if ( !_TOD.is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) 4001760c: 80 a6 a0 00 cmp %i2, 0 40017610: 02 bf ff fd be 40017604 40017614: 82 10 20 09 mov 9, %g1 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 40017618: 7f ff f3 1e call 40014290 <_TOD_Validate> 4001761c: 90 10 00 19 mov %i1, %o0 40017620: 80 8a 20 ff btst 0xff, %o0 40017624: 12 80 00 04 bne 40017634 40017628: 82 10 20 14 mov 0x14, %g1 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 4001762c: 81 c7 e0 08 ret 40017630: 91 e8 00 01 restore %g0, %g1, %o0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 40017634: 7f ff f2 dd call 400141a8 <_TOD_To_seconds> 40017638: 90 10 00 19 mov %i1, %o0 4001763c: b2 10 00 08 mov %o0, %i1 40017640: d0 1f 23 b8 ldd [ %i4 + 0x3b8 ], %o0 40017644: 94 10 20 00 clr %o2 40017648: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 4001764c: 40 00 52 36 call 4002bf24 <__divdi3> 40017650: 96 12 e2 00 or %o3, 0x200, %o3 ! 3b9aca00 if ( seconds <= _TOD_Seconds_since_epoch() ) 40017654: 80 a6 40 09 cmp %i1, %o1 40017658: 08 bf ff f5 bleu 4001762c 4001765c: 82 10 20 14 mov 0x14, %g1 40017660: 92 10 00 18 mov %i0, %o1 40017664: 11 10 00 f7 sethi %hi(0x4003dc00), %o0 40017668: 94 07 bf fc add %fp, -4, %o2 4001766c: 40 00 0b 86 call 4001a484 <_Objects_Get> 40017670: 90 12 21 d8 or %o0, 0x1d8, %o0 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 40017674: c2 07 bf fc ld [ %fp + -4 ], %g1 40017678: 80 a0 60 00 cmp %g1, 0 4001767c: 12 80 00 19 bne 400176e0 40017680: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 40017684: 40 00 13 78 call 4001c464 <_Watchdog_Remove> 40017688: 90 02 20 10 add %o0, 0x10, %o0 4001768c: d0 1f 23 b8 ldd [ %i4 + 0x3b8 ], %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 40017690: 82 10 20 03 mov 3, %g1 40017694: 94 10 20 00 clr %o2 40017698: c2 24 20 38 st %g1, [ %l0 + 0x38 ] 4001769c: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 400176a0: c0 24 20 18 clr [ %l0 + 0x18 ] 400176a4: 96 12 e2 00 or %o3, 0x200, %o3 the_watchdog->routine = routine; 400176a8: f4 24 20 2c st %i2, [ %l0 + 0x2c ] the_watchdog->id = id; 400176ac: f0 24 20 30 st %i0, [ %l0 + 0x30 ] 400176b0: 40 00 52 1d call 4002bf24 <__divdi3> 400176b4: f6 24 20 34 st %i3, [ %l0 + 0x34 ] _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); (*timer_server->schedule_operation)( timer_server, the_timer ); 400176b8: c2 07 60 04 ld [ %i5 + 4 ], %g1 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(); 400176bc: b2 26 40 09 sub %i1, %o1, %i1 (*timer_server->schedule_operation)( timer_server, the_timer ); 400176c0: 90 10 00 1d mov %i5, %o0 400176c4: 92 10 00 10 mov %l0, %o1 400176c8: 9f c0 40 00 call %g1 400176cc: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Thread_Enable_dispatch(); 400176d0: 40 00 0f 50 call 4001b410 <_Thread_Enable_dispatch> 400176d4: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 400176d8: 10 bf ff cb b 40017604 400176dc: 82 10 20 00 clr %g1 ! 0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 400176e0: 10 bf ff c9 b 40017604 400176e4: 82 10 20 04 mov 4, %g1 =============================================================================== 400077dc : #include int sched_get_priority_max( int policy ) { 400077dc: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 400077e0: 80 a6 20 04 cmp %i0, 4 400077e4: 08 80 00 08 bleu 40007804 400077e8: 82 10 20 01 mov 1, %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 400077ec: 40 00 22 40 call 400100ec <__errno> 400077f0: b0 10 3f ff mov -1, %i0 400077f4: 82 10 20 16 mov 0x16, %g1 400077f8: c2 22 00 00 st %g1, [ %o0 ] 400077fc: 81 c7 e0 08 ret 40007800: 81 e8 00 00 restore int sched_get_priority_max( int policy ) { switch ( policy ) { 40007804: b1 28 40 18 sll %g1, %i0, %i0 40007808: 80 8e 20 17 btst 0x17, %i0 4000780c: 02 bf ff f8 be 400077ec <== NEVER TAKEN 40007810: 03 10 00 7b sethi %hi(0x4001ec00), %g1 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 40007814: f0 08 61 fc ldub [ %g1 + 0x1fc ], %i0 ! 4001edfc } 40007818: 81 c7 e0 08 ret 4000781c: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 40007820 : * 13.3.6 Get Scheduling Parameter Limits, P1003.1b-1993, p. 258 */ int sched_get_priority_min( int policy ) { 40007820: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 40007824: 80 a6 20 04 cmp %i0, 4 40007828: 08 80 00 08 bleu 40007848 4000782c: 82 10 00 18 mov %i0, %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 40007830: 40 00 22 2f call 400100ec <__errno> 40007834: b0 10 3f ff mov -1, %i0 40007838: 82 10 20 16 mov 0x16, %g1 4000783c: c2 22 00 00 st %g1, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 40007840: 81 c7 e0 08 ret 40007844: 81 e8 00 00 restore */ int sched_get_priority_min( int policy ) { switch ( policy ) { 40007848: 84 10 20 01 mov 1, %g2 4000784c: 83 28 80 01 sll %g2, %g1, %g1 40007850: 80 88 60 17 btst 0x17, %g1 40007854: 02 bf ff f7 be 40007830 <== NEVER TAKEN 40007858: b0 10 20 01 mov 1, %i0 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 4000785c: 81 c7 e0 08 ret 40007860: 81 e8 00 00 restore =============================================================================== 40007864 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 40007864: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 40007868: 80 a6 20 00 cmp %i0, 0 4000786c: 12 80 00 0a bne 40007894 <== ALWAYS TAKEN 40007870: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); if ( !interval ) 40007874: 02 80 00 13 be 400078c0 40007878: 03 10 00 7e sethi %hi(0x4001f800), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 4000787c: d0 00 61 10 ld [ %g1 + 0x110 ], %o0 ! 4001f910 <_Thread_Ticks_per_timeslice> 40007880: 92 10 00 19 mov %i1, %o1 40007884: 40 00 0f 59 call 4000b5e8 <_Timespec_From_ticks> 40007888: b0 10 20 00 clr %i0 return 0; } 4000788c: 81 c7 e0 08 ret 40007890: 81 e8 00 00 restore { /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 40007894: 7f ff ee ed call 40003448 40007898: 01 00 00 00 nop 4000789c: 80 a2 00 18 cmp %o0, %i0 400078a0: 02 bf ff f5 be 40007874 400078a4: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 400078a8: 40 00 22 11 call 400100ec <__errno> 400078ac: b0 10 3f ff mov -1, %i0 400078b0: 82 10 20 03 mov 3, %g1 400078b4: c2 22 00 00 st %g1, [ %o0 ] 400078b8: 81 c7 e0 08 ret 400078bc: 81 e8 00 00 restore if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); 400078c0: 40 00 22 0b call 400100ec <__errno> 400078c4: b0 10 3f ff mov -1, %i0 400078c8: 82 10 20 16 mov 0x16, %g1 400078cc: c2 22 00 00 st %g1, [ %o0 ] 400078d0: 81 c7 e0 08 ret 400078d4: 81 e8 00 00 restore =============================================================================== 4000812c : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 4000812c: 9d e3 bf 88 save %sp, -120, %sp * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40008130: 03 10 00 8e sethi %hi(0x40023800), %g1 40008134: c4 00 60 c0 ld [ %g1 + 0xc0 ], %g2 ! 400238c0 <_Thread_Dispatch_disable_level> size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 40008138: f4 27 a0 4c st %i2, [ %fp + 0x4c ] ++level; 4000813c: 84 00 a0 01 inc %g2 40008140: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 40008144: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 40008148: fa 27 a0 58 st %i5, [ %fp + 0x58 ] _Thread_Dispatch_disable_level = level; 4000814c: c4 20 60 c0 st %g2, [ %g1 + 0xc0 ] Objects_Locations location; size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 40008150: b4 8e 62 00 andcc %i1, 0x200, %i2 40008154: 12 80 00 27 bne 400081f0 40008158: b6 10 20 00 clr %i3 const char *name, Objects_Id *id, size_t *len ) { return _POSIX_Name_to_id( &_POSIX_Semaphore_Information, name, id, len ); 4000815c: 39 10 00 8e sethi %hi(0x40023800), %i4 40008160: 92 10 00 18 mov %i0, %o1 40008164: 90 17 23 84 or %i4, 0x384, %o0 40008168: 94 07 bf f0 add %fp, -16, %o2 4000816c: 7f ff fe 5c call 40007adc <_POSIX_Name_to_id> 40008170: 96 07 bf fc add %fp, -4, %o3 * 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 ) { 40008174: ba 92 20 00 orcc %o0, 0, %i5 40008178: 22 80 00 0e be,a 400081b0 4000817c: 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) ) ) { 40008180: 80 a7 60 02 cmp %i5, 2 40008184: 12 80 00 04 bne 40008194 40008188: 80 a6 a0 00 cmp %i2, 0 4000818c: 12 80 00 1d bne 40008200 40008190: d2 07 bf fc ld [ %fp + -4 ], %o1 _Thread_Enable_dispatch(); 40008194: 40 00 0e 73 call 4000bb60 <_Thread_Enable_dispatch> 40008198: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 4000819c: 40 00 25 30 call 4001165c <__errno> 400081a0: 01 00 00 00 nop 400081a4: fa 22 00 00 st %i5, [ %o0 ] 400081a8: 81 c7 e0 08 ret 400081ac: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 400081b0: 80 a6 6a 00 cmp %i1, 0xa00 400081b4: 02 80 00 1f be 40008230 400081b8: d2 07 bf f0 ld [ %fp + -16 ], %o1 RTEMS_INLINE_ROUTINE POSIX_Semaphore_Control *_POSIX_Semaphore_Get ( sem_t *id, Objects_Locations *location ) { return (POSIX_Semaphore_Control *) 400081bc: 94 07 bf f8 add %fp, -8, %o2 400081c0: 40 00 0a 7a call 4000aba8 <_Objects_Get> 400081c4: 90 17 23 84 or %i4, 0x384, %o0 _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); } the_semaphore = _POSIX_Semaphore_Get( (sem_t *) &the_semaphore_id, &location ); the_semaphore->open_count += 1; 400081c8: 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( (sem_t *) &the_semaphore_id, &location ); 400081cc: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 400081d0: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 400081d4: 40 00 0e 63 call 4000bb60 <_Thread_Enable_dispatch> 400081d8: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 400081dc: 40 00 0e 61 call 4000bb60 <_Thread_Enable_dispatch> 400081e0: 01 00 00 00 nop return_id: #if defined(RTEMS_USE_16_BIT_OBJECT) the_semaphore->Semaphore_id = the_semaphore->Object.id; return &the_semaphore->Semaphore_id; #else return (sem_t *)&the_semaphore->Object.id; 400081e4: f0 07 bf f4 ld [ %fp + -12 ], %i0 400081e8: 81 c7 e0 08 ret 400081ec: 91 ee 20 08 restore %i0, 8, %o0 size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 400081f0: 82 07 a0 4c add %fp, 0x4c, %g1 mode = va_arg( arg, mode_t ); value = va_arg( arg, unsigned int ); 400081f4: f6 07 a0 50 ld [ %fp + 0x50 ], %i3 size_t name_len; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 400081f8: 10 bf ff d9 b 4000815c 400081fc: c2 27 bf ec st %g1, [ %fp + -20 ] /* * 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( 40008200: 94 10 20 00 clr %o2 40008204: 96 10 00 1b mov %i3, %o3 40008208: 98 07 bf f4 add %fp, -12, %o4 4000820c: 40 00 1a b9 call 4000ecf0 <_POSIX_Semaphore_Create_support> 40008210: 90 10 00 18 mov %i0, %o0 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 40008214: 40 00 0e 53 call 4000bb60 <_Thread_Enable_dispatch> 40008218: ba 10 00 08 mov %o0, %i5 if ( status == -1 ) 4000821c: 80 a7 7f ff cmp %i5, -1 40008220: 32 bf ff f2 bne,a 400081e8 <== ALWAYS TAKEN 40008224: f0 07 bf f4 ld [ %fp + -12 ], %i0 the_semaphore->Semaphore_id = the_semaphore->Object.id; return &the_semaphore->Semaphore_id; #else return (sem_t *)&the_semaphore->Object.id; #endif } 40008228: 81 c7 e0 08 ret <== NOT EXECUTED 4000822c: 91 e8 3f ff restore %g0, -1, %o0 <== NOT EXECUTED /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); 40008230: 40 00 0e 4c call 4000bb60 <_Thread_Enable_dispatch> 40008234: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 40008238: 40 00 25 09 call 4001165c <__errno> 4000823c: 01 00 00 00 nop 40008240: 82 10 20 11 mov 0x11, %g1 ! 11 40008244: c2 22 00 00 st %g1, [ %o0 ] 40008248: 81 c7 e0 08 ret 4000824c: 81 e8 00 00 restore =============================================================================== 4000a284 : int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { 4000a284: 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 ); 4000a288: 90 10 00 19 mov %i1, %o0 4000a28c: 40 00 16 6f call 4000fc48 <_POSIX_Absolute_timeout_to_ticks> 4000a290: 92 07 bf fc add %fp, -4, %o1 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 4000a294: d4 07 bf fc ld [ %fp + -4 ], %o2 * 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 ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) 4000a298: 80 a2 20 03 cmp %o0, 3 4000a29c: 02 80 00 06 be 4000a2b4 <== ALWAYS TAKEN 4000a2a0: 90 10 00 18 mov %i0, %o0 do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); 4000a2a4: 40 00 19 69 call 40010848 <_POSIX_Semaphore_Wait_support> <== NOT EXECUTED 4000a2a8: 92 10 20 00 clr %o1 <== NOT EXECUTED 4000a2ac: 81 c7 e0 08 ret <== NOT EXECUTED 4000a2b0: 91 e8 00 08 restore %g0, %o0, %o0 <== NOT EXECUTED 4000a2b4: 40 00 19 65 call 40010848 <_POSIX_Semaphore_Wait_support> 4000a2b8: 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; } 4000a2bc: 81 c7 e0 08 ret 4000a2c0: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 40007790 : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 40007790: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 40007794: 80 a6 a0 00 cmp %i2, 0 40007798: 02 80 00 0d be 400077cc 4000779c: 87 2e 20 02 sll %i0, 2, %g3 *oact = _POSIX_signals_Vectors[ sig ]; 400077a0: 05 10 00 6a sethi %hi(0x4001a800), %g2 400077a4: 83 2e 20 04 sll %i0, 4, %g1 400077a8: 84 10 a1 70 or %g2, 0x170, %g2 400077ac: 82 20 40 03 sub %g1, %g3, %g1 400077b0: c6 00 80 01 ld [ %g2 + %g1 ], %g3 400077b4: 82 00 80 01 add %g2, %g1, %g1 400077b8: c6 26 80 00 st %g3, [ %i2 ] 400077bc: c4 00 60 04 ld [ %g1 + 4 ], %g2 400077c0: c4 26 a0 04 st %g2, [ %i2 + 4 ] 400077c4: c2 00 60 08 ld [ %g1 + 8 ], %g1 400077c8: c2 26 a0 08 st %g1, [ %i2 + 8 ] if ( !sig ) 400077cc: 80 a6 20 00 cmp %i0, 0 400077d0: 02 80 00 33 be 4000789c 400077d4: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 400077d8: 82 06 3f ff add %i0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 400077dc: 80 a0 60 1f cmp %g1, 0x1f 400077e0: 18 80 00 2f bgu 4000789c 400077e4: 80 a6 20 09 cmp %i0, 9 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 400077e8: 02 80 00 2d be 4000789c 400077ec: 80 a6 60 00 cmp %i1, 0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 400077f0: 02 80 00 1a be 40007858 <== NEVER TAKEN 400077f4: 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 ); 400077f8: 7f ff eb 17 call 40002454 400077fc: 01 00 00 00 nop 40007800: ba 10 00 08 mov %o0, %i5 if ( act->sa_handler == SIG_DFL ) { 40007804: c2 06 60 08 ld [ %i1 + 8 ], %g1 40007808: 80 a0 60 00 cmp %g1, 0 4000780c: 02 80 00 15 be 40007860 40007810: 83 2e 20 02 sll %i0, 2, %g1 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); 40007814: 40 00 17 c0 call 4000d714 <_POSIX_signals_Clear_process_signals> 40007818: 90 10 00 18 mov %i0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 4000781c: c4 06 40 00 ld [ %i1 ], %g2 40007820: 87 2e 20 02 sll %i0, 2, %g3 40007824: 03 10 00 6a sethi %hi(0x4001a800), %g1 40007828: b1 2e 20 04 sll %i0, 4, %i0 4000782c: 82 10 61 70 or %g1, 0x170, %g1 40007830: b0 26 00 03 sub %i0, %g3, %i0 40007834: c4 20 40 18 st %g2, [ %g1 + %i0 ] 40007838: c4 06 60 04 ld [ %i1 + 4 ], %g2 4000783c: b0 00 40 18 add %g1, %i0, %i0 40007840: c4 26 20 04 st %g2, [ %i0 + 4 ] 40007844: c2 06 60 08 ld [ %i1 + 8 ], %g1 40007848: c2 26 20 08 st %g1, [ %i0 + 8 ] } _ISR_Enable( level ); 4000784c: 7f ff eb 06 call 40002464 40007850: 90 10 00 1d mov %i5, %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; 40007854: 82 10 20 00 clr %g1 } 40007858: 81 c7 e0 08 ret 4000785c: 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 ]; 40007860: b1 2e 20 04 sll %i0, 4, %i0 40007864: b0 26 00 01 sub %i0, %g1, %i0 40007868: 03 10 00 64 sethi %hi(0x40019000), %g1 4000786c: 82 10 60 54 or %g1, 0x54, %g1 ! 40019054 <_POSIX_signals_Default_vectors> 40007870: c8 00 40 18 ld [ %g1 + %i0 ], %g4 40007874: 82 00 40 18 add %g1, %i0, %g1 40007878: c6 00 60 04 ld [ %g1 + 4 ], %g3 4000787c: c4 00 60 08 ld [ %g1 + 8 ], %g2 40007880: 03 10 00 6a sethi %hi(0x4001a800), %g1 40007884: 82 10 61 70 or %g1, 0x170, %g1 ! 4001a970 <_POSIX_signals_Vectors> 40007888: c8 20 40 18 st %g4, [ %g1 + %i0 ] 4000788c: b0 00 40 18 add %g1, %i0, %i0 40007890: c6 26 20 04 st %g3, [ %i0 + 4 ] 40007894: 10 bf ff ee b 4000784c 40007898: 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 ); 4000789c: 40 00 23 2a call 40010544 <__errno> 400078a0: 01 00 00 00 nop 400078a4: 84 10 20 16 mov 0x16, %g2 ! 16 400078a8: 82 10 3f ff mov -1, %g1 400078ac: 10 bf ff eb b 40007858 400078b0: c4 22 00 00 st %g2, [ %o0 ] =============================================================================== 40007d20 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 40007d20: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 40007d24: ba 96 20 00 orcc %i0, 0, %i5 40007d28: 02 80 00 83 be 40007f34 40007d2c: 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 ) { 40007d30: 02 80 00 5b be 40007e9c 40007d34: 80 a6 60 00 cmp %i1, 0 if ( !_Timespec_Is_valid( timeout ) ) 40007d38: 40 00 0f 9d call 4000bbac <_Timespec_Is_valid> 40007d3c: 90 10 00 1a mov %i2, %o0 40007d40: 80 8a 20 ff btst 0xff, %o0 40007d44: 02 80 00 7c be 40007f34 40007d48: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 40007d4c: 40 00 0f ab call 4000bbf8 <_Timespec_To_ticks> 40007d50: 90 10 00 1a mov %i2, %o0 if ( !interval ) 40007d54: b0 92 20 00 orcc %o0, 0, %i0 40007d58: 02 80 00 77 be 40007f34 <== NEVER TAKEN 40007d5c: 80 a6 60 00 cmp %i1, 0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40007d60: 02 80 00 52 be 40007ea8 <== NEVER TAKEN 40007d64: 35 10 00 6c sethi %hi(0x4001b000), %i2 the_thread = _Thread_Executing; 40007d68: 35 10 00 6c sethi %hi(0x4001b000), %i2 40007d6c: b4 16 a1 70 or %i2, 0x170, %i2 ! 4001b170 <_Per_CPU_Information> 40007d70: f8 06 a0 10 ld [ %i2 + 0x10 ], %i4 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40007d74: 7f ff ea 93 call 400027c0 40007d78: f6 07 21 50 ld [ %i4 + 0x150 ], %i3 40007d7c: a0 10 00 08 mov %o0, %l0 if ( *set & api->signals_pending ) { 40007d80: c2 07 40 00 ld [ %i5 ], %g1 40007d84: c4 06 e0 d4 ld [ %i3 + 0xd4 ], %g2 40007d88: 80 88 40 02 btst %g1, %g2 40007d8c: 12 80 00 52 bne 40007ed4 40007d90: 01 00 00 00 nop return the_info->si_signo; } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 40007d94: 05 10 00 6c sethi %hi(0x4001b000), %g2 40007d98: c4 00 a3 c4 ld [ %g2 + 0x3c4 ], %g2 ! 4001b3c4 <_POSIX_signals_Pending> 40007d9c: 80 88 40 02 btst %g1, %g2 40007da0: 12 80 00 2e bne 40007e58 40007da4: 03 10 00 6b sethi %hi(0x4001ac00), %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 40007da8: c4 00 60 60 ld [ %g1 + 0x60 ], %g2 ! 4001ac60 <_Thread_Dispatch_disable_level> the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; return signo; } the_info->si_signo = -1; 40007dac: 86 10 3f ff mov -1, %g3 40007db0: c6 26 40 00 st %g3, [ %i1 ] ++level; 40007db4: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 40007db8: c4 20 60 60 st %g2, [ %g1 + 0x60 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 40007dbc: 82 10 20 04 mov 4, %g1 40007dc0: c2 27 20 34 st %g1, [ %i4 + 0x34 ] the_thread->Wait.option = *set; 40007dc4: c2 07 40 00 ld [ %i5 ], %g1 the_thread->Wait.return_argument = the_info; 40007dc8: f2 27 20 28 st %i1, [ %i4 + 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; 40007dcc: c2 27 20 30 st %g1, [ %i4 + 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; 40007dd0: a2 10 20 01 mov 1, %l1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 40007dd4: 21 10 00 6c sethi %hi(0x4001b000), %l0 40007dd8: a0 14 23 5c or %l0, 0x35c, %l0 ! 4001b35c <_POSIX_signals_Wait_queue> 40007ddc: e0 27 20 44 st %l0, [ %i4 + 0x44 ] 40007de0: e2 24 20 30 st %l1, [ %l0 + 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 ); 40007de4: 7f ff ea 7b call 400027d0 40007de8: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 40007dec: 90 10 00 10 mov %l0, %o0 40007df0: 92 10 00 18 mov %i0, %o1 40007df4: 15 10 00 2e sethi %hi(0x4000b800), %o2 40007df8: 40 00 0d ff call 4000b5f4 <_Thread_queue_Enqueue_with_handler> 40007dfc: 94 12 a1 d4 or %o2, 0x1d4, %o2 ! 4000b9d4 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 40007e00: 40 00 0c bd call 4000b0f4 <_Thread_Enable_dispatch> 40007e04: 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 ); 40007e08: d2 06 40 00 ld [ %i1 ], %o1 40007e0c: 90 10 00 1b mov %i3, %o0 40007e10: 94 10 00 19 mov %i1, %o2 40007e14: 96 10 20 00 clr %o3 40007e18: 40 00 18 7c call 4000e008 <_POSIX_signals_Clear_signals> 40007e1c: 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) 40007e20: c2 06 a0 10 ld [ %i2 + 0x10 ], %g1 40007e24: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007e28: 80 a0 60 04 cmp %g1, 4 40007e2c: 12 80 00 3b bne 40007f18 40007e30: 01 00 00 00 nop || !(*set & signo_to_mask( the_info->si_signo )) ) { 40007e34: f0 06 40 00 ld [ %i1 ], %i0 40007e38: c2 07 40 00 ld [ %i5 ], %g1 40007e3c: 84 06 3f ff add %i0, -1, %g2 40007e40: a3 2c 40 02 sll %l1, %g2, %l1 40007e44: 80 8c 40 01 btst %l1, %g1 40007e48: 02 80 00 34 be 40007f18 40007e4c: 01 00 00 00 nop errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } 40007e50: 81 c7 e0 08 ret 40007e54: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40007e58: 7f ff ff 9a call 40007cc0 <_POSIX_signals_Get_lowest> 40007e5c: 90 10 00 02 mov %g2, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40007e60: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 40007e64: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 40007e68: 96 10 20 01 mov 1, %o3 40007e6c: 90 10 00 1b mov %i3, %o0 40007e70: 92 10 00 18 mov %i0, %o1 40007e74: 40 00 18 65 call 4000e008 <_POSIX_signals_Clear_signals> 40007e78: 98 10 20 00 clr %o4 _ISR_Enable( level ); 40007e7c: 7f ff ea 55 call 400027d0 40007e80: 90 10 00 10 mov %l0, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 40007e84: 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; 40007e88: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 40007e8c: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 40007e90: c0 26 60 08 clr [ %i1 + 8 ] 40007e94: 81 c7 e0 08 ret 40007e98: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40007e9c: 12 bf ff b3 bne 40007d68 40007ea0: b0 10 20 00 clr %i0 the_thread = _Thread_Executing; 40007ea4: 35 10 00 6c sethi %hi(0x4001b000), %i2 40007ea8: b4 16 a1 70 or %i2, 0x170, %i2 ! 4001b170 <_Per_CPU_Information> 40007eac: f8 06 a0 10 ld [ %i2 + 0x10 ], %i4 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 40007eb0: b2 07 bf f4 add %fp, -12, %i1 * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 40007eb4: 7f ff ea 43 call 400027c0 40007eb8: f6 07 21 50 ld [ %i4 + 0x150 ], %i3 40007ebc: a0 10 00 08 mov %o0, %l0 if ( *set & api->signals_pending ) { 40007ec0: c2 07 40 00 ld [ %i5 ], %g1 40007ec4: c4 06 e0 d4 ld [ %i3 + 0xd4 ], %g2 40007ec8: 80 88 40 02 btst %g1, %g2 40007ecc: 22 bf ff b3 be,a 40007d98 40007ed0: 05 10 00 6c sethi %hi(0x4001b000), %g2 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 40007ed4: 7f ff ff 7b call 40007cc0 <_POSIX_signals_Get_lowest> 40007ed8: 90 10 00 02 mov %g2, %o0 _POSIX_signals_Clear_signals( 40007edc: 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 ); 40007ee0: 92 10 00 08 mov %o0, %o1 40007ee4: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 40007ee8: 96 10 20 00 clr %o3 40007eec: 90 10 00 1b mov %i3, %o0 40007ef0: 40 00 18 46 call 4000e008 <_POSIX_signals_Clear_signals> 40007ef4: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 40007ef8: 7f ff ea 36 call 400027d0 40007efc: 90 10 00 10 mov %l0, %o0 the_info->si_code = SI_USER; 40007f00: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 40007f04: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 40007f08: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 40007f0c: f0 06 40 00 ld [ %i1 ], %i0 40007f10: 81 c7 e0 08 ret 40007f14: 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; 40007f18: 40 00 23 6d call 40010ccc <__errno> 40007f1c: b0 10 3f ff mov -1, %i0 40007f20: c2 06 a0 10 ld [ %i2 + 0x10 ], %g1 40007f24: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 40007f28: c2 22 00 00 st %g1, [ %o0 ] return -1; } return the_info->si_signo; } 40007f2c: 81 c7 e0 08 ret 40007f30: 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 ); 40007f34: 40 00 23 66 call 40010ccc <__errno> 40007f38: b0 10 3f ff mov -1, %i0 40007f3c: 82 10 20 16 mov 0x16, %g1 40007f40: c2 22 00 00 st %g1, [ %o0 ] 40007f44: 81 c7 e0 08 ret 40007f48: 81 e8 00 00 restore =============================================================================== 40009b4c : int sigwait( const sigset_t *set, int *sig ) { 40009b4c: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 40009b50: 92 10 20 00 clr %o1 40009b54: 90 10 00 18 mov %i0, %o0 40009b58: 7f ff ff 6e call 40009910 40009b5c: 94 10 20 00 clr %o2 if ( status != -1 ) { 40009b60: 80 a2 3f ff cmp %o0, -1 40009b64: 02 80 00 07 be 40009b80 40009b68: 80 a6 60 00 cmp %i1, 0 if ( sig ) 40009b6c: 02 80 00 0a be 40009b94 <== NEVER TAKEN 40009b70: 01 00 00 00 nop *sig = status; 40009b74: d0 26 40 00 st %o0, [ %i1 ] return 0; 40009b78: 81 c7 e0 08 ret 40009b7c: 91 e8 20 00 restore %g0, 0, %o0 } return errno; 40009b80: 40 00 22 86 call 40012598 <__errno> 40009b84: 01 00 00 00 nop 40009b88: f0 02 00 00 ld [ %o0 ], %i0 40009b8c: 81 c7 e0 08 ret 40009b90: 81 e8 00 00 restore } 40009b94: 81 c7 e0 08 ret <== NOT EXECUTED 40009b98: 91 e8 20 00 restore %g0, 0, %o0 <== NOT EXECUTED =============================================================================== 400069c8 : */ long sysconf( int name ) { 400069c8: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 400069cc: 80 a6 20 02 cmp %i0, 2 400069d0: 02 80 00 12 be 40006a18 400069d4: 82 10 00 18 mov %i0, %g1 return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 400069d8: 80 a6 20 04 cmp %i0, 4 400069dc: 02 80 00 16 be 40006a34 400069e0: 80 a0 60 33 cmp %g1, 0x33 return rtems_libio_number_iops; if ( name == _SC_GETPW_R_SIZE_MAX ) 400069e4: 02 80 00 0b be 40006a10 400069e8: b0 10 24 00 mov 0x400, %i0 return 1024; if ( name == _SC_PAGESIZE ) 400069ec: 80 a0 60 08 cmp %g1, 8 400069f0: 02 80 00 08 be 40006a10 400069f4: 31 00 00 04 sethi %hi(0x1000), %i0 return PAGE_SIZE; if ( name == _SC_SYMLOOP_MAX ) 400069f8: 80 a0 60 4f cmp %g1, 0x4f 400069fc: 02 80 00 05 be 40006a10 <== NEVER TAKEN 40006a00: b0 10 20 20 mov 0x20, %i0 return RTEMS_FILESYSTEM_SYMLOOP_MAX; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 40006a04: 80 a0 62 03 cmp %g1, 0x203 40006a08: 12 80 00 0f bne 40006a44 <== ALWAYS TAKEN 40006a0c: b0 10 20 00 clr %i0 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); } 40006a10: 81 c7 e0 08 ret 40006a14: 81 e8 00 00 restore int name ) { if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick()); 40006a18: 03 10 00 56 sethi %hi(0x40015800), %g1 long sysconf( int name ) { if ( name == _SC_CLK_TCK ) return (TOD_MICROSECONDS_PER_SECOND / 40006a1c: d2 00 60 b4 ld [ %g1 + 0xb4 ], %o1 ! 400158b4 40006a20: 11 00 03 d0 sethi %hi(0xf4000), %o0 40006a24: 40 00 32 7c call 40013414 <.udiv> 40006a28: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 40006a2c: 81 c7 e0 08 ret 40006a30: 91 e8 00 08 restore %g0, %o0, %o0 rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) return rtems_libio_number_iops; 40006a34: 03 10 00 5c sethi %hi(0x40017000), %g1 40006a38: f0 00 60 e8 ld [ %g1 + 0xe8 ], %i0 ! 400170e8 40006a3c: 81 c7 e0 08 ret 40006a40: 81 e8 00 00 restore #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 40006a44: 40 00 23 23 call 4000f6d0 <__errno> 40006a48: b0 10 3f ff mov -1, %i0 40006a4c: 82 10 20 16 mov 0x16, %g1 40006a50: c2 22 00 00 st %g1, [ %o0 ] } 40006a54: 81 c7 e0 08 ret 40006a58: 81 e8 00 00 restore =============================================================================== 40008250 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 40008250: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 40008254: 80 a6 20 01 cmp %i0, 1 40008258: 12 80 00 3d bne 4000834c 4000825c: 80 a6 a0 00 cmp %i2, 0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 40008260: 02 80 00 3b be 4000834c 40008264: 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) { 40008268: 02 80 00 0e be 400082a0 4000826c: 03 10 00 8e sethi %hi(0x40023800), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 40008270: c2 06 40 00 ld [ %i1 ], %g1 40008274: 82 00 7f ff add %g1, -1, %g1 40008278: 80 a0 60 01 cmp %g1, 1 4000827c: 18 80 00 34 bgu 4000834c <== NEVER TAKEN 40008280: 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 ) 40008284: c2 06 60 04 ld [ %i1 + 4 ], %g1 40008288: 80 a0 60 00 cmp %g1, 0 4000828c: 02 80 00 30 be 4000834c <== NEVER TAKEN 40008290: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 40008294: 80 a0 60 1f cmp %g1, 0x1f 40008298: 18 80 00 2d bgu 4000834c <== NEVER TAKEN 4000829c: 03 10 00 8e sethi %hi(0x40023800), %g1 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { uint32_t level = _Thread_Dispatch_disable_level; 400082a0: c4 00 60 c0 ld [ %g1 + 0xc0 ], %g2 ! 400238c0 <_Thread_Dispatch_disable_level> ++level; 400082a4: 84 00 a0 01 inc %g2 _Thread_Dispatch_disable_level = level; 400082a8: c4 20 60 c0 st %g2, [ %g1 + 0xc0 ] * 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 ); 400082ac: 3b 10 00 8e sethi %hi(0x40023800), %i5 400082b0: 40 00 08 e0 call 4000a630 <_Objects_Allocate> 400082b4: 90 17 63 c4 or %i5, 0x3c4, %o0 ! 40023bc4 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 400082b8: 80 a2 20 00 cmp %o0, 0 400082bc: 02 80 00 2a be 40008364 400082c0: 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; 400082c4: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 400082c8: 03 10 00 8f sethi %hi(0x40023c00), %g1 400082cc: c2 00 62 20 ld [ %g1 + 0x220 ], %g1 ! 40023e20 <_Per_CPU_Information+0x10> if ( evp != NULL ) { 400082d0: 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; 400082d4: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 400082d8: 02 80 00 08 be 400082f8 400082dc: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 400082e0: c6 06 40 00 ld [ %i1 ], %g3 ptimer->inf.sigev_signo = evp->sigev_signo; 400082e4: c4 06 60 04 ld [ %i1 + 4 ], %g2 ptimer->inf.sigev_value = evp->sigev_value; 400082e8: 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; 400082ec: c6 22 20 40 st %g3, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 400082f0: c4 22 20 44 st %g2, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 400082f4: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 400082f8: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 400082fc: ba 17 63 c4 or %i5, 0x3c4, %i5 40008300: c6 07 60 1c ld [ %i5 + 0x1c ], %g3 } ptimer->overrun = 0; 40008304: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 40008308: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 4000830c: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 40008310: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 40008314: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40008318: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 4000831c: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 40008320: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 40008324: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 40008328: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 4000832c: 85 28 a0 02 sll %g2, 2, %g2 40008330: 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; 40008334: 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; 40008338: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 4000833c: 40 00 0e 09 call 4000bb60 <_Thread_Enable_dispatch> 40008340: b0 10 20 00 clr %i0 return 0; } 40008344: 81 c7 e0 08 ret 40008348: 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 ); 4000834c: 40 00 24 c4 call 4001165c <__errno> 40008350: b0 10 3f ff mov -1, %i0 40008354: 82 10 20 16 mov 0x16, %g1 40008358: c2 22 00 00 st %g1, [ %o0 ] 4000835c: 81 c7 e0 08 ret 40008360: 81 e8 00 00 restore /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { _Thread_Enable_dispatch(); 40008364: 40 00 0d ff call 4000bb60 <_Thread_Enable_dispatch> 40008368: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one( EAGAIN ); 4000836c: 40 00 24 bc call 4001165c <__errno> 40008370: 01 00 00 00 nop 40008374: 82 10 20 0b mov 0xb, %g1 ! b 40008378: c2 22 00 00 st %g1, [ %o0 ] 4000837c: 81 c7 e0 08 ret 40008380: 81 e8 00 00 restore =============================================================================== 40006ea8 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 40006ea8: 9d e3 bf 78 save %sp, -136, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 40006eac: 80 a6 a0 00 cmp %i2, 0 40006eb0: 02 80 00 86 be 400070c8 <== NEVER TAKEN 40006eb4: 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) ) ) { 40006eb8: 40 00 10 37 call 4000af94 <_Timespec_Is_valid> 40006ebc: 90 06 a0 08 add %i2, 8, %o0 40006ec0: 80 8a 20 ff btst 0xff, %o0 40006ec4: 02 80 00 81 be 400070c8 40006ec8: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 40006ecc: 40 00 10 32 call 4000af94 <_Timespec_Is_valid> 40006ed0: 90 10 00 1a mov %i2, %o0 40006ed4: 80 8a 20 ff btst 0xff, %o0 40006ed8: 02 80 00 7c be 400070c8 <== NEVER TAKEN 40006edc: 80 8e 7f fb btst -5, %i1 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 40006ee0: 12 80 00 7a bne 400070c8 40006ee4: 80 a6 60 04 cmp %i1, 4 rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 40006ee8: c8 06 80 00 ld [ %i2 ], %g4 40006eec: c6 06 a0 04 ld [ %i2 + 4 ], %g3 40006ef0: c4 06 a0 08 ld [ %i2 + 8 ], %g2 40006ef4: c2 06 a0 0c ld [ %i2 + 0xc ], %g1 40006ef8: c8 27 bf f0 st %g4, [ %fp + -16 ] 40006efc: c6 27 bf f4 st %g3, [ %fp + -12 ] 40006f00: c4 27 bf f8 st %g2, [ %fp + -8 ] /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 40006f04: 02 80 00 4c be 40007034 40006f08: c2 27 bf fc st %g1, [ %fp + -4 ] RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get ( timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) 40006f0c: 92 10 00 18 mov %i0, %o1 40006f10: 11 10 00 7f sethi %hi(0x4001fc00), %o0 40006f14: 94 07 bf dc add %fp, -36, %o2 40006f18: 40 00 09 ba call 40009600 <_Objects_Get> 40006f1c: 90 12 20 d4 or %o0, 0xd4, %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 ) { 40006f20: c2 07 bf dc ld [ %fp + -36 ], %g1 40006f24: 80 a0 60 00 cmp %g1, 0 40006f28: 12 80 00 68 bne 400070c8 <== NEVER TAKEN 40006f2c: b2 10 00 08 mov %o0, %i1 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 ) { 40006f30: c2 07 bf f8 ld [ %fp + -8 ], %g1 40006f34: 80 a0 60 00 cmp %g1, 0 40006f38: 12 80 00 05 bne 40006f4c 40006f3c: c2 07 bf fc ld [ %fp + -4 ], %g1 40006f40: 80 a0 60 00 cmp %g1, 0 40006f44: 02 80 00 67 be 400070e0 40006f48: 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 ); 40006f4c: 40 00 10 4b call 4000b078 <_Timespec_To_ticks> 40006f50: 90 10 00 1a mov %i2, %o0 40006f54: d0 26 60 64 st %o0, [ %i1 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 40006f58: 40 00 10 48 call 4000b078 <_Timespec_To_ticks> 40006f5c: 90 07 bf f8 add %fp, -8, %o0 activated = _POSIX_Timer_Insert_helper( 40006f60: d4 06 60 08 ld [ %i1 + 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 ); 40006f64: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 40006f68: 98 10 00 19 mov %i1, %o4 40006f6c: 90 06 60 10 add %i1, 0x10, %o0 40006f70: 17 10 00 1c sethi %hi(0x40007000), %o3 40006f74: 40 00 19 c7 call 4000d690 <_POSIX_Timer_Insert_helper> 40006f78: 96 12 e1 4c or %o3, 0x14c, %o3 ! 4000714c <_POSIX_Timer_TSR> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 40006f7c: 80 8a 20 ff btst 0xff, %o0 40006f80: 02 80 00 29 be 40007024 40006f84: 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 ) 40006f88: 02 80 00 0b be 40006fb4 40006f8c: c2 07 bf f0 ld [ %fp + -16 ], %g1 *ovalue = ptimer->timer_data; 40006f90: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 40006f94: c2 26 c0 00 st %g1, [ %i3 ] 40006f98: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 40006f9c: c2 26 e0 04 st %g1, [ %i3 + 4 ] 40006fa0: c2 06 60 5c ld [ %i1 + 0x5c ], %g1 40006fa4: c2 26 e0 08 st %g1, [ %i3 + 8 ] 40006fa8: c2 06 60 60 ld [ %i1 + 0x60 ], %g1 40006fac: c2 26 e0 0c st %g1, [ %i3 + 0xc ] ptimer->timer_data = normalize; 40006fb0: c2 07 bf f0 ld [ %fp + -16 ], %g1 ) { Timestamp_Control tod_as_timestamp; Timestamp_Control *tod_as_timestamp_ptr; tod_as_timestamp_ptr = 40006fb4: 90 07 bf e0 add %fp, -32, %o0 40006fb8: c2 26 60 54 st %g1, [ %i1 + 0x54 ] 40006fbc: c2 07 bf f4 ld [ %fp + -12 ], %g1 40006fc0: 13 10 00 7e sethi %hi(0x4001f800), %o1 40006fc4: c2 26 60 58 st %g1, [ %i1 + 0x58 ] 40006fc8: c2 07 bf f8 ld [ %fp + -8 ], %g1 40006fcc: 92 12 61 58 or %o1, 0x158, %o1 40006fd0: c2 26 60 5c st %g1, [ %i1 + 0x5c ] 40006fd4: c2 07 bf fc ld [ %fp + -4 ], %g1 40006fd8: c2 26 60 60 st %g1, [ %i1 + 0x60 ] /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 40006fdc: 82 10 20 03 mov 3, %g1 40006fe0: 40 00 06 b4 call 40008ab0 <_TOD_Get_with_nanoseconds> 40006fe4: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } 40006fe8: f8 1a 00 00 ldd [ %o0 ], %i4 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 40006fec: 94 10 20 00 clr %o2 40006ff0: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 40006ff4: 90 10 00 1c mov %i4, %o0 40006ff8: 96 12 e2 00 or %o3, 0x200, %o3 40006ffc: 40 00 4a ad call 40019ab0 <__divdi3> 40007000: 92 10 00 1d mov %i5, %o1 _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 40007004: 94 10 20 00 clr %o2 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 40007008: d2 26 60 6c st %o1, [ %i1 + 0x6c ] _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 4000700c: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 40007010: 90 10 00 1c mov %i4, %o0 40007014: 96 12 e2 00 or %o3, 0x200, %o3 40007018: 40 00 4b 91 call 40019e5c <__moddi3> 4000701c: 92 10 00 1d mov %i5, %o1 40007020: d2 26 60 70 st %o1, [ %i1 + 0x70 ] ptimer->timer_data = normalize; /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; _TOD_Get( &ptimer->time ); _Thread_Enable_dispatch(); 40007024: 40 00 0d 2e call 4000a4dc <_Thread_Enable_dispatch> 40007028: b0 10 20 00 clr %i0 4000702c: 81 c7 e0 08 ret 40007030: 81 e8 00 00 restore 40007034: 90 07 bf e0 add %fp, -32, %o0 40007038: 13 10 00 7e sethi %hi(0x4001f800), %o1 4000703c: 40 00 06 9d call 40008ab0 <_TOD_Get_with_nanoseconds> 40007040: 92 12 61 58 or %o1, 0x158, %o1 ! 4001f958 <_TOD> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } 40007044: f8 1a 00 00 ldd [ %o0 ], %i4 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 40007048: 94 10 20 00 clr %o2 4000704c: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 40007050: 90 10 00 1c mov %i4, %o0 40007054: 96 12 e2 00 or %o3, 0x200, %o3 40007058: 40 00 4a 96 call 40019ab0 <__divdi3> 4000705c: 92 10 00 1d mov %i5, %o1 _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 40007060: 94 10 20 00 clr %o2 static inline void _Timestamp64_implementation_To_timespec( const Timestamp64_Control *_timestamp, struct timespec *_timespec ) { _timespec->tv_sec = (time_t) (*_timestamp / 1000000000L); 40007064: d2 27 bf e8 st %o1, [ %fp + -24 ] _timespec->tv_nsec = (long) (*_timestamp % 1000000000L); 40007068: 17 0e e6 b2 sethi %hi(0x3b9ac800), %o3 4000706c: 90 10 00 1c mov %i4, %o0 40007070: 96 12 e2 00 or %o3, 0x200, %o3 40007074: 40 00 4b 7a call 40019e5c <__moddi3> 40007078: 92 10 00 1d mov %i5, %o1 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 4000707c: 90 07 bf f8 add %fp, -8, %o0 40007080: d2 27 bf ec st %o1, [ %fp + -20 ] 40007084: 40 00 0f d7 call 4000afe0 <_Timespec_Less_than> 40007088: 92 07 bf e8 add %fp, -24, %o1 4000708c: 80 8a 20 ff btst 0xff, %o0 40007090: 12 80 00 0e bne 400070c8 40007094: 92 07 bf f8 add %fp, -8, %o1 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 40007098: 90 07 bf e8 add %fp, -24, %o0 4000709c: 40 00 0f e3 call 4000b028 <_Timespec_Subtract> 400070a0: 94 10 00 09 mov %o1, %o2 400070a4: 92 10 00 18 mov %i0, %o1 400070a8: 11 10 00 7f sethi %hi(0x4001fc00), %o0 400070ac: 94 07 bf dc add %fp, -36, %o2 400070b0: 40 00 09 54 call 40009600 <_Objects_Get> 400070b4: 90 12 20 d4 or %o0, 0xd4, %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 ) { 400070b8: c2 07 bf dc ld [ %fp + -36 ], %g1 400070bc: 80 a0 60 00 cmp %g1, 0 400070c0: 02 bf ff 9c be 40006f30 400070c4: b2 10 00 08 mov %o0, %i1 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 400070c8: 40 00 24 11 call 4001010c <__errno> 400070cc: b0 10 3f ff mov -1, %i0 400070d0: 82 10 20 16 mov 0x16, %g1 400070d4: c2 22 00 00 st %g1, [ %o0 ] } 400070d8: 81 c7 e0 08 ret 400070dc: 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 ); 400070e0: 40 00 10 ef call 4000b49c <_Watchdog_Remove> 400070e4: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 400070e8: 80 a6 e0 00 cmp %i3, 0 400070ec: 02 80 00 0b be 40007118 400070f0: c2 07 bf f0 ld [ %fp + -16 ], %g1 *ovalue = ptimer->timer_data; 400070f4: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 400070f8: c2 26 c0 00 st %g1, [ %i3 ] 400070fc: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 40007100: c2 26 e0 04 st %g1, [ %i3 + 4 ] 40007104: c2 06 60 5c ld [ %i1 + 0x5c ], %g1 40007108: c2 26 e0 08 st %g1, [ %i3 + 8 ] 4000710c: c2 06 60 60 ld [ %i1 + 0x60 ], %g1 40007110: c2 26 e0 0c st %g1, [ %i3 + 0xc ] /* The new data are set */ ptimer->timer_data = normalize; 40007114: c2 07 bf f0 ld [ %fp + -16 ], %g1 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; /* Returns with success */ _Thread_Enable_dispatch(); return 0; 40007118: 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; 4000711c: c2 26 60 54 st %g1, [ %i1 + 0x54 ] 40007120: c2 07 bf f4 ld [ %fp + -12 ], %g1 40007124: c2 26 60 58 st %g1, [ %i1 + 0x58 ] 40007128: c2 07 bf f8 ld [ %fp + -8 ], %g1 4000712c: c2 26 60 5c st %g1, [ %i1 + 0x5c ] 40007130: c2 07 bf fc ld [ %fp + -4 ], %g1 40007134: c2 26 60 60 st %g1, [ %i1 + 0x60 ] /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 40007138: 82 10 20 04 mov 4, %g1 /* Returns with success */ _Thread_Enable_dispatch(); 4000713c: 40 00 0c e8 call 4000a4dc <_Thread_Enable_dispatch> 40007140: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] 40007144: 81 c7 e0 08 ret 40007148: 81 e8 00 00 restore =============================================================================== 40006df4 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 40006df4: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 40006df8: 3b 10 00 65 sethi %hi(0x40019400), %i5 40006dfc: ba 17 62 58 or %i5, 0x258, %i5 ! 40019658 <_POSIX_signals_Ualarm_timer> 40006e00: c2 07 60 1c ld [ %i5 + 0x1c ], %g1 40006e04: 80 a0 60 00 cmp %g1, 0 40006e08: 02 80 00 24 be 40006e98 40006e0c: b8 10 00 18 mov %i0, %i4 _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 40006e10: 40 00 10 8e call 4000b048 <_Watchdog_Remove> 40006e14: 90 10 00 1d mov %i5, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 40006e18: 90 02 3f fe add %o0, -2, %o0 40006e1c: 80 a2 20 01 cmp %o0, 1 40006e20: 08 80 00 26 bleu 40006eb8 <== ALWAYS TAKEN 40006e24: 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 ) { 40006e28: 80 a7 20 00 cmp %i4, 0 40006e2c: 02 80 00 19 be 40006e90 40006e30: 37 00 03 d0 sethi %hi(0xf4000), %i3 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 40006e34: 90 10 00 1c mov %i4, %o0 40006e38: 40 00 37 2b call 40014ae4 <.udiv> 40006e3c: 92 16 e2 40 or %i3, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006e40: 92 16 e2 40 or %i3, 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; 40006e44: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 40006e48: 40 00 37 d3 call 40014d94 <.urem> 40006e4c: 90 10 00 1c mov %i4, %o0 40006e50: 87 2a 20 07 sll %o0, 7, %g3 40006e54: 82 10 00 08 mov %o0, %g1 40006e58: 85 2a 20 02 sll %o0, 2, %g2 40006e5c: 84 20 c0 02 sub %g3, %g2, %g2 40006e60: 82 00 80 01 add %g2, %g1, %g1 40006e64: 83 28 60 03 sll %g1, 3, %g1 ticks = _Timespec_To_ticks( &tp ); 40006e68: 90 07 bf f8 add %fp, -8, %o0 40006e6c: 40 00 0f 3e call 4000ab64 <_Timespec_To_ticks> 40006e70: c2 27 bf fc st %g1, [ %fp + -4 ] if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 40006e74: 40 00 0f 3c call 4000ab64 <_Timespec_To_ticks> 40006e78: 90 07 bf f8 add %fp, -8, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006e7c: 92 10 00 1d mov %i5, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 40006e80: d0 27 60 0c st %o0, [ %i5 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 40006e84: 11 10 00 63 sethi %hi(0x40018c00), %o0 40006e88: 40 00 10 11 call 4000aecc <_Watchdog_Insert> 40006e8c: 90 12 22 08 or %o0, 0x208, %o0 ! 40018e08 <_Watchdog_Ticks_chain> } return remaining; } 40006e90: 81 c7 e0 08 ret 40006e94: 81 e8 00 00 restore Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40006e98: 03 10 00 1b sethi %hi(0x40006c00), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 40006e9c: c0 27 60 08 clr [ %i5 + 8 ] the_watchdog->routine = routine; 40006ea0: 82 10 61 c4 or %g1, 0x1c4, %g1 the_watchdog->id = id; 40006ea4: c0 27 60 20 clr [ %i5 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 40006ea8: c2 27 60 1c st %g1, [ %i5 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 40006eac: c0 27 60 24 clr [ %i5 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 40006eb0: 10 bf ff de b 40006e28 40006eb4: 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); 40006eb8: c4 07 60 0c ld [ %i5 + 0xc ], %g2 40006ebc: c2 07 60 18 ld [ %i5 + 0x18 ], %g1 40006ec0: d0 07 60 14 ld [ %i5 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40006ec4: 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); 40006ec8: 90 02 00 02 add %o0, %g2, %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 40006ecc: 40 00 0f 11 call 4000ab10 <_Timespec_From_ticks> 40006ed0: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 40006ed4: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 40006ed8: 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; 40006edc: 85 28 60 03 sll %g1, 3, %g2 40006ee0: 87 28 60 08 sll %g1, 8, %g3 40006ee4: 84 20 c0 02 sub %g3, %g2, %g2 remaining += tp.tv_nsec / 1000; 40006ee8: 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; 40006eec: b1 28 a0 06 sll %g2, 6, %i0 40006ef0: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 40006ef4: 40 00 36 fe call 40014aec <.div> 40006ef8: 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; 40006efc: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 40006f00: 10 bf ff ca b 40006e28 40006f04: b0 02 00 18 add %o0, %i0, %i0