=============================================================================== 020092cc <_CORE_RWLock_Obtain_for_reading>: Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_RWLock_API_mp_support_callout api_rwlock_mp_support ) { 20092cc: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 20092d0: 03 00 80 64 sethi %hi(0x2019000), %g1 * If unlocked, then OK to read. * If locked for reading and no waiters, then OK to read. * If any thread is waiting, then we wait. */ _ISR_Disable( level ); 20092d4: 7f ff e9 79 call 20038b8 20092d8: e0 00 63 a8 ld [ %g1 + 0x3a8 ], %l0 ! 20193a8 <_Thread_Executing> 20092dc: a2 10 00 08 mov %o0, %l1 switch ( the_rwlock->current_state ) { 20092e0: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 20092e4: 80 a0 60 00 cmp %g1, 0 20092e8: 22 80 00 06 be,a 2009300 <_CORE_RWLock_Obtain_for_reading+0x34> 20092ec: 82 10 20 01 mov 1, %g1 20092f0: 80 a0 60 01 cmp %g1, 1 20092f4: 12 80 00 16 bne 200934c <_CORE_RWLock_Obtain_for_reading+0x80> 20092f8: 80 8e a0 ff btst 0xff, %i2 20092fc: 30 80 00 06 b,a 2009314 <_CORE_RWLock_Obtain_for_reading+0x48> case CORE_RWLOCK_UNLOCKED: the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 2009300: c2 26 20 44 st %g1, [ %i0 + 0x44 ] the_rwlock->number_of_readers += 1; 2009304: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 2009308: 82 00 60 01 inc %g1 200930c: c2 26 20 48 st %g1, [ %i0 + 0x48 ] _ISR_Enable( level ); 2009310: 30 80 00 0a b,a 2009338 <_CORE_RWLock_Obtain_for_reading+0x6c> executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; return; case CORE_RWLOCK_LOCKED_FOR_READING: { Thread_Control *waiter; waiter = _Thread_queue_First( &the_rwlock->Wait_queue ); 2009314: 40 00 08 02 call 200b31c <_Thread_queue_First> 2009318: 90 10 00 18 mov %i0, %o0 if ( !waiter ) { 200931c: 80 a2 20 00 cmp %o0, 0 2009320: 32 80 00 0b bne,a 200934c <_CORE_RWLock_Obtain_for_reading+0x80><== NEVER TAKEN 2009324: 80 8e a0 ff btst 0xff, %i2 <== NOT EXECUTED the_rwlock->number_of_readers += 1; 2009328: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 200932c: 82 00 60 01 inc %g1 2009330: c2 26 20 48 st %g1, [ %i0 + 0x48 ] _ISR_Enable( level ); 2009334: 90 10 00 11 mov %l1, %o0 2009338: 7f ff e9 64 call 20038c8 200933c: 01 00 00 00 nop executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 2009340: c0 24 20 34 clr [ %l0 + 0x34 ] return; 2009344: 81 c7 e0 08 ret 2009348: 81 e8 00 00 restore /* * If the thread is not willing to wait, then return immediately. */ if ( !wait ) { 200934c: 32 80 00 08 bne,a 200936c <_CORE_RWLock_Obtain_for_reading+0xa0> 2009350: 82 10 20 01 mov 1, %g1 _ISR_Enable( level ); 2009354: 7f ff e9 5d call 20038c8 2009358: 90 10 00 11 mov %l1, %o0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 200935c: 82 10 20 02 mov 2, %g1 2009360: c2 24 20 34 st %g1, [ %l0 + 0x34 ] 2009364: 81 c7 e0 08 ret 2009368: 81 e8 00 00 restore 200936c: c2 26 20 30 st %g1, [ %i0 + 0x30 ] /* * We need to wait to enter this critical section */ _Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue ); executing->Wait.queue = &the_rwlock->Wait_queue; 2009370: f0 24 20 44 st %i0, [ %l0 + 0x44 ] executing->Wait.id = id; 2009374: f2 24 20 20 st %i1, [ %l0 + 0x20 ] executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_READ; 2009378: c0 24 20 30 clr [ %l0 + 0x30 ] executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 200937c: c0 24 20 34 clr [ %l0 + 0x34 ] _ISR_Enable( level ); 2009380: 90 10 00 11 mov %l1, %o0 2009384: 7f ff e9 51 call 20038c8 2009388: 35 00 80 25 sethi %hi(0x2009400), %i2 _Thread_queue_Enqueue_with_handler( 200938c: b2 10 00 1b mov %i3, %i1 2009390: 40 00 07 02 call 200af98 <_Thread_queue_Enqueue_with_handler> 2009394: 95 ee a1 1c restore %i2, 0x11c, %o2 =============================================================================== 02009424 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 2009424: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Thread_Control *executing = _Thread_Executing; 2009428: 03 00 80 64 sethi %hi(0x2019000), %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 ); 200942c: 7f ff e9 23 call 20038b8 2009430: e0 00 63 a8 ld [ %g1 + 0x3a8 ], %l0 ! 20193a8 <_Thread_Executing> 2009434: 84 10 00 08 mov %o0, %g2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 2009438: c2 06 20 44 ld [ %i0 + 0x44 ], %g1 200943c: 80 a0 60 00 cmp %g1, 0 2009440: 12 80 00 08 bne 2009460 <_CORE_RWLock_Release+0x3c> 2009444: 80 a0 60 01 cmp %g1, 1 _ISR_Enable( level ); 2009448: 7f ff e9 20 call 20038c8 200944c: b0 10 20 00 clr %i0 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 2009450: 82 10 20 02 mov 2, %g1 2009454: c2 24 20 34 st %g1, [ %l0 + 0x34 ] 2009458: 81 c7 e0 08 ret 200945c: 81 e8 00 00 restore return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 2009460: 32 80 00 0b bne,a 200948c <_CORE_RWLock_Release+0x68> 2009464: c0 24 20 34 clr [ %l0 + 0x34 ] the_rwlock->number_of_readers -= 1; 2009468: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 200946c: 82 00 7f ff add %g1, -1, %g1 if ( the_rwlock->number_of_readers != 0 ) { 2009470: 80 a0 60 00 cmp %g1, 0 2009474: 02 80 00 05 be 2009488 <_CORE_RWLock_Release+0x64> 2009478: c2 26 20 48 st %g1, [ %i0 + 0x48 ] /* must be unlocked again */ _ISR_Enable( level ); 200947c: 7f ff e9 13 call 20038c8 2009480: b0 10 20 00 clr %i0 return CORE_RWLOCK_SUCCESSFUL; 2009484: 30 80 00 24 b,a 2009514 <_CORE_RWLock_Release+0xf0> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 2009488: c0 24 20 34 clr [ %l0 + 0x34 ] /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; 200948c: c0 26 20 44 clr [ %i0 + 0x44 ] _ISR_Enable( level ); 2009490: 7f ff e9 0e call 20038c8 2009494: 90 10 00 02 mov %g2, %o0 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 2009498: 40 00 06 5f call 200ae14 <_Thread_queue_Dequeue> 200949c: 90 10 00 18 mov %i0, %o0 if ( next ) { 20094a0: 80 a2 20 00 cmp %o0, 0 20094a4: 22 80 00 1c be,a 2009514 <_CORE_RWLock_Release+0xf0> 20094a8: b0 10 20 00 clr %i0 if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 20094ac: c2 02 20 30 ld [ %o0 + 0x30 ], %g1 20094b0: 80 a0 60 01 cmp %g1, 1 20094b4: 32 80 00 05 bne,a 20094c8 <_CORE_RWLock_Release+0xa4> 20094b8: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 20094bc: 82 10 20 02 mov 2, %g1 return CORE_RWLOCK_SUCCESSFUL; 20094c0: 10 80 00 14 b 2009510 <_CORE_RWLock_Release+0xec> 20094c4: c2 26 20 44 st %g1, [ %i0 + 0x44 ] } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 20094c8: 82 00 60 01 inc %g1 20094cc: c2 26 20 48 st %g1, [ %i0 + 0x48 ] the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 20094d0: 82 10 20 01 mov 1, %g1 20094d4: c2 26 20 44 st %g1, [ %i0 + 0x44 ] /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); 20094d8: 40 00 07 91 call 200b31c <_Thread_queue_First> 20094dc: 90 10 00 18 mov %i0, %o0 if ( !next || 20094e0: 92 92 20 00 orcc %o0, 0, %o1 20094e4: 22 80 00 0c be,a 2009514 <_CORE_RWLock_Release+0xf0> 20094e8: b0 10 20 00 clr %i0 20094ec: c2 02 60 30 ld [ %o1 + 0x30 ], %g1 20094f0: 80 a0 60 01 cmp %g1, 1 20094f4: 02 80 00 07 be 2009510 <_CORE_RWLock_Release+0xec> <== NEVER TAKEN 20094f8: 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; 20094fc: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 2009500: 82 00 60 01 inc %g1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 2009504: 40 00 07 38 call 200b1e4 <_Thread_queue_Extract> 2009508: c2 26 20 48 st %g1, [ %i0 + 0x48 ] } 200950c: 30 bf ff f3 b,a 20094d8 <_CORE_RWLock_Release+0xb4> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 2009510: b0 10 20 00 clr %i0 2009514: 81 c7 e0 08 ret 2009518: 81 e8 00 00 restore =============================================================================== 0200951c <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 200951c: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 2009520: 90 10 00 18 mov %i0, %o0 2009524: 40 00 05 4e call 200aa5c <_Thread_Get> 2009528: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 200952c: c2 07 bf fc ld [ %fp + -4 ], %g1 2009530: 80 a0 60 00 cmp %g1, 0 2009534: 12 80 00 08 bne 2009554 <_CORE_RWLock_Timeout+0x38> <== NEVER TAKEN 2009538: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 200953c: 40 00 07 bb call 200b428 <_Thread_queue_Process_timeout> 2009540: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 2009544: 03 00 80 64 sethi %hi(0x2019000), %g1 2009548: c4 00 62 e8 ld [ %g1 + 0x2e8 ], %g2 ! 20192e8 <_Thread_Dispatch_disable_level> 200954c: 84 00 bf ff add %g2, -1, %g2 2009550: c4 20 62 e8 st %g2, [ %g1 + 0x2e8 ] 2009554: 81 c7 e0 08 ret 2009558: 81 e8 00 00 restore =============================================================================== 020177c4 <_CORE_message_queue_Broadcast>: Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 20177c4: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 20177c8: c2 06 20 4c ld [ %i0 + 0x4c ], %g1 Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 20177cc: a0 10 00 18 mov %i0, %l0 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 20177d0: 80 a6 80 01 cmp %i2, %g1 20177d4: 18 80 00 16 bgu 201782c <_CORE_message_queue_Broadcast+0x68><== NEVER TAKEN 20177d8: b0 10 20 01 mov 1, %i0 * NOTE: This check is critical because threads can block on * send and receive and this ensures that we are broadcasting * the message to threads waiting to receive -- not to send. */ if ( the_message_queue->number_of_pending_messages != 0 ) { 20177dc: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 20177e0: 80 a0 60 00 cmp %g1, 0 20177e4: 02 80 00 0b be 2017810 <_CORE_message_queue_Broadcast+0x4c> 20177e8: a2 10 20 00 clr %l1 *count = 0; 20177ec: c0 27 40 00 clr [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 20177f0: 81 c7 e0 08 ret 20177f4: 91 e8 20 00 restore %g0, 0, %o0 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 20177f8: 92 10 00 19 mov %i1, %o1 20177fc: 40 00 25 e7 call 2020f98 2017800: 94 10 00 1a mov %i2, %o2 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 2017804: c2 04 a0 28 ld [ %l2 + 0x28 ], %g1 */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 2017808: a2 04 60 01 inc %l1 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 201780c: f4 20 40 00 st %i2, [ %g1 ] /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 2017810: 40 00 0a c2 call 201a318 <_Thread_queue_Dequeue> 2017814: 90 10 00 10 mov %l0, %o0 2017818: a4 92 20 00 orcc %o0, 0, %l2 201781c: 32 bf ff f7 bne,a 20177f8 <_CORE_message_queue_Broadcast+0x34> 2017820: d0 04 a0 2c ld [ %l2 + 0x2c ], %o0 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 2017824: e2 27 40 00 st %l1, [ %i5 ] return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 2017828: b0 10 20 00 clr %i0 } 201782c: 81 c7 e0 08 ret 2017830: 81 e8 00 00 restore =============================================================================== 02010074 <_CORE_message_queue_Initialize>: CORE_message_queue_Control *the_message_queue, CORE_message_queue_Attributes *the_message_queue_attributes, uint32_t maximum_pending_messages, size_t maximum_message_size ) { 2010074: 9d e3 bf a0 save %sp, -96, %sp size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; 2010078: f4 26 20 44 st %i2, [ %i0 + 0x44 ] the_message_queue->number_of_pending_messages = 0; 201007c: c0 26 20 48 clr [ %i0 + 0x48 ] the_message_queue->maximum_message_size = maximum_message_size; 2010080: f6 26 20 4c st %i3, [ %i0 + 0x4c ] CORE_message_queue_Control *the_message_queue, CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; 2010084: c0 26 20 60 clr [ %i0 + 0x60 ] the_message_queue->notify_argument = the_argument; 2010088: c0 26 20 64 clr [ %i0 + 0x64 ] CORE_message_queue_Control *the_message_queue, CORE_message_queue_Attributes *the_message_queue_attributes, uint32_t maximum_pending_messages, size_t maximum_message_size ) { 201008c: a0 10 00 18 mov %i0, %l0 /* * Round size up to multiple of a pointer for chain init and * check for overflow on adding overhead to each message. */ allocated_message_size = maximum_message_size; if (allocated_message_size & (sizeof(uint32_t) - 1)) { 2010090: 80 8e e0 03 btst 3, %i3 2010094: 02 80 00 07 be 20100b0 <_CORE_message_queue_Initialize+0x3c> 2010098: a4 10 00 1b mov %i3, %l2 allocated_message_size += sizeof(uint32_t); 201009c: a4 06 e0 04 add %i3, 4, %l2 allocated_message_size &= ~(sizeof(uint32_t) - 1); 20100a0: a4 0c bf fc and %l2, -4, %l2 } if (allocated_message_size < maximum_message_size) 20100a4: 80 a4 80 1b cmp %l2, %i3 20100a8: 0a 80 00 22 bcs 2010130 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 20100ac: b0 10 20 00 clr %i0 /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); 20100b0: a2 04 a0 14 add %l2, 0x14, %l1 /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * 20100b4: 92 10 00 1a mov %i2, %o1 20100b8: 90 10 00 11 mov %l1, %o0 20100bc: 40 00 41 bf call 20207b8 <.umul> 20100c0: b0 10 20 00 clr %i0 (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 20100c4: 80 a2 00 12 cmp %o0, %l2 20100c8: 0a 80 00 1a bcs 2010130 <_CORE_message_queue_Initialize+0xbc><== NEVER TAKEN 20100cc: 01 00 00 00 nop /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); 20100d0: 40 00 0c 27 call 201316c <_Workspace_Allocate> 20100d4: 01 00 00 00 nop return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 20100d8: d0 24 20 5c st %o0, [ %l0 + 0x5c ] _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 20100dc: 80 a2 20 00 cmp %o0, 0 20100e0: 02 80 00 14 be 2010130 <_CORE_message_queue_Initialize+0xbc> 20100e4: 92 10 00 08 mov %o0, %o1 /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 20100e8: 90 04 20 68 add %l0, 0x68, %o0 20100ec: 94 10 00 1a mov %i2, %o2 20100f0: 40 00 16 ee call 2015ca8 <_Chain_Initialize> 20100f4: 96 10 00 11 mov %l1, %o3 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 20100f8: 82 04 20 54 add %l0, 0x54, %g1 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 20100fc: c2 24 20 50 st %g1, [ %l0 + 0x50 ] the_message_queue->message_buffers, (size_t) maximum_pending_messages, allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); 2010100: 82 04 20 50 add %l0, 0x50, %g1 the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 2010104: c2 24 20 58 st %g1, [ %l0 + 0x58 ] _Thread_queue_Initialize( 2010108: c2 06 40 00 ld [ %i1 ], %g1 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 201010c: c0 24 20 54 clr [ %l0 + 0x54 ] 2010110: 82 18 60 01 xor %g1, 1, %g1 2010114: 80 a0 00 01 cmp %g0, %g1 2010118: 90 10 00 10 mov %l0, %o0 201011c: 92 60 3f ff subx %g0, -1, %o1 2010120: 94 10 20 80 mov 0x80, %o2 2010124: 96 10 20 06 mov 6, %o3 2010128: 40 00 08 e7 call 20124c4 <_Thread_queue_Initialize> 201012c: b0 10 20 01 mov 1, %i0 STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } 2010130: 81 c7 e0 08 ret 2010134: 81 e8 00 00 restore =============================================================================== 02010138 <_CORE_message_queue_Seize>: void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 2010138: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 201013c: 27 00 80 94 sethi %hi(0x2025000), %l3 2010140: e4 04 e3 b8 ld [ %l3 + 0x3b8 ], %l2 ! 20253b8 <_Thread_Executing> void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 2010144: a0 10 00 18 mov %i0, %l0 ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 2010148: c0 24 a0 34 clr [ %l2 + 0x34 ] _ISR_Disable( level ); 201014c: 7f ff dd a3 call 20077d8 2010150: a2 10 00 19 mov %i1, %l1 2010154: 82 10 00 08 mov %o0, %g1 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 2010158: f2 06 20 50 ld [ %i0 + 0x50 ], %i1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 201015c: 84 06 20 54 add %i0, 0x54, %g2 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 2010160: 80 a6 40 02 cmp %i1, %g2 2010164: 02 80 00 24 be 20101f4 <_CORE_message_queue_Seize+0xbc> 2010168: 86 06 20 50 add %i0, 0x50, %g3 { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 201016c: c4 06 40 00 ld [ %i1 ], %g2 the_chain->first = new_first; 2010170: c4 26 20 50 st %g2, [ %i0 + 0x50 ] the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { 2010174: 80 a6 60 00 cmp %i1, 0 2010178: 02 80 00 1f be 20101f4 <_CORE_message_queue_Seize+0xbc> <== NEVER TAKEN 201017c: c6 20 a0 04 st %g3, [ %g2 + 4 ] the_message_queue->number_of_pending_messages -= 1; 2010180: c2 06 20 48 ld [ %i0 + 0x48 ], %g1 2010184: 82 00 7f ff add %g1, -1, %g1 2010188: c2 26 20 48 st %g1, [ %i0 + 0x48 ] _ISR_Enable( level ); 201018c: 7f ff dd 97 call 20077e8 2010190: a2 06 60 10 add %i1, 0x10, %l1 *size_p = the_message->Contents.size; 2010194: d4 06 60 0c ld [ %i1 + 0xc ], %o2 _Thread_Executing->Wait.count = 2010198: c2 04 e3 b8 ld [ %l3 + 0x3b8 ], %g1 the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; _ISR_Enable( level ); *size_p = the_message->Contents.size; 201019c: d4 26 c0 00 st %o2, [ %i3 ] _Thread_Executing->Wait.count = 20101a0: c4 06 60 08 ld [ %i1 + 8 ], %g2 20101a4: c4 20 60 24 st %g2, [ %g1 + 0x24 ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 20101a8: 92 10 00 11 mov %l1, %o1 20101ac: 40 00 22 ca call 2018cd4 20101b0: 90 10 00 1a mov %i2, %o0 * is not, then we can go ahead and free the buffer. * * NOTE: If we note that the queue was not full before this receive, * then we can avoid this dequeue. */ the_thread = _Thread_queue_Dequeue( &the_message_queue->Wait_queue ); 20101b4: 40 00 07 bb call 20120a0 <_Thread_queue_Dequeue> 20101b8: 90 10 00 18 mov %i0, %o0 if ( !the_thread ) { 20101bc: 82 92 20 00 orcc %o0, 0, %g1 20101c0: 32 80 00 04 bne,a 20101d0 <_CORE_message_queue_Seize+0x98> 20101c4: c4 00 60 24 ld [ %g1 + 0x24 ], %g2 RTEMS_INLINE_ROUTINE void _CORE_message_queue_Free_message_buffer ( CORE_message_queue_Control *the_message_queue, CORE_message_queue_Buffer_control *the_message ) { _Chain_Append( &the_message_queue->Inactive_messages, &the_message->Node ); 20101c8: 7f ff ff 7b call 200ffb4 <_Chain_Append> 20101cc: 91 ee 20 68 restore %i0, 0x68, %o0 */ _CORE_message_queue_Set_message_priority( the_message, the_thread->Wait.count ); the_message->Contents.size = (size_t) the_thread->Wait.option; 20101d0: d4 00 60 30 ld [ %g1 + 0x30 ], %o2 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 20101d4: d2 00 60 2c ld [ %g1 + 0x2c ], %o1 CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 20101d8: c4 26 60 08 st %g2, [ %i1 + 8 ] 20101dc: d4 26 60 0c st %o2, [ %i1 + 0xc ] const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 20101e0: 40 00 22 bd call 2018cd4 20101e4: 90 10 00 11 mov %l1, %o0 the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 20101e8: f4 06 60 08 ld [ %i1 + 8 ], %i2 20101ec: 40 00 16 bd call 2015ce0 <_CORE_message_queue_Insert_message> 20101f0: 81 e8 00 00 restore return; } #endif } if ( !wait ) { 20101f4: 80 8f 20 ff btst 0xff, %i4 20101f8: 32 80 00 08 bne,a 2010218 <_CORE_message_queue_Seize+0xe0> 20101fc: 84 10 20 01 mov 1, %g2 _ISR_Enable( level ); 2010200: 7f ff dd 7a call 20077e8 2010204: 90 10 00 01 mov %g1, %o0 executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 2010208: 82 10 20 04 mov 4, %g1 201020c: c2 24 a0 34 st %g1, [ %l2 + 0x34 ] executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 2010210: 81 c7 e0 08 ret 2010214: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE void _Thread_queue_Enter_critical_section ( Thread_queue_Control *the_thread_queue ) { the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 2010218: c4 24 20 30 st %g2, [ %l0 + 0x30 ] executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; 201021c: e0 24 a0 44 st %l0, [ %l2 + 0x44 ] executing->Wait.id = id; 2010220: e2 24 a0 20 st %l1, [ %l2 + 0x20 ] executing->Wait.return_argument_second.mutable_object = buffer; 2010224: f4 24 a0 2c st %i2, [ %l2 + 0x2c ] executing->Wait.return_argument = size_p; 2010228: f6 24 a0 28 st %i3, [ %l2 + 0x28 ] /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 201022c: 90 10 00 01 mov %g1, %o0 2010230: 7f ff dd 6e call 20077e8 2010234: 35 00 80 49 sethi %hi(0x2012400), %i2 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 2010238: b0 10 00 10 mov %l0, %i0 201023c: b2 10 00 1d mov %i5, %i1 2010240: 40 00 07 f9 call 2012224 <_Thread_queue_Enqueue_with_handler> 2010244: 95 ee a1 a4 restore %i2, 0x1a4, %o2 =============================================================================== 02006eb8 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 2006eb8: 9d e3 bf a0 save %sp, -96, %sp _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 2006ebc: 03 00 80 58 sethi %hi(0x2016000), %g1 2006ec0: c2 00 61 48 ld [ %g1 + 0x148 ], %g1 ! 2016148 <_Thread_Dispatch_disable_level> 2006ec4: 80 a0 60 00 cmp %g1, 0 2006ec8: 02 80 00 0d be 2006efc <_CORE_mutex_Seize+0x44> 2006ecc: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 2006ed0: 80 8e a0 ff btst 0xff, %i2 2006ed4: 02 80 00 0b be 2006f00 <_CORE_mutex_Seize+0x48> <== NEVER TAKEN 2006ed8: 90 10 00 18 mov %i0, %o0 2006edc: 03 00 80 58 sethi %hi(0x2016000), %g1 2006ee0: c2 00 62 f0 ld [ %g1 + 0x2f0 ], %g1 ! 20162f0 <_System_state_Current> 2006ee4: 80 a0 60 01 cmp %g1, 1 2006ee8: 08 80 00 05 bleu 2006efc <_CORE_mutex_Seize+0x44> 2006eec: 90 10 20 00 clr %o0 2006ef0: 92 10 20 00 clr %o1 2006ef4: 40 00 01 e5 call 2007688 <_Internal_error_Occurred> 2006ef8: 94 10 20 13 mov 0x13, %o2 2006efc: 90 10 00 18 mov %i0, %o0 2006f00: 40 00 15 cc call 200c630 <_CORE_mutex_Seize_interrupt_trylock> 2006f04: 92 07 a0 54 add %fp, 0x54, %o1 2006f08: 80 a2 20 00 cmp %o0, 0 2006f0c: 02 80 00 09 be 2006f30 <_CORE_mutex_Seize+0x78> 2006f10: 80 8e a0 ff btst 0xff, %i2 2006f14: 12 80 00 09 bne 2006f38 <_CORE_mutex_Seize+0x80> 2006f18: 35 00 80 58 sethi %hi(0x2016000), %i2 2006f1c: 7f ff ec ad call 20021d0 2006f20: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 2006f24: c2 06 a2 08 ld [ %i2 + 0x208 ], %g1 2006f28: 84 10 20 01 mov 1, %g2 2006f2c: c4 20 60 34 st %g2, [ %g1 + 0x34 ] 2006f30: 81 c7 e0 08 ret 2006f34: 81 e8 00 00 restore RTEMS_INLINE_ROUTINE void _Thread_queue_Enter_critical_section ( Thread_queue_Control *the_thread_queue ) { the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 2006f38: 82 10 20 01 mov 1, %g1 2006f3c: c2 26 20 30 st %g1, [ %i0 + 0x30 ] 2006f40: c2 06 a2 08 ld [ %i2 + 0x208 ], %g1 2006f44: f0 20 60 44 st %i0, [ %g1 + 0x44 ] 2006f48: f2 20 60 20 st %i1, [ %g1 + 0x20 ] 2006f4c: 03 00 80 58 sethi %hi(0x2016000), %g1 2006f50: c4 00 61 48 ld [ %g1 + 0x148 ], %g2 ! 2016148 <_Thread_Dispatch_disable_level> 2006f54: 84 00 a0 01 inc %g2 2006f58: c4 20 61 48 st %g2, [ %g1 + 0x148 ] 2006f5c: 7f ff ec 9d call 20021d0 2006f60: d0 07 a0 54 ld [ %fp + 0x54 ], %o0 2006f64: 90 10 00 18 mov %i0, %o0 2006f68: 7f ff ff bb call 2006e54 <_CORE_mutex_Seize_interrupt_blocking> 2006f6c: 92 10 00 1b mov %i3, %o1 2006f70: 81 c7 e0 08 ret 2006f74: 81 e8 00 00 restore =============================================================================== 02007110 <_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 ) { 2007110: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 2007114: 90 10 00 18 mov %i0, %o0 2007118: 40 00 06 3c call 2008a08 <_Thread_queue_Dequeue> 200711c: a0 10 00 18 mov %i0, %l0 2007120: 80 a2 20 00 cmp %o0, 0 2007124: 12 80 00 0e bne 200715c <_CORE_semaphore_Surrender+0x4c> 2007128: b0 10 20 00 clr %i0 if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 200712c: 7f ff ec 25 call 20021c0 2007130: 01 00 00 00 nop if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 2007134: c2 04 20 48 ld [ %l0 + 0x48 ], %g1 2007138: c4 04 20 40 ld [ %l0 + 0x40 ], %g2 200713c: 80 a0 40 02 cmp %g1, %g2 2007140: 1a 80 00 05 bcc 2007154 <_CORE_semaphore_Surrender+0x44> <== NEVER TAKEN 2007144: b0 10 20 04 mov 4, %i0 the_semaphore->count += 1; 2007148: 82 00 60 01 inc %g1 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 200714c: b0 10 20 00 clr %i0 #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; 2007150: c2 24 20 48 st %g1, [ %l0 + 0x48 ] else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 2007154: 7f ff ec 1f call 20021d0 2007158: 01 00 00 00 nop } return status; } 200715c: 81 c7 e0 08 ret 2007160: 81 e8 00 00 restore =============================================================================== 02005ce4 <_Event_Seize>: rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { 2005ce4: 9d e3 bf a0 save %sp, -96, %sp rtems_event_set pending_events; ISR_Level level; RTEMS_API_Control *api; Thread_blocking_operation_States sync_state; executing = _Thread_Executing; 2005ce8: 03 00 80 58 sethi %hi(0x2016000), %g1 2005cec: e0 00 62 08 ld [ %g1 + 0x208 ], %l0 ! 2016208 <_Thread_Executing> executing->Wait.return_code = RTEMS_SUCCESSFUL; 2005cf0: c0 24 20 34 clr [ %l0 + 0x34 ] api = executing->API_Extensions[ THREAD_API_RTEMS ]; _ISR_Disable( level ); 2005cf4: 7f ff f1 33 call 20021c0 2005cf8: e4 04 21 68 ld [ %l0 + 0x168 ], %l2 pending_events = api->pending_events; 2005cfc: c2 04 80 00 ld [ %l2 ], %g1 seized_events = _Event_sets_Get( pending_events, event_in ); if ( !_Event_sets_Is_empty( seized_events ) && 2005d00: a2 8e 00 01 andcc %i0, %g1, %l1 2005d04: 02 80 00 0f be 2005d40 <_Event_Seize+0x5c> 2005d08: 80 8e 60 01 btst 1, %i1 2005d0c: 80 a4 40 18 cmp %l1, %i0 2005d10: 22 80 00 06 be,a 2005d28 <_Event_Seize+0x44> 2005d14: 82 28 40 11 andn %g1, %l1, %g1 (seized_events == event_in || _Options_Is_any( option_set )) ) { 2005d18: 80 8e 60 02 btst 2, %i1 2005d1c: 22 80 00 09 be,a 2005d40 <_Event_Seize+0x5c> <== NEVER TAKEN 2005d20: 80 8e 60 01 btst 1, %i1 <== NOT EXECUTED 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) ); 2005d24: 82 28 40 11 andn %g1, %l1, %g1 api->pending_events = 2005d28: c2 24 80 00 st %g1, [ %l2 ] _Event_sets_Clear( pending_events, seized_events ); _ISR_Enable( level ); 2005d2c: 7f ff f1 29 call 20021d0 2005d30: 01 00 00 00 nop 2005d34: e2 26 c0 00 st %l1, [ %i3 ] 2005d38: 81 c7 e0 08 ret 2005d3c: 81 e8 00 00 restore *event_out = seized_events; return; } if ( _Options_Is_no_wait( option_set ) ) { 2005d40: 22 80 00 09 be,a 2005d64 <_Event_Seize+0x80> 2005d44: f2 24 20 30 st %i1, [ %l0 + 0x30 ] _ISR_Enable( level ); 2005d48: 7f ff f1 22 call 20021d0 2005d4c: 01 00 00 00 nop executing->Wait.return_code = RTEMS_UNSATISFIED; 2005d50: 82 10 20 0d mov 0xd, %g1 ! d 2005d54: c2 24 20 34 st %g1, [ %l0 + 0x34 ] *event_out = seized_events; 2005d58: e2 26 c0 00 st %l1, [ %i3 ] 2005d5c: 81 c7 e0 08 ret 2005d60: 81 e8 00 00 restore * * NOTE: Since interrupts are disabled, this isn't that much of an * issue but better safe than sorry. */ executing->Wait.option = (uint32_t) option_set; executing->Wait.count = (uint32_t) event_in; 2005d64: f0 24 20 24 st %i0, [ %l0 + 0x24 ] executing->Wait.return_argument = event_out; 2005d68: f6 24 20 28 st %i3, [ %l0 + 0x28 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 2005d6c: 84 10 20 01 mov 1, %g2 2005d70: 03 00 80 5a sethi %hi(0x2016800), %g1 2005d74: c4 20 62 78 st %g2, [ %g1 + 0x278 ] ! 2016a78 <_Event_Sync_state> _ISR_Enable( level ); 2005d78: 7f ff f1 16 call 20021d0 2005d7c: 01 00 00 00 nop if ( ticks ) { 2005d80: 80 a6 a0 00 cmp %i2, 0 2005d84: 02 80 00 0f be 2005dc0 <_Event_Seize+0xdc> 2005d88: 90 10 00 10 mov %l0, %o0 _Watchdog_Initialize( 2005d8c: c2 04 20 08 ld [ %l0 + 8 ], %g1 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 2005d90: 05 00 80 17 sethi %hi(0x2005c00), %g2 2005d94: 84 10 a3 98 or %g2, 0x398, %g2 ! 2005f98 <_Event_Timeout> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 2005d98: 11 00 80 58 sethi %hi(0x2016000), %o0 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 2005d9c: c0 24 20 50 clr [ %l0 + 0x50 ] the_watchdog->routine = routine; 2005da0: c4 24 20 64 st %g2, [ %l0 + 0x64 ] the_watchdog->id = id; 2005da4: c2 24 20 68 st %g1, [ %l0 + 0x68 ] the_watchdog->user_data = user_data; 2005da8: c0 24 20 6c clr [ %l0 + 0x6c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 2005dac: f4 24 20 54 st %i2, [ %l0 + 0x54 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 2005db0: 90 12 22 28 or %o0, 0x228, %o0 2005db4: 40 00 0e 82 call 20097bc <_Watchdog_Insert> 2005db8: 92 04 20 48 add %l0, 0x48, %o1 NULL ); _Watchdog_Insert_ticks( &executing->Timer, ticks ); } _Thread_Set_state( executing, STATES_WAITING_FOR_EVENT ); 2005dbc: 90 10 00 10 mov %l0, %o0 2005dc0: 40 00 0c 7d call 2008fb4 <_Thread_Set_state> 2005dc4: 92 10 21 00 mov 0x100, %o1 _ISR_Disable( level ); 2005dc8: 7f ff f0 fe call 20021c0 2005dcc: 01 00 00 00 nop sync_state = _Event_Sync_state; 2005dd0: 03 00 80 5a sethi %hi(0x2016800), %g1 2005dd4: f0 00 62 78 ld [ %g1 + 0x278 ], %i0 ! 2016a78 <_Event_Sync_state> _Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 2005dd8: c0 20 62 78 clr [ %g1 + 0x278 ] if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) { 2005ddc: 80 a6 20 01 cmp %i0, 1 2005de0: 12 80 00 04 bne 2005df0 <_Event_Seize+0x10c> 2005de4: b2 10 00 10 mov %l0, %i1 _ISR_Enable( level ); 2005de8: 7f ff f0 fa call 20021d0 2005dec: 91 e8 00 08 restore %g0, %o0, %o0 * An interrupt completed the thread's blocking request. * The blocking thread was satisfied by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ _Thread_blocking_operation_Cancel( sync_state, executing, level ); 2005df0: 40 00 08 71 call 2007fb4 <_Thread_blocking_operation_Cancel> 2005df4: 95 e8 00 08 restore %g0, %o0, %o2 =============================================================================== 02005e58 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 2005e58: 9d e3 bf a0 save %sp, -96, %sp rtems_event_set event_condition; rtems_event_set seized_events; rtems_option option_set; RTEMS_API_Control *api; api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 2005e5c: e2 06 21 68 ld [ %i0 + 0x168 ], %l1 option_set = (rtems_option) the_thread->Wait.option; 2005e60: e4 06 20 30 ld [ %i0 + 0x30 ], %l2 _ISR_Disable( level ); 2005e64: 7f ff f0 d7 call 20021c0 2005e68: a0 10 00 18 mov %i0, %l0 2005e6c: b0 10 00 08 mov %o0, %i0 pending_events = api->pending_events; 2005e70: c4 04 40 00 ld [ %l1 ], %g2 event_condition = (rtems_event_set) the_thread->Wait.count; 2005e74: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { 2005e78: 82 88 c0 02 andcc %g3, %g2, %g1 2005e7c: 12 80 00 03 bne 2005e88 <_Event_Surrender+0x30> 2005e80: 09 00 80 58 sethi %hi(0x2016000), %g4 _ISR_Enable( level ); 2005e84: 30 80 00 42 b,a 2005f8c <_Event_Surrender+0x134> /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && 2005e88: c8 01 21 e4 ld [ %g4 + 0x1e4 ], %g4 ! 20161e4 <_ISR_Nest_level> 2005e8c: 80 a1 20 00 cmp %g4, 0 2005e90: 22 80 00 1e be,a 2005f08 <_Event_Surrender+0xb0> 2005e94: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 2005e98: 09 00 80 58 sethi %hi(0x2016000), %g4 2005e9c: c8 01 22 08 ld [ %g4 + 0x208 ], %g4 ! 2016208 <_Thread_Executing> 2005ea0: 80 a4 00 04 cmp %l0, %g4 2005ea4: 32 80 00 19 bne,a 2005f08 <_Event_Surrender+0xb0> 2005ea8: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 2005eac: 09 00 80 5a sethi %hi(0x2016800), %g4 2005eb0: da 01 22 78 ld [ %g4 + 0x278 ], %o5 ! 2016a78 <_Event_Sync_state> /* * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && 2005eb4: 80 a3 60 02 cmp %o5, 2 2005eb8: 02 80 00 07 be 2005ed4 <_Event_Surrender+0x7c> <== NEVER TAKEN 2005ebc: 80 a0 40 03 cmp %g1, %g3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 2005ec0: c8 01 22 78 ld [ %g4 + 0x278 ], %g4 * If we are in an ISR and sending to the current thread, then * we have a critical section issue to deal with. */ if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 2005ec4: 80 a1 20 01 cmp %g4, 1 2005ec8: 32 80 00 10 bne,a 2005f08 <_Event_Surrender+0xb0> 2005ecc: c8 04 20 10 ld [ %l0 + 0x10 ], %g4 (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { 2005ed0: 80 a0 40 03 cmp %g1, %g3 2005ed4: 02 80 00 04 be 2005ee4 <_Event_Surrender+0x8c> 2005ed8: 80 8c a0 02 btst 2, %l2 2005edc: 02 80 00 0a be 2005f04 <_Event_Surrender+0xac> <== NEVER TAKEN 2005ee0: 01 00 00 00 nop RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear( rtems_event_set the_event_set, rtems_event_set the_mask ) { return ( the_event_set & ~(the_mask) ); 2005ee4: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 2005ee8: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 2005eec: c4 04 20 28 ld [ %l0 + 0x28 ], %g2 _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; 2005ef0: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 2005ef4: c2 20 80 00 st %g1, [ %g2 ] _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 2005ef8: 84 10 20 03 mov 3, %g2 2005efc: 03 00 80 5a sethi %hi(0x2016800), %g1 2005f00: c4 20 62 78 st %g2, [ %g1 + 0x278 ] ! 2016a78 <_Event_Sync_state> } _ISR_Enable( level ); 2005f04: 30 80 00 22 b,a 2005f8c <_Event_Surrender+0x134> } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 2005f08: 80 89 21 00 btst 0x100, %g4 2005f0c: 02 80 00 20 be 2005f8c <_Event_Surrender+0x134> 2005f10: 80 a0 40 03 cmp %g1, %g3 if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 2005f14: 02 80 00 04 be 2005f24 <_Event_Surrender+0xcc> 2005f18: 80 8c a0 02 btst 2, %l2 2005f1c: 02 80 00 1c be 2005f8c <_Event_Surrender+0x134> <== NEVER TAKEN 2005f20: 01 00 00 00 nop 2005f24: 84 28 80 01 andn %g2, %g1, %g2 api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 2005f28: c4 24 40 00 st %g2, [ %l1 ] the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 2005f2c: c4 04 20 28 ld [ %l0 + 0x28 ], %g2 * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; 2005f30: c0 24 20 24 clr [ %l0 + 0x24 ] *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 2005f34: c2 20 80 00 st %g1, [ %g2 ] _ISR_Flash( level ); 2005f38: 7f ff f0 a6 call 20021d0 2005f3c: 90 10 00 18 mov %i0, %o0 2005f40: 7f ff f0 a0 call 20021c0 2005f44: 01 00 00 00 nop if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 2005f48: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 2005f4c: 80 a0 60 02 cmp %g1, 2 2005f50: 02 80 00 06 be 2005f68 <_Event_Surrender+0x110> 2005f54: 82 10 20 03 mov 3, %g1 _ISR_Enable( level ); 2005f58: 7f ff f0 9e call 20021d0 2005f5c: 90 10 00 18 mov %i0, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 2005f60: 10 80 00 08 b 2005f80 <_Event_Surrender+0x128> 2005f64: 33 04 00 ff sethi %hi(0x1003fc00), %i1 RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 2005f68: c2 24 20 50 st %g1, [ %l0 + 0x50 ] _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 2005f6c: 7f ff f0 99 call 20021d0 2005f70: 90 10 00 18 mov %i0, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 2005f74: 40 00 0e 6d call 2009928 <_Watchdog_Remove> 2005f78: 90 04 20 48 add %l0, 0x48, %o0 2005f7c: 33 04 00 ff sethi %hi(0x1003fc00), %i1 2005f80: b2 16 63 f8 or %i1, 0x3f8, %i1 ! 1003fff8 2005f84: 40 00 08 9c call 20081f4 <_Thread_Clear_state> 2005f88: 91 e8 00 10 restore %g0, %l0, %o0 _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 2005f8c: 7f ff f0 91 call 20021d0 2005f90: 81 e8 00 00 restore =============================================================================== 02005f98 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 2005f98: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 2005f9c: 90 10 00 18 mov %i0, %o0 2005fa0: 40 00 09 ac call 2008650 <_Thread_Get> 2005fa4: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 2005fa8: c2 07 bf fc ld [ %fp + -4 ], %g1 2005fac: 80 a0 60 00 cmp %g1, 0 2005fb0: 12 80 00 1c bne 2006020 <_Event_Timeout+0x88> <== NEVER TAKEN 2005fb4: a0 10 00 08 mov %o0, %l0 * * If it is not satisfied, then it is "nothing happened" and * this is the "timeout" transition. After a request is satisfied, * a timeout is not allowed to occur. */ _ISR_Disable( level ); 2005fb8: 7f ff f0 82 call 20021c0 2005fbc: 01 00 00 00 nop return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 2005fc0: 03 00 80 58 sethi %hi(0x2016000), %g1 2005fc4: c2 00 62 08 ld [ %g1 + 0x208 ], %g1 ! 2016208 <_Thread_Executing> 2005fc8: 80 a4 00 01 cmp %l0, %g1 2005fcc: 12 80 00 09 bne 2005ff0 <_Event_Timeout+0x58> 2005fd0: c0 24 20 24 clr [ %l0 + 0x24 ] if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 2005fd4: 03 00 80 5a sethi %hi(0x2016800), %g1 2005fd8: c4 00 62 78 ld [ %g1 + 0x278 ], %g2 ! 2016a78 <_Event_Sync_state> 2005fdc: 80 a0 a0 01 cmp %g2, 1 2005fe0: 32 80 00 05 bne,a 2005ff4 <_Event_Timeout+0x5c> 2005fe4: 82 10 20 06 mov 6, %g1 _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 2005fe8: 84 10 20 02 mov 2, %g2 2005fec: c4 20 62 78 st %g2, [ %g1 + 0x278 ] } the_thread->Wait.return_code = RTEMS_TIMEOUT; 2005ff0: 82 10 20 06 mov 6, %g1 2005ff4: c2 24 20 34 st %g1, [ %l0 + 0x34 ] _ISR_Enable( level ); 2005ff8: 7f ff f0 76 call 20021d0 2005ffc: 01 00 00 00 nop 2006000: 90 10 00 10 mov %l0, %o0 2006004: 13 04 00 ff sethi %hi(0x1003fc00), %o1 2006008: 40 00 08 7b call 20081f4 <_Thread_Clear_state> 200600c: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 2006010: 03 00 80 58 sethi %hi(0x2016000), %g1 2006014: c4 00 61 48 ld [ %g1 + 0x148 ], %g2 ! 2016148 <_Thread_Dispatch_disable_level> 2006018: 84 00 bf ff add %g2, -1, %g2 200601c: c4 20 61 48 st %g2, [ %g1 + 0x148 ] 2006020: 81 c7 e0 08 ret 2006024: 81 e8 00 00 restore =============================================================================== 0200c7e0 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 200c7e0: 9d e3 bf 98 save %sp, -104, %sp 200c7e4: a0 10 00 18 mov %i0, %l0 if ( stats->max_search < search_count ) { stats->max_search = search_count; } return (void *) alloc_begin; } 200c7e8: e4 06 20 08 ld [ %i0 + 8 ], %l2 ) { Heap_Statistics *const stats = &heap->stats; Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); Heap_Block *block = _Heap_Free_list_first( heap ); uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE 200c7ec: ac 06 60 04 add %i1, 4, %l6 - HEAP_BLOCK_SIZE_OFFSET; uintptr_t const page_size = heap->page_size; 200c7f0: e8 06 20 10 ld [ %i0 + 0x10 ], %l4 uintptr_t alloc_begin = 0; uint32_t search_count = 0; if ( block_size_floor < alloc_size ) { 200c7f4: 80 a5 80 19 cmp %l6, %i1 200c7f8: 0a 80 00 67 bcs 200c994 <_Heap_Allocate_aligned_with_boundary+0x1b4> 200c7fc: b0 10 20 00 clr %i0 /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { 200c800: 80 a6 e0 00 cmp %i3, 0 200c804: 02 80 00 08 be 200c824 <_Heap_Allocate_aligned_with_boundary+0x44> 200c808: 82 05 20 07 add %l4, 7, %g1 if ( boundary < alloc_size ) { 200c80c: 80 a6 c0 19 cmp %i3, %i1 200c810: 0a 80 00 61 bcs 200c994 <_Heap_Allocate_aligned_with_boundary+0x1b4> 200c814: 80 a6 a0 00 cmp %i2, 0 return NULL; } if ( alignment == 0 ) { 200c818: 22 80 00 03 be,a 200c824 <_Heap_Allocate_aligned_with_boundary+0x44> 200c81c: b4 10 00 14 mov %l4, %i2 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 200c820: 82 05 20 07 add %l4, 7, %g1 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; 200c824: b8 10 20 04 mov 4, %i4 if ( boundary < alloc_size ) { return NULL; } if ( alignment == 0 ) { alignment = page_size; 200c828: a2 10 20 00 clr %l1 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size 200c82c: c2 27 bf f8 st %g1, [ %fp + -8 ] + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; 200c830: b8 27 00 19 sub %i4, %i1, %i4 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 200c834: 10 80 00 50 b 200c974 <_Heap_Allocate_aligned_with_boundary+0x194> 200c838: ba 10 3f f8 mov -8, %i5 /* * 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 ) { 200c83c: 80 a6 00 16 cmp %i0, %l6 200c840: 08 80 00 4c bleu 200c970 <_Heap_Allocate_aligned_with_boundary+0x190> 200c844: a2 04 60 01 inc %l1 if ( alignment == 0 ) { 200c848: 80 a6 a0 00 cmp %i2, 0 200c84c: 12 80 00 04 bne 200c85c <_Heap_Allocate_aligned_with_boundary+0x7c> 200c850: aa 04 a0 08 add %l2, 8, %l5 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 200c854: 10 80 00 3a b 200c93c <_Heap_Allocate_aligned_with_boundary+0x15c> 200c858: b0 10 00 15 mov %l5, %i0 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; 200c85c: c2 07 bf f8 ld [ %fp + -8 ], %g1 uintptr_t alignment, uintptr_t boundary ) { uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; 200c860: ee 04 20 14 ld [ %l0 + 0x14 ], %l7 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 200c864: b0 0e 3f fe and %i0, -2, %i0 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; 200c868: a6 20 40 17 sub %g1, %l7, %l3 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; 200c86c: b0 04 80 18 add %l2, %i0, %i0 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 200c870: 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 200c874: a6 04 c0 18 add %l3, %i0, %l3 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; uintptr_t alloc_begin = alloc_end - alloc_size; 200c878: b0 07 00 18 add %i4, %i0, %i0 200c87c: 40 00 17 9c call 20126ec <.urem> 200c880: 90 10 00 18 mov %i0, %o0 200c884: b0 26 00 08 sub %i0, %o0, %i0 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 ) { 200c888: 80 a6 00 13 cmp %i0, %l3 200c88c: 08 80 00 07 bleu 200c8a8 <_Heap_Allocate_aligned_with_boundary+0xc8> 200c890: 80 a6 e0 00 cmp %i3, 0 200c894: 90 10 00 13 mov %l3, %o0 200c898: 40 00 17 95 call 20126ec <.urem> 200c89c: 92 10 00 1a mov %i2, %o1 200c8a0: b0 24 c0 08 sub %l3, %o0, %i0 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { 200c8a4: 80 a6 e0 00 cmp %i3, 0 200c8a8: 02 80 00 18 be 200c908 <_Heap_Allocate_aligned_with_boundary+0x128> 200c8ac: 80 a6 00 15 cmp %i0, %l5 uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; 200c8b0: 82 05 40 19 add %l5, %i1, %g1 /* 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; 200c8b4: a6 06 00 19 add %i0, %i1, %l3 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; 200c8b8: 10 80 00 0a b 200c8e0 <_Heap_Allocate_aligned_with_boundary+0x100> 200c8bc: c2 27 bf fc st %g1, [ %fp + -4 ] uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { 200c8c0: 80 a2 00 01 cmp %o0, %g1 200c8c4: 0a 80 00 2b bcs 200c970 <_Heap_Allocate_aligned_with_boundary+0x190> 200c8c8: b0 22 00 19 sub %o0, %i1, %i0 200c8cc: 92 10 00 1a mov %i2, %o1 200c8d0: 40 00 17 87 call 20126ec <.urem> 200c8d4: 90 10 00 18 mov %i0, %o0 200c8d8: b0 26 00 08 sub %i0, %o0, %i0 return 0; } alloc_begin = boundary_line - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; 200c8dc: a6 06 00 19 add %i0, %i1, %l3 200c8e0: 90 10 00 13 mov %l3, %o0 200c8e4: 40 00 17 82 call 20126ec <.urem> 200c8e8: 92 10 00 1b mov %i3, %o1 200c8ec: 90 24 c0 08 sub %l3, %o0, %o0 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { 200c8f0: 80 a2 00 13 cmp %o0, %l3 200c8f4: 1a 80 00 04 bcc 200c904 <_Heap_Allocate_aligned_with_boundary+0x124> 200c8f8: 80 a6 00 08 cmp %i0, %o0 200c8fc: 0a bf ff f1 bcs 200c8c0 <_Heap_Allocate_aligned_with_boundary+0xe0> 200c900: c2 07 bf fc ld [ %fp + -4 ], %g1 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 ) { 200c904: 80 a6 00 15 cmp %i0, %l5 200c908: 2a 80 00 1b bcs,a 200c974 <_Heap_Allocate_aligned_with_boundary+0x194> 200c90c: e4 04 a0 08 ld [ %l2 + 8 ], %l2 200c910: a6 27 40 12 sub %i5, %l2, %l3 200c914: 90 10 00 18 mov %i0, %o0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 200c918: a6 04 c0 18 add %l3, %i0, %l3 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 200c91c: 40 00 17 74 call 20126ec <.urem> 200c920: 92 10 00 14 mov %l4, %o1 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 ) { 200c924: 90 a4 c0 08 subcc %l3, %o0, %o0 200c928: 02 80 00 06 be 200c940 <_Heap_Allocate_aligned_with_boundary+0x160> 200c92c: 80 a6 20 00 cmp %i0, 0 200c930: 80 a2 00 17 cmp %o0, %l7 200c934: 2a 80 00 10 bcs,a 200c974 <_Heap_Allocate_aligned_with_boundary+0x194> 200c938: e4 04 a0 08 ld [ %l2 + 8 ], %l2 boundary ); } } if ( alloc_begin != 0 ) { 200c93c: 80 a6 20 00 cmp %i0, 0 200c940: 22 80 00 0d be,a 200c974 <_Heap_Allocate_aligned_with_boundary+0x194><== NEVER TAKEN 200c944: e4 04 a0 08 ld [ %l2 + 8 ], %l2 <== NOT EXECUTED block = block->next; } if ( alloc_begin != 0 ) { /* Statistics */ stats->searches += search_count; 200c948: c2 04 20 4c ld [ %l0 + 0x4c ], %g1 block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 200c94c: 90 10 00 10 mov %l0, %o0 block = block->next; } if ( alloc_begin != 0 ) { /* Statistics */ stats->searches += search_count; 200c950: 82 00 40 11 add %g1, %l1, %g1 block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 200c954: 92 10 00 12 mov %l2, %o1 block = block->next; } if ( alloc_begin != 0 ) { /* Statistics */ stats->searches += search_count; 200c958: c2 24 20 4c st %g1, [ %l0 + 0x4c ] block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 200c95c: 94 10 00 18 mov %i0, %o2 200c960: 7f ff ea fd call 2007554 <_Heap_Block_allocate> 200c964: 96 10 00 19 mov %i1, %o3 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { 200c968: 10 80 00 08 b 200c988 <_Heap_Allocate_aligned_with_boundary+0x1a8> 200c96c: c2 04 20 44 ld [ %l0 + 0x44 ], %g1 if ( alloc_begin != 0 ) { break; } block = block->next; 200c970: e4 04 a0 08 ld [ %l2 + 8 ], %l2 if ( alignment == 0 ) { alignment = page_size; } } while ( block != free_list_tail ) { 200c974: 80 a4 80 10 cmp %l2, %l0 200c978: 32 bf ff b1 bne,a 200c83c <_Heap_Allocate_aligned_with_boundary+0x5c> 200c97c: f0 04 a0 04 ld [ %l2 + 4 ], %i0 200c980: b0 10 20 00 clr %i0 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { 200c984: c2 04 20 44 ld [ %l0 + 0x44 ], %g1 200c988: 80 a0 40 11 cmp %g1, %l1 200c98c: 2a 80 00 02 bcs,a 200c994 <_Heap_Allocate_aligned_with_boundary+0x1b4> 200c990: e2 24 20 44 st %l1, [ %l0 + 0x44 ] stats->max_search = search_count; } return (void *) alloc_begin; } 200c994: 81 c7 e0 08 ret 200c998: 81 e8 00 00 restore =============================================================================== 02011208 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 2011208: 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; 201120c: c0 27 bf fc clr [ %fp + -4 ] Heap_Block *extend_last_block = NULL; 2011210: c0 27 bf f8 clr [ %fp + -8 ] Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 2011214: a0 10 00 18 mov %i0, %l0 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 2011218: e4 06 20 20 ld [ %i0 + 0x20 ], %l2 Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; 201121c: e6 06 20 10 ld [ %i0 + 0x10 ], %l3 uintptr_t const min_block_size = heap->min_block_size; 2011220: d6 06 20 14 ld [ %i0 + 0x14 ], %o3 uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; 2011224: a2 06 40 1a add %i1, %i2, %l1 uintptr_t const free_size = stats->free_size; 2011228: e8 06 20 30 ld [ %i0 + 0x30 ], %l4 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 201122c: 92 10 00 1a mov %i2, %o1 uintptr_t const free_size = stats->free_size; uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { 2011230: 80 a4 40 19 cmp %l1, %i1 2011234: 0a 80 00 9f bcs 20114b0 <_Heap_Extend+0x2a8> 2011238: b0 10 20 00 clr %i0 return false; } extend_area_ok = _Heap_Get_first_and_last_block( 201123c: 90 10 00 19 mov %i1, %o0 2011240: 94 10 00 13 mov %l3, %o2 2011244: 98 07 bf fc add %fp, -4, %o4 2011248: 7f ff e8 4d call 200b37c <_Heap_Get_first_and_last_block> 201124c: 9a 07 bf f8 add %fp, -8, %o5 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 2011250: 80 8a 20 ff btst 0xff, %o0 2011254: 02 80 00 97 be 20114b0 <_Heap_Extend+0x2a8> 2011258: aa 10 00 12 mov %l2, %l5 201125c: ba 10 20 00 clr %i5 2011260: b8 10 20 00 clr %i4 2011264: b0 10 20 00 clr %i0 2011268: ae 10 20 00 clr %l7 201126c: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 (uintptr_t) start_block : heap->area_begin; uintptr_t const sub_area_end = start_block->prev_size; Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 2011270: 80 a0 40 11 cmp %g1, %l1 2011274: 1a 80 00 05 bcc 2011288 <_Heap_Extend+0x80> 2011278: ec 05 40 00 ld [ %l5 ], %l6 201127c: 80 a6 40 16 cmp %i1, %l6 2011280: 2a 80 00 8c bcs,a 20114b0 <_Heap_Extend+0x2a8> 2011284: b0 10 20 00 clr %i0 sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { 2011288: 80 a4 40 01 cmp %l1, %g1 201128c: 02 80 00 06 be 20112a4 <_Heap_Extend+0x9c> 2011290: 80 a4 40 16 cmp %l1, %l6 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 2011294: 2a 80 00 05 bcs,a 20112a8 <_Heap_Extend+0xa0> 2011298: b8 10 00 15 mov %l5, %i4 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 201129c: 10 80 00 04 b 20112ac <_Heap_Extend+0xa4> 20112a0: 90 10 00 16 mov %l6, %o0 20112a4: ae 10 00 15 mov %l5, %l7 20112a8: 90 10 00 16 mov %l6, %o0 20112ac: 7f ff cc 08 call 20042cc <.urem> 20112b0: 92 10 00 13 mov %l3, %o1 20112b4: b4 05 bf f8 add %l6, -8, %i2 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 20112b8: 80 a5 80 19 cmp %l6, %i1 20112bc: 12 80 00 05 bne 20112d0 <_Heap_Extend+0xc8> 20112c0: 90 26 80 08 sub %i2, %o0, %o0 start_block->prev_size = extend_area_end; 20112c4: e2 25 40 00 st %l1, [ %l5 ] RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_of_alloc_area( uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) 20112c8: 10 80 00 04 b 20112d8 <_Heap_Extend+0xd0> 20112cc: b0 10 00 08 mov %o0, %i0 merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 20112d0: 2a 80 00 02 bcs,a 20112d8 <_Heap_Extend+0xd0> 20112d4: ba 10 00 08 mov %o0, %i5 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 20112d8: ea 02 20 04 ld [ %o0 + 4 ], %l5 20112dc: aa 0d 7f fe and %l5, -2, %l5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 20112e0: aa 02 00 15 add %o0, %l5, %l5 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 20112e4: 80 a5 40 12 cmp %l5, %l2 20112e8: 12 bf ff e2 bne 2011270 <_Heap_Extend+0x68> 20112ec: 82 10 00 15 mov %l5, %g1 if ( extend_area_begin < heap->area_begin ) { 20112f0: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 20112f4: 80 a6 40 01 cmp %i1, %g1 20112f8: 3a 80 00 04 bcc,a 2011308 <_Heap_Extend+0x100> 20112fc: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 heap->area_begin = extend_area_begin; 2011300: 10 80 00 05 b 2011314 <_Heap_Extend+0x10c> 2011304: f2 24 20 18 st %i1, [ %l0 + 0x18 ] } else if ( heap->area_end < extend_area_end ) { 2011308: 80 a0 40 11 cmp %g1, %l1 201130c: 2a 80 00 02 bcs,a 2011314 <_Heap_Extend+0x10c> 2011310: e2 24 20 1c st %l1, [ %l0 + 0x1c ] heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 2011314: c4 07 bf fc ld [ %fp + -4 ], %g2 2011318: c2 07 bf f8 ld [ %fp + -8 ], %g1 extend_first_block->prev_size = extend_area_end; 201131c: e2 20 80 00 st %l1, [ %g2 ] heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 2011320: 86 20 40 02 sub %g1, %g2, %g3 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 2011324: 88 10 e0 01 or %g3, 1, %g4 extend_last_block->prev_size = extend_first_block_size; 2011328: c6 20 40 00 st %g3, [ %g1 ] extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = 201132c: c8 20 a0 04 st %g4, [ %g2 + 4 ] extend_first_block_size | HEAP_PREV_BLOCK_USED; extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 2011330: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 2011334: 80 a0 c0 02 cmp %g3, %g2 2011338: 08 80 00 04 bleu 2011348 <_Heap_Extend+0x140> 201133c: c0 20 60 04 clr [ %g1 + 4 ] heap->first_block = extend_first_block; 2011340: 10 80 00 06 b 2011358 <_Heap_Extend+0x150> 2011344: c4 24 20 20 st %g2, [ %l0 + 0x20 ] } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 2011348: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 201134c: 80 a0 80 01 cmp %g2, %g1 2011350: 2a 80 00 02 bcs,a 2011358 <_Heap_Extend+0x150> 2011354: c2 24 20 24 st %g1, [ %l0 + 0x24 ] heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { 2011358: 80 a5 e0 00 cmp %l7, 0 201135c: 02 80 00 14 be 20113ac <_Heap_Extend+0x1a4> 2011360: 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; 2011364: e4 04 20 10 ld [ %l0 + 0x10 ], %l2 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; 2011368: 92 10 00 12 mov %l2, %o1 201136c: 7f ff cb d8 call 20042cc <.urem> 2011370: 90 10 00 19 mov %i1, %o0 if ( remainder != 0 ) { 2011374: 80 a2 20 00 cmp %o0, 0 2011378: 02 80 00 04 be 2011388 <_Heap_Extend+0x180> <== ALWAYS TAKEN 201137c: c2 05 c0 00 ld [ %l7 ], %g1 return value - remainder + alignment; 2011380: b2 06 40 12 add %i1, %l2, %i1 <== NOT EXECUTED 2011384: b2 26 40 08 sub %i1, %o0, %i1 <== NOT EXECUTED uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = 2011388: 92 06 7f f8 add %i1, -8, %o1 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; 201138c: c2 26 7f f8 st %g1, [ %i1 + -8 ] uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE; uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = 2011390: 82 25 c0 09 sub %l7, %o1, %g1 first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; 2011394: 82 10 60 01 or %g1, 1, %g1 _Heap_Free_block( heap, new_first_block ); 2011398: 90 10 00 10 mov %l0, %o0 201139c: 7f ff ff 90 call 20111dc <_Heap_Free_block> 20113a0: c2 22 60 04 st %g1, [ %o1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 20113a4: 10 80 00 09 b 20113c8 <_Heap_Extend+0x1c0> 20113a8: 80 a6 20 00 cmp %i0, 0 heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { _Heap_Merge_below( heap, extend_area_begin, merge_below_block ); } else if ( link_below_block != NULL ) { 20113ac: 80 a7 20 00 cmp %i4, 0 20113b0: 02 80 00 05 be 20113c4 <_Heap_Extend+0x1bc> 20113b4: c2 07 bf f8 ld [ %fp + -8 ], %g1 { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = (link_begin - last_block_begin) | HEAP_PREV_BLOCK_USED; 20113b8: b8 27 00 01 sub %i4, %g1, %i4 20113bc: b8 17 20 01 or %i4, 1, %i4 ) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = 20113c0: f8 20 60 04 st %i4, [ %g1 + 4 ] link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 20113c4: 80 a6 20 00 cmp %i0, 0 20113c8: 02 80 00 15 be 201141c <_Heap_Extend+0x214> 20113cc: a2 04 7f f8 add %l1, -8, %l1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 20113d0: d2 04 20 10 ld [ %l0 + 0x10 ], %o1 uintptr_t extend_area_end ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( 20113d4: a2 24 40 18 sub %l1, %i0, %l1 20113d8: 7f ff cb bd call 20042cc <.urem> 20113dc: 90 10 00 11 mov %l1, %o0 ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = (last_block->size_and_flag - last_block_new_size) 20113e0: c4 06 20 04 ld [ %i0 + 4 ], %g2 20113e4: a2 24 40 08 sub %l1, %o0, %l1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 20113e8: 82 04 40 18 add %l1, %i0, %g1 (last_block->size_and_flag - last_block_new_size) 20113ec: 84 20 80 11 sub %g2, %l1, %g2 | HEAP_PREV_BLOCK_USED; 20113f0: 84 10 a0 01 or %g2, 1, %g2 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 20113f4: c4 20 60 04 st %g2, [ %g1 + 4 ] RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 20113f8: c2 06 20 04 ld [ %i0 + 4 ], %g1 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); 20113fc: 90 10 00 10 mov %l0, %o0 2011400: 82 08 60 01 and %g1, 1, %g1 2011404: 92 10 00 18 mov %i0, %o1 block->size_and_flag = size | flag; 2011408: a2 14 40 01 or %l1, %g1, %l1 201140c: 7f ff ff 74 call 20111dc <_Heap_Free_block> 2011410: e2 26 20 04 st %l1, [ %i0 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 2011414: 10 80 00 0f b 2011450 <_Heap_Extend+0x248> 2011418: 80 a6 20 00 cmp %i0, 0 ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { 201141c: 80 a7 60 00 cmp %i5, 0 2011420: 02 80 00 0b be 201144c <_Heap_Extend+0x244> 2011424: c6 07 bf fc ld [ %fp + -4 ], %g3 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 2011428: c4 07 60 04 ld [ %i5 + 4 ], %g2 _Heap_Link_above( 201142c: c2 07 bf f8 ld [ %fp + -8 ], %g1 ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); 2011430: 86 20 c0 1d sub %g3, %i5, %g3 2011434: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 2011438: 84 10 c0 02 or %g3, %g2, %g2 201143c: c4 27 60 04 st %g2, [ %i5 + 4 ] last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 2011440: c4 00 60 04 ld [ %g1 + 4 ], %g2 2011444: 84 10 a0 01 or %g2, 1, %g2 2011448: c4 20 60 04 st %g2, [ %g1 + 4 ] extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 201144c: 80 a6 20 00 cmp %i0, 0 2011450: 32 80 00 09 bne,a 2011474 <_Heap_Extend+0x26c> 2011454: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 2011458: 80 a5 e0 00 cmp %l7, 0 201145c: 32 80 00 06 bne,a 2011474 <_Heap_Extend+0x26c> 2011460: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 _Heap_Free_block( heap, extend_first_block ); 2011464: d2 07 bf fc ld [ %fp + -4 ], %o1 2011468: 7f ff ff 5d call 20111dc <_Heap_Free_block> 201146c: 90 10 00 10 mov %l0, %o0 */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( heap->last_block, (uintptr_t) heap->first_block - (uintptr_t) heap->last_block 2011470: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 2011474: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 2011478: c4 00 60 04 ld [ %g1 + 4 ], %g2 * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 201147c: 86 20 c0 01 sub %g3, %g1, %g3 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 2011480: 84 08 a0 01 and %g2, 1, %g2 block->size_and_flag = size | flag; 2011484: 84 10 c0 02 or %g3, %g2, %g2 2011488: c4 20 60 04 st %g2, [ %g1 + 4 ] } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 201148c: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 2011490: b0 10 20 01 mov 1, %i0 _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 2011494: a8 20 40 14 sub %g1, %l4, %l4 /* Statistics */ stats->size += extended_size; 2011498: c2 04 20 2c ld [ %l0 + 0x2c ], %g1 if ( extended_size_ptr != NULL ) 201149c: 80 a6 e0 00 cmp %i3, 0 _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; 20114a0: 82 00 40 14 add %g1, %l4, %g1 if ( extended_size_ptr != NULL ) 20114a4: 02 80 00 03 be 20114b0 <_Heap_Extend+0x2a8> <== NEVER TAKEN 20114a8: c2 24 20 2c st %g1, [ %l0 + 0x2c ] *extended_size_ptr = extended_size; 20114ac: e8 26 c0 00 st %l4, [ %i3 ] 20114b0: 81 c7 e0 08 ret 20114b4: 81 e8 00 00 restore =============================================================================== 0200c99c <_Heap_Free>: #include #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 200c99c: 9d e3 bf a0 save %sp, -96, %sp 200c9a0: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 200c9a4: 40 00 17 52 call 20126ec <.urem> 200c9a8: 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 200c9ac: d8 06 20 20 ld [ %i0 + 0x20 ], %o4 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 200c9b0: a2 06 7f f8 add %i1, -8, %l1 200c9b4: a0 10 00 18 mov %i0, %l0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 200c9b8: 90 24 40 08 sub %l1, %o0, %o0 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 200c9bc: 80 a2 00 0c cmp %o0, %o4 200c9c0: 0a 80 00 05 bcs 200c9d4 <_Heap_Free+0x38> 200c9c4: 82 10 20 00 clr %g1 200c9c8: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 200c9cc: 80 a0 40 08 cmp %g1, %o0 200c9d0: 82 60 3f ff subx %g0, -1, %g1 Heap_Block *next_block = NULL; uintptr_t block_size = 0; uintptr_t next_block_size = 0; bool next_is_free = false; if ( !_Heap_Is_block_in_heap( heap, block ) ) { 200c9d4: 80 a0 60 00 cmp %g1, 0 200c9d8: 02 80 00 6a be 200cb80 <_Heap_Free+0x1e4> 200c9dc: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 200c9e0: da 02 20 04 ld [ %o0 + 4 ], %o5 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 200c9e4: 84 0b 7f fe and %o5, -2, %g2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 200c9e8: 82 02 00 02 add %o0, %g2, %g1 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 200c9ec: 80 a0 40 0c cmp %g1, %o4 200c9f0: 0a 80 00 05 bcs 200ca04 <_Heap_Free+0x68> <== NEVER TAKEN 200c9f4: 86 10 20 00 clr %g3 200c9f8: c6 04 20 24 ld [ %l0 + 0x24 ], %g3 200c9fc: 80 a0 c0 01 cmp %g3, %g1 200ca00: 86 60 3f ff subx %g0, -1, %g3 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 200ca04: 80 a0 e0 00 cmp %g3, 0 200ca08: 02 80 00 5e be 200cb80 <_Heap_Free+0x1e4> <== NEVER TAKEN 200ca0c: b0 10 20 00 clr %i0 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 200ca10: c8 00 60 04 ld [ %g1 + 4 ], %g4 if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 200ca14: 80 89 20 01 btst 1, %g4 200ca18: 02 80 00 5a be 200cb80 <_Heap_Free+0x1e4> <== NEVER TAKEN 200ca1c: 88 09 3f fe and %g4, -2, %g4 _HAssert( false ); return false; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 200ca20: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 200ca24: 80 a0 40 09 cmp %g1, %o1 200ca28: 02 80 00 07 be 200ca44 <_Heap_Free+0xa8> 200ca2c: 96 10 20 00 clr %o3 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 200ca30: 86 00 40 04 add %g1, %g4, %g3 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 200ca34: c6 00 e0 04 ld [ %g3 + 4 ], %g3 200ca38: 86 08 e0 01 and %g3, 1, %g3 return false; } 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 )); 200ca3c: 80 a0 00 03 cmp %g0, %g3 200ca40: 96 60 3f ff subx %g0, -1, %o3 if ( !_Heap_Is_prev_used( block ) ) { 200ca44: 80 8b 60 01 btst 1, %o5 200ca48: 12 80 00 26 bne 200cae0 <_Heap_Free+0x144> 200ca4c: 80 8a e0 ff btst 0xff, %o3 uintptr_t const prev_size = block->prev_size; 200ca50: da 02 00 00 ld [ %o0 ], %o5 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 200ca54: 86 22 00 0d sub %o0, %o5, %g3 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 200ca58: 80 a0 c0 0c cmp %g3, %o4 200ca5c: 0a 80 00 04 bcs 200ca6c <_Heap_Free+0xd0> <== NEVER TAKEN 200ca60: 94 10 20 00 clr %o2 200ca64: 80 a2 40 03 cmp %o1, %g3 200ca68: 94 60 3f ff subx %g0, -1, %o2 Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { 200ca6c: 80 a2 a0 00 cmp %o2, 0 200ca70: 02 80 00 44 be 200cb80 <_Heap_Free+0x1e4> <== NEVER TAKEN 200ca74: b0 10 20 00 clr %i0 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 200ca78: d8 00 e0 04 ld [ %g3 + 4 ], %o4 return( false ); } /* As we always coalesce free blocks, the block that preceedes prev_block must have been used. */ if ( !_Heap_Is_prev_used ( prev_block) ) { 200ca7c: 80 8b 20 01 btst 1, %o4 200ca80: 02 80 00 40 be 200cb80 <_Heap_Free+0x1e4> <== NEVER TAKEN 200ca84: 80 8a e0 ff btst 0xff, %o3 _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 200ca88: 22 80 00 0f be,a 200cac4 <_Heap_Free+0x128> 200ca8c: 9a 00 80 0d add %g2, %o5, %o5 uintptr_t const size = block_size + prev_size + next_block_size; 200ca90: 88 00 80 04 add %g2, %g4, %g4 200ca94: 9a 01 00 0d add %g4, %o5, %o5 return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 200ca98: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = block->prev; 200ca9c: c2 00 60 0c ld [ %g1 + 0xc ], %g1 prev->next = next; 200caa0: c8 20 60 08 st %g4, [ %g1 + 8 ] next->prev = prev; 200caa4: c2 21 20 0c st %g1, [ %g4 + 0xc ] _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 200caa8: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 200caac: 82 00 7f ff add %g1, -1, %g1 200cab0: c2 24 20 38 st %g1, [ %l0 + 0x38 ] prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 200cab4: da 20 c0 0d st %o5, [ %g3 + %o5 ] if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 200cab8: 82 13 60 01 or %o5, 1, %g1 200cabc: 10 80 00 27 b 200cb58 <_Heap_Free+0x1bc> 200cac0: c2 20 e0 04 st %g1, [ %g3 + 4 ] next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 200cac4: 88 13 60 01 or %o5, 1, %g4 200cac8: c8 20 e0 04 st %g4, [ %g3 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 200cacc: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = size; 200cad0: da 22 00 02 st %o5, [ %o0 + %g2 ] _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 200cad4: 86 08 ff fe and %g3, -2, %g3 200cad8: 10 80 00 20 b 200cb58 <_Heap_Free+0x1bc> 200cadc: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 200cae0: 22 80 00 0d be,a 200cb14 <_Heap_Free+0x178> 200cae4: c6 04 20 08 ld [ %l0 + 8 ], %g3 uintptr_t const size = block_size + next_block_size; 200cae8: 86 01 00 02 add %g4, %g2, %g3 RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace( Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; 200caec: c8 00 60 08 ld [ %g1 + 8 ], %g4 Heap_Block *prev = old_block->prev; 200caf0: c2 00 60 0c ld [ %g1 + 0xc ], %g1 new_block->next = next; 200caf4: c8 22 20 08 st %g4, [ %o0 + 8 ] new_block->prev = prev; 200caf8: c2 22 20 0c st %g1, [ %o0 + 0xc ] next->prev = new_block; prev->next = new_block; 200cafc: d0 20 60 08 st %o0, [ %g1 + 8 ] Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; 200cb00: d0 21 20 0c st %o0, [ %g4 + 0xc ] _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 200cb04: 82 10 e0 01 or %g3, 1, %g1 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 200cb08: c6 22 00 03 st %g3, [ %o0 + %g3 ] next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 200cb0c: 10 80 00 13 b 200cb58 <_Heap_Free+0x1bc> 200cb10: c2 22 20 04 st %g1, [ %o0 + 4 ] ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; 200cb14: e0 22 20 0c st %l0, [ %o0 + 0xc ] Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 200cb18: c6 22 20 08 st %g3, [ %o0 + 8 ] new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 200cb1c: d0 20 e0 0c st %o0, [ %g3 + 0xc ] next_block->prev_size = size; } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; 200cb20: 86 10 a0 01 or %g2, 1, %g3 200cb24: c6 22 20 04 st %g3, [ %o0 + 4 ] next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 200cb28: c6 00 60 04 ld [ %g1 + 4 ], %g3 next_block->prev_size = block_size; 200cb2c: c4 22 00 02 st %g2, [ %o0 + %g2 ] } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 200cb30: 86 08 ff fe and %g3, -2, %g3 200cb34: c6 20 60 04 st %g3, [ %g1 + 4 ] next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 200cb38: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 if ( stats->max_free_blocks < stats->free_blocks ) { 200cb3c: c6 04 20 3c ld [ %l0 + 0x3c ], %g3 block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 200cb40: 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; 200cb44: d0 24 20 08 st %o0, [ %l0 + 8 ] if ( stats->max_free_blocks < stats->free_blocks ) { 200cb48: 80 a0 c0 01 cmp %g3, %g1 200cb4c: 1a 80 00 03 bcc 200cb58 <_Heap_Free+0x1bc> 200cb50: c2 24 20 38 st %g1, [ %l0 + 0x38 ] stats->max_free_blocks = stats->free_blocks; 200cb54: c2 24 20 3c st %g1, [ %l0 + 0x3c ] } } /* Statistics */ --stats->used_blocks; 200cb58: c2 04 20 40 ld [ %l0 + 0x40 ], %g1 ++stats->frees; stats->free_size += block_size; return( true ); 200cb5c: b0 10 20 01 mov 1, %i0 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 200cb60: 82 00 7f ff add %g1, -1, %g1 200cb64: c2 24 20 40 st %g1, [ %l0 + 0x40 ] ++stats->frees; 200cb68: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 200cb6c: 82 00 60 01 inc %g1 200cb70: c2 24 20 50 st %g1, [ %l0 + 0x50 ] stats->free_size += block_size; 200cb74: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 200cb78: 84 00 40 02 add %g1, %g2, %g2 200cb7c: c4 24 20 30 st %g2, [ %l0 + 0x30 ] return( true ); } 200cb80: 81 c7 e0 08 ret 200cb84: 81 e8 00 00 restore =============================================================================== 020141c4 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 20141c4: 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); 20141c8: d2 06 20 10 ld [ %i0 + 0x10 ], %o1 20141cc: 7f ff f9 48 call 20126ec <.urem> 20141d0: 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 20141d4: 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); 20141d8: a2 06 7f f8 add %i1, -8, %l1 20141dc: a0 10 00 18 mov %i0, %l0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 20141e0: 90 24 40 08 sub %l1, %o0, %o0 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 20141e4: 80 a2 00 02 cmp %o0, %g2 20141e8: 0a 80 00 05 bcs 20141fc <_Heap_Size_of_alloc_area+0x38> 20141ec: 82 10 20 00 clr %g1 20141f0: c2 06 20 24 ld [ %i0 + 0x24 ], %g1 20141f4: 80 a0 40 08 cmp %g1, %o0 20141f8: 82 60 3f ff subx %g0, -1, %g1 uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr; Heap_Block *block = _Heap_Block_of_alloc_area( alloc_begin, page_size ); Heap_Block *next_block = NULL; uintptr_t block_size = 0; if ( !_Heap_Is_block_in_heap( heap, block ) ) { 20141fc: 80 a0 60 00 cmp %g1, 0 2014200: 02 80 00 15 be 2014254 <_Heap_Size_of_alloc_area+0x90> 2014204: b0 10 20 00 clr %i0 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 2014208: e2 02 20 04 ld [ %o0 + 4 ], %l1 201420c: a2 0c 7f fe and %l1, -2, %l1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 2014210: a2 02 00 11 add %o0, %l1, %l1 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 2014214: 80 a4 40 02 cmp %l1, %g2 2014218: 0a 80 00 05 bcs 201422c <_Heap_Size_of_alloc_area+0x68> <== NEVER TAKEN 201421c: 82 10 20 00 clr %g1 2014220: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 2014224: 80 a0 40 11 cmp %g1, %l1 2014228: 82 60 3f ff subx %g0, -1, %g1 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 201422c: 80 a0 60 00 cmp %g1, 0 2014230: 02 80 00 09 be 2014254 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 2014234: b0 10 20 00 clr %i0 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 2014238: c2 04 60 04 ld [ %l1 + 4 ], %g1 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 201423c: 80 88 60 01 btst 1, %g1 2014240: 02 80 00 05 be 2014254 <_Heap_Size_of_alloc_area+0x90> <== NEVER TAKEN 2014244: a2 24 40 19 sub %l1, %i1, %l1 return false; } *alloc_size = (uintptr_t) next_block + HEAP_BLOCK_SIZE_OFFSET - alloc_begin; return true; 2014248: b0 10 20 01 mov 1, %i0 || !_Heap_Is_prev_used( next_block ) ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_BLOCK_SIZE_OFFSET - alloc_begin; 201424c: a2 04 60 04 add %l1, 4, %l1 2014250: e2 26 80 00 st %l1, [ %i2 ] return true; } 2014254: 81 c7 e0 08 ret 2014258: 81 e8 00 00 restore =============================================================================== 020084f0 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 20084f0: 9d e3 bf 80 save %sp, -128, %sp uintptr_t const min_block_size = heap->min_block_size; Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 20084f4: 23 00 80 21 sethi %hi(0x2008400), %l1 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 20084f8: a0 10 00 18 mov %i0, %l0 uintptr_t const page_size = heap->page_size; 20084fc: e4 06 20 10 ld [ %i0 + 0x10 ], %l2 uintptr_t const min_block_size = heap->min_block_size; 2008500: e8 06 20 14 ld [ %i0 + 0x14 ], %l4 Heap_Block *const first_block = heap->first_block; 2008504: e6 06 20 20 ld [ %i0 + 0x20 ], %l3 Heap_Block *const last_block = heap->last_block; 2008508: ea 06 20 24 ld [ %i0 + 0x24 ], %l5 Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 200850c: 80 8e a0 ff btst 0xff, %i2 2008510: 02 80 00 04 be 2008520 <_Heap_Walk+0x30> 2008514: a2 14 60 9c or %l1, 0x9c, %l1 2008518: 23 00 80 21 sethi %hi(0x2008400), %l1 200851c: a2 14 60 a4 or %l1, 0xa4, %l1 ! 20084a4 <_Heap_Walk_print> if ( !_System_state_Is_up( _System_state_Get() ) ) { 2008520: 03 00 80 62 sethi %hi(0x2018800), %g1 2008524: c2 00 61 90 ld [ %g1 + 0x190 ], %g1 ! 2018990 <_System_state_Current> 2008528: 80 a0 60 03 cmp %g1, 3 200852c: 12 80 01 2d bne 20089e0 <_Heap_Walk+0x4f0> 2008530: b0 10 20 01 mov 1, %i0 Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; (*printer)( 2008534: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 2008538: da 04 20 18 ld [ %l0 + 0x18 ], %o5 200853c: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 2008540: c2 04 20 08 ld [ %l0 + 8 ], %g1 2008544: e6 23 a0 60 st %l3, [ %sp + 0x60 ] 2008548: c2 23 a0 68 st %g1, [ %sp + 0x68 ] 200854c: c2 04 20 0c ld [ %l0 + 0xc ], %g1 2008550: ea 23 a0 64 st %l5, [ %sp + 0x64 ] 2008554: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 2008558: 90 10 00 19 mov %i1, %o0 200855c: 92 10 20 00 clr %o1 2008560: 15 00 80 57 sethi %hi(0x2015c00), %o2 2008564: 96 10 00 12 mov %l2, %o3 2008568: 94 12 a2 c0 or %o2, 0x2c0, %o2 200856c: 9f c4 40 00 call %l1 2008570: 98 10 00 14 mov %l4, %o4 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 2008574: 80 a4 a0 00 cmp %l2, 0 2008578: 12 80 00 07 bne 2008594 <_Heap_Walk+0xa4> 200857c: 80 8c a0 07 btst 7, %l2 (*printer)( source, true, "page size is zero\n" ); 2008580: 15 00 80 57 sethi %hi(0x2015c00), %o2 2008584: 90 10 00 19 mov %i1, %o0 2008588: 92 10 20 01 mov 1, %o1 200858c: 10 80 00 38 b 200866c <_Heap_Walk+0x17c> 2008590: 94 12 a3 58 or %o2, 0x358, %o2 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 2008594: 22 80 00 08 be,a 20085b4 <_Heap_Walk+0xc4> 2008598: 90 10 00 14 mov %l4, %o0 (*printer)( 200859c: 15 00 80 57 sethi %hi(0x2015c00), %o2 20085a0: 90 10 00 19 mov %i1, %o0 20085a4: 92 10 20 01 mov 1, %o1 20085a8: 94 12 a3 70 or %o2, 0x370, %o2 20085ac: 10 80 01 0b b 20089d8 <_Heap_Walk+0x4e8> 20085b0: 96 10 00 12 mov %l2, %o3 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 20085b4: 7f ff e5 44 call 2001ac4 <.urem> 20085b8: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 20085bc: 80 a2 20 00 cmp %o0, 0 20085c0: 22 80 00 08 be,a 20085e0 <_Heap_Walk+0xf0> 20085c4: 90 04 e0 08 add %l3, 8, %o0 (*printer)( 20085c8: 15 00 80 57 sethi %hi(0x2015c00), %o2 20085cc: 90 10 00 19 mov %i1, %o0 20085d0: 92 10 20 01 mov 1, %o1 20085d4: 94 12 a3 90 or %o2, 0x390, %o2 20085d8: 10 80 01 00 b 20089d8 <_Heap_Walk+0x4e8> 20085dc: 96 10 00 14 mov %l4, %o3 20085e0: 7f ff e5 39 call 2001ac4 <.urem> 20085e4: 92 10 00 12 mov %l2, %o1 ); return false; } if ( 20085e8: 80 a2 20 00 cmp %o0, 0 20085ec: 22 80 00 08 be,a 200860c <_Heap_Walk+0x11c> 20085f0: c2 04 e0 04 ld [ %l3 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 20085f4: 15 00 80 57 sethi %hi(0x2015c00), %o2 20085f8: 90 10 00 19 mov %i1, %o0 20085fc: 92 10 20 01 mov 1, %o1 2008600: 94 12 a3 b8 or %o2, 0x3b8, %o2 2008604: 10 80 00 f5 b 20089d8 <_Heap_Walk+0x4e8> 2008608: 96 10 00 13 mov %l3, %o3 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 200860c: 80 88 60 01 btst 1, %g1 2008610: 32 80 00 07 bne,a 200862c <_Heap_Walk+0x13c> 2008614: ec 05 60 04 ld [ %l5 + 4 ], %l6 (*printer)( 2008618: 15 00 80 57 sethi %hi(0x2015c00), %o2 200861c: 90 10 00 19 mov %i1, %o0 2008620: 92 10 20 01 mov 1, %o1 2008624: 10 80 00 12 b 200866c <_Heap_Walk+0x17c> 2008628: 94 12 a3 f0 or %o2, 0x3f0, %o2 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 200862c: 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); 2008630: ac 05 40 16 add %l5, %l6, %l6 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 2008634: c2 05 a0 04 ld [ %l6 + 4 ], %g1 ); return false; } if ( _Heap_Is_free( last_block ) ) { 2008638: 80 88 60 01 btst 1, %g1 200863c: 12 80 00 07 bne 2008658 <_Heap_Walk+0x168> 2008640: 80 a5 80 13 cmp %l6, %l3 (*printer)( 2008644: 15 00 80 58 sethi %hi(0x2016000), %o2 2008648: 90 10 00 19 mov %i1, %o0 200864c: 92 10 20 01 mov 1, %o1 2008650: 10 80 00 07 b 200866c <_Heap_Walk+0x17c> 2008654: 94 12 a0 20 or %o2, 0x20, %o2 ); return false; } if ( 2008658: 02 80 00 08 be 2008678 <_Heap_Walk+0x188> <== ALWAYS TAKEN 200865c: 15 00 80 58 sethi %hi(0x2016000), %o2 _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 2008660: 90 10 00 19 mov %i1, %o0 <== NOT EXECUTED 2008664: 92 10 20 01 mov 1, %o1 <== NOT EXECUTED 2008668: 94 12 a0 38 or %o2, 0x38, %o2 <== NOT EXECUTED 200866c: 9f c4 40 00 call %l1 2008670: b0 10 20 00 clr %i0 2008674: 30 80 00 db b,a 20089e0 <_Heap_Walk+0x4f0> block = next_block; } while ( block != first_block ); return true; } 2008678: d6 04 20 08 ld [ %l0 + 8 ], %o3 int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 200867c: fa 04 20 10 ld [ %l0 + 0x10 ], %i5 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); 2008680: ae 10 00 10 mov %l0, %l7 2008684: 10 80 00 32 b 200874c <_Heap_Walk+0x25c> 2008688: b8 10 00 0b mov %o3, %i4 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 200868c: 80 a0 80 1c cmp %g2, %i4 2008690: 18 80 00 05 bgu 20086a4 <_Heap_Walk+0x1b4> 2008694: 82 10 20 00 clr %g1 2008698: c2 04 20 24 ld [ %l0 + 0x24 ], %g1 200869c: 80 a0 40 1c cmp %g1, %i4 20086a0: 82 60 3f ff subx %g0, -1, %g1 const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { 20086a4: 80 a0 60 00 cmp %g1, 0 20086a8: 32 80 00 08 bne,a 20086c8 <_Heap_Walk+0x1d8> 20086ac: 90 07 20 08 add %i4, 8, %o0 (*printer)( 20086b0: 15 00 80 58 sethi %hi(0x2016000), %o2 20086b4: 96 10 00 1c mov %i4, %o3 20086b8: 90 10 00 19 mov %i1, %o0 20086bc: 92 10 20 01 mov 1, %o1 20086c0: 10 80 00 c6 b 20089d8 <_Heap_Walk+0x4e8> 20086c4: 94 12 a0 68 or %o2, 0x68, %o2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 20086c8: 7f ff e4 ff call 2001ac4 <.urem> 20086cc: 92 10 00 1d mov %i5, %o1 ); return false; } if ( 20086d0: 80 a2 20 00 cmp %o0, 0 20086d4: 22 80 00 08 be,a 20086f4 <_Heap_Walk+0x204> 20086d8: c2 07 20 04 ld [ %i4 + 4 ], %g1 !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 20086dc: 15 00 80 58 sethi %hi(0x2016000), %o2 20086e0: 96 10 00 1c mov %i4, %o3 20086e4: 90 10 00 19 mov %i1, %o0 20086e8: 92 10 20 01 mov 1, %o1 20086ec: 10 80 00 bb b 20089d8 <_Heap_Walk+0x4e8> 20086f0: 94 12 a0 88 or %o2, 0x88, %o2 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 20086f4: 82 08 7f fe and %g1, -2, %g1 block = next_block; } while ( block != first_block ); return true; } 20086f8: 82 07 00 01 add %i4, %g1, %g1 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 20086fc: c2 00 60 04 ld [ %g1 + 4 ], %g1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 2008700: 80 88 60 01 btst 1, %g1 2008704: 22 80 00 08 be,a 2008724 <_Heap_Walk+0x234> 2008708: d8 07 20 0c ld [ %i4 + 0xc ], %o4 (*printer)( 200870c: 15 00 80 58 sethi %hi(0x2016000), %o2 2008710: 96 10 00 1c mov %i4, %o3 2008714: 90 10 00 19 mov %i1, %o0 2008718: 92 10 20 01 mov 1, %o1 200871c: 10 80 00 af b 20089d8 <_Heap_Walk+0x4e8> 2008720: 94 12 a0 b8 or %o2, 0xb8, %o2 ); return false; } if ( free_block->prev != prev_block ) { 2008724: 80 a3 00 17 cmp %o4, %l7 2008728: 22 80 00 08 be,a 2008748 <_Heap_Walk+0x258> 200872c: ae 10 00 1c mov %i4, %l7 (*printer)( 2008730: 15 00 80 58 sethi %hi(0x2016000), %o2 2008734: 96 10 00 1c mov %i4, %o3 2008738: 90 10 00 19 mov %i1, %o0 200873c: 92 10 20 01 mov 1, %o1 2008740: 10 80 00 49 b 2008864 <_Heap_Walk+0x374> 2008744: 94 12 a0 d8 or %o2, 0xd8, %o2 return false; } prev_block = free_block; free_block = free_block->next; 2008748: f8 07 20 08 ld [ %i4 + 8 ], %i4 const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *const first_free_block = _Heap_Free_list_first( heap ); const Heap_Block *prev_block = free_list_tail; const Heap_Block *free_block = first_free_block; while ( free_block != free_list_tail ) { 200874c: 80 a7 00 10 cmp %i4, %l0 2008750: 32 bf ff cf bne,a 200868c <_Heap_Walk+0x19c> 2008754: c4 04 20 20 ld [ %l0 + 0x20 ], %g2 2008758: 35 00 80 58 sethi %hi(0x2016000), %i2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 200875c: 31 00 80 58 sethi %hi(0x2016000), %i0 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 2008760: b4 16 a2 98 or %i2, 0x298, %i2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 2008764: b0 16 22 80 or %i0, 0x280, %i0 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 2008768: 37 00 80 58 sethi %hi(0x2016000), %i3 block = next_block; } while ( block != first_block ); return true; } 200876c: c2 05 a0 04 ld [ %l6 + 4 ], %g1 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 2008770: c6 04 20 20 ld [ %l0 + 0x20 ], %g3 - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; 2008774: ae 08 7f fe and %g1, -2, %l7 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 2008778: ba 05 80 17 add %l6, %l7, %i5 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; 200877c: 80 a0 c0 1d cmp %g3, %i5 2008780: 18 80 00 05 bgu 2008794 <_Heap_Walk+0x2a4> <== NEVER TAKEN 2008784: 84 10 20 00 clr %g2 2008788: c4 04 20 24 ld [ %l0 + 0x24 ], %g2 200878c: 80 a0 80 1d cmp %g2, %i5 2008790: 84 60 3f ff subx %g0, -1, %g2 bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 2008794: 80 a0 a0 00 cmp %g2, 0 2008798: 12 80 00 07 bne 20087b4 <_Heap_Walk+0x2c4> 200879c: 84 1d 80 15 xor %l6, %l5, %g2 (*printer)( 20087a0: 15 00 80 58 sethi %hi(0x2016000), %o2 20087a4: 90 10 00 19 mov %i1, %o0 20087a8: 92 10 20 01 mov 1, %o1 20087ac: 10 80 00 2c b 200885c <_Heap_Walk+0x36c> 20087b0: 94 12 a1 10 or %o2, 0x110, %o2 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; 20087b4: 80 a0 00 02 cmp %g0, %g2 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 20087b8: c2 27 bf fc st %g1, [ %fp + -4 ] 20087bc: b8 40 20 00 addx %g0, 0, %i4 20087c0: 90 10 00 17 mov %l7, %o0 20087c4: 7f ff e4 c0 call 2001ac4 <.urem> 20087c8: 92 10 00 12 mov %l2, %o1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 20087cc: 80 a2 20 00 cmp %o0, 0 20087d0: 02 80 00 0c be 2008800 <_Heap_Walk+0x310> 20087d4: c2 07 bf fc ld [ %fp + -4 ], %g1 20087d8: 80 8f 20 ff btst 0xff, %i4 20087dc: 02 80 00 0a be 2008804 <_Heap_Walk+0x314> 20087e0: 80 a5 c0 14 cmp %l7, %l4 (*printer)( 20087e4: 15 00 80 58 sethi %hi(0x2016000), %o2 20087e8: 90 10 00 19 mov %i1, %o0 20087ec: 92 10 20 01 mov 1, %o1 20087f0: 94 12 a1 40 or %o2, 0x140, %o2 20087f4: 96 10 00 16 mov %l6, %o3 20087f8: 10 80 00 1b b 2008864 <_Heap_Walk+0x374> 20087fc: 98 10 00 17 mov %l7, %o4 ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 2008800: 80 a5 c0 14 cmp %l7, %l4 2008804: 1a 80 00 0d bcc 2008838 <_Heap_Walk+0x348> 2008808: 80 a7 40 16 cmp %i5, %l6 200880c: 80 8f 20 ff btst 0xff, %i4 2008810: 02 80 00 0a be 2008838 <_Heap_Walk+0x348> <== NEVER TAKEN 2008814: 80 a7 40 16 cmp %i5, %l6 (*printer)( 2008818: 15 00 80 58 sethi %hi(0x2016000), %o2 200881c: 90 10 00 19 mov %i1, %o0 2008820: 92 10 20 01 mov 1, %o1 2008824: 94 12 a1 70 or %o2, 0x170, %o2 2008828: 96 10 00 16 mov %l6, %o3 200882c: 98 10 00 17 mov %l7, %o4 2008830: 10 80 00 3f b 200892c <_Heap_Walk+0x43c> 2008834: 9a 10 00 14 mov %l4, %o5 ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 2008838: 38 80 00 0e bgu,a 2008870 <_Heap_Walk+0x380> 200883c: b8 08 60 01 and %g1, 1, %i4 2008840: 80 8f 20 ff btst 0xff, %i4 2008844: 02 80 00 0b be 2008870 <_Heap_Walk+0x380> 2008848: b8 08 60 01 and %g1, 1, %i4 (*printer)( 200884c: 15 00 80 58 sethi %hi(0x2016000), %o2 2008850: 90 10 00 19 mov %i1, %o0 2008854: 92 10 20 01 mov 1, %o1 2008858: 94 12 a1 a0 or %o2, 0x1a0, %o2 200885c: 96 10 00 16 mov %l6, %o3 2008860: 98 10 00 1d mov %i5, %o4 2008864: 9f c4 40 00 call %l1 2008868: b0 10 20 00 clr %i0 200886c: 30 80 00 5d b,a 20089e0 <_Heap_Walk+0x4f0> block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; 2008870: c2 07 60 04 ld [ %i5 + 4 ], %g1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 2008874: 80 88 60 01 btst 1, %g1 2008878: 12 80 00 3f bne 2008974 <_Heap_Walk+0x484> 200887c: 80 a7 20 00 cmp %i4, 0 false, "block 0x%08x: size %u, prev 0x%08x%s, next 0x%08x%s\n", block, block_size, block->prev, block->prev == first_free_block ? 2008880: da 05 a0 0c ld [ %l6 + 0xc ], %o5 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 2008884: c2 04 20 08 ld [ %l0 + 8 ], %g1 2008888: 05 00 80 57 sethi %hi(0x2015c00), %g2 block = next_block; } while ( block != first_block ); return true; } 200888c: c8 04 20 0c ld [ %l0 + 0xc ], %g4 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 2008890: 80 a3 40 01 cmp %o5, %g1 2008894: 02 80 00 07 be 20088b0 <_Heap_Walk+0x3c0> 2008898: 86 10 a2 80 or %g2, 0x280, %g3 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 200889c: 80 a3 40 10 cmp %o5, %l0 20088a0: 12 80 00 04 bne 20088b0 <_Heap_Walk+0x3c0> 20088a4: 86 16 e2 48 or %i3, 0x248, %g3 20088a8: 19 00 80 57 sethi %hi(0x2015c00), %o4 20088ac: 86 13 22 90 or %o4, 0x290, %g3 ! 2015e90 block->next, block->next == last_free_block ? 20088b0: c4 05 a0 08 ld [ %l6 + 8 ], %g2 Heap_Block *const last_free_block = _Heap_Free_list_last( heap ); bool const prev_used = _Heap_Is_prev_used( block ); uintptr_t const block_size = _Heap_Block_size( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); (*printer)( 20088b4: 19 00 80 57 sethi %hi(0x2015c00), %o4 20088b8: 80 a0 80 04 cmp %g2, %g4 20088bc: 02 80 00 07 be 20088d8 <_Heap_Walk+0x3e8> 20088c0: 82 13 22 a0 or %o4, 0x2a0, %g1 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 20088c4: 80 a0 80 10 cmp %g2, %l0 20088c8: 12 80 00 04 bne 20088d8 <_Heap_Walk+0x3e8> 20088cc: 82 16 e2 48 or %i3, 0x248, %g1 20088d0: 09 00 80 57 sethi %hi(0x2015c00), %g4 20088d4: 82 11 22 b0 or %g4, 0x2b0, %g1 ! 2015eb0 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)( 20088d8: c6 23 a0 5c st %g3, [ %sp + 0x5c ] 20088dc: c4 23 a0 60 st %g2, [ %sp + 0x60 ] 20088e0: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 20088e4: 90 10 00 19 mov %i1, %o0 20088e8: 92 10 20 00 clr %o1 20088ec: 15 00 80 58 sethi %hi(0x2016000), %o2 20088f0: 96 10 00 16 mov %l6, %o3 20088f4: 94 12 a1 d8 or %o2, 0x1d8, %o2 20088f8: 9f c4 40 00 call %l1 20088fc: 98 10 00 17 mov %l7, %o4 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 2008900: da 07 40 00 ld [ %i5 ], %o5 2008904: 80 a5 c0 0d cmp %l7, %o5 2008908: 02 80 00 0c be 2008938 <_Heap_Walk+0x448> 200890c: 80 a7 20 00 cmp %i4, 0 (*printer)( 2008910: 15 00 80 58 sethi %hi(0x2016000), %o2 2008914: fa 23 a0 5c st %i5, [ %sp + 0x5c ] 2008918: 90 10 00 19 mov %i1, %o0 200891c: 92 10 20 01 mov 1, %o1 2008920: 94 12 a2 10 or %o2, 0x210, %o2 2008924: 96 10 00 16 mov %l6, %o3 2008928: 98 10 00 17 mov %l7, %o4 200892c: 9f c4 40 00 call %l1 2008930: b0 10 20 00 clr %i0 2008934: 30 80 00 2b b,a 20089e0 <_Heap_Walk+0x4f0> ); return false; } if ( !prev_used ) { 2008938: 32 80 00 0a bne,a 2008960 <_Heap_Walk+0x470> 200893c: c2 04 20 08 ld [ %l0 + 8 ], %g1 (*printer)( 2008940: 15 00 80 58 sethi %hi(0x2016000), %o2 2008944: 90 10 00 19 mov %i1, %o0 2008948: 92 10 20 01 mov 1, %o1 200894c: 10 80 00 22 b 20089d4 <_Heap_Walk+0x4e4> 2008950: 94 12 a2 50 or %o2, 0x250, %o2 { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { if ( free_block == block ) { 2008954: 02 80 00 19 be 20089b8 <_Heap_Walk+0x4c8> 2008958: 80 a7 40 13 cmp %i5, %l3 return true; } free_block = free_block->next; 200895c: c2 00 60 08 ld [ %g1 + 8 ], %g1 ) { const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); const Heap_Block *free_block = _Heap_Free_list_first( heap ); while ( free_block != free_list_tail ) { 2008960: 80 a0 40 10 cmp %g1, %l0 2008964: 12 bf ff fc bne 2008954 <_Heap_Walk+0x464> 2008968: 80 a0 40 16 cmp %g1, %l6 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 200896c: 10 80 00 17 b 20089c8 <_Heap_Walk+0x4d8> 2008970: 15 00 80 58 sethi %hi(0x2016000), %o2 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 2008974: 22 80 00 0a be,a 200899c <_Heap_Walk+0x4ac> 2008978: da 05 80 00 ld [ %l6 ], %o5 (*printer)( 200897c: 90 10 00 19 mov %i1, %o0 2008980: 92 10 20 00 clr %o1 2008984: 94 10 00 18 mov %i0, %o2 2008988: 96 10 00 16 mov %l6, %o3 200898c: 9f c4 40 00 call %l1 2008990: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 2008994: 10 80 00 09 b 20089b8 <_Heap_Walk+0x4c8> 2008998: 80 a7 40 13 cmp %i5, %l3 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 200899c: 90 10 00 19 mov %i1, %o0 20089a0: 92 10 20 00 clr %o1 20089a4: 94 10 00 1a mov %i2, %o2 20089a8: 96 10 00 16 mov %l6, %o3 20089ac: 9f c4 40 00 call %l1 20089b0: 98 10 00 17 mov %l7, %o4 block->prev_size ); } block = next_block; } while ( block != first_block ); 20089b4: 80 a7 40 13 cmp %i5, %l3 20089b8: 32 bf ff 6d bne,a 200876c <_Heap_Walk+0x27c> 20089bc: ac 10 00 1d mov %i5, %l6 return true; } 20089c0: 81 c7 e0 08 ret 20089c4: 91 e8 20 01 restore %g0, 1, %o0 return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 20089c8: 90 10 00 19 mov %i1, %o0 20089cc: 92 10 20 01 mov 1, %o1 20089d0: 94 12 a2 c0 or %o2, 0x2c0, %o2 20089d4: 96 10 00 16 mov %l6, %o3 20089d8: 9f c4 40 00 call %l1 20089dc: b0 10 20 00 clr %i0 20089e0: 81 c7 e0 08 ret 20089e4: 81 e8 00 00 restore =============================================================================== 02007740 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 2007740: 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 ) 2007744: c2 06 20 18 ld [ %i0 + 0x18 ], %g1 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 2007748: a0 10 00 18 mov %i0, %l0 * If the application is using the optional manager stubs and * still attempts to create the object, the information block * should be all zeroed out because it is in the BSS. So let's * check that code for this manager is even present. */ if ( information->size == 0 ) 200774c: 80 a0 60 00 cmp %g1, 0 2007750: 02 80 00 20 be 20077d0 <_Objects_Allocate+0x90> <== NEVER TAKEN 2007754: b0 10 20 00 clr %i0 /* * OK. The manager should be initialized and configured to have objects. * With any luck, it is safe to attempt to allocate an object. */ the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 2007758: a2 04 20 20 add %l0, 0x20, %l1 200775c: 7f ff fd 7e call 2006d54 <_Chain_Get> 2007760: 90 10 00 11 mov %l1, %o0 if ( information->auto_extend ) { 2007764: c2 0c 20 12 ldub [ %l0 + 0x12 ], %g1 2007768: 80 a0 60 00 cmp %g1, 0 200776c: 02 80 00 19 be 20077d0 <_Objects_Allocate+0x90> 2007770: 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 ) { 2007774: 80 a2 20 00 cmp %o0, 0 2007778: 32 80 00 0a bne,a 20077a0 <_Objects_Allocate+0x60> 200777c: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 _Objects_Extend_information( information ); 2007780: 40 00 00 1e call 20077f8 <_Objects_Extend_information> 2007784: 90 10 00 10 mov %l0, %o0 the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 2007788: 7f ff fd 73 call 2006d54 <_Chain_Get> 200778c: 90 10 00 11 mov %l1, %o0 } if ( the_object ) { 2007790: b0 92 20 00 orcc %o0, 0, %i0 2007794: 02 80 00 0f be 20077d0 <_Objects_Allocate+0x90> 2007798: 01 00 00 00 nop uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 200779c: c2 14 20 0a lduh [ %l0 + 0xa ], %g1 20077a0: d0 16 20 0a lduh [ %i0 + 0xa ], %o0 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 20077a4: d2 14 20 14 lduh [ %l0 + 0x14 ], %o1 20077a8: 40 00 2b 25 call 201243c <.udiv> 20077ac: 90 22 00 01 sub %o0, %g1, %o0 information->inactive_per_block[ block ]--; 20077b0: c2 04 20 30 ld [ %l0 + 0x30 ], %g1 20077b4: 91 2a 20 02 sll %o0, 2, %o0 20077b8: c4 00 40 08 ld [ %g1 + %o0 ], %g2 20077bc: 84 00 bf ff add %g2, -1, %g2 20077c0: c4 20 40 08 st %g2, [ %g1 + %o0 ] information->inactive--; 20077c4: c2 14 20 2c lduh [ %l0 + 0x2c ], %g1 20077c8: 82 00 7f ff add %g1, -1, %g1 20077cc: c2 34 20 2c sth %g1, [ %l0 + 0x2c ] ); } #endif return the_object; } 20077d0: 81 c7 e0 08 ret 20077d4: 81 e8 00 00 restore =============================================================================== 02007b54 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint32_t the_class ) { 2007b54: 9d e3 bf a0 save %sp, -96, %sp Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 2007b58: 80 a6 60 00 cmp %i1, 0 2007b5c: 02 80 00 17 be 2007bb8 <_Objects_Get_information+0x64> 2007b60: a0 10 20 00 clr %l0 /* * This call implicitly validates the_api so we do not call * _Objects_Is_api_valid above here. */ the_class_api_maximum = _Objects_API_maximum_class( the_api ); 2007b64: 40 00 14 09 call 200cb88 <_Objects_API_maximum_class> 2007b68: 90 10 00 18 mov %i0, %o0 if ( the_class_api_maximum == 0 ) 2007b6c: 80 a2 20 00 cmp %o0, 0 2007b70: 02 80 00 12 be 2007bb8 <_Objects_Get_information+0x64> 2007b74: 80 a6 40 08 cmp %i1, %o0 return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 2007b78: 18 80 00 10 bgu 2007bb8 <_Objects_Get_information+0x64> 2007b7c: 03 00 80 58 sethi %hi(0x2016000), %g1 return NULL; if ( !_Objects_Information_table[ the_api ] ) 2007b80: b1 2e 20 02 sll %i0, 2, %i0 2007b84: 82 10 60 b0 or %g1, 0xb0, %g1 2007b88: c2 00 40 18 ld [ %g1 + %i0 ], %g1 2007b8c: 80 a0 60 00 cmp %g1, 0 2007b90: 02 80 00 0a be 2007bb8 <_Objects_Get_information+0x64> <== NEVER TAKEN 2007b94: b3 2e 60 02 sll %i1, 2, %i1 return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 2007b98: e0 00 40 19 ld [ %g1 + %i1 ], %l0 if ( !info ) 2007b9c: 80 a4 20 00 cmp %l0, 0 2007ba0: 02 80 00 06 be 2007bb8 <_Objects_Get_information+0x64> <== NEVER TAKEN 2007ba4: 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 ) 2007ba8: c2 14 20 10 lduh [ %l0 + 0x10 ], %g1 return NULL; 2007bac: 80 a0 00 01 cmp %g0, %g1 2007bb0: 82 60 20 00 subx %g0, 0, %g1 2007bb4: a0 0c 00 01 and %l0, %g1, %l0 #endif return info; } 2007bb8: 81 c7 e0 08 ret 2007bbc: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 020194ac <_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; 20194ac: c2 02 20 08 ld [ %o0 + 8 ], %g1 if ( information->maximum >= index ) { 20194b0: c4 12 20 10 lduh [ %o0 + 0x10 ], %g2 /* * You can't just extract the index portion or you can get tricked * by a value between 1 and maximum. */ index = id - information->minimum_id + 1; 20194b4: 82 22 40 01 sub %o1, %g1, %g1 20194b8: 82 00 60 01 inc %g1 if ( information->maximum >= index ) { 20194bc: 80 a0 80 01 cmp %g2, %g1 20194c0: 0a 80 00 09 bcs 20194e4 <_Objects_Get_no_protection+0x38> 20194c4: 83 28 60 02 sll %g1, 2, %g1 if ( (the_object = information->local_table[ index ]) != NULL ) { 20194c8: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 20194cc: d0 00 80 01 ld [ %g2 + %g1 ], %o0 20194d0: 80 a2 20 00 cmp %o0, 0 20194d4: 02 80 00 05 be 20194e8 <_Objects_Get_no_protection+0x3c> <== NEVER TAKEN 20194d8: 82 10 20 01 mov 1, %g1 *location = OBJECTS_LOCAL; return the_object; 20194dc: 81 c3 e0 08 retl 20194e0: 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; 20194e4: 82 10 20 01 mov 1, %g1 return NULL; 20194e8: 90 10 20 00 clr %o0 } 20194ec: 81 c3 e0 08 retl 20194f0: c2 22 80 00 st %g1, [ %o2 ] =============================================================================== 020093fc <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 20093fc: 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; 2009400: 92 96 20 00 orcc %i0, 0, %o1 2009404: 12 80 00 06 bne 200941c <_Objects_Id_to_name+0x20> 2009408: 83 32 60 18 srl %o1, 0x18, %g1 200940c: 03 00 80 7a sethi %hi(0x201e800), %g1 2009410: c2 00 60 28 ld [ %g1 + 0x28 ], %g1 ! 201e828 <_Thread_Executing> 2009414: d2 00 60 08 ld [ %g1 + 8 ], %o1 2009418: 83 32 60 18 srl %o1, 0x18, %g1 200941c: 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 ) 2009420: 84 00 7f ff add %g1, -1, %g2 2009424: 80 a0 a0 02 cmp %g2, 2 2009428: 18 80 00 16 bgu 2009480 <_Objects_Id_to_name+0x84> 200942c: a0 10 20 03 mov 3, %l0 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 2009430: 10 80 00 16 b 2009488 <_Objects_Id_to_name+0x8c> 2009434: 83 28 60 02 sll %g1, 2, %g1 return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 2009438: 85 28 a0 02 sll %g2, 2, %g2 200943c: d0 00 40 02 ld [ %g1 + %g2 ], %o0 if ( !information ) 2009440: 80 a2 20 00 cmp %o0, 0 2009444: 02 80 00 0f be 2009480 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 2009448: 01 00 00 00 nop return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 200944c: c2 0a 20 38 ldub [ %o0 + 0x38 ], %g1 2009450: 80 a0 60 00 cmp %g1, 0 2009454: 12 80 00 0b bne 2009480 <_Objects_Id_to_name+0x84> <== NEVER TAKEN 2009458: 01 00 00 00 nop return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 200945c: 7f ff ff cb call 2009388 <_Objects_Get> 2009460: 94 07 bf fc add %fp, -4, %o2 if ( !the_object ) 2009464: 80 a2 20 00 cmp %o0, 0 2009468: 02 80 00 06 be 2009480 <_Objects_Id_to_name+0x84> 200946c: 01 00 00 00 nop return OBJECTS_INVALID_ID; *name = the_object->name; 2009470: c2 02 20 0c ld [ %o0 + 0xc ], %g1 _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 2009474: a0 10 20 00 clr %l0 the_object = _Objects_Get( information, tmpId, &ignored_location ); if ( !the_object ) return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); 2009478: 40 00 02 68 call 2009e18 <_Thread_Enable_dispatch> 200947c: c2 26 40 00 st %g1, [ %i1 ] return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 2009480: 81 c7 e0 08 ret 2009484: 91 e8 00 10 restore %g0, %l0, %o0 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 2009488: 05 00 80 79 sethi %hi(0x201e400), %g2 200948c: 84 10 a2 d0 or %g2, 0x2d0, %g2 ! 201e6d0 <_Objects_Information_table> 2009490: c2 00 80 01 ld [ %g2 + %g1 ], %g1 2009494: 80 a0 60 00 cmp %g1, 0 2009498: 12 bf ff e8 bne 2009438 <_Objects_Id_to_name+0x3c> <== ALWAYS TAKEN 200949c: 85 32 60 1b srl %o1, 0x1b, %g2 20094a0: 30 bf ff f8 b,a 2009480 <_Objects_Id_to_name+0x84> <== NOT EXECUTED =============================================================================== 020084ec <_Objects_Set_name>: bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 20084ec: 9d e3 bf a0 save %sp, -96, %sp size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 20084f0: d2 16 20 3a lduh [ %i0 + 0x3a ], %o1 20084f4: 40 00 22 eb call 20110a0 20084f8: 90 10 00 1a mov %i2, %o0 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 20084fc: c2 0e 20 38 ldub [ %i0 + 0x38 ], %g1 2008500: 80 a0 60 00 cmp %g1, 0 2008504: 02 80 00 17 be 2008560 <_Objects_Set_name+0x74> 2008508: a0 10 00 08 mov %o0, %l0 char *d; d = _Workspace_Allocate( length + 1 ); 200850c: 90 02 20 01 inc %o0 2008510: 40 00 07 3f call 200a20c <_Workspace_Allocate> 2008514: b0 10 20 00 clr %i0 if ( !d ) 2008518: 80 a2 20 00 cmp %o0, 0 200851c: 02 80 00 26 be 20085b4 <_Objects_Set_name+0xc8> <== NEVER TAKEN 2008520: a2 10 00 08 mov %o0, %l1 return false; if ( the_object->name.name_p ) { 2008524: d0 06 60 0c ld [ %i1 + 0xc ], %o0 2008528: 80 a2 20 00 cmp %o0, 0 200852c: 22 80 00 06 be,a 2008544 <_Objects_Set_name+0x58> 2008530: 90 10 00 11 mov %l1, %o0 _Workspace_Free( (void *)the_object->name.name_p ); 2008534: 40 00 07 3f call 200a230 <_Workspace_Free> 2008538: 01 00 00 00 nop the_object->name.name_p = NULL; 200853c: c0 26 60 0c clr [ %i1 + 0xc ] } strncpy( d, name, length ); 2008540: 90 10 00 11 mov %l1, %o0 2008544: 92 10 00 1a mov %i2, %o1 2008548: 40 00 22 95 call 2010f9c 200854c: 94 10 00 10 mov %l0, %o2 d[length] = '\0'; 2008550: c0 2c 40 10 clrb [ %l1 + %l0 ] the_object->name.name_p = d; 2008554: e2 26 60 0c st %l1, [ %i1 + 0xc ] ((3 < length) ? s[ 3 ] : ' ') ); } return true; 2008558: 81 c7 e0 08 ret 200855c: 91 e8 20 01 restore %g0, 1, %o0 d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( 2008560: c4 4e 80 00 ldsb [ %i2 ], %g2 2008564: 03 00 08 00 sethi %hi(0x200000), %g1 2008568: 80 a2 20 01 cmp %o0, 1 200856c: 08 80 00 04 bleu 200857c <_Objects_Set_name+0x90> 2008570: 85 28 a0 18 sll %g2, 0x18, %g2 2008574: c2 4e a0 01 ldsb [ %i2 + 1 ], %g1 2008578: 83 28 60 10 sll %g1, 0x10, %g1 200857c: 84 10 40 02 or %g1, %g2, %g2 2008580: 80 a4 20 02 cmp %l0, 2 2008584: 08 80 00 04 bleu 2008594 <_Objects_Set_name+0xa8> 2008588: 03 00 00 08 sethi %hi(0x2000), %g1 200858c: c2 4e a0 02 ldsb [ %i2 + 2 ], %g1 2008590: 83 28 60 08 sll %g1, 8, %g1 2008594: 84 10 80 01 or %g2, %g1, %g2 2008598: 80 a4 20 03 cmp %l0, 3 200859c: 08 80 00 03 bleu 20085a8 <_Objects_Set_name+0xbc> 20085a0: 82 10 20 20 mov 0x20, %g1 20085a4: c2 4e a0 03 ldsb [ %i2 + 3 ], %g1 20085a8: 82 10 80 01 or %g2, %g1, %g1 ((3 < length) ? s[ 3 ] : ' ') ); } return true; 20085ac: b0 10 20 01 mov 1, %i0 d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( 20085b0: c2 26 60 0c st %g1, [ %i1 + 0xc ] ); } return true; } 20085b4: 81 c7 e0 08 ret 20085b8: 81 e8 00 00 restore =============================================================================== 020072c4 <_POSIX_Condition_variables_Wait_support>: pthread_cond_t *cond, pthread_mutex_t *mutex, Watchdog_Interval timeout, bool already_timedout ) { 20072c4: 9d e3 bf 98 save %sp, -104, %sp 20072c8: a0 10 00 18 mov %i0, %l0 register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 20072cc: a2 07 bf fc add %fp, -4, %l1 20072d0: 90 10 00 19 mov %i1, %o0 20072d4: 92 10 00 11 mov %l1, %o1 20072d8: 40 00 00 65 call 200746c <_POSIX_Mutex_Get> 20072dc: b0 10 20 16 mov 0x16, %i0 20072e0: 80 a2 20 00 cmp %o0, 0 20072e4: 02 80 00 3f be 20073e0 <_POSIX_Condition_variables_Wait_support+0x11c> 20072e8: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 20072ec: 03 00 80 63 sethi %hi(0x2018c00), %g1 20072f0: c4 00 61 18 ld [ %g1 + 0x118 ], %g2 ! 2018d18 <_Thread_Dispatch_disable_level> return EINVAL; } _Thread_Unnest_dispatch(); the_cond = _POSIX_Condition_variables_Get( cond, &location ); 20072f4: 90 10 00 10 mov %l0, %o0 20072f8: 84 00 bf ff add %g2, -1, %g2 20072fc: 92 10 00 11 mov %l1, %o1 2007300: c4 20 61 18 st %g2, [ %g1 + 0x118 ] 2007304: 7f ff ff 72 call 20070cc <_POSIX_Condition_variables_Get> 2007308: 01 00 00 00 nop switch ( location ) { 200730c: c2 07 bf fc ld [ %fp + -4 ], %g1 2007310: 80 a0 60 00 cmp %g1, 0 2007314: 12 80 00 0c bne 2007344 <_POSIX_Condition_variables_Wait_support+0x80> 2007318: a4 10 00 08 mov %o0, %l2 case OBJECTS_LOCAL: if ( the_cond->Mutex && ( the_cond->Mutex != *mutex ) ) { 200731c: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 2007320: 80 a0 60 00 cmp %g1, 0 2007324: 02 80 00 0a be 200734c <_POSIX_Condition_variables_Wait_support+0x88> 2007328: 01 00 00 00 nop 200732c: c4 06 40 00 ld [ %i1 ], %g2 2007330: 80 a0 40 02 cmp %g1, %g2 2007334: 02 80 00 06 be 200734c <_POSIX_Condition_variables_Wait_support+0x88> 2007338: 01 00 00 00 nop _Thread_Enable_dispatch(); 200733c: 40 00 0c f1 call 200a700 <_Thread_Enable_dispatch> 2007340: 01 00 00 00 nop return EINVAL; 2007344: 81 c7 e0 08 ret 2007348: 81 e8 00 00 restore } (void) pthread_mutex_unlock( mutex ); 200734c: 40 00 00 f1 call 2007710 2007350: 90 10 00 19 mov %i1, %o0 _Thread_Enable_dispatch(); return EINVAL; } */ if ( !already_timedout ) { 2007354: 80 8e e0 ff btst 0xff, %i3 2007358: 12 80 00 1b bne 20073c4 <_POSIX_Condition_variables_Wait_support+0x100> 200735c: 23 00 80 63 sethi %hi(0x2018c00), %l1 the_cond->Mutex = *mutex; 2007360: c2 06 40 00 ld [ %i1 ], %g1 2007364: c2 24 a0 14 st %g1, [ %l2 + 0x14 ] 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; 2007368: 82 10 20 01 mov 1, %g1 200736c: c2 24 a0 48 st %g1, [ %l2 + 0x48 ] _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 2007370: c2 04 61 d8 ld [ %l1 + 0x1d8 ], %g1 _Thread_Executing->Wait.queue = &the_cond->Wait_queue; 2007374: 90 04 a0 18 add %l2, 0x18, %o0 if ( !already_timedout ) { the_cond->Mutex = *mutex; _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 2007378: c0 20 60 34 clr [ %g1 + 0x34 ] _Thread_Executing->Wait.queue = &the_cond->Wait_queue; _Thread_Executing->Wait.id = *cond; 200737c: c4 04 00 00 ld [ %l0 ], %g2 _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 2007380: 92 10 00 1a mov %i2, %o1 2007384: 15 00 80 2c sethi %hi(0x200b000), %o2 2007388: 94 12 a0 70 or %o2, 0x70, %o2 ! 200b070 <_Thread_queue_Timeout> if ( !already_timedout ) { the_cond->Mutex = *mutex; _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; _Thread_Executing->Wait.queue = &the_cond->Wait_queue; 200738c: d0 20 60 44 st %o0, [ %g1 + 0x44 ] _Thread_Executing->Wait.id = *cond; _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 2007390: 40 00 0e 38 call 200ac70 <_Thread_queue_Enqueue_with_handler> 2007394: c4 20 60 20 st %g2, [ %g1 + 0x20 ] _Thread_Enable_dispatch(); 2007398: 40 00 0c da call 200a700 <_Thread_Enable_dispatch> 200739c: 01 00 00 00 nop /* * Switch ourself out because we blocked as a result of the * _Thread_queue_Enqueue. */ status = _Thread_Executing->Wait.return_code; 20073a0: c2 04 61 d8 ld [ %l1 + 0x1d8 ], %g1 20073a4: f0 00 60 34 ld [ %g1 + 0x34 ], %i0 if ( status && status != ETIMEDOUT ) 20073a8: 80 a6 20 74 cmp %i0, 0x74 20073ac: 02 80 00 08 be 20073cc <_POSIX_Condition_variables_Wait_support+0x108> 20073b0: 80 a6 20 00 cmp %i0, 0 20073b4: 02 80 00 06 be 20073cc <_POSIX_Condition_variables_Wait_support+0x108><== ALWAYS TAKEN 20073b8: 01 00 00 00 nop 20073bc: 81 c7 e0 08 ret <== NOT EXECUTED 20073c0: 81 e8 00 00 restore <== NOT EXECUTED return status; } else { _Thread_Enable_dispatch(); 20073c4: 40 00 0c cf call 200a700 <_Thread_Enable_dispatch> 20073c8: b0 10 20 74 mov 0x74, %i0 /* * When we get here the dispatch disable level is 0. */ mutex_status = pthread_mutex_lock( mutex ); 20073cc: 40 00 00 b0 call 200768c 20073d0: 90 10 00 19 mov %i1, %o0 if ( mutex_status ) 20073d4: 80 a2 20 00 cmp %o0, 0 20073d8: 32 bf ff db bne,a 2007344 <_POSIX_Condition_variables_Wait_support+0x80> 20073dc: b0 10 20 16 mov 0x16, %i0 case OBJECTS_ERROR: break; } return EINVAL; } 20073e0: 81 c7 e0 08 ret 20073e4: 81 e8 00 00 restore =============================================================================== 0200b35c <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 200b35c: 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( 200b360: 11 00 80 9b sethi %hi(0x2026c00), %o0 200b364: 92 10 00 18 mov %i0, %o1 200b368: 90 12 20 fc or %o0, 0xfc, %o0 200b36c: 40 00 0c 90 call 200e5ac <_Objects_Get> 200b370: 94 07 bf fc add %fp, -4, %o2 Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 200b374: c2 07 bf fc ld [ %fp + -4 ], %g1 200b378: 80 a0 60 00 cmp %g1, 0 200b37c: 12 80 00 3e bne 200b474 <_POSIX_Message_queue_Receive_support+0x118> 200b380: 01 00 00 00 nop case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 200b384: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 200b388: 84 08 60 03 and %g1, 3, %g2 200b38c: 80 a0 a0 01 cmp %g2, 1 200b390: 32 80 00 08 bne,a 200b3b0 <_POSIX_Message_queue_Receive_support+0x54> 200b394: d0 02 20 10 ld [ %o0 + 0x10 ], %o0 _Thread_Enable_dispatch(); 200b398: 40 00 0e e5 call 200ef2c <_Thread_Enable_dispatch> 200b39c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EBADF ); 200b3a0: 40 00 2a b1 call 2015e64 <__errno> 200b3a4: 01 00 00 00 nop 200b3a8: 10 80 00 0b b 200b3d4 <_POSIX_Message_queue_Receive_support+0x78> 200b3ac: 82 10 20 09 mov 9, %g1 ! 9 } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 200b3b0: c4 02 20 68 ld [ %o0 + 0x68 ], %g2 200b3b4: 80 a6 80 02 cmp %i2, %g2 200b3b8: 1a 80 00 09 bcc 200b3dc <_POSIX_Message_queue_Receive_support+0x80> 200b3bc: 84 10 3f ff mov -1, %g2 _Thread_Enable_dispatch(); 200b3c0: 40 00 0e db call 200ef2c <_Thread_Enable_dispatch> 200b3c4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EMSGSIZE ); 200b3c8: 40 00 2a a7 call 2015e64 <__errno> 200b3cc: 01 00 00 00 nop 200b3d0: 82 10 20 7a mov 0x7a, %g1 ! 7a 200b3d4: 10 80 00 26 b 200b46c <_POSIX_Message_queue_Receive_support+0x110> 200b3d8: c2 22 00 00 st %g1, [ %o0 ] /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 200b3dc: c4 27 bf f8 st %g2, [ %fp + -8 ] /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 200b3e0: 80 8f 20 ff btst 0xff, %i4 200b3e4: 02 80 00 06 be 200b3fc <_POSIX_Message_queue_Receive_support+0xa0><== NEVER TAKEN 200b3e8: 98 10 20 00 clr %o4 do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 200b3ec: 05 00 00 10 sethi %hi(0x4000), %g2 200b3f0: 82 08 40 02 and %g1, %g2, %g1 200b3f4: 80 a0 00 01 cmp %g0, %g1 200b3f8: 98 60 3f ff subx %g0, -1, %o4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 200b3fc: 9a 10 00 1d mov %i5, %o5 200b400: 90 02 20 1c add %o0, 0x1c, %o0 200b404: 92 10 00 18 mov %i0, %o1 200b408: 94 10 00 19 mov %i1, %o2 200b40c: 96 07 bf f8 add %fp, -8, %o3 200b410: 40 00 08 2b call 200d4bc <_CORE_message_queue_Seize> 200b414: 98 0b 20 01 and %o4, 1, %o4 &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 200b418: 40 00 0e c5 call 200ef2c <_Thread_Enable_dispatch> 200b41c: 3b 00 80 9a sethi %hi(0x2026800), %i5 *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 200b420: c2 07 60 98 ld [ %i5 + 0x98 ], %g1 ! 2026898 <_Thread_Executing> RTEMS_INLINE_ROUTINE unsigned int _POSIX_Message_queue_Priority_from_core( CORE_message_queue_Submit_types priority ) { /* absolute value without a library dependency */ return ((priority >= 0) ? priority : -priority); 200b424: c6 00 60 24 ld [ %g1 + 0x24 ], %g3 if ( !_Thread_Executing->Wait.return_code ) 200b428: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 200b42c: 85 38 e0 1f sra %g3, 0x1f, %g2 200b430: 86 18 80 03 xor %g2, %g3, %g3 200b434: 84 20 c0 02 sub %g3, %g2, %g2 200b438: 80 a0 60 00 cmp %g1, 0 200b43c: 12 80 00 05 bne 200b450 <_POSIX_Message_queue_Receive_support+0xf4> 200b440: c4 26 c0 00 st %g2, [ %i3 ] return length_out; 200b444: f0 07 bf f8 ld [ %fp + -8 ], %i0 200b448: 81 c7 e0 08 ret 200b44c: 81 e8 00 00 restore rtems_set_errno_and_return_minus_one( 200b450: 40 00 2a 85 call 2015e64 <__errno> 200b454: 01 00 00 00 nop 200b458: c2 07 60 98 ld [ %i5 + 0x98 ], %g1 200b45c: b8 10 00 08 mov %o0, %i4 200b460: 40 00 00 9c call 200b6d0 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 200b464: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 200b468: d0 27 00 00 st %o0, [ %i4 ] 200b46c: 81 c7 e0 08 ret 200b470: 91 e8 3f ff restore %g0, -1, %o0 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 200b474: 40 00 2a 7c call 2015e64 <__errno> 200b478: b0 10 3f ff mov -1, %i0 200b47c: 82 10 20 09 mov 9, %g1 200b480: c2 22 00 00 st %g1, [ %o0 ] } 200b484: 81 c7 e0 08 ret 200b488: 81 e8 00 00 restore =============================================================================== 0200bc28 <_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 ]; 200bc28: c2 02 21 6c ld [ %o0 + 0x16c ], %g1 if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 200bc2c: c4 00 60 d4 ld [ %g1 + 0xd4 ], %g2 200bc30: 80 a0 a0 00 cmp %g2, 0 200bc34: 12 80 00 12 bne 200bc7c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54><== NEVER TAKEN 200bc38: 01 00 00 00 nop 200bc3c: c4 00 60 d8 ld [ %g1 + 0xd8 ], %g2 200bc40: 80 a0 a0 01 cmp %g2, 1 200bc44: 12 80 00 0e bne 200bc7c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 200bc48: 01 00 00 00 nop thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 200bc4c: c2 00 60 dc ld [ %g1 + 0xdc ], %g1 200bc50: 80 a0 60 00 cmp %g1, 0 200bc54: 02 80 00 0a be 200bc7c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> 200bc58: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 200bc5c: 03 00 80 5d sethi %hi(0x2017400), %g1 200bc60: c4 00 61 c8 ld [ %g1 + 0x1c8 ], %g2 ! 20175c8 <_Thread_Dispatch_disable_level> thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 200bc64: 92 10 3f ff mov -1, %o1 200bc68: 84 00 bf ff add %g2, -1, %g2 200bc6c: c4 20 61 c8 st %g2, [ %g1 + 0x1c8 ] 200bc70: 82 13 c0 00 mov %o7, %g1 200bc74: 40 00 01 f4 call 200c444 <_POSIX_Thread_Exit> 200bc78: 9e 10 40 00 mov %g1, %o7 } else _Thread_Enable_dispatch(); 200bc7c: 82 13 c0 00 mov %o7, %g1 200bc80: 7f ff f3 3e call 2008978 <_Thread_Enable_dispatch> 200bc84: 9e 10 40 00 mov %g1, %o7 =============================================================================== 0200d0d4 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 200d0d4: 9d e3 bf a0 save %sp, -96, %sp if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 200d0d8: d0 06 40 00 ld [ %i1 ], %o0 200d0dc: 7f ff ff f3 call 200d0a8 <_POSIX_Priority_Is_valid> 200d0e0: a0 10 00 18 mov %i0, %l0 200d0e4: 80 8a 20 ff btst 0xff, %o0 200d0e8: 02 80 00 11 be 200d12c <_POSIX_Thread_Translate_sched_param+0x58><== NEVER TAKEN 200d0ec: b0 10 20 16 mov 0x16, %i0 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 200d0f0: c0 26 80 00 clr [ %i2 ] *budget_callout = NULL; if ( policy == SCHED_OTHER ) { 200d0f4: 80 a4 20 00 cmp %l0, 0 200d0f8: 12 80 00 06 bne 200d110 <_POSIX_Thread_Translate_sched_param+0x3c> 200d0fc: c0 26 c0 00 clr [ %i3 ] *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 200d100: 82 10 20 01 mov 1, %g1 200d104: c2 26 80 00 st %g1, [ %i2 ] return 0; 200d108: 81 c7 e0 08 ret 200d10c: 91 e8 20 00 restore %g0, 0, %o0 } if ( policy == SCHED_FIFO ) { 200d110: 80 a4 20 01 cmp %l0, 1 200d114: 02 80 00 06 be 200d12c <_POSIX_Thread_Translate_sched_param+0x58> 200d118: b0 10 20 00 clr %i0 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 200d11c: 80 a4 20 02 cmp %l0, 2 200d120: 32 80 00 05 bne,a 200d134 <_POSIX_Thread_Translate_sched_param+0x60> 200d124: 80 a4 20 04 cmp %l0, 4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 200d128: e0 26 80 00 st %l0, [ %i2 ] return 0; 200d12c: 81 c7 e0 08 ret 200d130: 81 e8 00 00 restore } if ( policy == SCHED_SPORADIC ) { 200d134: 12 bf ff fe bne 200d12c <_POSIX_Thread_Translate_sched_param+0x58> 200d138: b0 10 20 16 mov 0x16, %i0 if ( (param->sched_ss_repl_period.tv_sec == 0) && 200d13c: c2 06 60 08 ld [ %i1 + 8 ], %g1 200d140: 80 a0 60 00 cmp %g1, 0 200d144: 32 80 00 07 bne,a 200d160 <_POSIX_Thread_Translate_sched_param+0x8c> 200d148: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 200d14c: c2 06 60 0c ld [ %i1 + 0xc ], %g1 200d150: 80 a0 60 00 cmp %g1, 0 200d154: 02 80 00 1d be 200d1c8 <_POSIX_Thread_Translate_sched_param+0xf4> 200d158: 01 00 00 00 nop (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 200d15c: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 200d160: 80 a0 60 00 cmp %g1, 0 200d164: 12 80 00 06 bne 200d17c <_POSIX_Thread_Translate_sched_param+0xa8> 200d168: 01 00 00 00 nop 200d16c: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 200d170: 80 a0 60 00 cmp %g1, 0 200d174: 02 bf ff ee be 200d12c <_POSIX_Thread_Translate_sched_param+0x58> 200d178: b0 10 20 16 mov 0x16, %i0 (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 200d17c: 7f ff f5 38 call 200a65c <_Timespec_To_ticks> 200d180: 90 06 60 08 add %i1, 8, %o0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; 200d184: b0 10 20 16 mov 0x16, %i0 if ( (param->sched_ss_init_budget.tv_sec == 0) && (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 200d188: a0 10 00 08 mov %o0, %l0 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 200d18c: 7f ff f5 34 call 200a65c <_Timespec_To_ticks> 200d190: 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 ) < 200d194: 80 a4 00 08 cmp %l0, %o0 200d198: 0a 80 00 0c bcs 200d1c8 <_POSIX_Thread_Translate_sched_param+0xf4> 200d19c: 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 ) ) 200d1a0: 7f ff ff c2 call 200d0a8 <_POSIX_Priority_Is_valid> 200d1a4: d0 06 60 04 ld [ %i1 + 4 ], %o0 200d1a8: 80 8a 20 ff btst 0xff, %o0 200d1ac: 02 bf ff e0 be 200d12c <_POSIX_Thread_Translate_sched_param+0x58> 200d1b0: 82 10 20 03 mov 3, %g1 return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 200d1b4: c2 26 80 00 st %g1, [ %i2 ] *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; 200d1b8: b0 10 20 00 clr %i0 if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 200d1bc: 03 00 80 1a sethi %hi(0x2006800), %g1 200d1c0: 82 10 62 70 or %g1, 0x270, %g1 ! 2006a70 <_POSIX_Threads_Sporadic_budget_callout> 200d1c4: c2 26 c0 00 st %g1, [ %i3 ] return 0; } return EINVAL; } 200d1c8: 81 c7 e0 08 ret 200d1cc: 81 e8 00 00 restore =============================================================================== 020067b0 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 20067b0: 9d e3 bf 60 save %sp, -160, %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; 20067b4: 03 00 80 72 sethi %hi(0x201c800), %g1 20067b8: 82 10 63 cc or %g1, 0x3cc, %g1 ! 201cbcc maximum = Configuration_POSIX_API.number_of_initialization_threads; 20067bc: e6 00 60 30 ld [ %g1 + 0x30 ], %l3 if ( !user_threads || maximum == 0 ) 20067c0: 80 a4 e0 00 cmp %l3, 0 20067c4: 02 80 00 1d be 2006838 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 20067c8: e2 00 60 34 ld [ %g1 + 0x34 ], %l1 20067cc: 80 a4 60 00 cmp %l1, 0 20067d0: 02 80 00 1a be 2006838 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN 20067d4: a4 10 20 00 clr %l2 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); 20067d8: a0 07 bf c0 add %fp, -64, %l0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); status = pthread_create( 20067dc: a8 07 bf fc add %fp, -4, %l4 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); 20067e0: 40 00 1a 7c call 200d1d0 20067e4: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 20067e8: 92 10 20 02 mov 2, %o1 20067ec: 40 00 1a 85 call 200d200 20067f0: 90 10 00 10 mov %l0, %o0 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 20067f4: d2 04 60 04 ld [ %l1 + 4 ], %o1 20067f8: 40 00 1a 91 call 200d23c 20067fc: 90 10 00 10 mov %l0, %o0 status = pthread_create( 2006800: d4 04 40 00 ld [ %l1 ], %o2 2006804: 90 10 00 14 mov %l4, %o0 2006808: 92 10 00 10 mov %l0, %o1 200680c: 7f ff ff 35 call 20064e0 2006810: 96 10 20 00 clr %o3 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 2006814: 94 92 20 00 orcc %o0, 0, %o2 2006818: 22 80 00 05 be,a 200682c <_POSIX_Threads_Initialize_user_threads_body+0x7c> 200681c: a4 04 a0 01 inc %l2 _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 2006820: 90 10 20 02 mov 2, %o0 2006824: 40 00 07 ee call 20087dc <_Internal_error_Occurred> 2006828: 92 10 20 01 mov 1, %o1 * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { 200682c: 80 a4 80 13 cmp %l2, %l3 2006830: 0a bf ff ec bcs 20067e0 <_POSIX_Threads_Initialize_user_threads_body+0x30><== NEVER TAKEN 2006834: a2 04 60 08 add %l1, 8, %l1 2006838: 81 c7 e0 08 ret 200683c: 81 e8 00 00 restore =============================================================================== 0200bf4c <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 200bf4c: 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 ]; 200bf50: e0 06 61 6c ld [ %i1 + 0x16c ], %l0 /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); 200bf54: 40 00 04 17 call 200cfb0 <_Timespec_To_ticks> 200bf58: 90 04 20 94 add %l0, 0x94, %o0 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 200bf5c: 03 00 80 55 sethi %hi(0x2015400), %g1 200bf60: d2 08 62 34 ldub [ %g1 + 0x234 ], %o1 ! 2015634 200bf64: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 the_thread->cpu_time_budget = ticks; 200bf68: d0 26 60 78 st %o0, [ %i1 + 0x78 ] 200bf6c: 92 22 40 01 sub %o1, %g1, %o1 */ #if 0 printk( "TSR %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 200bf70: c2 06 60 1c ld [ %i1 + 0x1c ], %g1 200bf74: 80 a0 60 00 cmp %g1, 0 200bf78: 12 80 00 08 bne 200bf98 <_POSIX_Threads_Sporadic_budget_TSR+0x4c><== NEVER TAKEN 200bf7c: 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 ) { 200bf80: c2 06 60 14 ld [ %i1 + 0x14 ], %g1 200bf84: 80 a0 40 09 cmp %g1, %o1 200bf88: 08 80 00 04 bleu 200bf98 <_POSIX_Threads_Sporadic_budget_TSR+0x4c> 200bf8c: 90 10 00 19 mov %i1, %o0 _Thread_Change_priority( the_thread, new_priority, true ); 200bf90: 7f ff f0 1e call 2008008 <_Thread_Change_priority> 200bf94: 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 ); 200bf98: 40 00 04 06 call 200cfb0 <_Timespec_To_ticks> 200bf9c: 90 04 20 8c add %l0, 0x8c, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 200bfa0: 31 00 80 58 sethi %hi(0x2016000), %i0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 200bfa4: d0 24 20 b0 st %o0, [ %l0 + 0xb0 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 200bfa8: b0 16 22 28 or %i0, 0x228, %i0 200bfac: 7f ff f6 04 call 20097bc <_Watchdog_Insert> 200bfb0: 93 ec 20 a4 restore %l0, 0xa4, %o1 =============================================================================== 0200bfb8 <_POSIX_Threads_Sporadic_budget_callout>: ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 200bfb8: c4 02 21 6c ld [ %o0 + 0x16c ], %g2 /* * This will prevent the thread from consuming its entire "budget" * while at low priority. */ the_thread->cpu_time_budget = 0xFFFFFFFF; /* XXX should be based on MAX_U32 */ 200bfbc: 86 10 3f ff mov -1, %g3 200bfc0: c4 00 a0 88 ld [ %g2 + 0x88 ], %g2 200bfc4: c6 22 20 78 st %g3, [ %o0 + 0x78 ] 200bfc8: 07 00 80 55 sethi %hi(0x2015400), %g3 200bfcc: d2 08 e2 34 ldub [ %g3 + 0x234 ], %o1 ! 2015634 200bfd0: 92 22 40 02 sub %o1, %g2, %o1 */ #if 0 printk( "callout %d %d %d\n", the_thread->resource_count, the_thread->current_priority, new_priority ); #endif if ( the_thread->resource_count == 0 ) { 200bfd4: c4 02 20 1c ld [ %o0 + 0x1c ], %g2 200bfd8: 80 a0 a0 00 cmp %g2, 0 200bfdc: 12 80 00 09 bne 200c000 <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 200bfe0: d2 22 20 18 st %o1, [ %o0 + 0x18 ] /* * Make sure we are actually lowering it. If they have lowered it * to logically lower than sched_ss_low_priority, then we do not want to * change it. */ if ( the_thread->current_priority < new_priority ) { 200bfe4: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 200bfe8: 80 a0 40 09 cmp %g1, %o1 200bfec: 1a 80 00 05 bcc 200c000 <_POSIX_Threads_Sporadic_budget_callout+0x48><== NEVER TAKEN 200bff0: 94 10 20 01 mov 1, %o2 _Thread_Change_priority( the_thread, new_priority, true ); 200bff4: 82 13 c0 00 mov %o7, %g1 200bff8: 7f ff f0 04 call 2008008 <_Thread_Change_priority> 200bffc: 9e 10 40 00 mov %g1, %o7 200c000: 81 c3 e0 08 retl <== NOT EXECUTED =============================================================================== 020064dc <_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) { 20064dc: 9d e3 bf a0 save %sp, -96, %sp bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 20064e0: c2 06 60 68 ld [ %i1 + 0x68 ], %g1 20064e4: 82 00 60 01 inc %g1 20064e8: c2 26 60 68 st %g1, [ %i1 + 0x68 ] /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 20064ec: c2 06 60 54 ld [ %i1 + 0x54 ], %g1 20064f0: 80 a0 60 00 cmp %g1, 0 20064f4: 32 80 00 07 bne,a 2006510 <_POSIX_Timer_TSR+0x34> 20064f8: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 20064fc: c2 06 60 58 ld [ %i1 + 0x58 ], %g1 2006500: 80 a0 60 00 cmp %g1, 0 2006504: 02 80 00 0f be 2006540 <_POSIX_Timer_TSR+0x64> <== NEVER TAKEN 2006508: 82 10 20 04 mov 4, %g1 ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 200650c: d2 06 60 64 ld [ %i1 + 0x64 ], %o1 2006510: d4 06 60 08 ld [ %i1 + 8 ], %o2 2006514: 90 06 60 10 add %i1, 0x10, %o0 2006518: 17 00 80 19 sethi %hi(0x2006400), %o3 200651c: 98 10 00 19 mov %i1, %o4 2006520: 40 00 1a 19 call 200cd84 <_POSIX_Timer_Insert_helper> 2006524: 96 12 e0 dc or %o3, 0xdc, %o3 ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 2006528: 80 8a 20 ff btst 0xff, %o0 200652c: 02 80 00 0a be 2006554 <_POSIX_Timer_TSR+0x78> <== NEVER TAKEN 2006530: 01 00 00 00 nop return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 2006534: 40 00 05 bd call 2007c28 <_TOD_Get> 2006538: 90 06 60 6c add %i1, 0x6c, %o0 200653c: 82 10 20 03 mov 3, %g1 /* * The sending of the signal to the process running the handling function * specified for that signal is simulated */ if ( pthread_kill ( ptimer->thread_id, ptimer->inf.sigev_signo ) ) { 2006540: d0 06 60 38 ld [ %i1 + 0x38 ], %o0 2006544: d2 06 60 44 ld [ %i1 + 0x44 ], %o1 2006548: 40 00 18 f8 call 200c928 200654c: c2 2e 60 3c stb %g1, [ %i1 + 0x3c ] } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 2006550: c0 26 60 68 clr [ %i1 + 0x68 ] 2006554: 81 c7 e0 08 ret 2006558: 81 e8 00 00 restore =============================================================================== 0200e3fc <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 200e3fc: 9d e3 bf 90 save %sp, -112, %sp siginfo_t siginfo_struct; sigset_t saved_signals_blocked; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 200e400: 98 10 20 01 mov 1, %o4 200e404: 90 10 00 18 mov %i0, %o0 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 200e408: a0 10 00 18 mov %i0, %l0 siginfo_t siginfo_struct; sigset_t saved_signals_blocked; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 200e40c: a2 07 bf f4 add %fp, -12, %l1 200e410: 92 10 00 19 mov %i1, %o1 200e414: 94 10 00 11 mov %l1, %o2 200e418: 96 0e a0 ff and %i2, 0xff, %o3 200e41c: 40 00 00 21 call 200e4a0 <_POSIX_signals_Clear_signals> 200e420: b0 10 20 00 clr %i0 200e424: 80 8a 20 ff btst 0xff, %o0 200e428: 02 80 00 1c be 200e498 <_POSIX_signals_Check_signal+0x9c> 200e42c: 83 2e 60 02 sll %i1, 2, %g1 #endif /* * Just to prevent sending a signal which is currently being ignored. */ if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN ) 200e430: 07 00 80 59 sethi %hi(0x2016400), %g3 200e434: 85 2e 60 04 sll %i1, 4, %g2 200e438: 86 10 e2 d8 or %g3, 0x2d8, %g3 200e43c: 84 20 80 01 sub %g2, %g1, %g2 200e440: 88 00 c0 02 add %g3, %g2, %g4 200e444: c2 01 20 08 ld [ %g4 + 8 ], %g1 200e448: 80 a0 60 01 cmp %g1, 1 200e44c: 02 80 00 13 be 200e498 <_POSIX_signals_Check_signal+0x9c> <== NEVER TAKEN 200e450: 01 00 00 00 nop return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 200e454: e4 04 20 cc ld [ %l0 + 0xcc ], %l2 api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 200e458: c8 01 20 04 ld [ %g4 + 4 ], %g4 /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 200e45c: c4 00 c0 02 ld [ %g3 + %g2 ], %g2 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 200e460: 88 11 00 12 or %g4, %l2, %g4 /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 200e464: 80 a0 a0 02 cmp %g2, 2 200e468: 12 80 00 08 bne 200e488 <_POSIX_signals_Check_signal+0x8c> 200e46c: c8 24 20 cc st %g4, [ %l0 + 0xcc ] case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 200e470: 90 10 00 19 mov %i1, %o0 200e474: 92 10 00 11 mov %l1, %o1 200e478: 9f c0 40 00 call %g1 200e47c: 94 10 20 00 clr %o2 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 200e480: 10 80 00 05 b 200e494 <_POSIX_signals_Check_signal+0x98> 200e484: e4 24 20 cc st %l2, [ %l0 + 0xcc ] default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 200e488: 9f c0 40 00 call %g1 200e48c: 90 10 00 19 mov %i1, %o0 } /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 200e490: e4 24 20 cc st %l2, [ %l0 + 0xcc ] return true; 200e494: b0 10 20 01 mov 1, %i0 } 200e498: 81 c7 e0 08 ret 200e49c: 81 e8 00 00 restore =============================================================================== 0200eb6c <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 200eb6c: 9d e3 bf a0 save %sp, -96, %sp clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 200eb70: 7f ff cd 94 call 20021c0 200eb74: 01 00 00 00 nop if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 200eb78: 85 2e 20 04 sll %i0, 4, %g2 200eb7c: 83 2e 20 02 sll %i0, 2, %g1 200eb80: 82 20 80 01 sub %g2, %g1, %g1 200eb84: 05 00 80 59 sethi %hi(0x2016400), %g2 200eb88: 84 10 a2 d8 or %g2, 0x2d8, %g2 ! 20166d8 <_POSIX_signals_Vectors> 200eb8c: c4 00 80 01 ld [ %g2 + %g1 ], %g2 200eb90: 80 a0 a0 02 cmp %g2, 2 200eb94: 12 80 00 0a bne 200ebbc <_POSIX_signals_Clear_process_signals+0x50> 200eb98: 05 00 80 5a sethi %hi(0x2016800), %g2 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 200eb9c: 05 00 80 5a sethi %hi(0x2016800), %g2 200eba0: 84 10 a0 d0 or %g2, 0xd0, %g2 ! 20168d0 <_POSIX_signals_Siginfo> */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 200eba4: 86 00 40 02 add %g1, %g2, %g3 if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 200eba8: c2 00 80 01 ld [ %g2 + %g1 ], %g1 200ebac: 86 00 e0 04 add %g3, 4, %g3 200ebb0: 80 a0 40 03 cmp %g1, %g3 200ebb4: 12 80 00 0e bne 200ebec <_POSIX_signals_Clear_process_signals+0x80><== NEVER TAKEN 200ebb8: 05 00 80 5a sethi %hi(0x2016800), %g2 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 200ebbc: c6 00 a0 cc ld [ %g2 + 0xcc ], %g3 ! 20168cc <_POSIX_signals_Pending> 200ebc0: b0 06 3f ff add %i0, -1, %i0 200ebc4: 82 10 20 01 mov 1, %g1 200ebc8: 83 28 40 18 sll %g1, %i0, %g1 200ebcc: 82 28 c0 01 andn %g3, %g1, %g1 if ( !_POSIX_signals_Pending ) 200ebd0: 80 a0 60 00 cmp %g1, 0 200ebd4: 12 80 00 06 bne 200ebec <_POSIX_signals_Clear_process_signals+0x80><== NEVER TAKEN 200ebd8: c2 20 a0 cc st %g1, [ %g2 + 0xcc ] _Thread_Do_post_task_switch_extension--; 200ebdc: 03 00 80 58 sethi %hi(0x2016000), %g1 200ebe0: c4 00 61 ec ld [ %g1 + 0x1ec ], %g2 ! 20161ec <_Thread_Do_post_task_switch_extension> 200ebe4: 84 00 bf ff add %g2, -1, %g2 200ebe8: c4 20 61 ec st %g2, [ %g1 + 0x1ec ] } _ISR_Enable( level ); 200ebec: 7f ff cd 79 call 20021d0 200ebf0: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 02006f80 <_POSIX_signals_Get_highest>: sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 2006f80: 82 10 20 1b mov 0x1b, %g1 ! 1b 2006f84: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_highest( 2006f88: 86 00 7f ff add %g1, -1, %g3 2006f8c: 87 28 80 03 sll %g2, %g3, %g3 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 2006f90: 80 88 c0 08 btst %g3, %o0 2006f94: 12 80 00 11 bne 2006fd8 <_POSIX_signals_Get_highest+0x58> <== NEVER TAKEN 2006f98: 01 00 00 00 nop sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 2006f9c: 82 00 60 01 inc %g1 2006fa0: 80 a0 60 20 cmp %g1, 0x20 2006fa4: 12 bf ff fa bne 2006f8c <_POSIX_signals_Get_highest+0xc> 2006fa8: 86 00 7f ff add %g1, -1, %g3 2006fac: 82 10 20 01 mov 1, %g1 2006fb0: 84 10 20 01 mov 1, %g2 #include #include #include #include int _POSIX_signals_Get_highest( 2006fb4: 86 00 7f ff add %g1, -1, %g3 2006fb8: 87 28 80 03 sll %g2, %g3, %g3 #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { if ( set & signo_to_mask( signo ) ) { 2006fbc: 80 88 c0 08 btst %g3, %o0 2006fc0: 12 80 00 06 bne 2006fd8 <_POSIX_signals_Get_highest+0x58> 2006fc4: 01 00 00 00 nop */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 2006fc8: 82 00 60 01 inc %g1 2006fcc: 80 a0 60 1b cmp %g1, 0x1b 2006fd0: 12 bf ff fa bne 2006fb8 <_POSIX_signals_Get_highest+0x38> <== ALWAYS TAKEN 2006fd4: 86 00 7f ff add %g1, -1, %g3 * a return 0. This routine will NOT be called unless a signal * is pending in the set passed in. */ found_it: return signo; } 2006fd8: 81 c3 e0 08 retl 2006fdc: 90 10 00 01 mov %g1, %o0 =============================================================================== 02022a4c <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 2022a4c: 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 ) ) { 2022a50: c2 06 20 10 ld [ %i0 + 0x10 ], %g1 2022a54: 1b 04 00 20 sethi %hi(0x10008000), %o5 2022a58: 86 06 7f ff add %i1, -1, %g3 2022a5c: 84 10 20 01 mov 1, %g2 2022a60: 98 08 40 0d and %g1, %o5, %o4 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 2022a64: a0 10 00 18 mov %i0, %l0 2022a68: 92 10 00 1a mov %i2, %o1 POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 2022a6c: c8 06 21 6c ld [ %i0 + 0x16c ], %g4 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 2022a70: 80 a3 00 0d cmp %o4, %o5 2022a74: 12 80 00 1b bne 2022ae0 <_POSIX_signals_Unblock_thread+0x94> 2022a78: 87 28 80 03 sll %g2, %g3, %g3 if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 2022a7c: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 2022a80: 80 88 c0 01 btst %g3, %g1 2022a84: 12 80 00 07 bne 2022aa0 <_POSIX_signals_Unblock_thread+0x54> 2022a88: 82 10 20 04 mov 4, %g1 2022a8c: c2 01 20 cc ld [ %g4 + 0xcc ], %g1 2022a90: 80 a8 c0 01 andncc %g3, %g1, %g0 2022a94: 02 80 00 11 be 2022ad8 <_POSIX_signals_Unblock_thread+0x8c> 2022a98: b0 10 20 00 clr %i0 the_thread->Wait.return_code = EINTR; 2022a9c: 82 10 20 04 mov 4, %g1 2022aa0: c2 24 20 34 st %g1, [ %l0 + 0x34 ] the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { 2022aa4: 80 a2 60 00 cmp %o1, 0 2022aa8: 12 80 00 07 bne 2022ac4 <_POSIX_signals_Unblock_thread+0x78> 2022aac: d0 04 20 28 ld [ %l0 + 0x28 ], %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 2022ab0: 82 10 20 01 mov 1, %g1 the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; 2022ab4: f2 22 00 00 st %i1, [ %o0 ] the_info->si_code = SI_USER; 2022ab8: c2 22 20 04 st %g1, [ %o0 + 4 ] the_info->si_value.sival_int = 0; 2022abc: 10 80 00 04 b 2022acc <_POSIX_signals_Unblock_thread+0x80> 2022ac0: c0 22 20 08 clr [ %o0 + 8 ] } else { *the_info = *info; 2022ac4: 7f ff c8 bd call 2014db8 2022ac8: 94 10 20 0c mov 0xc, %o2 } _Thread_queue_Extract_with_proxy( the_thread ); 2022acc: 90 10 00 10 mov %l0, %o0 2022ad0: 7f ff ae 9f call 200e54c <_Thread_queue_Extract_with_proxy> 2022ad4: b0 10 20 01 mov 1, %i0 return true; 2022ad8: 81 c7 e0 08 ret 2022adc: 81 e8 00 00 restore } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 2022ae0: c8 01 20 cc ld [ %g4 + 0xcc ], %g4 2022ae4: 80 a8 c0 04 andncc %g3, %g4, %g0 2022ae8: 02 bf ff fc be 2022ad8 <_POSIX_signals_Unblock_thread+0x8c> 2022aec: b0 10 20 00 clr %i0 * + Any other combination, do nothing. */ the_thread->do_post_task_switch_extension = true; if ( the_thread->current_state & STATES_INTERRUPTIBLE_BY_SIGNAL ) { 2022af0: 07 04 00 00 sethi %hi(0x10000000), %g3 2022af4: 80 88 40 03 btst %g1, %g3 2022af8: 02 80 00 13 be 2022b44 <_POSIX_signals_Unblock_thread+0xf8> 2022afc: c4 2c 20 74 stb %g2, [ %l0 + 0x74 ] the_thread->Wait.return_code = EINTR; 2022b00: 84 10 20 04 mov 4, %g2 #if 0 if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) ) _Thread_queue_Extract_with_proxy( the_thread ); else #endif if ( _States_Is_delaying(the_thread->current_state) ){ 2022b04: 80 88 60 08 btst 8, %g1 2022b08: 02 bf ff f4 be 2022ad8 <_POSIX_signals_Unblock_thread+0x8c><== NEVER TAKEN 2022b0c: c4 24 20 34 st %g2, [ %l0 + 0x34 ] if ( _Watchdog_Is_active( &the_thread->Timer ) ) 2022b10: c2 04 20 50 ld [ %l0 + 0x50 ], %g1 2022b14: 80 a0 60 02 cmp %g1, 2 2022b18: 12 80 00 05 bne 2022b2c <_POSIX_signals_Unblock_thread+0xe0><== NEVER TAKEN 2022b1c: 90 10 00 10 mov %l0, %o0 (void) _Watchdog_Remove( &the_thread->Timer ); 2022b20: 7f ff b1 5f call 200f09c <_Watchdog_Remove> 2022b24: 90 04 20 48 add %l0, 0x48, %o0 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 2022b28: 90 10 00 10 mov %l0, %o0 2022b2c: 13 04 00 ff sethi %hi(0x1003fc00), %o1 } else if ( the_thread->current_state == STATES_READY ) { if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _ISR_Signals_to_thread_executing = true; } } return false; 2022b30: b0 10 20 00 clr %i0 2022b34: 7f ff ab 79 call 200d918 <_Thread_Clear_state> 2022b38: 92 12 63 f8 or %o1, 0x3f8, %o1 2022b3c: 81 c7 e0 08 ret 2022b40: 81 e8 00 00 restore if ( _States_Is_delaying(the_thread->current_state) ){ if ( _Watchdog_Is_active( &the_thread->Timer ) ) (void) _Watchdog_Remove( &the_thread->Timer ); _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 2022b44: 80 a0 60 00 cmp %g1, 0 2022b48: 12 bf ff e4 bne 2022ad8 <_POSIX_signals_Unblock_thread+0x8c><== NEVER TAKEN 2022b4c: 03 00 80 98 sethi %hi(0x2026000), %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 2022b50: c2 00 62 44 ld [ %g1 + 0x244 ], %g1 ! 2026244 <_ISR_Nest_level> 2022b54: 80 a0 60 00 cmp %g1, 0 2022b58: 02 bf ff e0 be 2022ad8 <_POSIX_signals_Unblock_thread+0x8c> 2022b5c: 03 00 80 98 sethi %hi(0x2026000), %g1 2022b60: c2 00 62 68 ld [ %g1 + 0x268 ], %g1 ! 2026268 <_Thread_Executing> 2022b64: 80 a4 00 01 cmp %l0, %g1 2022b68: 12 bf ff dc bne 2022ad8 <_POSIX_signals_Unblock_thread+0x8c><== NEVER TAKEN 2022b6c: 03 00 80 98 sethi %hi(0x2026000), %g1 _ISR_Signals_to_thread_executing = true; 2022b70: c4 28 63 08 stb %g2, [ %g1 + 0x308 ] ! 2026308 <_ISR_Signals_to_thread_executing> } } return false; } 2022b74: 81 c7 e0 08 ret 2022b78: 81 e8 00 00 restore =============================================================================== 0200c360 <_RTEMS_tasks_Post_switch_extension>: */ void _RTEMS_tasks_Post_switch_extension( Thread_Control *executing ) { 200c360: 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 ]; 200c364: e0 06 21 68 ld [ %i0 + 0x168 ], %l0 if ( !api ) 200c368: 80 a4 20 00 cmp %l0, 0 200c36c: 02 80 00 1d be 200c3e0 <_RTEMS_tasks_Post_switch_extension+0x80><== NEVER TAKEN 200c370: 01 00 00 00 nop * Signal Processing */ asr = &api->Signal; _ISR_Disable( level ); 200c374: 7f ff d7 93 call 20021c0 200c378: 01 00 00 00 nop signal_set = asr->signals_posted; 200c37c: e6 04 20 14 ld [ %l0 + 0x14 ], %l3 asr->signals_posted = 0; 200c380: c0 24 20 14 clr [ %l0 + 0x14 ] _ISR_Enable( level ); 200c384: 7f ff d7 93 call 20021d0 200c388: 01 00 00 00 nop if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ 200c38c: 80 a4 e0 00 cmp %l3, 0 200c390: 02 80 00 14 be 200c3e0 <_RTEMS_tasks_Post_switch_extension+0x80> 200c394: a2 07 bf fc add %fp, -4, %l1 return; asr->nest_level += 1; 200c398: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 200c39c: d0 04 20 10 ld [ %l0 + 0x10 ], %o0 if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ return; asr->nest_level += 1; 200c3a0: 82 00 60 01 inc %g1 200c3a4: c2 24 20 1c st %g1, [ %l0 + 0x1c ] rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 200c3a8: 94 10 00 11 mov %l1, %o2 200c3ac: 25 00 00 3f sethi %hi(0xfc00), %l2 200c3b0: 40 00 08 a3 call 200e63c 200c3b4: 92 14 a3 ff or %l2, 0x3ff, %o1 ! ffff (*asr->handler)( signal_set ); 200c3b8: c2 04 20 0c ld [ %l0 + 0xc ], %g1 200c3bc: 9f c0 40 00 call %g1 200c3c0: 90 10 00 13 mov %l3, %o0 asr->nest_level -= 1; 200c3c4: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 200c3c8: 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; 200c3cc: 82 00 7f ff add %g1, -1, %g1 rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 200c3d0: 92 14 a3 ff or %l2, 0x3ff, %o1 asr->nest_level += 1; rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); (*asr->handler)( signal_set ); asr->nest_level -= 1; 200c3d4: c2 24 20 1c st %g1, [ %l0 + 0x1c ] rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 200c3d8: 40 00 08 99 call 200e63c 200c3dc: 94 10 00 11 mov %l1, %o2 200c3e0: 81 c7 e0 08 ret 200c3e4: 81 e8 00 00 restore =============================================================================== 020079e0 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 20079e0: 9d e3 bf 98 save %sp, -104, %sp 20079e4: 11 00 80 7b sethi %hi(0x201ec00), %o0 20079e8: 92 10 00 18 mov %i0, %o1 20079ec: 90 12 20 64 or %o0, 0x64, %o0 20079f0: 40 00 07 ea call 2009998 <_Objects_Get> 20079f4: 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 ) { 20079f8: c2 07 bf fc ld [ %fp + -4 ], %g1 20079fc: 80 a0 60 00 cmp %g1, 0 2007a00: 12 80 00 24 bne 2007a90 <_Rate_monotonic_Timeout+0xb0> <== NEVER TAKEN 2007a04: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: the_thread = the_period->owner; 2007a08: d0 02 20 40 ld [ %o0 + 0x40 ], %o0 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 2007a0c: 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); 2007a10: c4 02 20 10 ld [ %o0 + 0x10 ], %g2 2007a14: 80 88 80 01 btst %g2, %g1 2007a18: 22 80 00 0b be,a 2007a44 <_Rate_monotonic_Timeout+0x64> 2007a1c: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 2007a20: c4 02 20 20 ld [ %o0 + 0x20 ], %g2 2007a24: c2 04 20 08 ld [ %l0 + 8 ], %g1 2007a28: 80 a0 80 01 cmp %g2, %g1 2007a2c: 32 80 00 06 bne,a 2007a44 <_Rate_monotonic_Timeout+0x64> 2007a30: c2 04 20 38 ld [ %l0 + 0x38 ], %g1 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 2007a34: 13 04 00 ff sethi %hi(0x1003fc00), %o1 2007a38: 40 00 09 48 call 2009f58 <_Thread_Clear_state> 2007a3c: 92 12 63 f8 or %o1, 0x3f8, %o1 ! 1003fff8 2007a40: 30 80 00 06 b,a 2007a58 <_Rate_monotonic_Timeout+0x78> _Thread_Unblock( the_thread ); _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { 2007a44: 80 a0 60 01 cmp %g1, 1 2007a48: 12 80 00 0d bne 2007a7c <_Rate_monotonic_Timeout+0x9c> 2007a4c: 82 10 20 04 mov 4, %g1 the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 2007a50: 82 10 20 03 mov 3, %g1 2007a54: c2 24 20 38 st %g1, [ %l0 + 0x38 ] _Rate_monotonic_Initiate_statistics( the_period ); 2007a58: 7f ff fe 67 call 20073f4 <_Rate_monotonic_Initiate_statistics> 2007a5c: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 2007a60: c2 04 20 3c ld [ %l0 + 0x3c ], %g1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 2007a64: 11 00 80 7b sethi %hi(0x201ec00), %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 2007a68: c2 24 20 1c st %g1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 2007a6c: 90 12 22 b8 or %o0, 0x2b8, %o0 2007a70: 40 00 0f 88 call 200b890 <_Watchdog_Insert> 2007a74: 92 04 20 10 add %l0, 0x10, %o1 2007a78: 30 80 00 02 b,a 2007a80 <_Rate_monotonic_Timeout+0xa0> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 2007a7c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 2007a80: 03 00 80 7b sethi %hi(0x201ec00), %g1 2007a84: c4 00 61 d8 ld [ %g1 + 0x1d8 ], %g2 ! 201edd8 <_Thread_Dispatch_disable_level> 2007a88: 84 00 bf ff add %g2, -1, %g2 2007a8c: c4 20 61 d8 st %g2, [ %g1 + 0x1d8 ] 2007a90: 81 c7 e0 08 ret 2007a94: 81 e8 00 00 restore =============================================================================== 020073f8 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 20073f8: 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(); 20073fc: 03 00 80 7a sethi %hi(0x201e800), %g1 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 2007400: a0 10 00 18 mov %i0, %l0 uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 2007404: d2 00 63 84 ld [ %g1 + 0x384 ], %o1 if ((!the_tod) || 2007408: 80 a4 20 00 cmp %l0, 0 200740c: 02 80 00 2b be 20074b8 <_TOD_Validate+0xc0> <== NEVER TAKEN 2007410: b0 10 20 00 clr %i0 ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 2007414: 11 00 03 d0 sethi %hi(0xf4000), %o0 2007418: 40 00 4b 3e call 201a110 <.udiv> 200741c: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 2007420: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 2007424: 80 a0 40 08 cmp %g1, %o0 2007428: 1a 80 00 24 bcc 20074b8 <_TOD_Validate+0xc0> 200742c: 01 00 00 00 nop (the_tod->ticks >= ticks_per_second) || 2007430: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 2007434: 80 a0 60 3b cmp %g1, 0x3b 2007438: 18 80 00 20 bgu 20074b8 <_TOD_Validate+0xc0> 200743c: 01 00 00 00 nop (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 2007440: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 2007444: 80 a0 60 3b cmp %g1, 0x3b 2007448: 18 80 00 1c bgu 20074b8 <_TOD_Validate+0xc0> 200744c: 01 00 00 00 nop (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 2007450: c2 04 20 0c ld [ %l0 + 0xc ], %g1 2007454: 80 a0 60 17 cmp %g1, 0x17 2007458: 18 80 00 18 bgu 20074b8 <_TOD_Validate+0xc0> 200745c: 01 00 00 00 nop (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 2007460: c2 04 20 04 ld [ %l0 + 4 ], %g1 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || 2007464: 80 a0 60 00 cmp %g1, 0 2007468: 02 80 00 14 be 20074b8 <_TOD_Validate+0xc0> <== NEVER TAKEN 200746c: 80 a0 60 0c cmp %g1, 0xc (the_tod->month == 0) || 2007470: 18 80 00 12 bgu 20074b8 <_TOD_Validate+0xc0> 2007474: 01 00 00 00 nop (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 2007478: c6 04 00 00 ld [ %l0 ], %g3 (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || 200747c: 80 a0 e7 c3 cmp %g3, 0x7c3 2007480: 08 80 00 0e bleu 20074b8 <_TOD_Validate+0xc0> 2007484: 01 00 00 00 nop (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 2007488: c4 04 20 08 ld [ %l0 + 8 ], %g2 (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 200748c: 80 a0 a0 00 cmp %g2, 0 2007490: 02 80 00 0a be 20074b8 <_TOD_Validate+0xc0> <== NEVER TAKEN 2007494: 80 88 e0 03 btst 3, %g3 2007498: 07 00 80 75 sethi %hi(0x201d400), %g3 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 200749c: 12 80 00 03 bne 20074a8 <_TOD_Validate+0xb0> 20074a0: 86 10 e2 d8 or %g3, 0x2d8, %g3 ! 201d6d8 <_TOD_Days_per_month> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 20074a4: 82 00 60 0d add %g1, 0xd, %g1 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 20074a8: 83 28 60 02 sll %g1, 2, %g1 20074ac: c2 00 c0 01 ld [ %g3 + %g1 ], %g1 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 20074b0: 80 a0 40 02 cmp %g1, %g2 20074b4: b0 60 3f ff subx %g0, -1, %i0 if ( the_tod->day > days_in_month ) return false; return true; } 20074b8: 81 c7 e0 08 ret 20074bc: 81 e8 00 00 restore =============================================================================== 02008008 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 2008008: 9d e3 bf a0 save %sp, -96, %sp */ /* * Save original state */ original_state = the_thread->current_state; 200800c: e2 06 20 10 ld [ %i0 + 0x10 ], %l1 /* * Set a transient state for the thread so it is pulled off the Ready chains. * This will prevent it from being scheduled no matter what happens in an * ISR. */ _Thread_Set_transient( the_thread ); 2008010: 40 00 04 4c call 2009140 <_Thread_Set_transient> 2008014: 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 ) 2008018: c2 06 20 14 ld [ %i0 + 0x14 ], %g1 200801c: 80 a0 40 19 cmp %g1, %i1 2008020: 02 80 00 05 be 2008034 <_Thread_Change_priority+0x2c> 2008024: a0 10 00 18 mov %i0, %l0 _Thread_Set_priority( the_thread, new_priority ); 2008028: 90 10 00 18 mov %i0, %o0 200802c: 40 00 03 c8 call 2008f4c <_Thread_Set_priority> 2008030: 92 10 00 19 mov %i1, %o1 _ISR_Disable( level ); 2008034: 7f ff e8 63 call 20021c0 2008038: 01 00 00 00 nop 200803c: b0 10 00 08 mov %o0, %i0 /* * If the thread has more than STATES_TRANSIENT set, then it is blocked, * If it is blocked on a thread queue, then we need to requeue it. */ state = the_thread->current_state; 2008040: f2 04 20 10 ld [ %l0 + 0x10 ], %i1 if ( state != STATES_TRANSIENT ) { 2008044: 80 a6 60 04 cmp %i1, 4 2008048: 02 80 00 10 be 2008088 <_Thread_Change_priority+0x80> 200804c: a2 0c 60 04 and %l1, 4, %l1 /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 2008050: 80 a4 60 00 cmp %l1, 0 2008054: 12 80 00 03 bne 2008060 <_Thread_Change_priority+0x58> <== NEVER TAKEN 2008058: 82 0e 7f fb and %i1, -5, %g1 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 200805c: c2 24 20 10 st %g1, [ %l0 + 0x10 ] _ISR_Enable( level ); 2008060: 7f ff e8 5c call 20021d0 2008064: 90 10 00 18 mov %i0, %o0 if ( _States_Is_waiting_on_thread_queue( state ) ) { 2008068: 03 00 00 ef sethi %hi(0x3bc00), %g1 200806c: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 2008070: 80 8e 40 01 btst %i1, %g1 2008074: 02 80 00 5e be 20081ec <_Thread_Change_priority+0x1e4> 2008078: 01 00 00 00 nop _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 200807c: f0 04 20 44 ld [ %l0 + 0x44 ], %i0 2008080: 40 00 03 86 call 2008e98 <_Thread_queue_Requeue> 2008084: 93 e8 00 10 restore %g0, %l0, %o1 } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { 2008088: 80 a4 60 00 cmp %l1, 0 200808c: 12 80 00 1c bne 20080fc <_Thread_Change_priority+0xf4> <== NEVER TAKEN 2008090: 01 00 00 00 nop RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 2008094: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 2008098: c4 14 20 96 lduh [ %l0 + 0x96 ], %g2 200809c: c6 10 40 00 lduh [ %g1 ], %g3 * Interrupts are STILL disabled. * We now know the thread will be in the READY state when we remove * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 20080a0: c0 24 20 10 clr [ %l0 + 0x10 ] 20080a4: 84 10 c0 02 or %g3, %g2, %g2 20080a8: c4 30 40 00 sth %g2, [ %g1 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 20080ac: 03 00 80 58 sethi %hi(0x2016000), %g1 20080b0: c6 14 20 94 lduh [ %l0 + 0x94 ], %g3 20080b4: c4 10 61 fc lduh [ %g1 + 0x1fc ], %g2 _Priority_Add_to_bit_map( &the_thread->Priority_map ); if ( prepend_it ) 20080b8: 80 8e a0 ff btst 0xff, %i2 20080bc: 84 10 c0 02 or %g3, %g2, %g2 20080c0: c4 30 61 fc sth %g2, [ %g1 + 0x1fc ] 20080c4: 02 80 00 08 be 20080e4 <_Thread_Change_priority+0xdc> 20080c8: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 20080cc: c4 00 40 00 ld [ %g1 ], %g2 Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 20080d0: c2 24 20 04 st %g1, [ %l0 + 4 ] before_node = after_node->next; after_node->next = the_node; 20080d4: e0 20 40 00 st %l0, [ %g1 ] the_node->next = before_node; 20080d8: c4 24 00 00 st %g2, [ %l0 ] before_node->previous = the_node; 20080dc: 10 80 00 08 b 20080fc <_Thread_Change_priority+0xf4> 20080e0: e0 20 a0 04 st %l0, [ %g2 + 4 ] */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 20080e4: 84 00 60 04 add %g1, 4, %g2 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 20080e8: c4 24 00 00 st %g2, [ %l0 ] old_last_node = the_chain->last; 20080ec: c4 00 60 08 ld [ %g1 + 8 ], %g2 the_chain->last = the_node; 20080f0: e0 20 60 08 st %l0, [ %g1 + 8 ] old_last_node->next = the_node; 20080f4: e0 20 80 00 st %l0, [ %g2 ] the_node->previous = old_last_node; 20080f8: c4 24 20 04 st %g2, [ %l0 + 4 ] _Chain_Prepend_unprotected( the_thread->ready, &the_thread->Object.Node ); else _Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node ); } _ISR_Flash( level ); 20080fc: 7f ff e8 35 call 20021d0 2008100: 90 10 00 18 mov %i0, %o0 2008104: 7f ff e8 2f call 20021c0 2008108: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) _Thread_Ready_chain[ _Priority_Get_highest() ].first; 200810c: 03 00 80 58 sethi %hi(0x2016000), %g1 2008110: da 00 60 a4 ld [ %g1 + 0xa4 ], %o5 ! 20160a4 <_Thread_Ready_chain> RTEMS_INLINE_ROUTINE Priority_Control _Priority_Get_highest( void ) { Priority_Bit_map_control minor; Priority_Bit_map_control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 2008114: 03 00 80 58 sethi %hi(0x2016000), %g1 2008118: c4 10 61 fc lduh [ %g1 + 0x1fc ], %g2 ! 20161fc <_Priority_Major_bit_map> 200811c: 03 00 80 52 sethi %hi(0x2014800), %g1 2008120: 85 28 a0 10 sll %g2, 0x10, %g2 2008124: 87 30 a0 10 srl %g2, 0x10, %g3 2008128: 80 a0 e0 ff cmp %g3, 0xff 200812c: 18 80 00 05 bgu 2008140 <_Thread_Change_priority+0x138> 2008130: 82 10 63 68 or %g1, 0x368, %g1 2008134: c4 08 40 03 ldub [ %g1 + %g3 ], %g2 2008138: 10 80 00 04 b 2008148 <_Thread_Change_priority+0x140> 200813c: 84 00 a0 08 add %g2, 8, %g2 2008140: 85 30 a0 18 srl %g2, 0x18, %g2 2008144: c4 08 40 02 ldub [ %g1 + %g2 ], %g2 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 2008148: 83 28 a0 10 sll %g2, 0x10, %g1 200814c: 07 00 80 58 sethi %hi(0x2016000), %g3 2008150: 83 30 60 0f srl %g1, 0xf, %g1 2008154: 86 10 e2 80 or %g3, 0x280, %g3 2008158: c6 10 c0 01 lduh [ %g3 + %g1 ], %g3 200815c: 03 00 80 52 sethi %hi(0x2014800), %g1 2008160: 87 28 e0 10 sll %g3, 0x10, %g3 2008164: 89 30 e0 10 srl %g3, 0x10, %g4 2008168: 80 a1 20 ff cmp %g4, 0xff 200816c: 18 80 00 05 bgu 2008180 <_Thread_Change_priority+0x178> 2008170: 82 10 63 68 or %g1, 0x368, %g1 2008174: c2 08 40 04 ldub [ %g1 + %g4 ], %g1 2008178: 10 80 00 04 b 2008188 <_Thread_Change_priority+0x180> 200817c: 82 00 60 08 add %g1, 8, %g1 2008180: 87 30 e0 18 srl %g3, 0x18, %g3 2008184: c2 08 40 03 ldub [ %g1 + %g3 ], %g1 return (_Priority_Bits_index( major ) << 4) + _Priority_Bits_index( minor ); 2008188: 83 28 60 10 sll %g1, 0x10, %g1 200818c: 83 30 60 10 srl %g1, 0x10, %g1 Priority_Bit_map_control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); return (_Priority_Bits_index( major ) << 4) + 2008190: 85 28 a0 10 sll %g2, 0x10, %g2 2008194: 85 30 a0 0c srl %g2, 0xc, %g2 2008198: 84 00 40 02 add %g1, %g2, %g2 200819c: 83 28 a0 02 sll %g2, 2, %g1 20081a0: 85 28 a0 04 sll %g2, 4, %g2 20081a4: 84 20 80 01 sub %g2, %g1, %g2 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 20081a8: c4 03 40 02 ld [ %o5 + %g2 ], %g2 20081ac: 03 00 80 58 sethi %hi(0x2016000), %g1 20081b0: c4 20 61 d8 st %g2, [ %g1 + 0x1d8 ] ! 20161d8 <_Thread_Heir> * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 20081b4: 03 00 80 58 sethi %hi(0x2016000), %g1 20081b8: c2 00 62 08 ld [ %g1 + 0x208 ], %g1 ! 2016208 <_Thread_Executing> * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Thread_Calculate_heir(); if ( !_Thread_Is_executing_also_the_heir() && 20081bc: 80 a0 40 02 cmp %g1, %g2 20081c0: 02 80 00 09 be 20081e4 <_Thread_Change_priority+0x1dc> 20081c4: 01 00 00 00 nop 20081c8: c2 08 60 75 ldub [ %g1 + 0x75 ], %g1 20081cc: 80 a0 60 00 cmp %g1, 0 20081d0: 02 80 00 05 be 20081e4 <_Thread_Change_priority+0x1dc> 20081d4: 01 00 00 00 nop _Thread_Executing->is_preemptible ) _Context_Switch_necessary = true; 20081d8: 84 10 20 01 mov 1, %g2 ! 1 20081dc: 03 00 80 58 sethi %hi(0x2016000), %g1 20081e0: c4 28 62 18 stb %g2, [ %g1 + 0x218 ] ! 2016218 <_Context_Switch_necessary> _ISR_Enable( level ); 20081e4: 7f ff e7 fb call 20021d0 20081e8: 81 e8 00 00 restore 20081ec: 81 c7 e0 08 ret 20081f0: 81 e8 00 00 restore =============================================================================== 020081f4 <_Thread_Clear_state>: void _Thread_Clear_state( Thread_Control *the_thread, States_Control state ) { 20081f4: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 20081f8: 7f ff e7 f2 call 20021c0 20081fc: a0 10 00 18 mov %i0, %l0 2008200: b0 10 00 08 mov %o0, %i0 current_state = the_thread->current_state; 2008204: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 if ( current_state & state ) { 2008208: 80 8e 40 01 btst %i1, %g1 200820c: 02 80 00 2e be 20082c4 <_Thread_Clear_state+0xd0> 2008210: 01 00 00 00 nop RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); 2008214: b2 28 40 19 andn %g1, %i1, %i1 current_state = the_thread->current_state = _States_Clear( state, current_state ); if ( _States_Is_ready( current_state ) ) { 2008218: 80 a6 60 00 cmp %i1, 0 200821c: 12 80 00 2a bne 20082c4 <_Thread_Clear_state+0xd0> 2008220: f2 24 20 10 st %i1, [ %l0 + 0x10 ] RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 2008224: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 2008228: c4 14 20 96 lduh [ %l0 + 0x96 ], %g2 200822c: c6 10 40 00 lduh [ %g1 ], %g3 2008230: 84 10 c0 02 or %g3, %g2, %g2 2008234: c4 30 40 00 sth %g2, [ %g1 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 2008238: 03 00 80 58 sethi %hi(0x2016000), %g1 200823c: c6 14 20 94 lduh [ %l0 + 0x94 ], %g3 2008240: c4 10 61 fc lduh [ %g1 + 0x1fc ], %g2 2008244: 84 10 c0 02 or %g3, %g2, %g2 2008248: c4 30 61 fc sth %g2, [ %g1 + 0x1fc ] _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node); 200824c: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 2008250: 84 00 60 04 add %g1, 4, %g2 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 2008254: c4 24 00 00 st %g2, [ %l0 ] old_last_node = the_chain->last; 2008258: c4 00 60 08 ld [ %g1 + 8 ], %g2 the_chain->last = the_node; 200825c: e0 20 60 08 st %l0, [ %g1 + 8 ] old_last_node->next = the_node; 2008260: e0 20 80 00 st %l0, [ %g2 ] the_node->previous = old_last_node; 2008264: c4 24 20 04 st %g2, [ %l0 + 4 ] _ISR_Flash( level ); 2008268: 7f ff e7 da call 20021d0 200826c: 01 00 00 00 nop 2008270: 7f ff e7 d4 call 20021c0 2008274: 01 00 00 00 nop * 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 ( the_thread->current_priority < _Thread_Heir->current_priority ) { 2008278: 05 00 80 58 sethi %hi(0x2016000), %g2 200827c: c6 00 a1 d8 ld [ %g2 + 0x1d8 ], %g3 ! 20161d8 <_Thread_Heir> 2008280: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 2008284: c6 00 e0 14 ld [ %g3 + 0x14 ], %g3 2008288: 80 a0 40 03 cmp %g1, %g3 200828c: 1a 80 00 0e bcc 20082c4 <_Thread_Clear_state+0xd0> 2008290: 01 00 00 00 nop _Thread_Heir = the_thread; 2008294: e0 20 a1 d8 st %l0, [ %g2 + 0x1d8 ] if ( _Thread_Executing->is_preemptible || 2008298: 05 00 80 58 sethi %hi(0x2016000), %g2 200829c: c4 00 a2 08 ld [ %g2 + 0x208 ], %g2 ! 2016208 <_Thread_Executing> 20082a0: c4 08 a0 75 ldub [ %g2 + 0x75 ], %g2 20082a4: 80 a0 a0 00 cmp %g2, 0 20082a8: 12 80 00 05 bne 20082bc <_Thread_Clear_state+0xc8> 20082ac: 84 10 20 01 mov 1, %g2 20082b0: 80 a0 60 00 cmp %g1, 0 20082b4: 12 80 00 04 bne 20082c4 <_Thread_Clear_state+0xd0> <== ALWAYS TAKEN 20082b8: 01 00 00 00 nop the_thread->current_priority == 0 ) _Context_Switch_necessary = true; 20082bc: 03 00 80 58 sethi %hi(0x2016000), %g1 20082c0: c4 28 62 18 stb %g2, [ %g1 + 0x218 ] ! 2016218 <_Context_Switch_necessary> } } } _ISR_Enable( level ); 20082c4: 7f ff e7 c3 call 20021d0 20082c8: 81 e8 00 00 restore =============================================================================== 02008478 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 2008478: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 200847c: 90 10 00 18 mov %i0, %o0 2008480: 40 00 00 74 call 2008650 <_Thread_Get> 2008484: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 2008488: c2 07 bf fc ld [ %fp + -4 ], %g1 200848c: 80 a0 60 00 cmp %g1, 0 2008490: 12 80 00 08 bne 20084b0 <_Thread_Delay_ended+0x38> <== NEVER TAKEN 2008494: 13 04 00 00 sethi %hi(0x10000000), %o1 #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 2008498: 7f ff ff 57 call 20081f4 <_Thread_Clear_state> 200849c: 92 12 60 18 or %o1, 0x18, %o1 ! 10000018 20084a0: 03 00 80 58 sethi %hi(0x2016000), %g1 20084a4: c4 00 61 48 ld [ %g1 + 0x148 ], %g2 ! 2016148 <_Thread_Dispatch_disable_level> 20084a8: 84 00 bf ff add %g2, -1, %g2 20084ac: c4 20 61 48 st %g2, [ %g1 + 0x148 ] 20084b0: 81 c7 e0 08 ret 20084b4: 81 e8 00 00 restore =============================================================================== 020084b8 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 20084b8: 9d e3 bf 90 save %sp, -112, %sp Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 20084bc: 2d 00 80 58 sethi %hi(0x2016000), %l6 _ISR_Disable( level ); 20084c0: 7f ff e7 40 call 20021c0 20084c4: e0 05 a2 08 ld [ %l6 + 0x208 ], %l0 ! 2016208 <_Thread_Executing> #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 20084c8: 25 00 80 58 sethi %hi(0x2016000), %l2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 20084cc: 2f 00 80 58 sethi %hi(0x2016000), %l7 20084d0: 33 00 80 58 sethi %hi(0x2016000), %i1 heir = _Thread_Heir; 20084d4: 35 00 80 58 sethi %hi(0x2016000), %i2 _Thread_Dispatch_disable_level = 1; 20084d8: b6 10 20 01 mov 1, %i3 #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; 20084dc: 39 00 80 58 sethi %hi(0x2016000), %i4 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 20084e0: aa 07 bf f8 add %fp, -8, %l5 _Timestamp_Subtract( 20084e4: a8 07 bf f0 add %fp, -16, %l4 20084e8: a4 14 a2 10 or %l2, 0x210, %l2 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 20084ec: 3b 00 80 58 sethi %hi(0x2016000), %i5 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 20084f0: 10 80 00 36 b 20085c8 <_Thread_Dispatch+0x110> 20084f4: 27 00 80 58 sethi %hi(0x2016000), %l3 heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 20084f8: f6 26 61 48 st %i3, [ %i1 + 0x148 ] _Thread_Executing = heir; #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 ) 20084fc: c2 04 60 7c ld [ %l1 + 0x7c ], %g1 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Context_Switch_necessary = false; 2008500: c0 2d e2 18 clrb [ %l7 + 0x218 ] _Thread_Executing = heir; #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 ) 2008504: 80 a0 60 01 cmp %g1, 1 2008508: 12 80 00 04 bne 2008518 <_Thread_Dispatch+0x60> 200850c: e2 25 a2 08 st %l1, [ %l6 + 0x208 ] heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 2008510: c2 07 20 a8 ld [ %i4 + 0xa8 ], %g1 2008514: c2 24 60 78 st %g1, [ %l1 + 0x78 ] _ISR_Enable( level ); 2008518: 7f ff e7 2e call 20021d0 200851c: 01 00 00 00 nop #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 2008520: 40 00 10 91 call 200c764 <_TOD_Get_uptime> 2008524: 90 10 00 15 mov %l5, %o0 _Timestamp_Subtract( 2008528: 90 10 00 12 mov %l2, %o0 200852c: 92 10 00 15 mov %l5, %o1 2008530: 40 00 03 e7 call 20094cc <_Timespec_Subtract> 2008534: 94 10 00 14 mov %l4, %o2 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 2008538: 90 04 20 84 add %l0, 0x84, %o0 200853c: 40 00 03 cb call 2009468 <_Timespec_Add_to> 2008540: 92 10 00 14 mov %l4, %o1 _Thread_Time_of_last_context_switch = uptime; 2008544: c2 07 bf f8 ld [ %fp + -8 ], %g1 2008548: c2 24 80 00 st %g1, [ %l2 ] 200854c: c2 07 bf fc ld [ %fp + -4 ], %g1 2008550: c2 24 a0 04 st %g1, [ %l2 + 4 ] #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 2008554: c2 07 61 d4 ld [ %i5 + 0x1d4 ], %g1 2008558: 80 a0 60 00 cmp %g1, 0 200855c: 02 80 00 06 be 2008574 <_Thread_Dispatch+0xbc> <== NEVER TAKEN 2008560: 90 10 00 10 mov %l0, %o0 executing->libc_reent = *_Thread_libc_reent; 2008564: c4 00 40 00 ld [ %g1 ], %g2 2008568: c4 24 21 64 st %g2, [ %l0 + 0x164 ] *_Thread_libc_reent = heir->libc_reent; 200856c: c4 04 61 64 ld [ %l1 + 0x164 ], %g2 2008570: c4 20 40 00 st %g2, [ %g1 ] } _User_extensions_Thread_switch( executing, heir ); 2008574: 40 00 04 83 call 2009780 <_User_extensions_Thread_switch> 2008578: 92 10 00 11 mov %l1, %o1 if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 200857c: 90 04 20 d8 add %l0, 0xd8, %o0 2008580: 40 00 05 ad call 2009c34 <_CPU_Context_switch> 2008584: 92 04 60 d8 add %l1, 0xd8, %o1 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( (executing->fp_context != NULL) && 2008588: c2 04 21 60 ld [ %l0 + 0x160 ], %g1 200858c: 80 a0 60 00 cmp %g1, 0 2008590: 02 80 00 0c be 20085c0 <_Thread_Dispatch+0x108> 2008594: d0 04 e1 d0 ld [ %l3 + 0x1d0 ], %o0 2008598: 80 a4 00 08 cmp %l0, %o0 200859c: 02 80 00 09 be 20085c0 <_Thread_Dispatch+0x108> 20085a0: 80 a2 20 00 cmp %o0, 0 !_Thread_Is_allocated_fp( executing ) ) { if ( _Thread_Allocated_fp != NULL ) 20085a4: 02 80 00 04 be 20085b4 <_Thread_Dispatch+0xfc> 20085a8: 01 00 00 00 nop _Context_Save_fp( &_Thread_Allocated_fp->fp_context ); 20085ac: 40 00 05 68 call 2009b4c <_CPU_Context_save_fp> 20085b0: 90 02 21 60 add %o0, 0x160, %o0 _Context_Restore_fp( &executing->fp_context ); 20085b4: 40 00 05 83 call 2009bc0 <_CPU_Context_restore_fp> 20085b8: 90 04 21 60 add %l0, 0x160, %o0 _Thread_Allocated_fp = executing; 20085bc: e0 24 e1 d0 st %l0, [ %l3 + 0x1d0 ] #endif #endif executing = _Thread_Executing; _ISR_Disable( level ); 20085c0: 7f ff e7 00 call 20021c0 20085c4: e0 05 a2 08 ld [ %l6 + 0x208 ], %l0 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 20085c8: c2 0d e2 18 ldub [ %l7 + 0x218 ], %g1 20085cc: 80 a0 60 00 cmp %g1, 0 20085d0: 32 bf ff ca bne,a 20084f8 <_Thread_Dispatch+0x40> 20085d4: e2 06 a1 d8 ld [ %i2 + 0x1d8 ], %l1 executing = _Thread_Executing; _ISR_Disable( level ); } _Thread_Dispatch_disable_level = 0; 20085d8: 03 00 80 58 sethi %hi(0x2016000), %g1 20085dc: c0 20 61 48 clr [ %g1 + 0x148 ] ! 2016148 <_Thread_Dispatch_disable_level> _ISR_Enable( level ); 20085e0: 7f ff e6 fc call 20021d0 20085e4: 01 00 00 00 nop if ( _Thread_Do_post_task_switch_extension || 20085e8: 03 00 80 58 sethi %hi(0x2016000), %g1 20085ec: c2 00 61 ec ld [ %g1 + 0x1ec ], %g1 ! 20161ec <_Thread_Do_post_task_switch_extension> 20085f0: 80 a0 60 00 cmp %g1, 0 20085f4: 12 80 00 06 bne 200860c <_Thread_Dispatch+0x154> 20085f8: 01 00 00 00 nop 20085fc: c2 0c 20 74 ldub [ %l0 + 0x74 ], %g1 2008600: 80 a0 60 00 cmp %g1, 0 2008604: 02 80 00 04 be 2008614 <_Thread_Dispatch+0x15c> 2008608: 01 00 00 00 nop executing->do_post_task_switch_extension ) { executing->do_post_task_switch_extension = false; _API_extensions_Run_postswitch(); 200860c: 7f ff f9 72 call 2006bd4 <_API_extensions_Run_postswitch> 2008610: c0 2c 20 74 clrb [ %l0 + 0x74 ] 2008614: 81 c7 e0 08 ret 2008618: 81 e8 00 00 restore =============================================================================== 0200e970 <_Thread_Evaluate_mode>: bool _Thread_Evaluate_mode( void ) { Thread_Control *executing; executing = _Thread_Executing; 200e970: 03 00 80 58 sethi %hi(0x2016000), %g1 200e974: c2 00 62 08 ld [ %g1 + 0x208 ], %g1 ! 2016208 <_Thread_Executing> if ( !_States_Is_ready( executing->current_state ) || 200e978: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 200e97c: 80 a0 a0 00 cmp %g2, 0 200e980: 12 80 00 0b bne 200e9ac <_Thread_Evaluate_mode+0x3c> <== NEVER TAKEN 200e984: 84 10 20 01 mov 1, %g2 200e988: 05 00 80 58 sethi %hi(0x2016000), %g2 200e98c: c4 00 a1 d8 ld [ %g2 + 0x1d8 ], %g2 ! 20161d8 <_Thread_Heir> 200e990: 80 a0 40 02 cmp %g1, %g2 200e994: 02 80 00 09 be 200e9b8 <_Thread_Evaluate_mode+0x48> 200e998: 90 10 20 00 clr %o0 ( !_Thread_Is_heir( executing ) && executing->is_preemptible ) ) { 200e99c: c2 08 60 75 ldub [ %g1 + 0x75 ], %g1 200e9a0: 80 a0 60 00 cmp %g1, 0 200e9a4: 02 80 00 05 be 200e9b8 <_Thread_Evaluate_mode+0x48> <== NEVER TAKEN 200e9a8: 84 10 20 01 mov 1, %g2 _Context_Switch_necessary = true; 200e9ac: 03 00 80 58 sethi %hi(0x2016000), %g1 return true; 200e9b0: 90 10 20 01 mov 1, %o0 executing = _Thread_Executing; if ( !_States_Is_ready( executing->current_state ) || ( !_Thread_Is_heir( executing ) && executing->is_preemptible ) ) { _Context_Switch_necessary = true; 200e9b4: c4 28 62 18 stb %g2, [ %g1 + 0x218 ] return true; } return false; } 200e9b8: 81 c3 e0 08 retl =============================================================================== 02008650 <_Thread_Get>: Thread_Control *_Thread_Get ( Objects_Id id, Objects_Locations *location ) { 2008650: 82 10 00 08 mov %o0, %g1 uint32_t the_class; Objects_Information **api_information; Objects_Information *information; Thread_Control *tp = (Thread_Control *) 0; if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) { 2008654: 80 a2 20 00 cmp %o0, 0 2008658: 12 80 00 0a bne 2008680 <_Thread_Get+0x30> 200865c: 94 10 00 09 mov %o1, %o2 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 2008660: 03 00 80 58 sethi %hi(0x2016000), %g1 2008664: c4 00 61 48 ld [ %g1 + 0x148 ], %g2 ! 2016148 <_Thread_Dispatch_disable_level> 2008668: 84 00 a0 01 inc %g2 200866c: c4 20 61 48 st %g2, [ %g1 + 0x148 ] _Thread_Disable_dispatch(); *location = OBJECTS_LOCAL; tp = _Thread_Executing; 2008670: 03 00 80 58 sethi %hi(0x2016000), %g1 Objects_Information *information; Thread_Control *tp = (Thread_Control *) 0; if ( _Objects_Are_ids_equal( id, OBJECTS_ID_OF_SELF ) ) { _Thread_Disable_dispatch(); *location = OBJECTS_LOCAL; 2008674: c0 22 40 00 clr [ %o1 ] tp = _Thread_Executing; goto done; 2008678: 81 c3 e0 08 retl 200867c: d0 00 62 08 ld [ %g1 + 0x208 ], %o0 */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); 2008680: 87 32 20 18 srl %o0, 0x18, %g3 2008684: 86 08 e0 07 and %g3, 7, %g3 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) 2008688: 84 00 ff ff add %g3, -1, %g2 200868c: 80 a0 a0 02 cmp %g2, 2 2008690: 28 80 00 16 bleu,a 20086e8 <_Thread_Get+0x98> 2008694: 85 32 20 1b srl %o0, 0x1b, %g2 goto done; } the_class = _Objects_Get_class( id ); if ( the_class != 1 ) { /* threads are always first class :) */ *location = OBJECTS_ERROR; 2008698: 82 10 20 01 mov 1, %g1 200869c: 10 80 00 09 b 20086c0 <_Thread_Get+0x70> 20086a0: c2 22 80 00 st %g1, [ %o2 ] goto done; } api_information = _Objects_Information_table[ the_api ]; 20086a4: 09 00 80 58 sethi %hi(0x2016000), %g4 20086a8: 88 11 20 b0 or %g4, 0xb0, %g4 ! 20160b0 <_Objects_Information_table> 20086ac: c6 01 00 03 ld [ %g4 + %g3 ], %g3 if ( !api_information ) { 20086b0: 80 a0 e0 00 cmp %g3, 0 20086b4: 32 80 00 05 bne,a 20086c8 <_Thread_Get+0x78> <== ALWAYS TAKEN 20086b8: d0 00 e0 04 ld [ %g3 + 4 ], %o0 *location = OBJECTS_ERROR; 20086bc: c4 22 80 00 st %g2, [ %o2 ] <== NOT EXECUTED goto done; 20086c0: 81 c3 e0 08 retl 20086c4: 90 10 20 00 clr %o0 } information = api_information[ the_class ]; if ( !information ) { 20086c8: 80 a2 20 00 cmp %o0, 0 20086cc: 12 80 00 04 bne 20086dc <_Thread_Get+0x8c> 20086d0: 92 10 00 01 mov %g1, %o1 *location = OBJECTS_ERROR; goto done; 20086d4: 81 c3 e0 08 retl 20086d8: c4 22 80 00 st %g2, [ %o2 ] } tp = (Thread_Control *) _Objects_Get( information, id, location ); 20086dc: 82 13 c0 00 mov %o7, %g1 20086e0: 7f ff fd 55 call 2007c34 <_Objects_Get> 20086e4: 9e 10 40 00 mov %g1, %o7 *location = OBJECTS_ERROR; goto done; } the_class = _Objects_Get_class( id ); if ( the_class != 1 ) { /* threads are always first class :) */ 20086e8: 80 a0 a0 01 cmp %g2, 1 20086ec: 22 bf ff ee be,a 20086a4 <_Thread_Get+0x54> 20086f0: 87 28 e0 02 sll %g3, 2, %g3 *location = OBJECTS_ERROR; 20086f4: 10 bf ff ea b 200869c <_Thread_Get+0x4c> 20086f8: 82 10 20 01 mov 1, %g1 =============================================================================== 0200e9c0 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 200e9c0: 9d e3 bf a0 save %sp, -96, %sp #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 200e9c4: 03 00 80 58 sethi %hi(0x2016000), %g1 200e9c8: e0 00 62 08 ld [ %g1 + 0x208 ], %l0 ! 2016208 <_Thread_Executing> /* * 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(); 200e9cc: 3f 00 80 3a sethi %hi(0x200e800), %i7 200e9d0: be 17 e1 c0 or %i7, 0x1c0, %i7 ! 200e9c0 <_Thread_Handler> /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 200e9d4: d0 04 20 b8 ld [ %l0 + 0xb8 ], %o0 _ISR_Set_level(level); 200e9d8: 7f ff cd fe call 20021d0 200e9dc: 91 2a 20 08 sll %o0, 8, %o0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 200e9e0: 03 00 80 57 sethi %hi(0x2015c00), %g1 doneConstructors = 1; 200e9e4: 84 10 20 01 mov 1, %g2 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 200e9e8: e2 08 62 08 ldub [ %g1 + 0x208 ], %l1 doneConstructors = 1; 200e9ec: c4 28 62 08 stb %g2, [ %g1 + 0x208 ] #endif #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH == TRUE ) if ( (executing->fp_context != NULL) && 200e9f0: c2 04 21 60 ld [ %l0 + 0x160 ], %g1 200e9f4: 80 a0 60 00 cmp %g1, 0 200e9f8: 02 80 00 0c be 200ea28 <_Thread_Handler+0x68> 200e9fc: 03 00 80 58 sethi %hi(0x2016000), %g1 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) RTEMS_INLINE_ROUTINE bool _Thread_Is_allocated_fp ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Allocated_fp ); 200ea00: d0 00 61 d0 ld [ %g1 + 0x1d0 ], %o0 ! 20161d0 <_Thread_Allocated_fp> 200ea04: 80 a4 00 08 cmp %l0, %o0 200ea08: 02 80 00 08 be 200ea28 <_Thread_Handler+0x68> 200ea0c: 80 a2 20 00 cmp %o0, 0 !_Thread_Is_allocated_fp( executing ) ) { if ( _Thread_Allocated_fp != NULL ) 200ea10: 22 80 00 06 be,a 200ea28 <_Thread_Handler+0x68> 200ea14: e0 20 61 d0 st %l0, [ %g1 + 0x1d0 ] _Context_Save_fp( &_Thread_Allocated_fp->fp_context ); 200ea18: 7f ff ec 4d call 2009b4c <_CPU_Context_save_fp> 200ea1c: 90 02 21 60 add %o0, 0x160, %o0 _Thread_Allocated_fp = executing; 200ea20: 03 00 80 58 sethi %hi(0x2016000), %g1 200ea24: e0 20 61 d0 st %l0, [ %g1 + 0x1d0 ] ! 20161d0 <_Thread_Allocated_fp> /* * Take care that 'begin' extensions get to complete before * 'switch' extensions can run. This means must keep dispatch * disabled until all 'begin' extensions complete. */ _User_extensions_Thread_begin( executing ); 200ea28: 7f ff ea e9 call 20095cc <_User_extensions_Thread_begin> 200ea2c: 90 10 00 10 mov %l0, %o0 /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 200ea30: 7f ff e6 fb call 200861c <_Thread_Enable_dispatch> 200ea34: a3 2c 60 18 sll %l1, 0x18, %l1 /* * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { 200ea38: 80 a4 60 00 cmp %l1, 0 200ea3c: 32 80 00 05 bne,a 200ea50 <_Thread_Handler+0x90> 200ea40: c2 04 20 a0 ld [ %l0 + 0xa0 ], %g1 INIT_NAME (); 200ea44: 40 00 1a bf call 2015540 <_init> 200ea48: 01 00 00 00 nop } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 200ea4c: c2 04 20 a0 ld [ %l0 + 0xa0 ], %g1 200ea50: 80 a0 60 00 cmp %g1, 0 200ea54: 12 80 00 05 bne 200ea68 <_Thread_Handler+0xa8> 200ea58: 80 a0 60 01 cmp %g1, 1 executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 200ea5c: c2 04 20 9c ld [ %l0 + 0x9c ], %g1 200ea60: 10 80 00 06 b 200ea78 <_Thread_Handler+0xb8> 200ea64: d0 04 20 a8 ld [ %l0 + 0xa8 ], %o0 executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { 200ea68: 12 80 00 07 bne 200ea84 <_Thread_Handler+0xc4> <== NEVER TAKEN 200ea6c: 01 00 00 00 nop executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 200ea70: c2 04 20 9c ld [ %l0 + 0x9c ], %g1 200ea74: d0 04 20 a4 ld [ %l0 + 0xa4 ], %o0 200ea78: 9f c0 40 00 call %g1 200ea7c: 01 00 00 00 nop executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = 200ea80: d0 24 20 28 st %o0, [ %l0 + 0x28 ] * was placed in return_argument. This assumed that if it returned * anything (which is not supporting in all APIs), then it would be * able to fit in a (void *). */ _User_extensions_Thread_exitted( executing ); 200ea84: 7f ff ea e3 call 2009610 <_User_extensions_Thread_exitted> 200ea88: 90 10 00 10 mov %l0, %o0 _Internal_error_Occurred( 200ea8c: 90 10 20 00 clr %o0 200ea90: 92 10 20 01 mov 1, %o1 200ea94: 7f ff e2 fd call 2007688 <_Internal_error_Occurred> 200ea98: 94 10 20 06 mov 6, %o2 =============================================================================== 020086fc <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 20086fc: 9d e3 bf a0 save %sp, -96, %sp 2008700: 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; 2008704: c0 26 61 68 clr [ %i1 + 0x168 ] 2008708: c0 26 61 6c clr [ %i1 + 0x16c ] extensions_area = NULL; the_thread->libc_reent = NULL; 200870c: c0 26 61 64 clr [ %i1 + 0x164 ] Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 2008710: e0 07 a0 60 ld [ %fp + 0x60 ], %l0 2008714: e2 00 40 00 ld [ %g1 ], %l1 if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { 2008718: 80 a6 a0 00 cmp %i2, 0 200871c: 12 80 00 0d bne 2008750 <_Thread_Initialize+0x54> 2008720: e6 0f a0 5f ldub [ %fp + 0x5f ], %l3 actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 2008724: 90 10 00 19 mov %i1, %o0 2008728: 40 00 02 ab call 20091d4 <_Thread_Stack_Allocate> 200872c: 92 10 00 1b mov %i3, %o1 if ( !actual_stack_size || actual_stack_size < stack_size ) 2008730: 80 a2 00 1b cmp %o0, %i3 2008734: 0a 80 00 74 bcs 2008904 <_Thread_Initialize+0x208> 2008738: 80 a2 20 00 cmp %o0, 0 200873c: 02 80 00 72 be 2008904 <_Thread_Initialize+0x208> <== NEVER TAKEN 2008740: 82 10 20 01 mov 1, %g1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; 2008744: f4 06 60 d0 ld [ %i1 + 0xd0 ], %i2 the_thread->Start.core_allocated_stack = true; 2008748: 10 80 00 04 b 2008758 <_Thread_Initialize+0x5c> 200874c: c2 2e 60 c0 stb %g1, [ %i1 + 0xc0 ] } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 2008750: c0 2e 60 c0 clrb [ %i1 + 0xc0 ] 2008754: 90 10 00 1b mov %i3, %o0 Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 2008758: f4 26 60 c8 st %i2, [ %i1 + 0xc8 ] the_stack->size = size; 200875c: d0 26 60 c4 st %o0, [ %i1 + 0xc4 ] /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { 2008760: 80 8f 20 ff btst 0xff, %i4 2008764: 02 80 00 07 be 2008780 <_Thread_Initialize+0x84> 2008768: a4 10 20 00 clr %l2 fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); 200876c: 40 00 04 da call 2009ad4 <_Workspace_Allocate> 2008770: 90 10 20 88 mov 0x88, %o0 if ( !fp_area ) 2008774: a4 92 20 00 orcc %o0, 0, %l2 2008778: 02 80 00 42 be 2008880 <_Thread_Initialize+0x184> 200877c: b6 10 20 00 clr %i3 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 2008780: 03 00 80 58 sethi %hi(0x2016000), %g1 2008784: d0 00 61 e8 ld [ %g1 + 0x1e8 ], %o0 ! 20161e8 <_Thread_Maximum_extensions> fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); if ( !fp_area ) goto failed; fp_area = _Context_Fp_start( fp_area, 0 ); } the_thread->fp_context = fp_area; 2008788: e4 26 61 60 st %l2, [ %i1 + 0x160 ] the_thread->Start.fp_context = fp_area; 200878c: e4 26 60 cc st %l2, [ %i1 + 0xcc ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 2008790: c0 26 60 50 clr [ %i1 + 0x50 ] the_watchdog->routine = routine; 2008794: c0 26 60 64 clr [ %i1 + 0x64 ] the_watchdog->id = id; 2008798: c0 26 60 68 clr [ %i1 + 0x68 ] the_watchdog->user_data = user_data; 200879c: c0 26 60 6c clr [ %i1 + 0x6c ] #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 20087a0: 80 a2 20 00 cmp %o0, 0 20087a4: 02 80 00 08 be 20087c4 <_Thread_Initialize+0xc8> 20087a8: b6 10 20 00 clr %i3 extensions_area = _Workspace_Allocate( 20087ac: 90 02 20 01 inc %o0 20087b0: 40 00 04 c9 call 2009ad4 <_Workspace_Allocate> 20087b4: 91 2a 20 02 sll %o0, 2, %o0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 20087b8: b6 92 20 00 orcc %o0, 0, %i3 20087bc: 22 80 00 32 be,a 2008884 <_Thread_Initialize+0x188> 20087c0: d0 06 61 64 ld [ %i1 + 0x164 ], %o0 * if they are linked to the thread. An extension user may * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { 20087c4: 80 a6 e0 00 cmp %i3, 0 20087c8: 02 80 00 0b be 20087f4 <_Thread_Initialize+0xf8> 20087cc: f6 26 61 70 st %i3, [ %i1 + 0x170 ] for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 20087d0: 03 00 80 58 sethi %hi(0x2016000), %g1 20087d4: c4 00 61 e8 ld [ %g1 + 0x1e8 ], %g2 ! 20161e8 <_Thread_Maximum_extensions> 20087d8: 10 80 00 04 b 20087e8 <_Thread_Initialize+0xec> 20087dc: 82 10 20 00 clr %g1 20087e0: 82 00 60 01 inc %g1 the_thread->extensions[i] = NULL; 20087e4: c0 26 c0 03 clr [ %i3 + %g3 ] * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 20087e8: 80 a0 40 02 cmp %g1, %g2 20087ec: 08 bf ff fd bleu 20087e0 <_Thread_Initialize+0xe4> 20087f0: 87 28 60 02 sll %g1, 2, %g3 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 20087f4: c2 07 a0 64 ld [ %fp + 0x64 ], %g1 /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 20087f8: e6 2e 60 ac stb %l3, [ %i1 + 0xac ] the_thread->Start.budget_algorithm = budget_algorithm; 20087fc: e0 26 60 b0 st %l0, [ %i1 + 0xb0 ] the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { 2008800: 80 a4 20 02 cmp %l0, 2 2008804: 12 80 00 05 bne 2008818 <_Thread_Initialize+0x11c> 2008808: c2 26 60 b4 st %g1, [ %i1 + 0xb4 ] 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; 200880c: 03 00 80 58 sethi %hi(0x2016000), %g1 2008810: c2 00 60 a8 ld [ %g1 + 0xa8 ], %g1 ! 20160a8 <_Thread_Ticks_per_timeslice> 2008814: c2 26 60 78 st %g1, [ %i1 + 0x78 ] case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 2008818: c2 07 a0 68 ld [ %fp + 0x68 ], %g1 the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; the_thread->resource_count = 0; the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority ); 200881c: 90 10 00 19 mov %i1, %o0 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 2008820: c2 26 60 b8 st %g1, [ %i1 + 0xb8 ] the_thread->current_state = STATES_DORMANT; 2008824: 82 10 20 01 mov 1, %g1 the_thread->Wait.queue = NULL; the_thread->resource_count = 0; the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority ); 2008828: 92 10 00 1d mov %i5, %o1 #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; 200882c: c2 26 60 10 st %g1, [ %i1 + 0x10 ] the_thread->Wait.queue = NULL; 2008830: c0 26 60 44 clr [ %i1 + 0x44 ] the_thread->resource_count = 0; 2008834: c0 26 60 1c clr [ %i1 + 0x1c ] the_thread->real_priority = priority; 2008838: fa 26 60 18 st %i5, [ %i1 + 0x18 ] the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority ); 200883c: 40 00 01 c4 call 2008f4c <_Thread_Set_priority> 2008840: fa 26 60 bc st %i5, [ %i1 + 0xbc ] _Thread_Stack_Free( the_thread ); return false; } 2008844: c4 06 20 1c ld [ %i0 + 0x1c ], %g2 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 2008848: c2 16 60 0a lduh [ %i1 + 0xa ], %g1 /* * Initialize the CPU usage statistics */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Set_to_zero( &the_thread->cpu_time_used ); 200884c: c0 26 60 84 clr [ %i1 + 0x84 ] 2008850: c0 26 60 88 clr [ %i1 + 0x88 ] #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 2008854: 83 28 60 02 sll %g1, 2, %g1 2008858: f2 20 80 01 st %i1, [ %g2 + %g1 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 200885c: e2 26 60 0c st %l1, [ %i1 + 0xc ] * enabled when we get here. We want to be able to run the * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); 2008860: 90 10 00 19 mov %i1, %o0 2008864: 40 00 03 8d call 2009698 <_User_extensions_Thread_create> 2008868: b0 10 20 01 mov 1, %i0 if ( extension_status ) 200886c: 80 8a 20 ff btst 0xff, %o0 2008870: 22 80 00 05 be,a 2008884 <_Thread_Initialize+0x188> 2008874: d0 06 61 64 ld [ %i1 + 0x164 ], %o0 2008878: 81 c7 e0 08 ret 200887c: 81 e8 00 00 restore return true; failed: if ( the_thread->libc_reent ) 2008880: d0 06 61 64 ld [ %i1 + 0x164 ], %o0 2008884: 80 a2 20 00 cmp %o0, 0 2008888: 22 80 00 05 be,a 200889c <_Thread_Initialize+0x1a0> 200888c: d0 06 61 68 ld [ %i1 + 0x168 ], %o0 _Workspace_Free( the_thread->libc_reent ); 2008890: 40 00 04 9a call 2009af8 <_Workspace_Free> 2008894: 01 00 00 00 nop for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 2008898: d0 06 61 68 ld [ %i1 + 0x168 ], %o0 200889c: 80 a2 20 00 cmp %o0, 0 20088a0: 22 80 00 05 be,a 20088b4 <_Thread_Initialize+0x1b8> 20088a4: d0 06 61 6c ld [ %i1 + 0x16c ], %o0 _Workspace_Free( the_thread->API_Extensions[i] ); 20088a8: 40 00 04 94 call 2009af8 <_Workspace_Free> 20088ac: 01 00 00 00 nop failed: if ( the_thread->libc_reent ) _Workspace_Free( the_thread->libc_reent ); for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 20088b0: d0 06 61 6c ld [ %i1 + 0x16c ], %o0 20088b4: 80 a2 20 00 cmp %o0, 0 20088b8: 02 80 00 05 be 20088cc <_Thread_Initialize+0x1d0> 20088bc: 80 a6 e0 00 cmp %i3, 0 _Workspace_Free( the_thread->API_Extensions[i] ); 20088c0: 40 00 04 8e call 2009af8 <_Workspace_Free> 20088c4: 01 00 00 00 nop if ( extensions_area ) 20088c8: 80 a6 e0 00 cmp %i3, 0 20088cc: 02 80 00 05 be 20088e0 <_Thread_Initialize+0x1e4> 20088d0: 80 a4 a0 00 cmp %l2, 0 (void) _Workspace_Free( extensions_area ); 20088d4: 40 00 04 89 call 2009af8 <_Workspace_Free> 20088d8: 90 10 00 1b mov %i3, %o0 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( fp_area ) 20088dc: 80 a4 a0 00 cmp %l2, 0 20088e0: 02 80 00 05 be 20088f4 <_Thread_Initialize+0x1f8> 20088e4: 90 10 00 19 mov %i1, %o0 (void) _Workspace_Free( fp_area ); 20088e8: 40 00 04 84 call 2009af8 <_Workspace_Free> 20088ec: 90 10 00 12 mov %l2, %o0 #endif _Thread_Stack_Free( the_thread ); 20088f0: 90 10 00 19 mov %i1, %o0 20088f4: 40 00 02 4f call 2009230 <_Thread_Stack_Free> 20088f8: b0 10 20 00 clr %i0 return false; 20088fc: 81 c7 e0 08 ret 2008900: 81 e8 00 00 restore } 2008904: 81 c7 e0 08 ret 2008908: 91 e8 20 00 restore %g0, 0, %o0 =============================================================================== 0200c5d4 <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { 200c5d4: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; States_Control current_state; _ISR_Disable( level ); 200c5d8: 7f ff d7 76 call 20023b0 200c5dc: a0 10 00 18 mov %i0, %l0 200c5e0: b0 10 00 08 mov %o0, %i0 current_state = the_thread->current_state; 200c5e4: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 if ( current_state & STATES_SUSPENDED ) { 200c5e8: 80 88 60 02 btst 2, %g1 200c5ec: 02 80 00 2d be 200c6a0 <_Thread_Resume+0xcc> <== NEVER TAKEN 200c5f0: 82 08 7f fd and %g1, -3, %g1 current_state = the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); if ( _States_Is_ready( current_state ) ) { 200c5f4: 80 a0 60 00 cmp %g1, 0 200c5f8: 12 80 00 2a bne 200c6a0 <_Thread_Resume+0xcc> 200c5fc: c2 24 20 10 st %g1, [ %l0 + 0x10 ] RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 200c600: c2 04 20 90 ld [ %l0 + 0x90 ], %g1 200c604: c4 14 20 96 lduh [ %l0 + 0x96 ], %g2 200c608: c6 10 40 00 lduh [ %g1 ], %g3 200c60c: 84 10 c0 02 or %g3, %g2, %g2 200c610: c4 30 40 00 sth %g2, [ %g1 ] _Priority_Major_bit_map |= the_priority_map->ready_major; 200c614: 03 00 80 67 sethi %hi(0x2019c00), %g1 200c618: c6 14 20 94 lduh [ %l0 + 0x94 ], %g3 200c61c: c4 10 62 dc lduh [ %g1 + 0x2dc ], %g2 200c620: 84 10 c0 02 or %g3, %g2, %g2 200c624: c4 30 62 dc sth %g2, [ %g1 + 0x2dc ] _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node); 200c628: c2 04 20 8c ld [ %l0 + 0x8c ], %g1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 200c62c: 84 00 60 04 add %g1, 4, %g2 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 200c630: c4 24 00 00 st %g2, [ %l0 ] old_last_node = the_chain->last; 200c634: c4 00 60 08 ld [ %g1 + 8 ], %g2 the_chain->last = the_node; 200c638: e0 20 60 08 st %l0, [ %g1 + 8 ] old_last_node->next = the_node; 200c63c: e0 20 80 00 st %l0, [ %g2 ] the_node->previous = old_last_node; 200c640: c4 24 20 04 st %g2, [ %l0 + 4 ] _ISR_Flash( level ); 200c644: 7f ff d7 5f call 20023c0 200c648: 01 00 00 00 nop 200c64c: 7f ff d7 59 call 20023b0 200c650: 01 00 00 00 nop if ( the_thread->current_priority < _Thread_Heir->current_priority ) { 200c654: 05 00 80 67 sethi %hi(0x2019c00), %g2 200c658: c6 00 a2 b8 ld [ %g2 + 0x2b8 ], %g3 ! 2019eb8 <_Thread_Heir> 200c65c: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 200c660: c6 00 e0 14 ld [ %g3 + 0x14 ], %g3 200c664: 80 a0 40 03 cmp %g1, %g3 200c668: 1a 80 00 0e bcc 200c6a0 <_Thread_Resume+0xcc> 200c66c: 01 00 00 00 nop _Thread_Heir = the_thread; 200c670: e0 20 a2 b8 st %l0, [ %g2 + 0x2b8 ] if ( _Thread_Executing->is_preemptible || 200c674: 05 00 80 67 sethi %hi(0x2019c00), %g2 200c678: c4 00 a2 e8 ld [ %g2 + 0x2e8 ], %g2 ! 2019ee8 <_Thread_Executing> 200c67c: c4 08 a0 75 ldub [ %g2 + 0x75 ], %g2 200c680: 80 a0 a0 00 cmp %g2, 0 200c684: 12 80 00 05 bne 200c698 <_Thread_Resume+0xc4> 200c688: 84 10 20 01 mov 1, %g2 200c68c: 80 a0 60 00 cmp %g1, 0 200c690: 12 80 00 04 bne 200c6a0 <_Thread_Resume+0xcc> <== ALWAYS TAKEN 200c694: 01 00 00 00 nop the_thread->current_priority == 0 ) _Context_Switch_necessary = true; 200c698: 03 00 80 67 sethi %hi(0x2019c00), %g1 200c69c: c4 28 62 f8 stb %g2, [ %g1 + 0x2f8 ] ! 2019ef8 <_Context_Switch_necessary> } } } _ISR_Enable( level ); 200c6a0: 7f ff d7 48 call 20023c0 200c6a4: 81 e8 00 00 restore =============================================================================== 02009320 <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 2009320: 9d e3 bf a0 save %sp, -96, %sp Thread_Control *executing; executing = _Thread_Executing; 2009324: 03 00 80 58 sethi %hi(0x2016000), %g1 2009328: e0 00 62 08 ld [ %g1 + 0x208 ], %l0 ! 2016208 <_Thread_Executing> /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 200932c: c2 0c 20 75 ldub [ %l0 + 0x75 ], %g1 2009330: 80 a0 60 00 cmp %g1, 0 2009334: 02 80 00 23 be 20093c0 <_Thread_Tickle_timeslice+0xa0> 2009338: 01 00 00 00 nop return; if ( !_States_Is_ready( executing->current_state ) ) 200933c: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 2009340: 80 a0 60 00 cmp %g1, 0 2009344: 12 80 00 1f bne 20093c0 <_Thread_Tickle_timeslice+0xa0> 2009348: 01 00 00 00 nop /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 200934c: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 2009350: 80 a0 60 01 cmp %g1, 1 2009354: 0a 80 00 12 bcs 200939c <_Thread_Tickle_timeslice+0x7c> 2009358: 80 a0 60 02 cmp %g1, 2 200935c: 28 80 00 07 bleu,a 2009378 <_Thread_Tickle_timeslice+0x58> 2009360: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 2009364: 80 a0 60 03 cmp %g1, 3 2009368: 12 80 00 16 bne 20093c0 <_Thread_Tickle_timeslice+0xa0> <== NEVER TAKEN 200936c: 01 00 00 00 nop } break; #if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: if ( --executing->cpu_time_budget == 0 ) 2009370: 10 80 00 0d b 20093a4 <_Thread_Tickle_timeslice+0x84> 2009374: c2 04 20 78 ld [ %l0 + 0x78 ], %g1 case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: #endif if ( (int)(--executing->cpu_time_budget) <= 0 ) { 2009378: 82 00 7f ff add %g1, -1, %g1 200937c: 80 a0 60 00 cmp %g1, 0 2009380: 14 80 00 07 bg 200939c <_Thread_Tickle_timeslice+0x7c> 2009384: c2 24 20 78 st %g1, [ %l0 + 0x78 ] * at the priority of the currently executing thread, then the * 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. */ _Thread_Yield_processor(); 2009388: 40 00 00 10 call 20093c8 <_Thread_Yield_processor> 200938c: 01 00 00 00 nop executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 2009390: 03 00 80 58 sethi %hi(0x2016000), %g1 2009394: c2 00 60 a8 ld [ %g1 + 0xa8 ], %g1 ! 20160a8 <_Thread_Ticks_per_timeslice> 2009398: c2 24 20 78 st %g1, [ %l0 + 0x78 ] 200939c: 81 c7 e0 08 ret 20093a0: 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 ) 20093a4: 82 00 7f ff add %g1, -1, %g1 20093a8: 80 a0 60 00 cmp %g1, 0 20093ac: 12 bf ff fc bne 200939c <_Thread_Tickle_timeslice+0x7c> 20093b0: c2 24 20 78 st %g1, [ %l0 + 0x78 ] (*executing->budget_callout)( executing ); 20093b4: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 20093b8: 9f c0 40 00 call %g1 20093bc: 90 10 00 10 mov %l0, %o0 20093c0: 81 c7 e0 08 ret 20093c4: 81 e8 00 00 restore =============================================================================== 02008c20 <_Thread_queue_Enqueue_priority>: Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 2008c20: 9d e3 bf a0 save %sp, -96, %sp 2008c24: 82 06 60 3c add %i1, 0x3c, %g1 Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; 2008c28: e4 06 60 14 ld [ %i1 + 0x14 ], %l2 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 2008c2c: c2 26 60 38 st %g1, [ %i1 + 0x38 ] the_chain->permanent_null = NULL; 2008c30: c0 26 60 3c clr [ %i1 + 0x3c ] Chain_Node *previous_node; Chain_Node *search_node; Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); 2008c34: 82 06 60 38 add %i1, 0x38, %g1 the_chain->last = _Chain_Head(the_chain); 2008c38: c2 26 60 40 st %g1, [ %i1 + 0x40 ] priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; block_state = the_thread_queue->state; 2008c3c: ea 06 20 38 ld [ %i0 + 0x38 ], %l5 RTEMS_INLINE_ROUTINE uint32_t _Thread_queue_Header_number ( Priority_Control the_priority ) { return (the_priority / TASK_QUEUE_DATA_PRIORITIES_PER_HEADER); 2008c40: 83 34 a0 06 srl %l2, 6, %g1 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 2008c44: 3b 00 80 55 sethi %hi(0x2015400), %i5 _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; 2008c48: 85 28 60 02 sll %g1, 2, %g2 2008c4c: ad 28 60 04 sll %g1, 4, %l6 block_state = the_thread_queue->state; if ( _Thread_queue_Is_reverse_search( priority ) ) 2008c50: 80 8c a0 20 btst 0x20, %l2 _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; 2008c54: ac 25 80 02 sub %l6, %g2, %l6 2008c58: a8 06 00 16 add %i0, %l6, %l4 block_state = the_thread_queue->state; if ( _Thread_queue_Is_reverse_search( priority ) ) 2008c5c: 12 80 00 29 bne 2008d00 <_Thread_queue_Enqueue_priority+0xe0> 2008c60: ae 10 00 16 mov %l6, %l7 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 2008c64: a8 05 20 04 add %l4, 4, %l4 goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); 2008c68: 7f ff e5 56 call 20021c0 2008c6c: 01 00 00 00 nop 2008c70: a2 10 00 08 mov %o0, %l1 if ( _Thread_queue_Is_reverse_search( priority ) ) goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; 2008c74: a6 10 3f ff mov -1, %l3 _ISR_Disable( level ); search_thread = (Thread_Control *) header->first; while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 2008c78: 10 80 00 10 b 2008cb8 <_Thread_queue_Enqueue_priority+0x98> 2008c7c: e0 06 00 16 ld [ %i0 + %l6 ], %l0 search_priority = search_thread->current_priority; if ( priority <= search_priority ) 2008c80: 80 a4 80 13 cmp %l2, %l3 2008c84: 28 80 00 11 bleu,a 2008cc8 <_Thread_queue_Enqueue_priority+0xa8> 2008c88: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 break; search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); 2008c8c: 7f ff e5 51 call 20021d0 2008c90: 90 10 00 11 mov %l1, %o0 2008c94: 7f ff e5 4b call 20021c0 2008c98: 01 00 00 00 nop RTEMS_INLINE_ROUTINE bool _States_Are_set ( States_Control the_states, States_Control mask ) { return ( (the_states & mask) != STATES_READY); 2008c9c: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 2008ca0: 80 8d 40 01 btst %l5, %g1 2008ca4: 32 80 00 05 bne,a 2008cb8 <_Thread_queue_Enqueue_priority+0x98><== ALWAYS TAKEN 2008ca8: e0 04 00 00 ld [ %l0 ], %l0 _ISR_Enable( level ); 2008cac: 7f ff e5 49 call 20021d0 <== NOT EXECUTED 2008cb0: 90 10 00 11 mov %l1, %o0 <== NOT EXECUTED goto restart_forward_search; 2008cb4: 30 bf ff ed b,a 2008c68 <_Thread_queue_Enqueue_priority+0x48><== NOT EXECUTED restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->first; while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 2008cb8: 80 a4 00 14 cmp %l0, %l4 2008cbc: 32 bf ff f1 bne,a 2008c80 <_Thread_queue_Enqueue_priority+0x60> 2008cc0: e6 04 20 14 ld [ %l0 + 0x14 ], %l3 } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 2008cc4: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 2008cc8: 80 a0 60 01 cmp %g1, 1 2008ccc: 32 80 00 40 bne,a 2008dcc <_Thread_queue_Enqueue_priority+0x1ac> 2008cd0: e2 26 80 00 st %l1, [ %i2 ] THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) 2008cd4: 80 a4 80 13 cmp %l2, %l3 2008cd8: 02 80 00 31 be 2008d9c <_Thread_queue_Enqueue_priority+0x17c> 2008cdc: c0 26 20 30 clr [ %i0 + 0x30 ] goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; 2008ce0: c2 04 20 04 ld [ %l0 + 4 ], %g1 the_node = (Chain_Node *) the_thread; the_node->next = search_node; 2008ce4: e0 26 40 00 st %l0, [ %i1 ] the_node->previous = previous_node; 2008ce8: c2 26 60 04 st %g1, [ %i1 + 4 ] previous_node->next = the_node; 2008cec: f2 20 40 00 st %i1, [ %g1 ] search_node->previous = the_node; 2008cf0: f2 24 20 04 st %i1, [ %l0 + 4 ] the_thread->Wait.queue = the_thread_queue; 2008cf4: f0 26 60 44 st %i0, [ %i1 + 0x44 ] the_node->next = search_node; the_node->previous = previous_node; previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 2008cf8: 10 80 00 31 b 2008dbc <_Thread_queue_Enqueue_priority+0x19c> 2008cfc: 90 10 00 11 mov %l1, %o0 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); 2008d00: 7f ff e5 30 call 20021c0 2008d04: e6 0f 62 34 ldub [ %i5 + 0x234 ], %l3 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 2008d08: a6 04 e0 01 inc %l3 _ISR_Disable( level ); 2008d0c: a2 10 00 08 mov %o0, %l1 search_thread = (Thread_Control *) header->last; 2008d10: 82 06 00 17 add %i0, %l7, %g1 while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 2008d14: 10 80 00 10 b 2008d54 <_Thread_queue_Enqueue_priority+0x134> 2008d18: e0 00 60 08 ld [ %g1 + 8 ], %l0 search_priority = search_thread->current_priority; if ( priority >= search_priority ) 2008d1c: 80 a4 80 13 cmp %l2, %l3 2008d20: 3a 80 00 11 bcc,a 2008d64 <_Thread_queue_Enqueue_priority+0x144> 2008d24: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 break; search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); 2008d28: 7f ff e5 2a call 20021d0 2008d2c: 90 10 00 11 mov %l1, %o0 2008d30: 7f ff e5 24 call 20021c0 2008d34: 01 00 00 00 nop 2008d38: c2 04 20 10 ld [ %l0 + 0x10 ], %g1 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 2008d3c: 80 8d 40 01 btst %l5, %g1 2008d40: 32 80 00 05 bne,a 2008d54 <_Thread_queue_Enqueue_priority+0x134> 2008d44: e0 04 20 04 ld [ %l0 + 4 ], %l0 _ISR_Enable( level ); 2008d48: 7f ff e5 22 call 20021d0 2008d4c: 90 10 00 11 mov %l1, %o0 goto restart_reverse_search; 2008d50: 30 bf ff ec b,a 2008d00 <_Thread_queue_Enqueue_priority+0xe0> restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) header->last; while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 2008d54: 80 a4 00 14 cmp %l0, %l4 2008d58: 32 bf ff f1 bne,a 2008d1c <_Thread_queue_Enqueue_priority+0xfc> 2008d5c: e6 04 20 14 ld [ %l0 + 0x14 ], %l3 } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != 2008d60: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 2008d64: 80 a0 60 01 cmp %g1, 1 2008d68: 32 80 00 19 bne,a 2008dcc <_Thread_queue_Enqueue_priority+0x1ac> 2008d6c: e2 26 80 00 st %l1, [ %i2 ] THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if ( priority == search_priority ) 2008d70: 80 a4 80 13 cmp %l2, %l3 2008d74: 02 80 00 0a be 2008d9c <_Thread_queue_Enqueue_priority+0x17c> 2008d78: c0 26 20 30 clr [ %i0 + 0x30 ] goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; 2008d7c: c2 04 00 00 ld [ %l0 ], %g1 the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; 2008d80: e0 26 60 04 st %l0, [ %i1 + 4 ] search_node = (Chain_Node *) search_thread; next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; 2008d84: c2 26 40 00 st %g1, [ %i1 ] the_node->previous = search_node; search_node->next = the_node; 2008d88: f2 24 00 00 st %i1, [ %l0 ] next_node->previous = the_node; 2008d8c: f2 20 60 04 st %i1, [ %g1 + 4 ] the_thread->Wait.queue = the_thread_queue; 2008d90: f0 26 60 44 st %i0, [ %i1 + 0x44 ] the_node->next = search_node; the_node->previous = previous_node; previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 2008d94: 10 80 00 0a b 2008dbc <_Thread_queue_Enqueue_priority+0x19c> 2008d98: 90 10 00 11 mov %l1, %o0 2008d9c: a0 04 20 3c add %l0, 0x3c, %l0 _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; 2008da0: c2 04 20 04 ld [ %l0 + 4 ], %g1 the_node = (Chain_Node *) the_thread; the_node->next = search_node; 2008da4: e0 26 40 00 st %l0, [ %i1 ] the_node->previous = previous_node; 2008da8: c2 26 60 04 st %g1, [ %i1 + 4 ] previous_node->next = the_node; 2008dac: f2 20 40 00 st %i1, [ %g1 ] search_node->previous = the_node; 2008db0: f2 24 20 04 st %i1, [ %l0 + 4 ] the_thread->Wait.queue = the_thread_queue; 2008db4: f0 26 60 44 st %i0, [ %i1 + 0x44 ] _ISR_Enable( level ); 2008db8: 90 10 00 11 mov %l1, %o0 2008dbc: 7f ff e5 05 call 20021d0 2008dc0: b0 10 20 01 mov 1, %i0 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 2008dc4: 81 c7 e0 08 ret 2008dc8: 81 e8 00 00 restore * the mutex by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; 2008dcc: f0 06 20 30 ld [ %i0 + 0x30 ], %i0 } 2008dd0: 81 c7 e0 08 ret 2008dd4: 81 e8 00 00 restore =============================================================================== 02008e98 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 2008e98: 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 ) 2008e9c: 80 a6 20 00 cmp %i0, 0 2008ea0: 02 80 00 19 be 2008f04 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 2008ea4: 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 ) { 2008ea8: e2 06 20 34 ld [ %i0 + 0x34 ], %l1 2008eac: 80 a4 60 01 cmp %l1, 1 2008eb0: 12 80 00 15 bne 2008f04 <_Thread_queue_Requeue+0x6c> <== NEVER TAKEN 2008eb4: 01 00 00 00 nop Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 2008eb8: 7f ff e4 c2 call 20021c0 2008ebc: 01 00 00 00 nop 2008ec0: a0 10 00 08 mov %o0, %l0 2008ec4: c4 06 60 10 ld [ %i1 + 0x10 ], %g2 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 2008ec8: 03 00 00 ef sethi %hi(0x3bc00), %g1 2008ecc: 82 10 62 e0 or %g1, 0x2e0, %g1 ! 3bee0 2008ed0: 80 88 80 01 btst %g2, %g1 2008ed4: 02 80 00 0a be 2008efc <_Thread_queue_Requeue+0x64> <== NEVER TAKEN 2008ed8: 90 10 00 18 mov %i0, %o0 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 2008edc: 92 10 00 19 mov %i1, %o1 2008ee0: 94 10 20 01 mov 1, %o2 2008ee4: 40 00 0f 93 call 200cd30 <_Thread_queue_Extract_priority_helper> 2008ee8: e2 26 20 30 st %l1, [ %i0 + 0x30 ] (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 2008eec: 90 10 00 18 mov %i0, %o0 2008ef0: 92 10 00 19 mov %i1, %o1 2008ef4: 7f ff ff 4b call 2008c20 <_Thread_queue_Enqueue_priority> 2008ef8: 94 07 bf fc add %fp, -4, %o2 } _ISR_Enable( level ); 2008efc: 7f ff e4 b5 call 20021d0 2008f00: 90 10 00 10 mov %l0, %o0 2008f04: 81 c7 e0 08 ret 2008f08: 81 e8 00 00 restore =============================================================================== 02008f0c <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 2008f0c: 9d e3 bf 98 save %sp, -104, %sp Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 2008f10: 90 10 00 18 mov %i0, %o0 2008f14: 7f ff fd cf call 2008650 <_Thread_Get> 2008f18: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 2008f1c: c2 07 bf fc ld [ %fp + -4 ], %g1 2008f20: 80 a0 60 00 cmp %g1, 0 2008f24: 12 80 00 08 bne 2008f44 <_Thread_queue_Timeout+0x38> <== NEVER TAKEN 2008f28: 01 00 00 00 nop #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 2008f2c: 40 00 0f b7 call 200ce08 <_Thread_queue_Process_timeout> 2008f30: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 2008f34: 03 00 80 58 sethi %hi(0x2016000), %g1 2008f38: c4 00 61 48 ld [ %g1 + 0x148 ], %g2 ! 2016148 <_Thread_Dispatch_disable_level> 2008f3c: 84 00 bf ff add %g2, -1, %g2 2008f40: c4 20 61 48 st %g2, [ %g1 + 0x148 ] 2008f44: 81 c7 e0 08 ret 2008f48: 81 e8 00 00 restore =============================================================================== 02016b44 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 2016b44: 9d e3 bf 88 save %sp, -120, %sp static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 2016b48: 35 00 80 f6 sethi %hi(0x203d800), %i2 2016b4c: a4 07 bf e8 add %fp, -24, %l2 2016b50: b2 07 bf f4 add %fp, -12, %i1 2016b54: ac 07 bf f8 add %fp, -8, %l6 2016b58: a6 07 bf ec add %fp, -20, %l3 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 2016b5c: ec 27 bf f4 st %l6, [ %fp + -12 ] the_chain->permanent_null = NULL; 2016b60: c0 27 bf f8 clr [ %fp + -8 ] the_chain->last = _Chain_Head(the_chain); 2016b64: f2 27 bf fc st %i1, [ %fp + -4 ] */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 2016b68: e6 27 bf e8 st %l3, [ %fp + -24 ] the_chain->permanent_null = NULL; 2016b6c: c0 27 bf ec clr [ %fp + -20 ] the_chain->last = _Chain_Head(the_chain); 2016b70: e4 27 bf f0 st %l2, [ %fp + -16 ] */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 2016b74: aa 06 20 30 add %i0, 0x30, %l5 _Chain_Initialize_empty( &insert_chain ); _Chain_Initialize_empty( &fire_chain ); while ( true ) { _Timer_server_Get_watchdogs_that_fire_now( ts, &insert_chain, &fire_chain ); 2016b78: a8 10 00 12 mov %l2, %l4 static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 2016b7c: 37 00 80 f6 sethi %hi(0x203d800), %i3 /* * 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 ); 2016b80: a2 06 20 68 add %i0, 0x68, %l1 _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; 2016b84: b8 10 20 01 mov 1, %i4 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 2016b88: ba 06 20 08 add %i0, 8, %i5 static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 2016b8c: ae 06 20 40 add %i0, 0x40, %l7 { /* * 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; 2016b90: f2 26 20 78 st %i1, [ %i0 + 0x78 ] static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 2016b94: c2 06 a1 64 ld [ %i2 + 0x164 ], %g1 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 2016b98: d2 06 20 3c ld [ %i0 + 0x3c ], %o1 watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 2016b9c: 94 10 00 14 mov %l4, %o2 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 2016ba0: c2 26 20 3c st %g1, [ %i0 + 0x3c ] _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 2016ba4: 90 10 00 15 mov %l5, %o0 2016ba8: 40 00 12 63 call 201b534 <_Watchdog_Adjust_to_chain> 2016bac: 92 20 40 09 sub %g1, %o1, %o1 Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 2016bb0: d4 06 20 74 ld [ %i0 + 0x74 ], %o2 static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 2016bb4: e0 06 e0 9c ld [ %i3 + 0x9c ], %l0 /* * Process the seconds chain. Start by checking that the Time * of Day (TOD) has not been set backwards. If it has then * we want to adjust the watchdogs->Chain to indicate this. */ if ( snapshot > last_snapshot ) { 2016bb8: 80 a4 00 0a cmp %l0, %o2 2016bbc: 08 80 00 06 bleu 2016bd4 <_Timer_server_Body+0x90> 2016bc0: 92 24 00 0a sub %l0, %o2, %o1 /* * This path is for normal forward movement and cases where the * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 2016bc4: 90 10 00 11 mov %l1, %o0 2016bc8: 40 00 12 5b call 201b534 <_Watchdog_Adjust_to_chain> 2016bcc: 94 10 00 14 mov %l4, %o2 2016bd0: 30 80 00 06 b,a 2016be8 <_Timer_server_Body+0xa4> } else if ( snapshot < last_snapshot ) { 2016bd4: 1a 80 00 05 bcc 2016be8 <_Timer_server_Body+0xa4> 2016bd8: 90 10 00 11 mov %l1, %o0 /* * The current TOD is before the last TOD which indicates that * TOD has been set backwards. */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); 2016bdc: 92 10 20 01 mov 1, %o1 2016be0: 40 00 12 2d call 201b494 <_Watchdog_Adjust> 2016be4: 94 22 80 10 sub %o2, %l0, %o2 } watchdogs->last_snapshot = snapshot; 2016be8: e0 26 20 74 st %l0, [ %i0 + 0x74 ] } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 2016bec: d0 06 20 78 ld [ %i0 + 0x78 ], %o0 2016bf0: 40 00 02 d8 call 2017750 <_Chain_Get> 2016bf4: 01 00 00 00 nop if ( timer == NULL ) { 2016bf8: 92 92 20 00 orcc %o0, 0, %o1 2016bfc: 02 80 00 0c be 2016c2c <_Timer_server_Body+0xe8> 2016c00: 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 ) { 2016c04: c2 02 60 38 ld [ %o1 + 0x38 ], %g1 2016c08: 80 a0 60 01 cmp %g1, 1 2016c0c: 02 80 00 05 be 2016c20 <_Timer_server_Body+0xdc> 2016c10: 90 10 00 15 mov %l5, %o0 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 2016c14: 80 a0 60 03 cmp %g1, 3 2016c18: 12 bf ff f5 bne 2016bec <_Timer_server_Body+0xa8> <== NEVER TAKEN 2016c1c: 90 10 00 11 mov %l1, %o0 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 2016c20: 40 00 12 79 call 201b604 <_Watchdog_Insert> 2016c24: 92 02 60 10 add %o1, 0x10, %o1 2016c28: 30 bf ff f1 b,a 2016bec <_Timer_server_Body+0xa8> * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 2016c2c: 7f ff e3 44 call 200f93c 2016c30: 01 00 00 00 nop if ( _Chain_Is_empty( insert_chain ) ) { 2016c34: c2 07 bf f4 ld [ %fp + -12 ], %g1 2016c38: 80 a0 40 16 cmp %g1, %l6 2016c3c: 12 80 00 0a bne 2016c64 <_Timer_server_Body+0x120> <== NEVER TAKEN 2016c40: 01 00 00 00 nop ts->insert_chain = NULL; 2016c44: c0 26 20 78 clr [ %i0 + 0x78 ] _ISR_Enable( level ); 2016c48: 7f ff e3 41 call 200f94c 2016c4c: 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 ) ) { 2016c50: c2 07 bf e8 ld [ %fp + -24 ], %g1 2016c54: 80 a0 40 13 cmp %g1, %l3 2016c58: 12 80 00 06 bne 2016c70 <_Timer_server_Body+0x12c> 2016c5c: 01 00 00 00 nop 2016c60: 30 80 00 1a b,a 2016cc8 <_Timer_server_Body+0x184> ts->insert_chain = NULL; _ISR_Enable( level ); break; } else { _ISR_Enable( level ); 2016c64: 7f ff e3 3a call 200f94c <== NOT EXECUTED 2016c68: 01 00 00 00 nop <== NOT EXECUTED 2016c6c: 30 bf ff ca b,a 2016b94 <_Timer_server_Body+0x50> <== NOT EXECUTED /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 2016c70: 7f ff e3 33 call 200f93c 2016c74: 01 00 00 00 nop 2016c78: 84 10 00 08 mov %o0, %g2 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 2016c7c: e0 07 bf e8 ld [ %fp + -24 ], %l0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 2016c80: 80 a4 00 13 cmp %l0, %l3 2016c84: 02 80 00 0e be 2016cbc <_Timer_server_Body+0x178> 2016c88: 80 a4 20 00 cmp %l0, 0 { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 2016c8c: c2 04 00 00 ld [ %l0 ], %g1 the_chain->first = new_first; 2016c90: c2 27 bf e8 st %g1, [ %fp + -24 ] watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { 2016c94: 02 80 00 0a be 2016cbc <_Timer_server_Body+0x178> <== NEVER TAKEN 2016c98: e4 20 60 04 st %l2, [ %g1 + 4 ] watchdog->state = WATCHDOG_INACTIVE; 2016c9c: c0 24 20 08 clr [ %l0 + 8 ] _ISR_Enable( level ); 2016ca0: 7f ff e3 2b call 200f94c 2016ca4: 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 ); 2016ca8: c2 04 20 1c ld [ %l0 + 0x1c ], %g1 2016cac: d0 04 20 20 ld [ %l0 + 0x20 ], %o0 2016cb0: 9f c0 40 00 call %g1 2016cb4: d2 04 20 24 ld [ %l0 + 0x24 ], %o1 } 2016cb8: 30 bf ff ee b,a 2016c70 <_Timer_server_Body+0x12c> watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 2016cbc: 7f ff e3 24 call 200f94c 2016cc0: 90 10 00 02 mov %g2, %o0 2016cc4: 30 bf ff b3 b,a 2016b90 <_Timer_server_Body+0x4c> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 2016cc8: c0 2e 20 7c clrb [ %i0 + 0x7c ] /* * Block until there is something to do. */ _Thread_Disable_dispatch(); 2016ccc: 7f ff ff 6e call 2016a84 <_Thread_Disable_dispatch> 2016cd0: 01 00 00 00 nop _Thread_Set_state( ts->thread, STATES_DELAYING ); 2016cd4: d0 06 00 00 ld [ %i0 ], %o0 2016cd8: 40 00 0f 55 call 201aa2c <_Thread_Set_state> 2016cdc: 92 10 20 08 mov 8, %o1 _Timer_server_Reset_interval_system_watchdog( ts ); 2016ce0: 7f ff ff 6f call 2016a9c <_Timer_server_Reset_interval_system_watchdog> 2016ce4: 90 10 00 18 mov %i0, %o0 _Timer_server_Reset_tod_system_watchdog( ts ); 2016ce8: 7f ff ff 82 call 2016af0 <_Timer_server_Reset_tod_system_watchdog> 2016cec: 90 10 00 18 mov %i0, %o0 _Thread_Enable_dispatch(); 2016cf0: 40 00 0c 7b call 2019edc <_Thread_Enable_dispatch> 2016cf4: 01 00 00 00 nop static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 2016cf8: 90 10 00 1d mov %i5, %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; 2016cfc: f8 2e 20 7c stb %i4, [ %i0 + 0x7c ] static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 2016d00: 40 00 12 9c call 201b770 <_Watchdog_Remove> 2016d04: 01 00 00 00 nop static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 2016d08: 40 00 12 9a call 201b770 <_Watchdog_Remove> 2016d0c: 90 10 00 17 mov %l7, %o0 2016d10: 30 bf ff a0 b,a 2016b90 <_Timer_server_Body+0x4c> =============================================================================== 02016d14 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 2016d14: 9d e3 bf a0 save %sp, -96, %sp if ( ts->insert_chain == NULL ) { 2016d18: c2 06 20 78 ld [ %i0 + 0x78 ], %g1 2016d1c: 80 a0 60 00 cmp %g1, 0 2016d20: 12 80 00 49 bne 2016e44 <_Timer_server_Schedule_operation_method+0x130> 2016d24: a0 10 00 19 mov %i1, %l0 * is the reference point for the delta chain. Thus if we do not update the * reference point we have to add DT to the initial delta of the watchdog * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); 2016d28: 7f ff ff 57 call 2016a84 <_Thread_Disable_dispatch> 2016d2c: 01 00 00 00 nop if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 2016d30: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 2016d34: 80 a0 60 01 cmp %g1, 1 2016d38: 12 80 00 1f bne 2016db4 <_Timer_server_Schedule_operation_method+0xa0> 2016d3c: 80 a0 60 03 cmp %g1, 3 /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 2016d40: 7f ff e2 ff call 200f93c 2016d44: 01 00 00 00 nop snapshot = _Watchdog_Ticks_since_boot; 2016d48: 03 00 80 f6 sethi %hi(0x203d800), %g1 2016d4c: c4 00 61 64 ld [ %g1 + 0x164 ], %g2 ! 203d964 <_Watchdog_Ticks_since_boot> */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 2016d50: c2 06 20 30 ld [ %i0 + 0x30 ], %g1 last_snapshot = ts->Interval_watchdogs.last_snapshot; 2016d54: c8 06 20 3c ld [ %i0 + 0x3c ], %g4 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 2016d58: 86 06 20 34 add %i0, 0x34, %g3 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 2016d5c: 80 a0 40 03 cmp %g1, %g3 2016d60: 02 80 00 08 be 2016d80 <_Timer_server_Schedule_operation_method+0x6c> 2016d64: 88 20 80 04 sub %g2, %g4, %g4 /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 2016d68: da 00 60 10 ld [ %g1 + 0x10 ], %o5 if (delta_interval > delta) { 2016d6c: 80 a3 40 04 cmp %o5, %g4 2016d70: 08 80 00 03 bleu 2016d7c <_Timer_server_Schedule_operation_method+0x68> 2016d74: 86 10 20 00 clr %g3 delta_interval -= delta; 2016d78: 86 23 40 04 sub %o5, %g4, %g3 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 2016d7c: c6 20 60 10 st %g3, [ %g1 + 0x10 ] } ts->Interval_watchdogs.last_snapshot = snapshot; 2016d80: c4 26 20 3c st %g2, [ %i0 + 0x3c ] _ISR_Enable( level ); 2016d84: 7f ff e2 f2 call 200f94c 2016d88: 01 00 00 00 nop _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 2016d8c: 90 06 20 30 add %i0, 0x30, %o0 2016d90: 40 00 12 1d call 201b604 <_Watchdog_Insert> 2016d94: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 2016d98: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 2016d9c: 80 a0 60 00 cmp %g1, 0 2016da0: 12 80 00 27 bne 2016e3c <_Timer_server_Schedule_operation_method+0x128> 2016da4: 01 00 00 00 nop _Timer_server_Reset_interval_system_watchdog( ts ); 2016da8: 7f ff ff 3d call 2016a9c <_Timer_server_Reset_interval_system_watchdog> 2016dac: 90 10 00 18 mov %i0, %o0 2016db0: 30 80 00 23 b,a 2016e3c <_Timer_server_Schedule_operation_method+0x128> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 2016db4: 12 80 00 22 bne 2016e3c <_Timer_server_Schedule_operation_method+0x128> 2016db8: 01 00 00 00 nop /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 2016dbc: 7f ff e2 e0 call 200f93c 2016dc0: 01 00 00 00 nop */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 2016dc4: c4 06 20 68 ld [ %i0 + 0x68 ], %g2 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; 2016dc8: da 06 20 74 ld [ %i0 + 0x74 ], %o5 /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 2016dcc: 03 00 80 f6 sethi %hi(0x203d800), %g1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 2016dd0: 86 06 20 6c add %i0, 0x6c, %g3 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 2016dd4: 80 a0 80 03 cmp %g2, %g3 2016dd8: 02 80 00 0d be 2016e0c <_Timer_server_Schedule_operation_method+0xf8> 2016ddc: c2 00 60 9c ld [ %g1 + 0x9c ], %g1 first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 2016de0: c8 00 a0 10 ld [ %g2 + 0x10 ], %g4 if ( snapshot > last_snapshot ) { 2016de4: 80 a0 40 0d cmp %g1, %o5 } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 2016de8: 86 01 00 0d add %g4, %o5, %g3 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { 2016dec: 08 80 00 07 bleu 2016e08 <_Timer_server_Schedule_operation_method+0xf4> 2016df0: 86 20 c0 01 sub %g3, %g1, %g3 /* * We advanced in time. */ delta = snapshot - last_snapshot; 2016df4: 9a 20 40 0d sub %g1, %o5, %o5 if (delta_interval > delta) { 2016df8: 80 a1 00 0d cmp %g4, %o5 2016dfc: 08 80 00 03 bleu 2016e08 <_Timer_server_Schedule_operation_method+0xf4><== NEVER TAKEN 2016e00: 86 10 20 00 clr %g3 delta_interval -= delta; 2016e04: 86 21 00 0d sub %g4, %o5, %g3 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 2016e08: c6 20 a0 10 st %g3, [ %g2 + 0x10 ] } ts->TOD_watchdogs.last_snapshot = snapshot; 2016e0c: c2 26 20 74 st %g1, [ %i0 + 0x74 ] _ISR_Enable( level ); 2016e10: 7f ff e2 cf call 200f94c 2016e14: 01 00 00 00 nop _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 2016e18: 90 06 20 68 add %i0, 0x68, %o0 2016e1c: 40 00 11 fa call 201b604 <_Watchdog_Insert> 2016e20: 92 04 20 10 add %l0, 0x10, %o1 if ( !ts->active ) { 2016e24: c2 0e 20 7c ldub [ %i0 + 0x7c ], %g1 2016e28: 80 a0 60 00 cmp %g1, 0 2016e2c: 12 80 00 04 bne 2016e3c <_Timer_server_Schedule_operation_method+0x128> 2016e30: 01 00 00 00 nop _Timer_server_Reset_tod_system_watchdog( ts ); 2016e34: 7f ff ff 2f call 2016af0 <_Timer_server_Reset_tod_system_watchdog> 2016e38: 90 10 00 18 mov %i0, %o0 } } _Thread_Enable_dispatch(); 2016e3c: 40 00 0c 28 call 2019edc <_Thread_Enable_dispatch> 2016e40: 81 e8 00 00 restore * server is not preemptible, so we must be in interrupt context here. No * thread dispatch will happen until the timer server finishes its * critical section. We have to use the protected chain methods because * we may be interrupted by a higher priority interrupt. */ _Chain_Append( ts->insert_chain, &timer->Object.Node ); 2016e44: f0 06 20 78 ld [ %i0 + 0x78 ], %i0 2016e48: 40 00 02 2c call 20176f8 <_Chain_Append> 2016e4c: 81 e8 00 00 restore =============================================================================== 0200b9d0 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 200b9d0: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; _ISR_Disable( level ); 200b9d4: 7f ff de 06 call 20031ec 200b9d8: a0 10 00 18 mov %i0, %l0 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 200b9dc: c2 06 00 00 ld [ %i0 ], %g1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 200b9e0: a2 06 20 04 add %i0, 4, %l1 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { 200b9e4: 80 a0 40 11 cmp %g1, %l1 200b9e8: 02 80 00 1f be 200ba64 <_Watchdog_Adjust+0x94> 200b9ec: 80 a6 60 00 cmp %i1, 0 switch ( direction ) { 200b9f0: 02 80 00 1a be 200ba58 <_Watchdog_Adjust+0x88> 200b9f4: a4 10 20 01 mov 1, %l2 200b9f8: 80 a6 60 01 cmp %i1, 1 200b9fc: 12 80 00 1a bne 200ba64 <_Watchdog_Adjust+0x94> <== NEVER TAKEN 200ba00: 01 00 00 00 nop case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 200ba04: c4 00 60 10 ld [ %g1 + 0x10 ], %g2 200ba08: 10 80 00 07 b 200ba24 <_Watchdog_Adjust+0x54> 200ba0c: b4 00 80 1a add %g2, %i2, %i2 break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { 200ba10: f2 00 60 10 ld [ %g1 + 0x10 ], %i1 200ba14: 80 a6 80 19 cmp %i2, %i1 200ba18: 3a 80 00 05 bcc,a 200ba2c <_Watchdog_Adjust+0x5c> 200ba1c: e4 20 60 10 st %l2, [ %g1 + 0x10 ] _Watchdog_First( header )->delta_interval -= units; 200ba20: b4 26 40 1a sub %i1, %i2, %i2 break; 200ba24: 10 80 00 10 b 200ba64 <_Watchdog_Adjust+0x94> 200ba28: f4 20 60 10 st %i2, [ %g1 + 0x10 ] } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; _ISR_Enable( level ); 200ba2c: 7f ff dd f4 call 20031fc 200ba30: 01 00 00 00 nop _Watchdog_Tickle( header ); 200ba34: 40 00 00 93 call 200bc80 <_Watchdog_Tickle> 200ba38: 90 10 00 10 mov %l0, %o0 _ISR_Disable( level ); 200ba3c: 7f ff dd ec call 20031ec 200ba40: 01 00 00 00 nop if ( _Chain_Is_empty( header ) ) 200ba44: c2 04 00 00 ld [ %l0 ], %g1 200ba48: 80 a0 40 11 cmp %g1, %l1 200ba4c: 02 80 00 06 be 200ba64 <_Watchdog_Adjust+0x94> 200ba50: 01 00 00 00 nop while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; 200ba54: b4 26 80 19 sub %i2, %i1, %i2 switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 200ba58: 80 a6 a0 00 cmp %i2, 0 200ba5c: 32 bf ff ed bne,a 200ba10 <_Watchdog_Adjust+0x40> <== ALWAYS TAKEN 200ba60: c2 04 00 00 ld [ %l0 ], %g1 } break; } } _ISR_Enable( level ); 200ba64: 7f ff dd e6 call 20031fc 200ba68: 91 e8 00 08 restore %g0, %o0, %o0 =============================================================================== 02009928 <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { 2009928: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 200992c: 7f ff e2 25 call 20021c0 2009930: a0 10 00 18 mov %i0, %l0 previous_state = the_watchdog->state; 2009934: f0 06 20 08 ld [ %i0 + 8 ], %i0 switch ( previous_state ) { 2009938: 80 a6 20 01 cmp %i0, 1 200993c: 22 80 00 1d be,a 20099b0 <_Watchdog_Remove+0x88> 2009940: c0 24 20 08 clr [ %l0 + 8 ] 2009944: 0a 80 00 1c bcs 20099b4 <_Watchdog_Remove+0x8c> 2009948: 03 00 80 58 sethi %hi(0x2016000), %g1 200994c: 80 a6 20 03 cmp %i0, 3 2009950: 18 80 00 19 bgu 20099b4 <_Watchdog_Remove+0x8c> <== NEVER TAKEN 2009954: 01 00 00 00 nop 2009958: c2 04 00 00 ld [ %l0 ], %g1 break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 200995c: c0 24 20 08 clr [ %l0 + 8 ] next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 2009960: c4 00 40 00 ld [ %g1 ], %g2 2009964: 80 a0 a0 00 cmp %g2, 0 2009968: 02 80 00 07 be 2009984 <_Watchdog_Remove+0x5c> 200996c: 05 00 80 58 sethi %hi(0x2016000), %g2 next_watchdog->delta_interval += the_watchdog->delta_interval; 2009970: c6 00 60 10 ld [ %g1 + 0x10 ], %g3 2009974: c4 04 20 10 ld [ %l0 + 0x10 ], %g2 2009978: 84 00 c0 02 add %g3, %g2, %g2 200997c: c4 20 60 10 st %g2, [ %g1 + 0x10 ] if ( _Watchdog_Sync_count ) 2009980: 05 00 80 58 sethi %hi(0x2016000), %g2 2009984: c4 00 a2 a0 ld [ %g2 + 0x2a0 ], %g2 ! 20162a0 <_Watchdog_Sync_count> 2009988: 80 a0 a0 00 cmp %g2, 0 200998c: 22 80 00 07 be,a 20099a8 <_Watchdog_Remove+0x80> 2009990: c4 04 20 04 ld [ %l0 + 4 ], %g2 _Watchdog_Sync_level = _ISR_Nest_level; 2009994: 05 00 80 58 sethi %hi(0x2016000), %g2 2009998: c6 00 a1 e4 ld [ %g2 + 0x1e4 ], %g3 ! 20161e4 <_ISR_Nest_level> 200999c: 05 00 80 58 sethi %hi(0x2016000), %g2 20099a0: c6 20 a2 04 st %g3, [ %g2 + 0x204 ] ! 2016204 <_Watchdog_Sync_level> { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 20099a4: c4 04 20 04 ld [ %l0 + 4 ], %g2 next->previous = previous; 20099a8: c4 20 60 04 st %g2, [ %g1 + 4 ] previous->next = next; 20099ac: c2 20 80 00 st %g1, [ %g2 ] _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 20099b0: 03 00 80 58 sethi %hi(0x2016000), %g1 20099b4: c2 00 62 a4 ld [ %g1 + 0x2a4 ], %g1 ! 20162a4 <_Watchdog_Ticks_since_boot> 20099b8: c2 24 20 18 st %g1, [ %l0 + 0x18 ] _ISR_Enable( level ); 20099bc: 7f ff e2 05 call 20021d0 20099c0: 01 00 00 00 nop return( previous_state ); } 20099c4: 81 c7 e0 08 ret 20099c8: 81 e8 00 00 restore =============================================================================== 0200b1a8 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 200b1a8: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 200b1ac: 7f ff de e7 call 2002d48 200b1b0: a0 10 00 18 mov %i0, %l0 200b1b4: b0 10 00 08 mov %o0, %i0 printk( "Watchdog Chain: %s %p\n", name, header ); 200b1b8: 11 00 80 73 sethi %hi(0x201cc00), %o0 200b1bc: 94 10 00 19 mov %i1, %o2 200b1c0: 90 12 23 c0 or %o0, 0x3c0, %o0 200b1c4: 7f ff e5 b0 call 2004884 200b1c8: 92 10 00 10 mov %l0, %o1 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 200b1cc: e2 06 40 00 ld [ %i1 ], %l1 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 200b1d0: b2 06 60 04 add %i1, 4, %i1 if ( !_Chain_Is_empty( header ) ) { 200b1d4: 80 a4 40 19 cmp %l1, %i1 200b1d8: 02 80 00 0e be 200b210 <_Watchdog_Report_chain+0x68> 200b1dc: 11 00 80 73 sethi %hi(0x201cc00), %o0 node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 200b1e0: 92 10 00 11 mov %l1, %o1 200b1e4: 40 00 00 10 call 200b224 <_Watchdog_Report> 200b1e8: 90 10 20 00 clr %o0 _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = header->first ; node != _Chain_Tail(header) ; node = node->next ) 200b1ec: e2 04 40 00 ld [ %l1 ], %l1 Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = header->first ; 200b1f0: 80 a4 40 19 cmp %l1, %i1 200b1f4: 12 bf ff fc bne 200b1e4 <_Watchdog_Report_chain+0x3c> <== NEVER TAKEN 200b1f8: 92 10 00 11 mov %l1, %o1 { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 200b1fc: 11 00 80 73 sethi %hi(0x201cc00), %o0 200b200: 92 10 00 10 mov %l0, %o1 200b204: 7f ff e5 a0 call 2004884 200b208: 90 12 23 d8 or %o0, 0x3d8, %o0 200b20c: 30 80 00 03 b,a 200b218 <_Watchdog_Report_chain+0x70> } else { printk( "Chain is empty\n" ); 200b210: 7f ff e5 9d call 2004884 200b214: 90 12 23 e8 or %o0, 0x3e8, %o0 } _ISR_Enable( level ); 200b218: 7f ff de d0 call 2002d58 200b21c: 81 e8 00 00 restore =============================================================================== 02006214 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 2006214: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 2006218: 90 96 60 00 orcc %i1, 0, %o0 200621c: 12 80 00 06 bne 2006234 2006220: 80 a6 20 01 cmp %i0, 1 rtems_set_errno_and_return_minus_one( EINVAL ); 2006224: 40 00 27 1b call 200fe90 <__errno> 2006228: 01 00 00 00 nop 200622c: 10 80 00 15 b 2006280 2006230: 82 10 20 16 mov 0x16, %g1 ! 16 if ( clock_id == CLOCK_REALTIME ) { 2006234: 12 80 00 05 bne 2006248 2006238: 80 a6 20 04 cmp %i0, 4 _TOD_Get(tp); 200623c: 40 00 07 d7 call 2008198 <_TOD_Get> 2006240: b0 10 20 00 clr %i0 2006244: 30 80 00 16 b,a 200629c return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 2006248: 02 80 00 05 be 200625c <== NEVER TAKEN 200624c: 01 00 00 00 nop return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 2006250: 80 a6 20 02 cmp %i0, 2 2006254: 12 80 00 06 bne 200626c 2006258: 80 a6 20 03 cmp %i0, 3 _TOD_Get_uptime_as_timespec( tp ); 200625c: 40 00 07 ee call 2008214 <_TOD_Get_uptime_as_timespec> 2006260: b0 10 20 00 clr %i0 return 0; 2006264: 81 c7 e0 08 ret 2006268: 81 e8 00 00 restore } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 200626c: 12 80 00 08 bne 200628c 2006270: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 2006274: 40 00 27 07 call 200fe90 <__errno> 2006278: 01 00 00 00 nop 200627c: 82 10 20 58 mov 0x58, %g1 ! 58 2006280: c2 22 00 00 st %g1, [ %o0 ] 2006284: 81 c7 e0 08 ret 2006288: 91 e8 3f ff restore %g0, -1, %o0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); 200628c: 40 00 27 01 call 200fe90 <__errno> 2006290: b0 10 3f ff mov -1, %i0 2006294: 82 10 20 16 mov 0x16, %g1 2006298: c2 22 00 00 st %g1, [ %o0 ] return 0; } 200629c: 81 c7 e0 08 ret 20062a0: 81 e8 00 00 restore =============================================================================== 020062a4 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 20062a4: 9d e3 bf a0 save %sp, -96, %sp if ( !tp ) 20062a8: 90 96 60 00 orcc %i1, 0, %o0 20062ac: 02 80 00 0b be 20062d8 <== NEVER TAKEN 20062b0: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 20062b4: 80 a6 20 01 cmp %i0, 1 20062b8: 12 80 00 15 bne 200630c 20062bc: 80 a6 20 02 cmp %i0, 2 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 20062c0: c4 02 00 00 ld [ %o0 ], %g2 20062c4: 03 08 76 b9 sethi %hi(0x21dae400), %g1 20062c8: 82 10 60 ff or %g1, 0xff, %g1 ! 21dae4ff 20062cc: 80 a0 80 01 cmp %g2, %g1 20062d0: 38 80 00 06 bgu,a 20062e8 20062d4: 03 00 80 7a sethi %hi(0x201e800), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 20062d8: 40 00 26 ee call 200fe90 <__errno> 20062dc: 01 00 00 00 nop 20062e0: 10 80 00 13 b 200632c 20062e4: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 20062e8: c4 00 60 28 ld [ %g1 + 0x28 ], %g2 20062ec: 84 00 a0 01 inc %g2 20062f0: c4 20 60 28 st %g2, [ %g1 + 0x28 ] _Thread_Disable_dispatch(); _TOD_Set( tp ); 20062f4: 40 00 07 de call 200826c <_TOD_Set> 20062f8: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 20062fc: 40 00 0c d2 call 2009644 <_Thread_Enable_dispatch> 2006300: 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; 2006304: 81 c7 e0 08 ret 2006308: 81 e8 00 00 restore _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 200630c: 02 80 00 05 be 2006320 2006310: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) 2006314: 80 a6 20 03 cmp %i0, 3 2006318: 12 80 00 08 bne 2006338 200631c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( ENOSYS ); 2006320: 40 00 26 dc call 200fe90 <__errno> 2006324: 01 00 00 00 nop 2006328: 82 10 20 58 mov 0x58, %g1 ! 58 200632c: c2 22 00 00 st %g1, [ %o0 ] 2006330: 81 c7 e0 08 ret 2006334: 91 e8 3f ff restore %g0, -1, %o0 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 2006338: 40 00 26 d6 call 200fe90 <__errno> 200633c: b0 10 3f ff mov -1, %i0 2006340: 82 10 20 16 mov 0x16, %g1 2006344: c2 22 00 00 st %g1, [ %o0 ] return 0; } 2006348: 81 c7 e0 08 ret 200634c: 81 e8 00 00 restore =============================================================================== 02022728 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 2022728: 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() ) 202272c: 7f ff ff 1d call 20223a0 2022730: 01 00 00 00 nop 2022734: 80 a6 00 08 cmp %i0, %o0 2022738: 02 80 00 06 be 2022750 202273c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 2022740: 7f ff c7 44 call 2014450 <__errno> 2022744: 01 00 00 00 nop 2022748: 10 80 00 07 b 2022764 202274c: 82 10 20 03 mov 3, %g1 ! 3 /* * Validate the signal passed. */ if ( !sig ) 2022750: 12 80 00 08 bne 2022770 2022754: a0 06 7f ff add %i1, -1, %l0 rtems_set_errno_and_return_minus_one( EINVAL ); 2022758: 7f ff c7 3e call 2014450 <__errno> 202275c: 01 00 00 00 nop 2022760: 82 10 20 16 mov 0x16, %g1 ! 16 2022764: c2 22 00 00 st %g1, [ %o0 ] 2022768: 10 80 00 a5 b 20229fc 202276c: 90 10 3f ff mov -1, %o0 if ( !is_valid_signo(sig) ) 2022770: 80 a4 20 1f cmp %l0, 0x1f 2022774: 18 bf ff f9 bgu 2022758 2022778: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); /* * If the signal is being ignored, then we are out of here. */ if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) 202277c: 83 2e 60 02 sll %i1, 2, %g1 2022780: 85 2e 60 04 sll %i1, 4, %g2 2022784: 84 20 80 01 sub %g2, %g1, %g2 2022788: 03 00 80 99 sethi %hi(0x2026400), %g1 202278c: 82 10 63 38 or %g1, 0x338, %g1 ! 2026738 <_POSIX_signals_Vectors> 2022790: 82 00 40 02 add %g1, %g2, %g1 2022794: c2 00 60 08 ld [ %g1 + 8 ], %g1 2022798: 80 a0 60 01 cmp %g1, 1 202279c: 02 80 00 98 be 20229fc 20227a0: 90 10 20 00 clr %o0 /* * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) 20227a4: 80 a6 60 04 cmp %i1, 4 20227a8: 02 80 00 06 be 20227c0 20227ac: 80 a6 60 08 cmp %i1, 8 20227b0: 02 80 00 04 be 20227c0 20227b4: 80 a6 60 0b cmp %i1, 0xb 20227b8: 12 80 00 08 bne 20227d8 20227bc: 82 10 20 01 mov 1, %g1 return pthread_kill( pthread_self(), sig ); 20227c0: 40 00 01 2b call 2022c6c 20227c4: 01 00 00 00 nop 20227c8: 40 00 00 ed call 2022b7c 20227cc: 92 10 00 19 mov %i1, %o1 20227d0: 81 c7 e0 08 ret 20227d4: 91 e8 00 08 restore %g0, %o0, %o0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 20227d8: f2 27 bf f4 st %i1, [ %fp + -12 ] siginfo->si_code = SI_USER; 20227dc: c2 27 bf f8 st %g1, [ %fp + -8 ] if ( !value ) { 20227e0: 80 a6 a0 00 cmp %i2, 0 20227e4: 12 80 00 04 bne 20227f4 20227e8: a1 28 40 10 sll %g1, %l0, %l0 siginfo->si_value.sival_int = 0; 20227ec: 10 80 00 04 b 20227fc 20227f0: c0 27 bf fc clr [ %fp + -4 ] } else { siginfo->si_value = *value; 20227f4: c2 06 80 00 ld [ %i2 ], %g1 20227f8: c2 27 bf fc st %g1, [ %fp + -4 ] 20227fc: 03 00 80 98 sethi %hi(0x2026000), %g1 2022800: c4 00 61 a8 ld [ %g1 + 0x1a8 ], %g2 ! 20261a8 <_Thread_Dispatch_disable_level> 2022804: 84 00 a0 01 inc %g2 2022808: c4 20 61 a8 st %g2, [ %g1 + 0x1a8 ] /* * 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; 202280c: 03 00 80 98 sethi %hi(0x2026000), %g1 2022810: d0 00 62 68 ld [ %g1 + 0x268 ], %o0 ! 2026268 <_Thread_Executing> api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 2022814: c2 02 21 6c ld [ %o0 + 0x16c ], %g1 2022818: c2 00 60 cc ld [ %g1 + 0xcc ], %g1 202281c: 80 ac 00 01 andncc %l0, %g1, %g0 2022820: 12 80 00 4e bne 2022958 2022824: 03 00 80 9a sethi %hi(0x2026800), %g1 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = the_chain->first ; 2022828: 05 00 80 9a sethi %hi(0x2026800), %g2 202282c: c2 00 60 c4 ld [ %g1 + 0xc4 ], %g1 2022830: 10 80 00 0b b 202285c 2022834: 84 10 a0 c8 or %g2, 0xc8, %g2 !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 2022838: 90 10 00 01 mov %g1, %o0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 202283c: 80 8c 00 04 btst %l0, %g4 2022840: 12 80 00 46 bne 2022958 2022844: c6 00 61 6c ld [ %g1 + 0x16c ], %g3 /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 2022848: c6 00 e0 cc ld [ %g3 + 0xcc ], %g3 202284c: 80 ac 00 03 andncc %l0, %g3, %g0 2022850: 32 80 00 43 bne,a 202295c 2022854: 82 10 20 01 mov 1, %g1 the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = the_chain->first ; !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { 2022858: 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 = the_chain->first ; 202285c: 80 a0 40 02 cmp %g1, %g2 2022860: 32 bf ff f6 bne,a 2022838 2022864: c8 00 60 30 ld [ %g1 + 0x30 ], %g4 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 2022868: 03 00 80 95 sethi %hi(0x2025400), %g1 202286c: c6 08 61 14 ldub [ %g1 + 0x114 ], %g3 ! 2025514 2022870: 05 00 80 98 sethi %hi(0x2026000), %g2 2022874: 86 00 e0 01 inc %g3 2022878: 84 10 a1 18 or %g2, 0x118, %g2 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 202287c: 90 10 20 00 clr %o0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 2022880: 92 00 a0 08 add %g2, 8, %o1 */ RTEMS_INLINE_ROUTINE bool _States_Is_interruptible_by_signal ( States_Control the_states ) { return (the_states & STATES_INTERRUPTIBLE_BY_SIGNAL); 2022884: 19 04 00 00 sethi %hi(0x10000000), %o4 for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { /* * This can occur when no one is interested and an API is not configured. */ if ( !_Objects_Information_table[ the_api ] ) 2022888: c2 00 80 00 ld [ %g2 ], %g1 202288c: 80 a0 60 00 cmp %g1, 0 2022890: 22 80 00 2c be,a 2022940 <== NEVER TAKEN 2022894: 84 00 a0 04 add %g2, 4, %g2 <== NOT EXECUTED continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 2022898: c2 00 60 04 ld [ %g1 + 4 ], %g1 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 202289c: 9a 10 20 01 mov 1, %o5 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 20228a0: f4 10 60 10 lduh [ %g1 + 0x10 ], %i2 object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 20228a4: 10 80 00 23 b 2022930 20228a8: de 00 60 1c ld [ %g1 + 0x1c ], %o7 the_thread = (Thread_Control *) object_table[ index ]; 20228ac: c2 03 c0 01 ld [ %o7 + %g1 ], %g1 if ( !the_thread ) 20228b0: 80 a0 60 00 cmp %g1, 0 20228b4: 22 80 00 1f be,a 2022930 20228b8: 9a 03 60 01 inc %o5 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 20228bc: c8 00 60 14 ld [ %g1 + 0x14 ], %g4 20228c0: 80 a1 00 03 cmp %g4, %g3 20228c4: 38 80 00 1b bgu,a 2022930 20228c8: 9a 03 60 01 inc %o5 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 20228cc: d6 00 61 6c ld [ %g1 + 0x16c ], %o3 20228d0: d6 02 e0 cc ld [ %o3 + 0xcc ], %o3 20228d4: 80 ac 00 0b andncc %l0, %o3, %g0 20228d8: 22 80 00 16 be,a 2022930 20228dc: 9a 03 60 01 inc %o5 * * NOTE: We initialized interested_priority to PRIORITY_MAXIMUM + 1 * so we never have to worry about deferencing a NULL * interested thread. */ if ( the_thread->current_priority < interested_priority ) { 20228e0: 80 a1 00 03 cmp %g4, %g3 20228e4: 2a 80 00 11 bcs,a 2022928 20228e8: 86 10 00 04 mov %g4, %g3 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( !_States_Is_ready( interested->current_state ) ) { 20228ec: d4 02 20 10 ld [ %o0 + 0x10 ], %o2 20228f0: 80 a2 a0 00 cmp %o2, 0 20228f4: 22 80 00 0f be,a 2022930 <== NEVER TAKEN 20228f8: 9a 03 60 01 inc %o5 <== NOT EXECUTED /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 20228fc: d6 00 60 10 ld [ %g1 + 0x10 ], %o3 2022900: 80 a2 e0 00 cmp %o3, 0 2022904: 22 80 00 09 be,a 2022928 2022908: 86 10 00 04 mov %g4, %g3 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 202290c: 80 8a 80 0c btst %o2, %o4 2022910: 32 80 00 08 bne,a 2022930 2022914: 9a 03 60 01 inc %o5 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 2022918: 80 8a c0 0c btst %o3, %o4 202291c: 22 80 00 05 be,a 2022930 2022920: 9a 03 60 01 inc %o5 */ if ( !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 2022924: 86 10 00 04 mov %g4, %g3 2022928: 90 10 00 01 mov %g1, %o0 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 202292c: 9a 03 60 01 inc %o5 2022930: 80 a3 40 1a cmp %o5, %i2 2022934: 08 bf ff de bleu 20228ac 2022938: 83 2b 60 02 sll %o5, 2, %g1 202293c: 84 00 a0 04 add %g2, 4, %g2 * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { 2022940: 80 a0 80 09 cmp %g2, %o1 2022944: 32 bf ff d2 bne,a 202288c 2022948: c2 00 80 00 ld [ %g2 ], %g1 } } } } if ( interested ) { 202294c: 80 a2 20 00 cmp %o0, 0 2022950: 02 80 00 0a be 2022978 2022954: 01 00 00 00 nop * thread needs to do the post context switch extension so it can * evaluate the signals pending. */ process_it: the_thread->do_post_task_switch_extension = true; 2022958: 82 10 20 01 mov 1, %g1 ! 1 /* * 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 ) ) { 202295c: 92 10 00 19 mov %i1, %o1 * thread needs to do the post context switch extension so it can * evaluate the signals pending. */ process_it: the_thread->do_post_task_switch_extension = true; 2022960: c2 2a 20 74 stb %g1, [ %o0 + 0x74 ] /* * 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 ) ) { 2022964: 40 00 00 3a call 2022a4c <_POSIX_signals_Unblock_thread> 2022968: 94 07 bf f4 add %fp, -12, %o2 202296c: 80 8a 20 ff btst 0xff, %o0 2022970: 12 80 00 20 bne 20229f0 2022974: 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 ); 2022978: 40 00 00 24 call 2022a08 <_POSIX_signals_Set_process_signals> 202297c: 90 10 00 10 mov %l0, %o0 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 2022980: 83 2e 60 02 sll %i1, 2, %g1 2022984: b3 2e 60 04 sll %i1, 4, %i1 2022988: b2 26 40 01 sub %i1, %g1, %i1 202298c: 03 00 80 99 sethi %hi(0x2026400), %g1 2022990: 82 10 63 38 or %g1, 0x338, %g1 ! 2026738 <_POSIX_signals_Vectors> 2022994: c2 00 40 19 ld [ %g1 + %i1 ], %g1 2022998: 80 a0 60 02 cmp %g1, 2 202299c: 12 80 00 15 bne 20229f0 20229a0: 11 00 80 9a sethi %hi(0x2026800), %o0 psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 20229a4: 7f ff a6 b1 call 200c468 <_Chain_Get> 20229a8: 90 12 20 b8 or %o0, 0xb8, %o0 ! 20268b8 <_POSIX_signals_Inactive_siginfo> if ( !psiginfo ) { 20229ac: a0 92 20 00 orcc %o0, 0, %l0 20229b0: 12 80 00 08 bne 20229d0 20229b4: 92 07 bf f4 add %fp, -12, %o1 _Thread_Enable_dispatch(); 20229b8: 7f ff ac e2 call 200dd40 <_Thread_Enable_dispatch> 20229bc: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 20229c0: 7f ff c6 a4 call 2014450 <__errno> 20229c4: 01 00 00 00 nop 20229c8: 10 bf ff 67 b 2022764 20229cc: 82 10 20 0b mov 0xb, %g1 ! b } psiginfo->Info = *siginfo; 20229d0: 90 04 20 08 add %l0, 8, %o0 20229d4: 7f ff c8 f9 call 2014db8 20229d8: 94 10 20 0c mov 0xc, %o2 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 20229dc: 11 00 80 9a sethi %hi(0x2026800), %o0 20229e0: 92 10 00 10 mov %l0, %o1 20229e4: 90 12 21 30 or %o0, 0x130, %o0 20229e8: 7f ff a6 8a call 200c410 <_Chain_Append> 20229ec: 90 02 00 19 add %o0, %i1, %o0 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 20229f0: 7f ff ac d4 call 200dd40 <_Thread_Enable_dispatch> 20229f4: 01 00 00 00 nop return 0; 20229f8: 90 10 20 00 clr %o0 ! 0 } 20229fc: b0 10 00 08 mov %o0, %i0 2022a00: 81 c7 e0 08 ret 2022a04: 81 e8 00 00 restore =============================================================================== 0200add4 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { 200add4: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 200add8: 80 a0 60 00 cmp %g1, 0 200addc: 02 80 00 0f be 200ae18 200ade0: 90 10 20 16 mov 0x16, %o0 200ade4: c4 00 40 00 ld [ %g1 ], %g2 200ade8: 80 a0 a0 00 cmp %g2, 0 200adec: 02 80 00 0b be 200ae18 200adf0: 80 a2 60 04 cmp %o1, 4 return EINVAL; switch ( policy ) { 200adf4: 18 80 00 09 bgu 200ae18 200adf8: 90 10 20 86 mov 0x86, %o0 200adfc: 84 10 20 01 mov 1, %g2 200ae00: 85 28 80 09 sll %g2, %o1, %g2 200ae04: 80 88 a0 17 btst 0x17, %g2 200ae08: 02 80 00 04 be 200ae18 <== NEVER TAKEN 200ae0c: 01 00 00 00 nop case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 200ae10: d2 20 60 14 st %o1, [ %g1 + 0x14 ] 200ae14: 90 10 20 00 clr %o0 return 0; default: return ENOTSUP; } } 200ae18: 81 c3 e0 08 retl =============================================================================== 02006868 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 2006868: 9d e3 bf 90 save %sp, -112, %sp 200686c: a0 10 00 18 mov %i0, %l0 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 2006870: 80 a4 20 00 cmp %l0, 0 2006874: 02 80 00 1f be 20068f0 2006878: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( count == 0 ) 200687c: 80 a6 a0 00 cmp %i2, 0 2006880: 02 80 00 1c be 20068f0 2006884: 80 a6 60 00 cmp %i1, 0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 2006888: 32 80 00 06 bne,a 20068a0 200688c: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 2006890: b2 07 bf f0 add %fp, -16, %i1 2006894: 7f ff ff bd call 2006788 2006898: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 200689c: c2 06 40 00 ld [ %i1 ], %g1 20068a0: 80 a0 60 00 cmp %g1, 0 20068a4: 02 80 00 13 be 20068f0 20068a8: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 20068ac: c2 06 60 04 ld [ %i1 + 4 ], %g1 20068b0: 80 a0 60 00 cmp %g1, 0 20068b4: 12 80 00 0f bne 20068f0 <== NEVER TAKEN 20068b8: 03 00 80 5e sethi %hi(0x2017800), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 20068bc: c4 00 63 28 ld [ %g1 + 0x328 ], %g2 ! 2017b28 <_Thread_Dispatch_disable_level> } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 20068c0: c0 27 bf f8 clr [ %fp + -8 ] the_attributes.maximum_count = count; 20068c4: f4 27 bf fc st %i2, [ %fp + -4 ] 20068c8: 84 00 a0 01 inc %g2 20068cc: c4 20 63 28 st %g2, [ %g1 + 0x328 ] * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) _Objects_Allocate( &_POSIX_Barrier_Information ); 20068d0: 25 00 80 5f sethi %hi(0x2017c00), %l2 20068d4: 40 00 08 6b call 2008a80 <_Objects_Allocate> 20068d8: 90 14 a3 40 or %l2, 0x340, %o0 ! 2017f40 <_POSIX_Barrier_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 20068dc: a2 92 20 00 orcc %o0, 0, %l1 20068e0: 12 80 00 06 bne 20068f8 20068e4: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 20068e8: 40 00 0b f1 call 20098ac <_Thread_Enable_dispatch> 20068ec: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 20068f0: 81 c7 e0 08 ret 20068f4: 81 e8 00 00 restore } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 20068f8: 40 00 05 c7 call 2008014 <_CORE_barrier_Initialize> 20068fc: 92 07 bf f8 add %fp, -8, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 2006900: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; _Thread_Enable_dispatch(); return 0; } 2006904: a4 14 a3 40 or %l2, 0x340, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 2006908: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 200690c: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 2006910: 85 28 a0 02 sll %g2, 2, %g2 2006914: e2 20 c0 02 st %l1, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 2006918: c0 24 60 0c clr [ %l1 + 0xc ] ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 200691c: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 2006920: 40 00 0b e3 call 20098ac <_Thread_Enable_dispatch> 2006924: b0 10 20 00 clr %i0 return 0; } 2006928: 81 c7 e0 08 ret 200692c: 81 e8 00 00 restore =============================================================================== 02006028 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 2006028: 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 ) 200602c: 80 a6 20 00 cmp %i0, 0 2006030: 02 80 00 14 be 2006080 2006034: 01 00 00 00 nop rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 2006038: 03 00 80 5f sethi %hi(0x2017c00), %g1 200603c: c4 00 62 e8 ld [ %g1 + 0x2e8 ], %g2 ! 2017ee8 <_Thread_Dispatch_disable_level> 2006040: 84 00 a0 01 inc %g2 2006044: c4 20 62 e8 st %g2, [ %g1 + 0x2e8 ] return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 2006048: 40 00 11 7e call 200a640 <_Workspace_Allocate> 200604c: 90 10 20 10 mov 0x10, %o0 if ( handler ) { 2006050: 92 92 20 00 orcc %o0, 0, %o1 2006054: 02 80 00 09 be 2006078 <== NEVER TAKEN 2006058: 01 00 00 00 nop thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 200605c: 03 00 80 5f sethi %hi(0x2017c00), %g1 2006060: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 ! 2017fa8 <_Thread_Executing> handler_stack = &thread_support->Cancellation_Handlers; 2006064: d0 00 61 6c ld [ %g1 + 0x16c ], %o0 handler->routine = routine; 2006068: f0 22 60 08 st %i0, [ %o1 + 8 ] handler->arg = arg; 200606c: f2 22 60 0c st %i1, [ %o1 + 0xc ] _Chain_Append( handler_stack, &handler->Node ); 2006070: 40 00 05 fe call 2007868 <_Chain_Append> 2006074: 90 02 20 e0 add %o0, 0xe0, %o0 } _Thread_Enable_dispatch(); 2006078: 40 00 0c 18 call 20090d8 <_Thread_Enable_dispatch> 200607c: 81 e8 00 00 restore 2006080: 81 c7 e0 08 ret 2006084: 81 e8 00 00 restore =============================================================================== 02007128 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 2007128: 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; 200712c: 80 a6 60 00 cmp %i1, 0 2007130: 12 80 00 04 bne 2007140 2007134: a0 10 00 18 mov %i0, %l0 else the_attr = &_POSIX_Condition_variables_Default_attributes; 2007138: 33 00 80 5d sethi %hi(0x2017400), %i1 200713c: b2 16 62 c4 or %i1, 0x2c4, %i1 ! 20176c4 <_POSIX_Condition_variables_Default_attributes> /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 2007140: c2 06 60 04 ld [ %i1 + 4 ], %g1 2007144: 80 a0 60 01 cmp %g1, 1 2007148: 02 80 00 11 be 200718c <== NEVER TAKEN 200714c: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !the_attr->is_initialized ) 2007150: c2 06 40 00 ld [ %i1 ], %g1 2007154: 80 a0 60 00 cmp %g1, 0 2007158: 02 80 00 0d be 200718c 200715c: 03 00 80 63 sethi %hi(0x2018c00), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 2007160: c4 00 61 18 ld [ %g1 + 0x118 ], %g2 ! 2018d18 <_Thread_Dispatch_disable_level> 2007164: 84 00 a0 01 inc %g2 2007168: c4 20 61 18 st %g2, [ %g1 + 0x118 ] RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 200716c: 25 00 80 64 sethi %hi(0x2019000), %l2 2007170: 40 00 09 d9 call 20098d4 <_Objects_Allocate> 2007174: 90 14 a1 c8 or %l2, 0x1c8, %o0 ! 20191c8 <_POSIX_Condition_variables_Information> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 2007178: a2 92 20 00 orcc %o0, 0, %l1 200717c: 32 80 00 06 bne,a 2007194 2007180: c2 06 60 04 ld [ %i1 + 4 ], %g1 _Thread_Enable_dispatch(); 2007184: 40 00 0d 5f call 200a700 <_Thread_Enable_dispatch> 2007188: b0 10 20 0c mov 0xc, %i0 return ENOMEM; 200718c: 81 c7 e0 08 ret 2007190: 81 e8 00 00 restore the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; /* XXX some more initialization might need to go here */ _Thread_queue_Initialize( 2007194: 90 04 60 18 add %l1, 0x18, %o0 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 2007198: c2 24 60 10 st %g1, [ %l1 + 0x10 ] the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; /* XXX some more initialization might need to go here */ _Thread_queue_Initialize( 200719c: 92 10 20 00 clr %o1 20071a0: 94 10 28 00 mov 0x800, %o2 20071a4: 96 10 20 74 mov 0x74, %o3 20071a8: 40 00 0f 7a call 200af90 <_Thread_queue_Initialize> 20071ac: c0 24 60 14 clr [ %l1 + 0x14 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 20071b0: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } 20071b4: a4 14 a1 c8 or %l2, 0x1c8, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 20071b8: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 20071bc: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 20071c0: 85 28 a0 02 sll %g2, 2, %g2 20071c4: e2 20 c0 02 st %l1, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 20071c8: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 20071cc: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 20071d0: 40 00 0d 4c call 200a700 <_Thread_Enable_dispatch> 20071d4: b0 10 20 00 clr %i0 return 0; } 20071d8: 81 c7 e0 08 ret 20071dc: 81 e8 00 00 restore =============================================================================== 02006f8c : */ int pthread_condattr_destroy( pthread_condattr_t *attr ) { 2006f8c: 82 10 00 08 mov %o0, %g1 if ( !attr || attr->is_initialized == false ) 2006f90: 80 a0 60 00 cmp %g1, 0 2006f94: 02 80 00 08 be 2006fb4 2006f98: 90 10 20 16 mov 0x16, %o0 2006f9c: c4 00 40 00 ld [ %g1 ], %g2 2006fa0: 80 a0 a0 00 cmp %g2, 0 2006fa4: 02 80 00 04 be 2006fb4 <== NEVER TAKEN 2006fa8: 01 00 00 00 nop return EINVAL; attr->is_initialized = false; 2006fac: c0 20 40 00 clr [ %g1 ] return 0; 2006fb0: 90 10 20 00 clr %o0 } 2006fb4: 81 c3 e0 08 retl =============================================================================== 020064e0 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 20064e0: 9d e3 bf 58 save %sp, -168, %sp 20064e4: a0 10 00 18 mov %i0, %l0 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 20064e8: 80 a6 a0 00 cmp %i2, 0 20064ec: 02 80 00 66 be 2006684 20064f0: b0 10 20 0e mov 0xe, %i0 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 20064f4: 80 a6 60 00 cmp %i1, 0 20064f8: 32 80 00 05 bne,a 200650c 20064fc: c2 06 40 00 ld [ %i1 ], %g1 2006500: 33 00 80 6f sethi %hi(0x201bc00), %i1 2006504: b2 16 62 cc or %i1, 0x2cc, %i1 ! 201becc <_POSIX_Threads_Default_attributes> if ( !the_attr->is_initialized ) 2006508: c2 06 40 00 ld [ %i1 ], %g1 200650c: 80 a0 60 00 cmp %g1, 0 2006510: 02 80 00 5d be 2006684 2006514: b0 10 20 16 mov 0x16, %i0 * stack space if it is allowed to allocate it itself. * * NOTE: If the user provides the stack we will let it drop below * twice the minimum. */ if ( the_attr->stackaddr && !_Stack_Is_enough(the_attr->stacksize) ) 2006518: c2 06 60 04 ld [ %i1 + 4 ], %g1 200651c: 80 a0 60 00 cmp %g1, 0 2006520: 02 80 00 07 be 200653c 2006524: 03 00 80 73 sethi %hi(0x201cc00), %g1 2006528: c4 06 60 08 ld [ %i1 + 8 ], %g2 200652c: c2 00 60 04 ld [ %g1 + 4 ], %g1 2006530: 80 a0 80 01 cmp %g2, %g1 2006534: 0a 80 00 7a bcs 200671c 2006538: 01 00 00 00 nop * If inheritsched is set to PTHREAD_INHERIT_SCHED, then this thread * inherits scheduling attributes from the creating thread. If it is * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { 200653c: c2 06 60 10 ld [ %i1 + 0x10 ], %g1 2006540: 80 a0 60 01 cmp %g1, 1 2006544: 02 80 00 06 be 200655c 2006548: 80 a0 60 02 cmp %g1, 2 200654c: 12 80 00 4e bne 2006684 2006550: b0 10 20 16 mov 0x16, %i0 schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 2006554: 10 80 00 09 b 2006578 2006558: e4 06 60 14 ld [ %i1 + 0x14 ], %l2 * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 200655c: 03 00 80 75 sethi %hi(0x201d400), %g1 2006560: c2 00 63 b8 ld [ %g1 + 0x3b8 ], %g1 ! 201d7b8 <_Thread_Executing> schedpolicy = api->schedpolicy; schedparam = api->schedparam; 2006564: 90 07 bf dc add %fp, -36, %o0 * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 2006568: d2 00 61 6c ld [ %g1 + 0x16c ], %o1 schedpolicy = api->schedpolicy; 200656c: e4 02 60 80 ld [ %o1 + 0x80 ], %l2 schedparam = api->schedparam; 2006570: 10 80 00 04 b 2006580 2006574: 92 02 60 84 add %o1, 0x84, %o1 break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 2006578: 90 07 bf dc add %fp, -36, %o0 200657c: 92 06 60 18 add %i1, 0x18, %o1 2006580: 40 00 27 8d call 20103b4 2006584: 94 10 20 1c mov 0x1c, %o2 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 2006588: c2 06 60 0c ld [ %i1 + 0xc ], %g1 200658c: 80 a0 60 00 cmp %g1, 0 2006590: 12 80 00 3d bne 2006684 2006594: b0 10 20 86 mov 0x86, %i0 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 2006598: d0 07 bf dc ld [ %fp + -36 ], %o0 200659c: 40 00 1a c3 call 200d0a8 <_POSIX_Priority_Is_valid> 20065a0: b0 10 20 16 mov 0x16, %i0 20065a4: 80 8a 20 ff btst 0xff, %o0 20065a8: 02 80 00 37 be 2006684 <== NEVER TAKEN 20065ac: 03 00 80 73 sethi %hi(0x201cc00), %g1 return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 20065b0: ea 07 bf dc ld [ %fp + -36 ], %l5 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 20065b4: e6 08 60 08 ldub [ %g1 + 8 ], %l3 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 20065b8: 90 10 00 12 mov %l2, %o0 20065bc: 92 07 bf dc add %fp, -36, %o1 20065c0: 94 07 bf fc add %fp, -4, %o2 20065c4: 40 00 1a c4 call 200d0d4 <_POSIX_Thread_Translate_sched_param> 20065c8: 96 07 bf f8 add %fp, -8, %o3 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 20065cc: b0 92 20 00 orcc %o0, 0, %i0 20065d0: 12 80 00 2d bne 2006684 20065d4: 29 00 80 75 sethi %hi(0x201d400), %l4 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 20065d8: 40 00 05 fc call 2007dc8 <_API_Mutex_Lock> 20065dc: d0 05 23 b0 ld [ %l4 + 0x3b0 ], %o0 ! 201d7b0 <_RTEMS_Allocator_Mutex> * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 20065e0: 11 00 80 76 sethi %hi(0x201d800), %o0 20065e4: 40 00 08 ac call 2008894 <_Objects_Allocate> 20065e8: 90 12 21 90 or %o0, 0x190, %o0 ! 201d990 <_POSIX_Threads_Information> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 20065ec: a2 92 20 00 orcc %o0, 0, %l1 20065f0: 32 80 00 04 bne,a 2006600 20065f4: c2 06 60 08 ld [ %i1 + 8 ], %g1 _RTEMS_Unlock_allocator(); 20065f8: 10 80 00 21 b 200667c 20065fc: d0 05 23 b0 ld [ %l4 + 0x3b0 ], %o0 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 2006600: 05 00 80 73 sethi %hi(0x201cc00), %g2 2006604: d6 00 a0 04 ld [ %g2 + 4 ], %o3 ! 201cc04 2006608: 97 2a e0 01 sll %o3, 1, %o3 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 200660c: 80 a2 c0 01 cmp %o3, %g1 2006610: 1a 80 00 03 bcc 200661c 2006614: d4 06 60 04 ld [ %i1 + 4 ], %o2 2006618: 96 10 00 01 mov %g1, %o3 200661c: c2 07 bf fc ld [ %fp + -4 ], %g1 2006620: 9a 0c e0 ff and %l3, 0xff, %o5 2006624: c2 23 a0 60 st %g1, [ %sp + 0x60 ] 2006628: c2 07 bf f8 ld [ %fp + -8 ], %g1 200662c: c0 27 bf d4 clr [ %fp + -44 ] 2006630: c2 23 a0 64 st %g1, [ %sp + 0x64 ] 2006634: 82 07 bf d4 add %fp, -44, %g1 2006638: a6 10 20 01 mov 1, %l3 200663c: c0 23 a0 68 clr [ %sp + 0x68 ] 2006640: e6 23 a0 5c st %l3, [ %sp + 0x5c ] 2006644: c2 23 a0 6c st %g1, [ %sp + 0x6c ] 2006648: 29 00 80 76 sethi %hi(0x201d800), %l4 200664c: 92 10 00 11 mov %l1, %o1 2006650: 90 15 21 90 or %l4, 0x190, %o0 2006654: 98 10 20 01 mov 1, %o4 2006658: 40 00 0c 66 call 20097f0 <_Thread_Initialize> 200665c: 9a 23 40 15 sub %o5, %l5, %o5 budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 2006660: 80 8a 20 ff btst 0xff, %o0 2006664: 12 80 00 0a bne 200668c 2006668: 90 15 21 90 or %l4, 0x190, %o0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 200666c: 40 00 09 64 call 2008bfc <_Objects_Free> 2006670: 92 10 00 11 mov %l1, %o1 _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 2006674: 03 00 80 75 sethi %hi(0x201d400), %g1 2006678: d0 00 63 b0 ld [ %g1 + 0x3b0 ], %o0 ! 201d7b0 <_RTEMS_Allocator_Mutex> 200667c: 40 00 05 e9 call 2007e20 <_API_Mutex_Unlock> 2006680: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 2006684: 81 c7 e0 08 ret 2006688: 81 e8 00 00 restore } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 200668c: e8 04 61 6c ld [ %l1 + 0x16c ], %l4 api->Attributes = *the_attr; 2006690: 92 10 00 19 mov %i1, %o1 2006694: 94 10 20 3c mov 0x3c, %o2 2006698: 40 00 27 47 call 20103b4 200669c: 90 10 00 14 mov %l4, %o0 api->detachstate = the_attr->detachstate; 20066a0: c2 06 60 38 ld [ %i1 + 0x38 ], %g1 api->schedpolicy = schedpolicy; api->schedparam = schedparam; 20066a4: 92 07 bf dc add %fp, -36, %o1 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; 20066a8: c2 25 20 3c st %g1, [ %l4 + 0x3c ] api->schedpolicy = schedpolicy; api->schedparam = schedparam; 20066ac: 94 10 20 1c mov 0x1c, %o2 */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; 20066b0: e4 25 20 80 st %l2, [ %l4 + 0x80 ] api->schedparam = schedparam; 20066b4: 40 00 27 40 call 20103b4 20066b8: 90 05 20 84 add %l4, 0x84, %o0 the_thread->do_post_task_switch_extension = true; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 20066bc: 90 10 00 11 mov %l1, %o0 * This insures we evaluate the process-wide signals pending when we * first run. * * NOTE: Since the thread starts with all unblocked, this is necessary. */ the_thread->do_post_task_switch_extension = true; 20066c0: e6 2c 60 74 stb %l3, [ %l1 + 0x74 ] /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 20066c4: 92 10 20 01 mov 1, %o1 20066c8: 94 10 00 1a mov %i2, %o2 20066cc: 96 10 00 1b mov %i3, %o3 20066d0: 40 00 0f 3e call 200a3c8 <_Thread_Start> 20066d4: 98 10 20 00 clr %o4 _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 20066d8: 80 a4 a0 04 cmp %l2, 4 20066dc: 32 80 00 0a bne,a 2006704 20066e0: c2 04 60 08 ld [ %l1 + 8 ], %g1 _Watchdog_Insert_ticks( 20066e4: 40 00 0f de call 200a65c <_Timespec_To_ticks> 20066e8: 90 05 20 8c add %l4, 0x8c, %o0 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 20066ec: 92 05 20 a4 add %l4, 0xa4, %o1 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 20066f0: d0 25 20 b0 st %o0, [ %l4 + 0xb0 ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 20066f4: 11 00 80 75 sethi %hi(0x201d400), %o0 20066f8: 40 00 10 af call 200a9b4 <_Watchdog_Insert> 20066fc: 90 12 23 d8 or %o0, 0x3d8, %o0 ! 201d7d8 <_Watchdog_Ticks_chain> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 2006700: c2 04 60 08 ld [ %l1 + 8 ], %g1 2006704: c2 24 00 00 st %g1, [ %l0 ] _RTEMS_Unlock_allocator(); 2006708: 03 00 80 75 sethi %hi(0x201d400), %g1 200670c: 40 00 05 c5 call 2007e20 <_API_Mutex_Unlock> 2006710: d0 00 63 b0 ld [ %g1 + 0x3b0 ], %o0 ! 201d7b0 <_RTEMS_Allocator_Mutex> return 0; 2006714: 81 c7 e0 08 ret 2006718: 81 e8 00 00 restore } 200671c: 81 c7 e0 08 ret 2006720: 81 e8 00 00 restore =============================================================================== 02006298 : int pthread_key_create( pthread_key_t *key, void (*destructor)( void * ) ) { 2006298: 9d e3 bf a0 save %sp, -96, %sp 200629c: 03 00 80 60 sethi %hi(0x2018000), %g1 20062a0: c4 00 63 98 ld [ %g1 + 0x398 ], %g2 ! 2018398 <_Thread_Dispatch_disable_level> 20062a4: 84 00 a0 01 inc %g2 20062a8: c4 20 63 98 st %g2, [ %g1 + 0x398 ] * the inactive chain of free keys control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Keys_Control *_POSIX_Keys_Allocate( void ) { return (POSIX_Keys_Control *) _Objects_Allocate( &_POSIX_Keys_Information ); 20062ac: 11 00 80 62 sethi %hi(0x2018800), %o0 20062b0: 40 00 08 e9 call 2008654 <_Objects_Allocate> 20062b4: 90 12 20 08 or %o0, 8, %o0 ! 2018808 <_POSIX_Keys_Information> _Thread_Disable_dispatch(); the_key = _POSIX_Keys_Allocate(); if ( !the_key ) { 20062b8: a0 92 20 00 orcc %o0, 0, %l0 20062bc: 32 80 00 06 bne,a 20062d4 20062c0: f2 24 20 10 st %i1, [ %l0 + 0x10 ] _Thread_Enable_dispatch(); 20062c4: 40 00 0c 6f call 2009480 <_Thread_Enable_dispatch> 20062c8: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 20062cc: 81 c7 e0 08 ret 20062d0: 81 e8 00 00 restore } the_key->destructor = destructor; 20062d4: a4 10 00 10 mov %l0, %l2 * APIs are optional. * * NOTE: Currently RTEMS Classic API tasks are always enabled. */ for ( the_api = 1; 20062d8: a2 10 20 01 mov 1, %l1 the_api <= OBJECTS_APIS_LAST; the_api++ ) { if ( _Objects_Information_table[ the_api ] ) { 20062dc: 27 00 80 60 sethi %hi(0x2018000), %l3 int _EXFUN(pthread_once, (pthread_once_t *__once_control, void (*__init_routine)(void))); /* Thread-Specific Data Key Create, P1003.1c/Draft 10, p. 163 */ int _EXFUN(pthread_key_create, 20062e0: 83 2c 60 02 sll %l1, 2, %g1 20062e4: 84 14 e3 00 or %l3, 0x300, %g2 20062e8: c2 00 80 01 ld [ %g2 + %g1 ], %g1 20062ec: 80 a0 60 00 cmp %g1, 0 20062f0: 22 80 00 25 be,a 2006384 <== NEVER TAKEN 20062f4: c0 24 a0 18 clr [ %l2 + 0x18 ] <== NOT EXECUTED true, INTERNAL_ERROR_IMPLEMENTATION_KEY_CREATE_INCONSISTENCY ); #endif bytes_to_allocate = sizeof( void * ) * (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); 20062f8: c2 00 60 04 ld [ %g1 + 4 ], %g1 20062fc: e8 10 60 10 lduh [ %g1 + 0x10 ], %l4 2006300: a8 05 20 01 inc %l4 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_IMPLEMENTATION_KEY_CREATE_INCONSISTENCY ); #endif bytes_to_allocate = sizeof( void * ) * 2006304: a9 2d 20 02 sll %l4, 2, %l4 (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); table = _Workspace_Allocate( bytes_to_allocate ); 2006308: 40 00 11 e0 call 200aa88 <_Workspace_Allocate> 200630c: 90 10 00 14 mov %l4, %o0 if ( !table ) { 2006310: 82 92 20 00 orcc %o0, 0, %g1 2006314: 32 80 00 17 bne,a 2006370 2006318: c2 24 a0 18 st %g1, [ %l2 + 0x18 ] for ( --the_api; 200631c: a4 04 7f ff add %l1, -1, %l2 2006320: a2 04 60 03 add %l1, 3, %l1 2006324: a3 2c 60 02 sll %l1, 2, %l1 2006328: a2 04 00 11 add %l0, %l1, %l1 200632c: 10 80 00 05 b 2006340 2006330: a2 04 60 04 add %l1, 4, %l1 the_api >= 1; the_api-- ) _Workspace_Free( the_key->Values[ the_api ] ); 2006334: 40 00 11 de call 200aaac <_Workspace_Free> 2006338: a4 04 bf ff add %l2, -1, %l2 (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); table = _Workspace_Allocate( bytes_to_allocate ); if ( !table ) { for ( --the_api; the_api >= 1; the_api-- ) 200633c: a2 04 7f fc add %l1, -4, %l1 #endif bytes_to_allocate = sizeof( void * ) * (_Objects_Information_table[ the_api ][ 1 ]->maximum + 1); table = _Workspace_Allocate( bytes_to_allocate ); if ( !table ) { for ( --the_api; 2006340: 80 a4 a0 00 cmp %l2, 0 2006344: 32 bf ff fc bne,a 2006334 2006348: d0 04 40 00 ld [ %l1 ], %o0 */ RTEMS_INLINE_ROUTINE void _POSIX_Keys_Free ( POSIX_Keys_Control *the_key ) { _Objects_Free( &_POSIX_Keys_Information, &the_key->Object ); 200634c: 92 10 00 10 mov %l0, %o1 2006350: 11 00 80 62 sethi %hi(0x2018800), %o0 2006354: 90 12 20 08 or %o0, 8, %o0 ! 2018808 <_POSIX_Keys_Information> 2006358: 40 00 09 99 call 20089bc <_Objects_Free> 200635c: b0 10 20 0c mov 0xc, %i0 the_api >= 1; the_api-- ) _Workspace_Free( the_key->Values[ the_api ] ); _POSIX_Keys_Free( the_key ); _Thread_Enable_dispatch(); 2006360: 40 00 0c 48 call 2009480 <_Thread_Enable_dispatch> 2006364: 01 00 00 00 nop return ENOMEM; 2006368: 81 c7 e0 08 ret 200636c: 81 e8 00 00 restore } the_key->Values[ the_api ] = table; memset( table, '\0', bytes_to_allocate ); 2006370: 92 10 20 00 clr %o1 2006374: 40 00 28 29 call 2010418 2006378: 94 10 00 14 mov %l4, %o2 * NOTE: Currently RTEMS Classic API tasks are always enabled. */ for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) { 200637c: 10 80 00 03 b 2006388 2006380: a2 04 60 01 inc %l1 2006384: a2 04 60 01 inc %l1 <== NOT EXECUTED * APIs are optional. * * NOTE: Currently RTEMS Classic API tasks are always enabled. */ for ( the_api = 1; 2006388: 80 a4 60 04 cmp %l1, 4 200638c: 12 bf ff d5 bne 20062e0 2006390: a4 04 a0 04 add %l2, 4, %l2 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 2006394: c4 14 20 0a lduh [ %l0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 2006398: 07 00 80 62 sethi %hi(0x2018800), %g3 200639c: c6 00 e0 24 ld [ %g3 + 0x24 ], %g3 ! 2018824 <_POSIX_Keys_Information+0x1c> Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 20063a0: c2 04 20 08 ld [ %l0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 20063a4: 85 28 a0 02 sll %g2, 2, %g2 20063a8: e0 20 c0 02 st %l0, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 20063ac: c0 24 20 0c clr [ %l0 + 0xc ] } _Objects_Open_u32( &_POSIX_Keys_Information, &the_key->Object, 0 ); *key = the_key->Object.id; 20063b0: c2 26 00 00 st %g1, [ %i0 ] _Thread_Enable_dispatch(); 20063b4: 40 00 0c 33 call 2009480 <_Thread_Enable_dispatch> 20063b8: b0 10 20 00 clr %i0 return 0; } 20063bc: 81 c7 e0 08 ret 20063c0: 81 e8 00 00 restore =============================================================================== 020063c4 : */ int pthread_key_delete( pthread_key_t key ) { 20063c4: 9d e3 bf 98 save %sp, -104, %sp pthread_key_t id, Objects_Locations *location ) { return (POSIX_Keys_Control *) _Objects_Get( &_POSIX_Keys_Information, (Objects_Id) id, location ); 20063c8: 21 00 80 62 sethi %hi(0x2018800), %l0 20063cc: 92 10 00 18 mov %i0, %o1 20063d0: 90 14 20 08 or %l0, 8, %o0 20063d4: 40 00 09 dd call 2008b48 <_Objects_Get> 20063d8: 94 07 bf fc add %fp, -4, %o2 register POSIX_Keys_Control *the_key; Objects_Locations location; uint32_t the_api; the_key = _POSIX_Keys_Get( key, &location ); switch ( location ) { 20063dc: c2 07 bf fc ld [ %fp + -4 ], %g1 20063e0: 80 a0 60 00 cmp %g1, 0 20063e4: 12 80 00 19 bne 2006448 20063e8: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Keys_Information, &the_key->Object ); 20063ec: 90 14 20 08 or %l0, 8, %o0 20063f0: 92 10 00 11 mov %l1, %o1 20063f4: 40 00 08 be call 20086ec <_Objects_Close> 20063f8: a0 10 20 00 clr %l0 (pthread_key_t __key, _CONST void *__value)); void * _EXFUN(pthread_getspecific, (pthread_key_t __key)); /* Thread-Specific Data Key Deletion, P1003.1c/Draft 10, p. 167 */ int _EXFUN(pthread_key_delete, (pthread_key_t __key)); 20063fc: 82 04 40 10 add %l1, %l0, %g1 for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) if ( the_key->Values[ the_api ] ) 2006400: d0 00 60 18 ld [ %g1 + 0x18 ], %o0 2006404: 80 a2 20 00 cmp %o0, 0 2006408: 02 80 00 04 be 2006418 <== NEVER TAKEN 200640c: a0 04 20 04 add %l0, 4, %l0 _Workspace_Free( the_key->Values[ the_api ] ); 2006410: 40 00 11 a7 call 200aaac <_Workspace_Free> 2006414: 01 00 00 00 nop switch ( location ) { case OBJECTS_LOCAL: _Objects_Close( &_POSIX_Keys_Information, &the_key->Object ); for ( the_api = 1; the_api <= OBJECTS_APIS_LAST; the_api++ ) 2006418: 80 a4 20 0c cmp %l0, 0xc 200641c: 12 bf ff f9 bne 2006400 2006420: 82 04 40 10 add %l1, %l0, %g1 */ RTEMS_INLINE_ROUTINE void _POSIX_Keys_Free ( POSIX_Keys_Control *the_key ) { _Objects_Free( &_POSIX_Keys_Information, &the_key->Object ); 2006424: 92 10 00 11 mov %l1, %o1 2006428: 11 00 80 62 sethi %hi(0x2018800), %o0 200642c: 90 12 20 08 or %o0, 8, %o0 ! 2018808 <_POSIX_Keys_Information> 2006430: 40 00 09 63 call 20089bc <_Objects_Free> 2006434: b0 10 20 00 clr %i0 * NOTE: The destructor is not called and it is the responsibility * of the application to free the memory. */ _POSIX_Keys_Free( the_key ); _Thread_Enable_dispatch(); 2006438: 40 00 0c 12 call 2009480 <_Thread_Enable_dispatch> 200643c: 01 00 00 00 nop return 0; 2006440: 81 c7 e0 08 ret 2006444: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return EINVAL; } 2006448: 81 c7 e0 08 ret 200644c: 91 e8 20 16 restore %g0, 0x16, %o0 =============================================================================== 02005da8 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { 2005da8: 82 10 00 08 mov %o0, %g1 if ( !attr ) 2005dac: 80 a0 60 00 cmp %g1, 0 2005db0: 02 80 00 0b be 2005ddc 2005db4: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 2005db8: c4 00 40 00 ld [ %g1 ], %g2 2005dbc: 80 a0 a0 00 cmp %g2, 0 2005dc0: 02 80 00 07 be 2005ddc 2005dc4: 80 a2 60 00 cmp %o1, 0 return EINVAL; if ( !type ) 2005dc8: 02 80 00 05 be 2005ddc <== NEVER TAKEN 2005dcc: 01 00 00 00 nop return EINVAL; *type = attr->type; 2005dd0: c2 00 60 10 ld [ %g1 + 0x10 ], %g1 return 0; 2005dd4: 90 10 20 00 clr %o0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 2005dd8: c2 22 40 00 st %g1, [ %o1 ] return 0; } 2005ddc: 81 c3 e0 08 retl =============================================================================== 02008310 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { 2008310: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 2008314: 80 a0 60 00 cmp %g1, 0 2008318: 02 80 00 0a be 2008340 200831c: 90 10 20 16 mov 0x16, %o0 2008320: c4 00 40 00 ld [ %g1 ], %g2 2008324: 80 a0 a0 00 cmp %g2, 0 2008328: 02 80 00 06 be 2008340 200832c: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 2008330: 18 80 00 04 bgu 2008340 <== NEVER TAKEN 2008334: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 2008338: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 200833c: 90 10 20 00 clr %o0 default: return EINVAL; } } 2008340: 81 c3 e0 08 retl =============================================================================== 02005e14 : #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { 2005e14: 82 10 00 08 mov %o0, %g1 if ( !attr || !attr->is_initialized ) 2005e18: 80 a0 60 00 cmp %g1, 0 2005e1c: 02 80 00 0a be 2005e44 2005e20: 90 10 20 16 mov 0x16, %o0 2005e24: c4 00 40 00 ld [ %g1 ], %g2 2005e28: 80 a0 a0 00 cmp %g2, 0 2005e2c: 02 80 00 06 be 2005e44 <== NEVER TAKEN 2005e30: 80 a2 60 03 cmp %o1, 3 return EINVAL; switch ( type ) { 2005e34: 18 80 00 04 bgu 2005e44 2005e38: 01 00 00 00 nop case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 2005e3c: d2 20 60 10 st %o1, [ %g1 + 0x10 ] return 0; 2005e40: 90 10 20 00 clr %o0 default: return EINVAL; } } 2005e44: 81 c3 e0 08 retl =============================================================================== 02006b0c : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 2006b0c: 9d e3 bf 98 save %sp, -104, %sp if ( !once_control || !init_routine ) 2006b10: 80 a6 60 00 cmp %i1, 0 2006b14: 02 80 00 1c be 2006b84 2006b18: a0 10 00 18 mov %i0, %l0 2006b1c: 80 a6 20 00 cmp %i0, 0 2006b20: 22 80 00 17 be,a 2006b7c 2006b24: b0 10 20 16 mov 0x16, %i0 return EINVAL; if ( !once_control->init_executed ) { 2006b28: c2 06 20 04 ld [ %i0 + 4 ], %g1 2006b2c: 80 a0 60 00 cmp %g1, 0 2006b30: 12 80 00 13 bne 2006b7c 2006b34: b0 10 20 00 clr %i0 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 2006b38: 90 10 21 00 mov 0x100, %o0 2006b3c: 92 10 21 00 mov 0x100, %o1 2006b40: 40 00 03 05 call 2007754 2006b44: 94 07 bf fc add %fp, -4, %o2 if ( !once_control->init_executed ) { 2006b48: c2 04 20 04 ld [ %l0 + 4 ], %g1 2006b4c: 80 a0 60 00 cmp %g1, 0 2006b50: 12 80 00 07 bne 2006b6c <== NEVER TAKEN 2006b54: d0 07 bf fc ld [ %fp + -4 ], %o0 once_control->is_initialized = true; 2006b58: 82 10 20 01 mov 1, %g1 2006b5c: c2 24 00 00 st %g1, [ %l0 ] once_control->init_executed = true; (*init_routine)(); 2006b60: 9f c6 40 00 call %i1 2006b64: c2 24 20 04 st %g1, [ %l0 + 4 ] } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 2006b68: d0 07 bf fc ld [ %fp + -4 ], %o0 2006b6c: 92 10 21 00 mov 0x100, %o1 2006b70: 94 07 bf fc add %fp, -4, %o2 2006b74: 40 00 02 f8 call 2007754 2006b78: b0 10 20 00 clr %i0 2006b7c: 81 c7 e0 08 ret 2006b80: 81 e8 00 00 restore pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) return EINVAL; 2006b84: b0 10 20 16 mov 0x16, %i0 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } 2006b88: 81 c7 e0 08 ret 2006b8c: 81 e8 00 00 restore =============================================================================== 020073d8 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 20073d8: 9d e3 bf 90 save %sp, -112, %sp 20073dc: a0 10 00 18 mov %i0, %l0 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 20073e0: 80 a4 20 00 cmp %l0, 0 20073e4: 02 80 00 1b be 2007450 20073e8: b0 10 20 16 mov 0x16, %i0 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 20073ec: 80 a6 60 00 cmp %i1, 0 20073f0: 32 80 00 06 bne,a 2007408 20073f4: c2 06 40 00 ld [ %i1 ], %g1 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 20073f8: b2 07 bf f4 add %fp, -12, %i1 20073fc: 40 00 02 6b call 2007da8 2007400: 90 10 00 19 mov %i1, %o0 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 2007404: c2 06 40 00 ld [ %i1 ], %g1 2007408: 80 a0 60 00 cmp %g1, 0 200740c: 02 80 00 11 be 2007450 <== NEVER TAKEN 2007410: b0 10 20 16 mov 0x16, %i0 return EINVAL; switch ( the_attr->process_shared ) { 2007414: c2 06 60 04 ld [ %i1 + 4 ], %g1 2007418: 80 a0 60 00 cmp %g1, 0 200741c: 12 80 00 0d bne 2007450 <== NEVER TAKEN 2007420: 03 00 80 64 sethi %hi(0x2019000), %g1 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 2007424: c4 00 62 e8 ld [ %g1 + 0x2e8 ], %g2 ! 20192e8 <_Thread_Dispatch_disable_level> 2007428: 84 00 a0 01 inc %g2 200742c: c4 20 62 e8 st %g2, [ %g1 + 0x2e8 ] * the inactive chain of free RWLock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void ) { return (POSIX_RWLock_Control *) _Objects_Allocate( &_POSIX_RWLock_Information ); 2007430: 25 00 80 65 sethi %hi(0x2019400), %l2 2007434: 40 00 09 f2 call 2009bfc <_Objects_Allocate> 2007438: 90 14 a1 40 or %l2, 0x140, %o0 ! 2019540 <_POSIX_RWLock_Information> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 200743c: a2 92 20 00 orcc %o0, 0, %l1 2007440: 12 80 00 06 bne 2007458 2007444: 90 04 60 10 add %l1, 0x10, %o0 _Thread_Enable_dispatch(); 2007448: 40 00 0d 78 call 200aa28 <_Thread_Enable_dispatch> 200744c: b0 10 20 0b mov 0xb, %i0 return EAGAIN; 2007450: 81 c7 e0 08 ret 2007454: 81 e8 00 00 restore } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 2007458: 40 00 07 92 call 20092a0 <_CORE_RWLock_Initialize> 200745c: 92 07 bf fc add %fp, -4, %o1 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 2007460: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } 2007464: a4 14 a1 40 or %l2, 0x140, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 2007468: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 200746c: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 2007470: 85 28 a0 02 sll %g2, 2, %g2 2007474: e2 20 c0 02 st %l1, [ %g3 + %g2 ] _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 2007478: c0 24 60 0c clr [ %l1 + 0xc ] &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 200747c: c2 24 00 00 st %g1, [ %l0 ] _Thread_Enable_dispatch(); 2007480: 40 00 0d 6a call 200aa28 <_Thread_Enable_dispatch> 2007484: b0 10 20 00 clr %i0 return 0; } 2007488: 81 c7 e0 08 ret 200748c: 81 e8 00 00 restore =============================================================================== 02007500 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 2007500: 9d e3 bf 98 save %sp, -104, %sp Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; 2007504: a0 10 20 16 mov 0x16, %l0 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 2007508: 80 a6 20 00 cmp %i0, 0 200750c: 02 80 00 2a be 20075b4 2007510: 90 10 00 19 mov %i1, %o0 * * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); 2007514: 40 00 1b 3e call 200e20c <_POSIX_Absolute_timeout_to_ticks> 2007518: 92 07 bf f8 add %fp, -8, %o1 200751c: d2 06 00 00 ld [ %i0 ], %o1 2007520: a2 10 00 08 mov %o0, %l1 2007524: 94 07 bf fc add %fp, -4, %o2 2007528: 11 00 80 65 sethi %hi(0x2019400), %o0 200752c: 40 00 0a f1 call 200a0f0 <_Objects_Get> 2007530: 90 12 21 40 or %o0, 0x140, %o0 ! 2019540 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 2007534: c2 07 bf fc ld [ %fp + -4 ], %g1 2007538: 80 a0 60 00 cmp %g1, 0 200753c: 12 80 00 1e bne 20075b4 2007540: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 2007544: d2 06 00 00 ld [ %i0 ], %o1 int _EXFUN(pthread_rwlock_init, (pthread_rwlock_t *__rwlock, _CONST pthread_rwlockattr_t *__attr)); int _EXFUN(pthread_rwlock_destroy, (pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_rdlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_tryrdlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_timedrdlock, 2007548: 82 1c 60 03 xor %l1, 3, %g1 200754c: 90 02 20 10 add %o0, 0x10, %o0 2007550: 80 a0 00 01 cmp %g0, %g1 2007554: 98 10 20 00 clr %o4 2007558: a4 60 3f ff subx %g0, -1, %l2 200755c: 40 00 07 5c call 20092cc <_CORE_RWLock_Obtain_for_reading> 2007560: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 2007564: 40 00 0d 31 call 200aa28 <_Thread_Enable_dispatch> 2007568: 01 00 00 00 nop if ( !do_wait ) { 200756c: 80 a4 a0 00 cmp %l2, 0 2007570: 12 80 00 0c bne 20075a0 2007574: 03 00 80 64 sethi %hi(0x2019000), %g1 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 2007578: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 ! 20193a8 <_Thread_Executing> 200757c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 2007580: 80 a0 60 02 cmp %g1, 2 2007584: 32 80 00 08 bne,a 20075a4 2007588: 03 00 80 64 sethi %hi(0x2019000), %g1 switch (status) { 200758c: 80 a4 60 00 cmp %l1, 0 2007590: 02 80 00 09 be 20075b4 <== NEVER TAKEN 2007594: 80 a4 60 02 cmp %l1, 2 2007598: 08 80 00 07 bleu 20075b4 <== ALWAYS TAKEN 200759c: a0 10 20 74 mov 0x74, %l0 } } } return _POSIX_RWLock_Translate_core_RWLock_return_code( (CORE_RWLock_Status) _Thread_Executing->Wait.return_code 20075a0: 03 00 80 64 sethi %hi(0x2019000), %g1 20075a4: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 ! 20193a8 <_Thread_Executing> break; } } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 20075a8: 40 00 00 34 call 2007678 <_POSIX_RWLock_Translate_core_RWLock_return_code> 20075ac: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 20075b0: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 20075b4: 81 c7 e0 08 ret 20075b8: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 020075bc : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 20075bc: 9d e3 bf 98 save %sp, -104, %sp Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; 20075c0: a0 10 20 16 mov 0x16, %l0 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 20075c4: 80 a6 20 00 cmp %i0, 0 20075c8: 02 80 00 2a be 2007670 20075cc: 90 10 00 19 mov %i1, %o0 * * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); 20075d0: 40 00 1b 0f call 200e20c <_POSIX_Absolute_timeout_to_ticks> 20075d4: 92 07 bf f8 add %fp, -8, %o1 20075d8: d2 06 00 00 ld [ %i0 ], %o1 20075dc: a2 10 00 08 mov %o0, %l1 20075e0: 94 07 bf fc add %fp, -4, %o2 20075e4: 11 00 80 65 sethi %hi(0x2019400), %o0 20075e8: 40 00 0a c2 call 200a0f0 <_Objects_Get> 20075ec: 90 12 21 40 or %o0, 0x140, %o0 ! 2019540 <_POSIX_RWLock_Information> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 20075f0: c2 07 bf fc ld [ %fp + -4 ], %g1 20075f4: 80 a0 60 00 cmp %g1, 0 20075f8: 12 80 00 1e bne 2007670 20075fc: d6 07 bf f8 ld [ %fp + -8 ], %o3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 2007600: d2 06 00 00 ld [ %i0 ], %o1 (pthread_rwlock_t *__rwlock, _CONST struct timespec *__abstime)); int _EXFUN(pthread_rwlock_unlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_wrlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_trywrlock,(pthread_rwlock_t *__rwlock)); int _EXFUN(pthread_rwlock_timedwrlock, 2007604: 82 1c 60 03 xor %l1, 3, %g1 2007608: 90 02 20 10 add %o0, 0x10, %o0 200760c: 80 a0 00 01 cmp %g0, %g1 2007610: 98 10 20 00 clr %o4 2007614: a4 60 3f ff subx %g0, -1, %l2 2007618: 40 00 07 61 call 200939c <_CORE_RWLock_Obtain_for_writing> 200761c: 94 10 00 12 mov %l2, %o2 do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 2007620: 40 00 0d 02 call 200aa28 <_Thread_Enable_dispatch> 2007624: 01 00 00 00 nop if ( !do_wait && 2007628: 80 a4 a0 00 cmp %l2, 0 200762c: 12 80 00 0c bne 200765c 2007630: 03 00 80 64 sethi %hi(0x2019000), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 2007634: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 ! 20193a8 <_Thread_Executing> ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 2007638: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 200763c: 80 a0 60 02 cmp %g1, 2 2007640: 32 80 00 08 bne,a 2007660 2007644: 03 00 80 64 sethi %hi(0x2019000), %g1 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { switch (status) { 2007648: 80 a4 60 00 cmp %l1, 0 200764c: 02 80 00 09 be 2007670 <== NEVER TAKEN 2007650: 80 a4 60 02 cmp %l1, 2 2007654: 08 80 00 07 bleu 2007670 <== ALWAYS TAKEN 2007658: a0 10 20 74 mov 0x74, %l0 break; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( (CORE_RWLock_Status) _Thread_Executing->Wait.return_code 200765c: 03 00 80 64 sethi %hi(0x2019000), %g1 2007660: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 ! 20193a8 <_Thread_Executing> case POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE: break; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 2007664: 40 00 00 05 call 2007678 <_POSIX_RWLock_Translate_core_RWLock_return_code> 2007668: d0 00 60 34 ld [ %g1 + 0x34 ], %o0 200766c: a0 10 00 08 mov %o0, %l0 case OBJECTS_ERROR: break; } return EINVAL; } 2007670: 81 c7 e0 08 ret 2007674: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 02007dd0 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { 2007dd0: 82 10 00 08 mov %o0, %g1 if ( !attr ) 2007dd4: 80 a0 60 00 cmp %g1, 0 2007dd8: 02 80 00 0a be 2007e00 2007ddc: 90 10 20 16 mov 0x16, %o0 return EINVAL; if ( !attr->is_initialized ) 2007de0: c4 00 40 00 ld [ %g1 ], %g2 2007de4: 80 a0 a0 00 cmp %g2, 0 2007de8: 02 80 00 06 be 2007e00 2007dec: 80 a2 60 01 cmp %o1, 1 return EINVAL; switch ( pshared ) { 2007df0: 18 80 00 04 bgu 2007e00 <== NEVER TAKEN 2007df4: 01 00 00 00 nop case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 2007df8: d2 20 60 04 st %o1, [ %g1 + 4 ] return 0; 2007dfc: 90 10 20 00 clr %o0 default: return EINVAL; } } 2007e00: 81 c3 e0 08 retl =============================================================================== 02008f34 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 2008f34: 9d e3 bf 90 save %sp, -112, %sp 2008f38: a0 10 00 18 mov %i0, %l0 int rc; /* * Check all the parameters */ if ( !param ) 2008f3c: 80 a6 a0 00 cmp %i2, 0 2008f40: 02 80 00 3f be 200903c 2008f44: b0 10 20 16 mov 0x16, %i0 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 2008f48: 90 10 00 19 mov %i1, %o0 2008f4c: 92 10 00 1a mov %i2, %o1 2008f50: 94 07 bf fc add %fp, -4, %o2 2008f54: 40 00 19 37 call 200f430 <_POSIX_Thread_Translate_sched_param> 2008f58: 96 07 bf f8 add %fp, -8, %o3 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 2008f5c: b0 92 20 00 orcc %o0, 0, %i0 2008f60: 12 80 00 37 bne 200903c 2008f64: 11 00 80 6f sethi %hi(0x201bc00), %o0 2008f68: 92 10 00 10 mov %l0, %o1 2008f6c: 90 12 20 10 or %o0, 0x10, %o0 2008f70: 40 00 08 47 call 200b08c <_Objects_Get> 2008f74: 94 07 bf f4 add %fp, -12, %o2 /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 2008f78: c2 07 bf f4 ld [ %fp + -12 ], %g1 2008f7c: 80 a0 60 00 cmp %g1, 0 2008f80: 12 80 00 31 bne 2009044 2008f84: a2 10 00 08 mov %o0, %l1 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 2008f88: e0 02 21 6c ld [ %o0 + 0x16c ], %l0 if ( api->schedpolicy == SCHED_SPORADIC ) 2008f8c: c2 04 20 80 ld [ %l0 + 0x80 ], %g1 2008f90: 80 a0 60 04 cmp %g1, 4 2008f94: 32 80 00 05 bne,a 2008fa8 2008f98: f2 24 20 80 st %i1, [ %l0 + 0x80 ] (void) _Watchdog_Remove( &api->Sporadic_timer ); 2008f9c: 40 00 0f c3 call 200cea8 <_Watchdog_Remove> 2008fa0: 90 04 20 a4 add %l0, 0xa4, %o0 api->schedpolicy = policy; 2008fa4: f2 24 20 80 st %i1, [ %l0 + 0x80 ] api->schedparam = *param; 2008fa8: 90 04 20 84 add %l0, 0x84, %o0 2008fac: 92 10 00 1a mov %i2, %o1 2008fb0: 40 00 26 43 call 20128bc 2008fb4: 94 10 20 1c mov 0x1c, %o2 the_thread->budget_algorithm = budget_algorithm; 2008fb8: c2 07 bf fc ld [ %fp + -4 ], %g1 the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 2008fbc: 80 a6 60 00 cmp %i1, 0 if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; 2008fc0: c2 24 60 7c st %g1, [ %l1 + 0x7c ] the_thread->budget_callout = budget_callout; 2008fc4: c2 07 bf f8 ld [ %fp + -8 ], %g1 switch ( api->schedpolicy ) { 2008fc8: 06 80 00 1b bl 2009034 <== NEVER TAKEN 2008fcc: c2 24 60 80 st %g1, [ %l1 + 0x80 ] 2008fd0: 80 a6 60 02 cmp %i1, 2 2008fd4: 04 80 00 07 ble 2008ff0 2008fd8: 03 00 80 6e sethi %hi(0x201b800), %g1 2008fdc: 80 a6 60 04 cmp %i1, 4 2008fe0: 12 80 00 15 bne 2009034 <== NEVER TAKEN 2008fe4: 01 00 00 00 nop true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 2008fe8: 10 80 00 0d b 200901c 2008fec: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 2008ff0: c2 00 60 d8 ld [ %g1 + 0xd8 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 2008ff4: 90 10 00 11 mov %l1, %o0 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 2008ff8: c2 24 60 78 st %g1, [ %l1 + 0x78 ] 2008ffc: 03 00 80 6b sethi %hi(0x201ac00), %g1 2009000: d2 08 62 28 ldub [ %g1 + 0x228 ], %o1 ! 201ae28 2009004: c2 04 20 84 ld [ %l0 + 0x84 ], %g1 the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 2009008: 94 10 20 01 mov 1, %o2 200900c: 92 22 40 01 sub %o1, %g1, %o1 2009010: 40 00 08 e8 call 200b3b0 <_Thread_Change_priority> 2009014: d2 24 60 18 st %o1, [ %l1 + 0x18 ] the_thread, the_thread->real_priority, true ); break; 2009018: 30 80 00 07 b,a 2009034 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; _Watchdog_Remove( &api->Sporadic_timer ); 200901c: 90 04 20 a4 add %l0, 0xa4, %o0 2009020: 40 00 0f a2 call 200cea8 <_Watchdog_Remove> 2009024: c2 24 20 a0 st %g1, [ %l0 + 0xa0 ] _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 2009028: 90 10 20 00 clr %o0 200902c: 7f ff ff 7c call 2008e1c <_POSIX_Threads_Sporadic_budget_TSR> 2009030: 92 10 00 11 mov %l1, %o1 break; } _Thread_Enable_dispatch(); 2009034: 40 00 0a 64 call 200b9c4 <_Thread_Enable_dispatch> 2009038: 01 00 00 00 nop return 0; 200903c: 81 c7 e0 08 ret 2009040: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return ESRCH; 2009044: b0 10 20 03 mov 3, %i0 } 2009048: 81 c7 e0 08 ret 200904c: 81 e8 00 00 restore =============================================================================== 020067ac : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 20067ac: 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() ) 20067b0: 03 00 80 5f sethi %hi(0x2017c00), %g1 20067b4: c2 00 63 84 ld [ %g1 + 0x384 ], %g1 ! 2017f84 <_ISR_Nest_level> 20067b8: 80 a0 60 00 cmp %g1, 0 20067bc: 12 80 00 19 bne 2006820 <== NEVER TAKEN 20067c0: 01 00 00 00 nop 20067c4: 05 00 80 5f sethi %hi(0x2017c00), %g2 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 20067c8: 03 00 80 5f sethi %hi(0x2017c00), %g1 20067cc: c6 00 a2 e8 ld [ %g2 + 0x2e8 ], %g3 20067d0: c2 00 63 a8 ld [ %g1 + 0x3a8 ], %g1 20067d4: 86 00 e0 01 inc %g3 20067d8: c2 00 61 6c ld [ %g1 + 0x16c ], %g1 20067dc: c6 20 a2 e8 st %g3, [ %g2 + 0x2e8 ] _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 20067e0: c4 00 60 d4 ld [ %g1 + 0xd4 ], %g2 20067e4: 80 a0 a0 00 cmp %g2, 0 20067e8: 12 80 00 05 bne 20067fc <== NEVER TAKEN 20067ec: a0 10 20 00 clr %l0 /* Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ int _EXFUN(pthread_setcancelstate, (int __state, int *__oldstate)); int _EXFUN(pthread_setcanceltype, (int __type, int *__oldtype)); void _EXFUN(pthread_testcancel, (void)); 20067f0: c2 00 60 dc ld [ %g1 + 0xdc ], %g1 20067f4: 80 a0 00 01 cmp %g0, %g1 20067f8: a0 40 20 00 addx %g0, 0, %l0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 20067fc: 40 00 0a 37 call 20090d8 <_Thread_Enable_dispatch> 2006800: 01 00 00 00 nop if ( cancel ) 2006804: 80 8c 20 ff btst 0xff, %l0 2006808: 02 80 00 06 be 2006820 200680c: 01 00 00 00 nop _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 2006810: 03 00 80 5f sethi %hi(0x2017c00), %g1 2006814: f0 00 63 a8 ld [ %g1 + 0x3a8 ], %i0 ! 2017fa8 <_Thread_Executing> 2006818: 40 00 19 12 call 200cc60 <_POSIX_Thread_Exit> 200681c: 93 e8 3f ff restore %g0, -1, %o1 2006820: 81 c7 e0 08 ret 2006824: 81 e8 00 00 restore =============================================================================== 02009328 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 2009328: 9d e3 bf a0 save %sp, -96, %sp uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 200932c: 80 a6 20 00 cmp %i0, 0 2009330: 02 80 00 1d be 20093a4 <== NEVER TAKEN 2009334: 21 00 80 9d sethi %hi(0x2027400), %l0 2009338: a0 14 20 04 or %l0, 4, %l0 ! 2027404 <_Objects_Information_table+0x4> #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 200933c: a6 04 20 0c add %l0, 0xc, %l3 if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { if ( !_Objects_Information_table[ api_index ] ) 2009340: c2 04 00 00 ld [ %l0 ], %g1 2009344: 80 a0 60 00 cmp %g1, 0 2009348: 22 80 00 14 be,a 2009398 <== NEVER TAKEN 200934c: a0 04 20 04 add %l0, 4, %l0 <== NOT EXECUTED continue; information = _Objects_Information_table[ api_index ][ 1 ]; 2009350: e4 00 60 04 ld [ %g1 + 4 ], %l2 if ( !information ) 2009354: 80 a4 a0 00 cmp %l2, 0 2009358: 12 80 00 0b bne 2009384 200935c: a2 10 20 01 mov 1, %l1 continue; for ( i=1 ; i <= information->maximum ; i++ ) { 2009360: 10 80 00 0e b 2009398 2009364: a0 04 20 04 add %l0, 4, %l0 the_thread = (Thread_Control *)information->local_table[ i ]; 2009368: 83 2c 60 02 sll %l1, 2, %g1 200936c: d0 00 80 01 ld [ %g2 + %g1 ], %o0 if ( !the_thread ) 2009370: 80 a2 20 00 cmp %o0, 0 2009374: 02 80 00 04 be 2009384 2009378: a2 04 60 01 inc %l1 continue; (*routine)(the_thread); 200937c: 9f c6 00 00 call %i0 2009380: 01 00 00 00 nop information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 2009384: c2 14 a0 10 lduh [ %l2 + 0x10 ], %g1 2009388: 80 a4 40 01 cmp %l1, %g1 200938c: 28 bf ff f7 bleu,a 2009368 2009390: c4 04 a0 1c ld [ %l2 + 0x1c ], %g2 2009394: a0 04 20 04 add %l0, 4, %l0 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 2009398: 80 a4 00 13 cmp %l0, %l3 200939c: 32 bf ff ea bne,a 2009344 20093a0: c2 04 00 00 ld [ %l0 ], %g1 20093a4: 81 c7 e0 08 ret 20093a8: 81 e8 00 00 restore =============================================================================== 02014524 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 2014524: 9d e3 bf a0 save %sp, -96, %sp 2014528: a0 10 00 18 mov %i0, %l0 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 201452c: 80 a4 20 00 cmp %l0, 0 2014530: 02 80 00 1f be 20145ac 2014534: b0 10 20 03 mov 3, %i0 return RTEMS_INVALID_NAME; if ( !starting_address ) 2014538: 80 a6 60 00 cmp %i1, 0 201453c: 02 80 00 1c be 20145ac 2014540: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !id ) 2014544: 80 a7 60 00 cmp %i5, 0 2014548: 02 80 00 19 be 20145ac <== NEVER TAKEN 201454c: 80 a6 e0 00 cmp %i3, 0 return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 2014550: 02 80 00 32 be 2014618 2014554: 80 a6 a0 00 cmp %i2, 0 2014558: 02 80 00 30 be 2014618 201455c: 80 a6 80 1b cmp %i2, %i3 2014560: 0a 80 00 13 bcs 20145ac 2014564: b0 10 20 08 mov 8, %i0 2014568: 80 8e e0 07 btst 7, %i3 201456c: 12 80 00 10 bne 20145ac 2014570: 80 8e 60 07 btst 7, %i1 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 2014574: 12 80 00 0e bne 20145ac 2014578: b0 10 20 09 mov 9, %i0 201457c: 03 00 80 f6 sethi %hi(0x203d800), %g1 2014580: c4 00 60 08 ld [ %g1 + 8 ], %g2 ! 203d808 <_Thread_Dispatch_disable_level> 2014584: 84 00 a0 01 inc %g2 2014588: c4 20 60 08 st %g2, [ %g1 + 8 ] * 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 ); 201458c: 25 00 80 f5 sethi %hi(0x203d400), %l2 2014590: 40 00 12 8a call 2018fb8 <_Objects_Allocate> 2014594: 90 14 a2 14 or %l2, 0x214, %o0 ! 203d614 <_Partition_Information> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 2014598: a2 92 20 00 orcc %o0, 0, %l1 201459c: 12 80 00 06 bne 20145b4 20145a0: 92 10 00 1b mov %i3, %o1 _Thread_Enable_dispatch(); 20145a4: 40 00 16 4e call 2019edc <_Thread_Enable_dispatch> 20145a8: b0 10 20 05 mov 5, %i0 return RTEMS_TOO_MANY; 20145ac: 81 c7 e0 08 ret 20145b0: 81 e8 00 00 restore _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 20145b4: f2 24 60 10 st %i1, [ %l1 + 0x10 ] the_partition->length = length; 20145b8: f4 24 60 14 st %i2, [ %l1 + 0x14 ] the_partition->buffer_size = buffer_size; 20145bc: f6 24 60 18 st %i3, [ %l1 + 0x18 ] the_partition->attribute_set = attribute_set; 20145c0: f8 24 60 1c st %i4, [ %l1 + 0x1c ] the_partition->number_of_used_blocks = 0; 20145c4: c0 24 60 20 clr [ %l1 + 0x20 ] _Chain_Initialize( &the_partition->Memory, starting_address, length / buffer_size, buffer_size ); 20145c8: 40 00 63 73 call 202d394 <.udiv> 20145cc: 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, 20145d0: 92 10 00 19 mov %i1, %o1 length / buffer_size, buffer_size ); 20145d4: 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, 20145d8: 96 10 00 1b mov %i3, %o3 20145dc: a6 04 60 24 add %l1, 0x24, %l3 20145e0: 40 00 0c 6b call 201778c <_Chain_Initialize> 20145e4: 90 10 00 13 mov %l3, %o0 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 20145e8: c4 14 60 0a lduh [ %l1 + 0xa ], %g2 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 20145ec: a4 14 a2 14 or %l2, 0x214, %l2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 20145f0: c6 04 a0 1c ld [ %l2 + 0x1c ], %g3 Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( 20145f4: c2 04 60 08 ld [ %l1 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 20145f8: 85 28 a0 02 sll %g2, 2, %g2 20145fc: e2 20 c0 02 st %l1, [ %g3 + %g2 ] information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 2014600: e0 24 60 0c st %l0, [ %l1 + 0xc ] &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 2014604: c2 27 40 00 st %g1, [ %i5 ] name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 2014608: 40 00 16 35 call 2019edc <_Thread_Enable_dispatch> 201460c: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 2014610: 81 c7 e0 08 ret 2014614: 81 e8 00 00 restore if ( !id ) return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; 2014618: b0 10 20 08 mov 8, %i0 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } 201461c: 81 c7 e0 08 ret 2014620: 81 e8 00 00 restore =============================================================================== 0200755c : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 200755c: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); 2007560: 11 00 80 7b sethi %hi(0x201ec00), %o0 2007564: 92 10 00 18 mov %i0, %o1 2007568: 90 12 20 64 or %o0, 0x64, %o0 200756c: 40 00 09 0b call 2009998 <_Objects_Get> 2007570: 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 ) { 2007574: c2 07 bf fc ld [ %fp + -4 ], %g1 2007578: 80 a0 60 00 cmp %g1, 0 200757c: 12 80 00 64 bne 200770c 2007580: a0 10 00 08 mov %o0, %l0 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 2007584: 25 00 80 7b sethi %hi(0x201ec00), %l2 2007588: c4 02 20 40 ld [ %o0 + 0x40 ], %g2 200758c: c2 04 a2 98 ld [ %l2 + 0x298 ], %g1 2007590: 80 a0 80 01 cmp %g2, %g1 2007594: 02 80 00 06 be 20075ac 2007598: 80 a6 60 00 cmp %i1, 0 _Thread_Enable_dispatch(); 200759c: 40 00 0b 79 call 200a380 <_Thread_Enable_dispatch> 20075a0: b0 10 20 17 mov 0x17, %i0 return RTEMS_NOT_OWNER_OF_RESOURCE; 20075a4: 81 c7 e0 08 ret 20075a8: 81 e8 00 00 restore } if ( length == RTEMS_PERIOD_STATUS ) { 20075ac: 12 80 00 0e bne 20075e4 20075b0: 01 00 00 00 nop switch ( the_period->state ) { 20075b4: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 20075b8: 80 a0 60 04 cmp %g1, 4 20075bc: 18 80 00 06 bgu 20075d4 <== NEVER TAKEN 20075c0: b0 10 20 00 clr %i0 20075c4: 83 28 60 02 sll %g1, 2, %g1 20075c8: 05 00 80 73 sethi %hi(0x201cc00), %g2 20075cc: 84 10 a0 54 or %g2, 0x54, %g2 ! 201cc54 20075d0: f0 00 80 01 ld [ %g2 + %g1 ], %i0 case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); 20075d4: 40 00 0b 6b call 200a380 <_Thread_Enable_dispatch> 20075d8: 01 00 00 00 nop return( return_value ); 20075dc: 81 c7 e0 08 ret 20075e0: 81 e8 00 00 restore } _ISR_Disable( level ); 20075e4: 7f ff ee bc call 20030d4 20075e8: 01 00 00 00 nop 20075ec: a6 10 00 08 mov %o0, %l3 switch ( the_period->state ) { 20075f0: e2 04 20 38 ld [ %l0 + 0x38 ], %l1 20075f4: 80 a4 60 02 cmp %l1, 2 20075f8: 02 80 00 19 be 200765c 20075fc: 80 a4 60 04 cmp %l1, 4 2007600: 02 80 00 32 be 20076c8 2007604: 80 a4 60 00 cmp %l1, 0 2007608: 12 80 00 43 bne 2007714 <== NEVER TAKEN 200760c: 01 00 00 00 nop case RATE_MONOTONIC_INACTIVE: { _ISR_Enable( level ); 2007610: 7f ff ee b5 call 20030e4 2007614: 01 00 00 00 nop /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 2007618: 7f ff ff 77 call 20073f4 <_Rate_monotonic_Initiate_statistics> 200761c: 90 10 00 10 mov %l0, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 2007620: 82 10 20 02 mov 2, %g1 2007624: c2 24 20 38 st %g1, [ %l0 + 0x38 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 2007628: 03 00 80 1e sethi %hi(0x2007800), %g1 200762c: 82 10 61 e0 or %g1, 0x1e0, %g1 ! 20079e0 <_Rate_monotonic_Timeout> Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 2007630: c0 24 20 18 clr [ %l0 + 0x18 ] the_watchdog->routine = routine; 2007634: c2 24 20 2c st %g1, [ %l0 + 0x2c ] the_watchdog->id = id; 2007638: f0 24 20 30 st %i0, [ %l0 + 0x30 ] the_watchdog->user_data = user_data; 200763c: c0 24 20 34 clr [ %l0 + 0x34 ] _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 2007640: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 2007644: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 2007648: 11 00 80 7b sethi %hi(0x201ec00), %o0 200764c: 92 04 20 10 add %l0, 0x10, %o1 2007650: 40 00 10 90 call 200b890 <_Watchdog_Insert> 2007654: 90 12 22 b8 or %o0, 0x2b8, %o0 2007658: 30 80 00 18 b,a 20076b8 case RATE_MONOTONIC_ACTIVE: /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 200765c: 7f ff ff 82 call 2007464 <_Rate_monotonic_Update_statistics> 2007660: 90 10 00 10 mov %l0, %o0 /* * This tells the _Rate_monotonic_Timeout that this task is * in the process of blocking on the period and that we * may be changing the length of the next period. */ the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; 2007664: 82 10 20 01 mov 1, %g1 the_period->next_length = length; 2007668: f2 24 20 3c st %i1, [ %l0 + 0x3c ] /* * This tells the _Rate_monotonic_Timeout that this task is * in the process of blocking on the period and that we * may be changing the length of the next period. */ the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; 200766c: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; _ISR_Enable( level ); 2007670: 7f ff ee 9d call 20030e4 2007674: 90 10 00 13 mov %l3, %o0 _Thread_Executing->Wait.id = the_period->Object.id; 2007678: d0 04 a2 98 ld [ %l2 + 0x298 ], %o0 200767c: c2 04 20 08 ld [ %l0 + 8 ], %g1 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 2007680: 13 00 00 10 sethi %hi(0x4000), %o1 2007684: 40 00 0d b9 call 200ad68 <_Thread_Set_state> 2007688: c2 22 20 20 st %g1, [ %o0 + 0x20 ] /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 200768c: 7f ff ee 92 call 20030d4 2007690: 01 00 00 00 nop local_state = the_period->state; 2007694: e6 04 20 38 ld [ %l0 + 0x38 ], %l3 the_period->state = RATE_MONOTONIC_ACTIVE; 2007698: e2 24 20 38 st %l1, [ %l0 + 0x38 ] _ISR_Enable( level ); 200769c: 7f ff ee 92 call 20030e4 20076a0: 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 ) 20076a4: 80 a4 e0 03 cmp %l3, 3 20076a8: 12 80 00 04 bne 20076b8 20076ac: d0 04 a2 98 ld [ %l2 + 0x298 ], %o0 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 20076b0: 40 00 0a 2a call 2009f58 <_Thread_Clear_state> 20076b4: 13 00 00 10 sethi %hi(0x4000), %o1 _Thread_Enable_dispatch(); 20076b8: 40 00 0b 32 call 200a380 <_Thread_Enable_dispatch> 20076bc: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 20076c0: 81 c7 e0 08 ret 20076c4: 81 e8 00 00 restore case RATE_MONOTONIC_EXPIRED: /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 20076c8: 7f ff ff 67 call 2007464 <_Rate_monotonic_Update_statistics> 20076cc: 90 10 00 10 mov %l0, %o0 _ISR_Enable( level ); 20076d0: 7f ff ee 85 call 20030e4 20076d4: 90 10 00 13 mov %l3, %o0 the_period->state = RATE_MONOTONIC_ACTIVE; 20076d8: 82 10 20 02 mov 2, %g1 20076dc: 92 04 20 10 add %l0, 0x10, %o1 20076e0: 11 00 80 7b sethi %hi(0x201ec00), %o0 20076e4: 90 12 22 b8 or %o0, 0x2b8, %o0 ! 201eeb8 <_Watchdog_Ticks_chain> 20076e8: c2 24 20 38 st %g1, [ %l0 + 0x38 ] the_period->next_length = length; 20076ec: f2 24 20 3c st %i1, [ %l0 + 0x3c ] Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 20076f0: f2 24 20 1c st %i1, [ %l0 + 0x1c ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 20076f4: 40 00 10 67 call 200b890 <_Watchdog_Insert> 20076f8: b0 10 20 06 mov 6, %i0 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 20076fc: 40 00 0b 21 call 200a380 <_Thread_Enable_dispatch> 2007700: 01 00 00 00 nop return RTEMS_TIMEOUT; 2007704: 81 c7 e0 08 ret 2007708: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 200770c: 81 c7 e0 08 ret 2007710: 91 e8 20 04 restore %g0, 4, %o0 } 2007714: 81 c7 e0 08 ret <== NOT EXECUTED 2007718: 91 e8 20 04 restore %g0, 4, %o0 <== NOT EXECUTED =============================================================================== 0200771c : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 200771c: 9d e3 bf 30 save %sp, -208, %sp rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) 2007720: 80 a6 60 00 cmp %i1, 0 2007724: 02 80 00 79 be 2007908 <== NEVER TAKEN 2007728: 90 10 00 18 mov %i0, %o0 return; (*print)( context, "Period information by period\n" ); 200772c: 13 00 80 73 sethi %hi(0x201cc00), %o1 2007730: 9f c6 40 00 call %i1 2007734: 92 12 60 68 or %o1, 0x68, %o1 ! 201cc68 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 2007738: 90 10 00 18 mov %i0, %o0 200773c: 13 00 80 73 sethi %hi(0x201cc00), %o1 2007740: 9f c6 40 00 call %i1 2007744: 92 12 60 88 or %o1, 0x88, %o1 ! 201cc88 (*print)( context, "--- Wall times are in seconds ---\n" ); 2007748: 90 10 00 18 mov %i0, %o0 200774c: 13 00 80 73 sethi %hi(0x201cc00), %o1 2007750: 9f c6 40 00 call %i1 2007754: 92 12 60 b0 or %o1, 0xb0, %o1 ! 201ccb0 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 2007758: 90 10 00 18 mov %i0, %o0 200775c: 13 00 80 73 sethi %hi(0x201cc00), %o1 2007760: 9f c6 40 00 call %i1 2007764: 92 12 60 d8 or %o1, 0xd8, %o1 ! 201ccd8 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 2007768: 90 10 00 18 mov %i0, %o0 200776c: 13 00 80 73 sethi %hi(0x201cc00), %o1 2007770: 9f c6 40 00 call %i1 2007774: 92 12 61 28 or %o1, 0x128, %o1 ! 201cd28 /* * 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 ; 2007778: 3b 00 80 7b sethi %hi(0x201ec00), %i5 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, 200777c: 2b 00 80 73 sethi %hi(0x201cc00), %l5 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 2007780: 82 17 60 64 or %i5, 0x64, %g1 struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); (*print)( context, 2007784: 27 00 80 73 sethi %hi(0x201cc00), %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, 2007788: 35 00 80 73 sethi %hi(0x201cc00), %i2 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 200778c: e0 00 60 08 ld [ %g1 + 8 ], %l0 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 2007790: ae 07 bf a0 add %fp, -96, %l7 if ( status != RTEMS_SUCCESSFUL ) continue; /* If the above passed, so should this but check it anyway */ status = rtems_rate_monotonic_get_status( id, &the_status ); 2007794: ac 07 bf d8 add %fp, -40, %l6 #if defined(RTEMS_DEBUG) if ( status != RTEMS_SUCCESSFUL ) continue; #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 2007798: a4 07 bf f8 add %fp, -8, %l2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 200779c: aa 15 61 78 or %l5, 0x178, %l5 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; 20077a0: a8 07 bf b8 add %fp, -72, %l4 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 20077a4: a2 07 bf f0 add %fp, -16, %l1 (*print)( context, 20077a8: a6 14 e1 90 or %l3, 0x190, %l3 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; 20077ac: b8 07 bf d0 add %fp, -48, %i4 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 20077b0: 10 80 00 52 b 20078f8 20077b4: b4 16 a1 b0 or %i2, 0x1b0, %i2 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 20077b8: 40 00 1a f1 call 200e37c 20077bc: 92 10 00 17 mov %l7, %o1 if ( status != RTEMS_SUCCESSFUL ) 20077c0: 80 a2 20 00 cmp %o0, 0 20077c4: 32 80 00 4c bne,a 20078f4 20077c8: a0 04 20 01 inc %l0 continue; /* If the above passed, so should this but check it anyway */ status = rtems_rate_monotonic_get_status( id, &the_status ); 20077cc: 92 10 00 16 mov %l6, %o1 20077d0: 40 00 1b 18 call 200e430 20077d4: 90 10 00 10 mov %l0, %o0 #if defined(RTEMS_DEBUG) if ( status != RTEMS_SUCCESSFUL ) continue; #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 20077d8: d0 07 bf d8 ld [ %fp + -40 ], %o0 20077dc: 92 10 20 05 mov 5, %o1 20077e0: 40 00 00 ae call 2007a98 20077e4: 94 10 00 12 mov %l2, %o2 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 20077e8: d8 1f bf a0 ldd [ %fp + -96 ], %o4 20077ec: 92 10 00 15 mov %l5, %o1 20077f0: 90 10 00 18 mov %i0, %o0 20077f4: 94 10 00 10 mov %l0, %o2 20077f8: 9f c6 40 00 call %i1 20077fc: 96 10 00 12 mov %l2, %o3 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 2007800: d2 07 bf a0 ld [ %fp + -96 ], %o1 2007804: 80 a2 60 00 cmp %o1, 0 2007808: 12 80 00 08 bne 2007828 200780c: 94 10 00 11 mov %l1, %o2 (*print)( context, "\n" ); 2007810: 90 10 00 18 mov %i0, %o0 2007814: 13 00 80 6f sethi %hi(0x201bc00), %o1 2007818: 9f c6 40 00 call %i1 200781c: 92 12 63 48 or %o1, 0x348, %o1 ! 201bf48 <_rodata_start+0x158> continue; 2007820: 10 80 00 35 b 20078f4 2007824: a0 04 20 01 inc %l0 struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 2007828: 40 00 0e fa call 200b410 <_Timespec_Divide_by_integer> 200782c: 90 10 00 14 mov %l4, %o0 (*print)( context, 2007830: d0 07 bf ac ld [ %fp + -84 ], %o0 2007834: 40 00 48 5c call 20199a4 <.div> 2007838: 92 10 23 e8 mov 0x3e8, %o1 200783c: 96 10 00 08 mov %o0, %o3 2007840: d0 07 bf b4 ld [ %fp + -76 ], %o0 2007844: d6 27 bf 9c st %o3, [ %fp + -100 ] 2007848: 40 00 48 57 call 20199a4 <.div> 200784c: 92 10 23 e8 mov 0x3e8, %o1 2007850: c2 07 bf f0 ld [ %fp + -16 ], %g1 2007854: b6 10 00 08 mov %o0, %i3 2007858: d0 07 bf f4 ld [ %fp + -12 ], %o0 200785c: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 2007860: 40 00 48 51 call 20199a4 <.div> 2007864: 92 10 23 e8 mov 0x3e8, %o1 2007868: d8 07 bf b0 ld [ %fp + -80 ], %o4 200786c: d6 07 bf 9c ld [ %fp + -100 ], %o3 2007870: d4 07 bf a8 ld [ %fp + -88 ], %o2 2007874: 9a 10 00 1b mov %i3, %o5 2007878: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 200787c: 92 10 00 13 mov %l3, %o1 2007880: 9f c6 40 00 call %i1 2007884: 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); 2007888: d2 07 bf a0 ld [ %fp + -96 ], %o1 200788c: 94 10 00 11 mov %l1, %o2 2007890: 40 00 0e e0 call 200b410 <_Timespec_Divide_by_integer> 2007894: 90 10 00 1c mov %i4, %o0 (*print)( context, 2007898: d0 07 bf c4 ld [ %fp + -60 ], %o0 200789c: 40 00 48 42 call 20199a4 <.div> 20078a0: 92 10 23 e8 mov 0x3e8, %o1 20078a4: 96 10 00 08 mov %o0, %o3 20078a8: d0 07 bf cc ld [ %fp + -52 ], %o0 20078ac: d6 27 bf 9c st %o3, [ %fp + -100 ] 20078b0: 40 00 48 3d call 20199a4 <.div> 20078b4: 92 10 23 e8 mov 0x3e8, %o1 20078b8: c2 07 bf f0 ld [ %fp + -16 ], %g1 20078bc: b6 10 00 08 mov %o0, %i3 20078c0: d0 07 bf f4 ld [ %fp + -12 ], %o0 20078c4: 92 10 23 e8 mov 0x3e8, %o1 20078c8: 40 00 48 37 call 20199a4 <.div> 20078cc: c2 23 a0 5c st %g1, [ %sp + 0x5c ] 20078d0: d4 07 bf c0 ld [ %fp + -64 ], %o2 20078d4: d6 07 bf 9c ld [ %fp + -100 ], %o3 20078d8: d8 07 bf c8 ld [ %fp + -56 ], %o4 20078dc: d0 23 a0 60 st %o0, [ %sp + 0x60 ] 20078e0: 92 10 00 1a mov %i2, %o1 20078e4: 90 10 00 18 mov %i0, %o0 20078e8: 9f c6 40 00 call %i1 20078ec: 9a 10 00 1b mov %i3, %o5 * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; id++ ) { 20078f0: a0 04 20 01 inc %l0 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; id <= _Rate_monotonic_Information.maximum_id ; 20078f4: 82 17 60 64 or %i5, 0x64, %g1 /* * Cycle through all possible ids and try to report on each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; 20078f8: c2 00 60 0c ld [ %g1 + 0xc ], %g1 20078fc: 80 a4 00 01 cmp %l0, %g1 2007900: 08 bf ff ae bleu 20077b8 2007904: 90 10 00 10 mov %l0, %o0 2007908: 81 c7 e0 08 ret 200790c: 81 e8 00 00 restore =============================================================================== 02015ac8 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 2015ac8: 9d e3 bf 98 save %sp, -104, %sp 2015acc: 90 10 00 18 mov %i0, %o0 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 2015ad0: 80 a6 60 00 cmp %i1, 0 2015ad4: 02 80 00 2f be 2015b90 2015ad8: b0 10 20 0a mov 0xa, %i0 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 2015adc: 40 00 11 21 call 2019f60 <_Thread_Get> 2015ae0: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 2015ae4: c2 07 bf fc ld [ %fp + -4 ], %g1 ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 2015ae8: a2 10 00 08 mov %o0, %l1 switch ( location ) { 2015aec: 80 a0 60 00 cmp %g1, 0 2015af0: 12 80 00 28 bne 2015b90 2015af4: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 2015af8: e0 02 21 68 ld [ %o0 + 0x168 ], %l0 asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 2015afc: c2 04 20 0c ld [ %l0 + 0xc ], %g1 2015b00: 80 a0 60 00 cmp %g1, 0 2015b04: 02 80 00 25 be 2015b98 2015b08: 01 00 00 00 nop if ( asr->is_enabled ) { 2015b0c: c2 0c 20 08 ldub [ %l0 + 8 ], %g1 2015b10: 80 a0 60 00 cmp %g1, 0 2015b14: 02 80 00 16 be 2015b6c 2015b18: 01 00 00 00 nop rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 2015b1c: 7f ff e7 88 call 200f93c 2015b20: 01 00 00 00 nop *signal_set |= signals; 2015b24: c2 04 20 14 ld [ %l0 + 0x14 ], %g1 2015b28: b2 10 40 19 or %g1, %i1, %i1 2015b2c: f2 24 20 14 st %i1, [ %l0 + 0x14 ] _ISR_Enable( _level ); 2015b30: 7f ff e7 87 call 200f94c 2015b34: 01 00 00 00 nop _ASR_Post_signals( signal_set, &asr->signals_posted ); the_thread->do_post_task_switch_extension = true; if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 2015b38: 05 00 80 f6 sethi %hi(0x203d800), %g2 2015b3c: c4 00 a0 a4 ld [ %g2 + 0xa4 ], %g2 ! 203d8a4 <_ISR_Nest_level> if ( ! _ASR_Is_null_handler( asr->handler ) ) { if ( asr->is_enabled ) { _ASR_Post_signals( signal_set, &asr->signals_posted ); the_thread->do_post_task_switch_extension = true; 2015b40: 82 10 20 01 mov 1, %g1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 2015b44: 80 a0 a0 00 cmp %g2, 0 2015b48: 02 80 00 10 be 2015b88 2015b4c: c2 2c 60 74 stb %g1, [ %l1 + 0x74 ] 2015b50: 05 00 80 f6 sethi %hi(0x203d800), %g2 2015b54: c4 00 a0 c8 ld [ %g2 + 0xc8 ], %g2 ! 203d8c8 <_Thread_Executing> 2015b58: 80 a4 40 02 cmp %l1, %g2 2015b5c: 12 80 00 0b bne 2015b88 <== NEVER TAKEN 2015b60: 05 00 80 f6 sethi %hi(0x203d800), %g2 _ISR_Signals_to_thread_executing = true; 2015b64: 10 80 00 09 b 2015b88 2015b68: c2 28 a1 68 stb %g1, [ %g2 + 0x168 ] ! 203d968 <_ISR_Signals_to_thread_executing> rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 2015b6c: 7f ff e7 74 call 200f93c 2015b70: 01 00 00 00 nop *signal_set |= signals; 2015b74: c2 04 20 18 ld [ %l0 + 0x18 ], %g1 2015b78: b2 10 40 19 or %g1, %i1, %i1 2015b7c: f2 24 20 18 st %i1, [ %l0 + 0x18 ] _ISR_Enable( _level ); 2015b80: 7f ff e7 73 call 200f94c 2015b84: 01 00 00 00 nop } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 2015b88: 40 00 10 d5 call 2019edc <_Thread_Enable_dispatch> 2015b8c: b0 10 20 00 clr %i0 ! 0 return RTEMS_SUCCESSFUL; 2015b90: 81 c7 e0 08 ret 2015b94: 81 e8 00 00 restore } _Thread_Enable_dispatch(); 2015b98: 40 00 10 d1 call 2019edc <_Thread_Enable_dispatch> 2015b9c: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; 2015ba0: 81 c7 e0 08 ret 2015ba4: 81 e8 00 00 restore =============================================================================== 0200e63c : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 200e63c: 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 ) 200e640: 80 a6 a0 00 cmp %i2, 0 200e644: 02 80 00 53 be 200e790 200e648: a0 10 20 09 mov 9, %l0 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 200e64c: 03 00 80 58 sethi %hi(0x2016000), %g1 200e650: e0 00 62 08 ld [ %g1 + 0x208 ], %l0 ! 2016208 <_Thread_Executing> api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 200e654: c2 0c 20 75 ldub [ %l0 + 0x75 ], %g1 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 200e658: e2 04 21 68 ld [ %l0 + 0x168 ], %l1 asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 200e65c: 80 a0 00 01 cmp %g0, %g1 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 200e660: c2 04 20 7c ld [ %l0 + 0x7c ], %g1 executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 200e664: a4 60 3f ff subx %g0, -1, %l2 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 200e668: 80 a0 60 00 cmp %g1, 0 200e66c: 02 80 00 03 be 200e678 200e670: a5 2c a0 08 sll %l2, 8, %l2 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 200e674: a4 14 a2 00 or %l2, 0x200, %l2 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 200e678: c2 0c 60 08 ldub [ %l1 + 8 ], %g1 200e67c: 80 a0 00 01 cmp %g0, %g1 old_mode |= _ISR_Get_level(); 200e680: 7f ff ee 7c call 200a070 <_CPU_ISR_Get_level> 200e684: a6 60 3f ff subx %g0, -1, %l3 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 200e688: a7 2c e0 0a sll %l3, 0xa, %l3 200e68c: a6 14 c0 08 or %l3, %o0, %l3 old_mode |= _ISR_Get_level(); 200e690: a4 14 c0 12 or %l3, %l2, %l2 /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 200e694: 80 8e 61 00 btst 0x100, %i1 200e698: 02 80 00 06 be 200e6b0 200e69c: e4 26 80 00 st %l2, [ %i2 ] */ RTEMS_INLINE_ROUTINE bool _Modes_Is_preempt ( Modes_Control mode_set ) { return (mode_set & RTEMS_PREEMPT_MASK) == RTEMS_PREEMPT; 200e6a0: 82 0e 21 00 and %i0, 0x100, %g1 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 200e6a4: 80 a0 00 01 cmp %g0, %g1 200e6a8: 82 60 3f ff subx %g0, -1, %g1 200e6ac: c2 2c 20 75 stb %g1, [ %l0 + 0x75 ] if ( mask & RTEMS_TIMESLICE_MASK ) { 200e6b0: 80 8e 62 00 btst 0x200, %i1 200e6b4: 02 80 00 0b be 200e6e0 200e6b8: 80 8e 60 0f btst 0xf, %i1 if ( _Modes_Is_timeslice(mode_set) ) { 200e6bc: 80 8e 22 00 btst 0x200, %i0 200e6c0: 22 80 00 07 be,a 200e6dc 200e6c4: c0 24 20 7c clr [ %l0 + 0x7c ] executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 200e6c8: 82 10 20 01 mov 1, %g1 200e6cc: c2 24 20 7c st %g1, [ %l0 + 0x7c ] executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 200e6d0: 03 00 80 58 sethi %hi(0x2016000), %g1 200e6d4: c2 00 60 a8 ld [ %g1 + 0xa8 ], %g1 ! 20160a8 <_Thread_Ticks_per_timeslice> 200e6d8: c2 24 20 78 st %g1, [ %l0 + 0x78 ] /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 200e6dc: 80 8e 60 0f btst 0xf, %i1 200e6e0: 02 80 00 06 be 200e6f8 200e6e4: 80 8e 64 00 btst 0x400, %i1 */ RTEMS_INLINE_ROUTINE ISR_Level _Modes_Get_interrupt_level ( Modes_Control mode_set ) { return ( mode_set & RTEMS_INTERRUPT_MASK ); 200e6e8: 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 ) ); 200e6ec: 7f ff ce b9 call 20021d0 200e6f0: 91 2a 20 08 sll %o0, 8, %o0 */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 200e6f4: 80 8e 64 00 btst 0x400, %i1 200e6f8: 02 80 00 18 be 200e758 200e6fc: a4 10 20 00 clr %l2 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 200e700: c4 0c 60 08 ldub [ %l1 + 8 ], %g2 */ RTEMS_INLINE_ROUTINE bool _Modes_Is_asr_disabled ( Modes_Control mode_set ) { return (mode_set & RTEMS_ASR_MASK) == RTEMS_NO_ASR; 200e704: b0 0e 24 00 and %i0, 0x400, %i0 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 200e708: 80 a0 00 18 cmp %g0, %i0 200e70c: 82 60 3f ff subx %g0, -1, %g1 is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 200e710: 80 a0 40 02 cmp %g1, %g2 200e714: 22 80 00 12 be,a 200e75c 200e718: 03 00 80 58 sethi %hi(0x2016000), %g1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 200e71c: 7f ff ce a9 call 20021c0 200e720: c2 2c 60 08 stb %g1, [ %l1 + 8 ] _signals = information->signals_pending; 200e724: c2 04 60 18 ld [ %l1 + 0x18 ], %g1 information->signals_pending = information->signals_posted; 200e728: c4 04 60 14 ld [ %l1 + 0x14 ], %g2 information->signals_posted = _signals; 200e72c: c2 24 60 14 st %g1, [ %l1 + 0x14 ] rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; 200e730: c4 24 60 18 st %g2, [ %l1 + 0x18 ] information->signals_posted = _signals; _ISR_Enable( _level ); 200e734: 7f ff ce a7 call 20021d0 200e738: 01 00 00 00 nop asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 200e73c: c2 04 60 14 ld [ %l1 + 0x14 ], %g1 200e740: 80 a0 60 00 cmp %g1, 0 200e744: 02 80 00 06 be 200e75c 200e748: 03 00 80 58 sethi %hi(0x2016000), %g1 needs_asr_dispatching = true; executing->do_post_task_switch_extension = true; 200e74c: 82 10 20 01 mov 1, %g1 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { needs_asr_dispatching = true; 200e750: a4 10 20 01 mov 1, %l2 executing->do_post_task_switch_extension = true; 200e754: c2 2c 20 74 stb %g1, [ %l0 + 0x74 ] } } } if ( _System_state_Is_up( _System_state_Get() ) ) 200e758: 03 00 80 58 sethi %hi(0x2016000), %g1 200e75c: c2 00 62 f0 ld [ %g1 + 0x2f0 ], %g1 ! 20162f0 <_System_state_Current> 200e760: 80 a0 60 03 cmp %g1, 3 200e764: 12 80 00 0b bne 200e790 <== NEVER TAKEN 200e768: a0 10 20 00 clr %l0 if ( _Thread_Evaluate_mode() || needs_asr_dispatching ) 200e76c: 40 00 00 81 call 200e970 <_Thread_Evaluate_mode> 200e770: 01 00 00 00 nop 200e774: 80 8a 20 ff btst 0xff, %o0 200e778: 12 80 00 04 bne 200e788 200e77c: 80 8c a0 ff btst 0xff, %l2 200e780: 02 80 00 04 be 200e790 200e784: 01 00 00 00 nop _Thread_Dispatch(); 200e788: 7f ff e7 4c call 20084b8 <_Thread_Dispatch> 200e78c: a0 10 20 00 clr %l0 ! 0 return RTEMS_SUCCESSFUL; } 200e790: 81 c7 e0 08 ret 200e794: 91 e8 00 10 restore %g0, %l0, %o0 =============================================================================== 0200adbc : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 200adbc: 9d e3 bf 98 save %sp, -104, %sp register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 200adc0: 80 a6 60 00 cmp %i1, 0 200adc4: 02 80 00 07 be 200ade0 200adc8: 90 10 00 18 mov %i0, %o0 RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && ( the_priority <= RTEMS_MAXIMUM_PRIORITY ) ); 200adcc: 03 00 80 67 sethi %hi(0x2019c00), %g1 200add0: c2 08 63 f4 ldub [ %g1 + 0x3f4 ], %g1 ! 2019ff4 200add4: 80 a6 40 01 cmp %i1, %g1 200add8: 18 80 00 1c bgu 200ae48 200addc: b0 10 20 13 mov 0x13, %i0 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 200ade0: 80 a6 a0 00 cmp %i2, 0 200ade4: 02 80 00 19 be 200ae48 200ade8: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 200adec: 40 00 08 60 call 200cf6c <_Thread_Get> 200adf0: 92 07 bf fc add %fp, -4, %o1 switch ( location ) { 200adf4: c2 07 bf fc ld [ %fp + -4 ], %g1 200adf8: 80 a0 60 00 cmp %g1, 0 200adfc: 12 80 00 13 bne 200ae48 200ae00: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 200ae04: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 200ae08: 80 a6 60 00 cmp %i1, 0 200ae0c: 02 80 00 0d be 200ae40 200ae10: c2 26 80 00 st %g1, [ %i2 ] the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 200ae14: c2 02 20 1c ld [ %o0 + 0x1c ], %g1 200ae18: 80 a0 60 00 cmp %g1, 0 200ae1c: 02 80 00 06 be 200ae34 200ae20: f2 22 20 18 st %i1, [ %o0 + 0x18 ] 200ae24: c2 02 20 14 ld [ %o0 + 0x14 ], %g1 200ae28: 80 a0 40 19 cmp %g1, %i1 200ae2c: 08 80 00 05 bleu 200ae40 <== ALWAYS TAKEN 200ae30: 01 00 00 00 nop the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 200ae34: 92 10 00 19 mov %i1, %o1 200ae38: 40 00 06 a7 call 200c8d4 <_Thread_Change_priority> 200ae3c: 94 10 20 00 clr %o2 } _Thread_Enable_dispatch(); 200ae40: 40 00 08 2a call 200cee8 <_Thread_Enable_dispatch> 200ae44: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 200ae48: 81 c7 e0 08 ret 200ae4c: 81 e8 00 00 restore =============================================================================== 020164ac : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 20164ac: 9d e3 bf 98 save %sp, -104, %sp Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 20164b0: 11 00 80 f8 sethi %hi(0x203e000), %o0 20164b4: 92 10 00 18 mov %i0, %o1 20164b8: 90 12 21 84 or %o0, 0x184, %o0 20164bc: 40 00 0c 0e call 20194f4 <_Objects_Get> 20164c0: 94 07 bf fc add %fp, -4, %o2 Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 20164c4: c2 07 bf fc ld [ %fp + -4 ], %g1 20164c8: 80 a0 60 00 cmp %g1, 0 20164cc: 12 80 00 0c bne 20164fc 20164d0: 01 00 00 00 nop case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 20164d4: c2 02 20 38 ld [ %o0 + 0x38 ], %g1 20164d8: 80 a0 60 04 cmp %g1, 4 20164dc: 02 80 00 04 be 20164ec <== NEVER TAKEN 20164e0: 01 00 00 00 nop (void) _Watchdog_Remove( &the_timer->Ticker ); 20164e4: 40 00 14 a3 call 201b770 <_Watchdog_Remove> 20164e8: 90 02 20 10 add %o0, 0x10, %o0 _Thread_Enable_dispatch(); 20164ec: 40 00 0e 7c call 2019edc <_Thread_Enable_dispatch> 20164f0: b0 10 20 00 clr %i0 return RTEMS_SUCCESSFUL; 20164f4: 81 c7 e0 08 ret 20164f8: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 20164fc: 81 c7 e0 08 ret 2016500: 91 e8 20 04 restore %g0, 4, %o0 =============================================================================== 02016994 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 2016994: 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; 2016998: 03 00 80 f8 sethi %hi(0x203e000), %g1 201699c: e2 00 61 c4 ld [ %g1 + 0x1c4 ], %l1 ! 203e1c4 <_Timer_server> rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 20169a0: a0 10 00 18 mov %i0, %l0 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) 20169a4: 80 a4 60 00 cmp %l1, 0 20169a8: 02 80 00 33 be 2016a74 20169ac: b0 10 20 0e mov 0xe, %i0 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 20169b0: 03 00 80 f6 sethi %hi(0x203d800), %g1 20169b4: c2 08 60 1c ldub [ %g1 + 0x1c ], %g1 ! 203d81c <_TOD_Is_set> 20169b8: 80 a0 60 00 cmp %g1, 0 20169bc: 02 80 00 2e be 2016a74 <== NEVER TAKEN 20169c0: b0 10 20 0b mov 0xb, %i0 return RTEMS_NOT_DEFINED; if ( !routine ) 20169c4: 80 a6 a0 00 cmp %i2, 0 20169c8: 02 80 00 2b be 2016a74 20169cc: b0 10 20 09 mov 9, %i0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 20169d0: 90 10 00 19 mov %i1, %o0 20169d4: 7f ff f4 12 call 2013a1c <_TOD_Validate> 20169d8: b0 10 20 14 mov 0x14, %i0 20169dc: 80 8a 20 ff btst 0xff, %o0 20169e0: 02 80 00 27 be 2016a7c 20169e4: 01 00 00 00 nop return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 20169e8: 7f ff f3 d9 call 201394c <_TOD_To_seconds> 20169ec: 90 10 00 19 mov %i1, %o0 if ( seconds <= _TOD_Seconds_since_epoch() ) 20169f0: 27 00 80 f6 sethi %hi(0x203d800), %l3 20169f4: c2 04 e0 9c ld [ %l3 + 0x9c ], %g1 ! 203d89c <_TOD_Now> 20169f8: 80 a2 00 01 cmp %o0, %g1 20169fc: 08 80 00 1e bleu 2016a74 2016a00: a4 10 00 08 mov %o0, %l2 2016a04: 11 00 80 f8 sethi %hi(0x203e000), %o0 2016a08: 92 10 00 10 mov %l0, %o1 2016a0c: 90 12 21 84 or %o0, 0x184, %o0 2016a10: 40 00 0a b9 call 20194f4 <_Objects_Get> 2016a14: 94 07 bf fc add %fp, -4, %o2 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 2016a18: c2 07 bf fc ld [ %fp + -4 ], %g1 2016a1c: b2 10 00 08 mov %o0, %i1 2016a20: 80 a0 60 00 cmp %g1, 0 2016a24: 12 80 00 14 bne 2016a74 2016a28: b0 10 20 04 mov 4, %i0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 2016a2c: 40 00 13 51 call 201b770 <_Watchdog_Remove> 2016a30: 90 02 20 10 add %o0, 0x10, %o0 the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 2016a34: 82 10 20 03 mov 3, %g1 2016a38: c2 26 60 38 st %g1, [ %i1 + 0x38 ] _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 2016a3c: c2 04 e0 9c ld [ %l3 + 0x9c ], %g1 (*timer_server->schedule_operation)( timer_server, the_timer ); 2016a40: 90 10 00 11 mov %l1, %o0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 2016a44: a4 24 80 01 sub %l2, %g1, %l2 (*timer_server->schedule_operation)( timer_server, the_timer ); 2016a48: c2 04 60 04 ld [ %l1 + 4 ], %g1 2016a4c: 92 10 00 19 mov %i1, %o1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 2016a50: c0 26 60 18 clr [ %i1 + 0x18 ] the_watchdog->routine = routine; 2016a54: f4 26 60 2c st %i2, [ %i1 + 0x2c ] the_watchdog->id = id; 2016a58: e0 26 60 30 st %l0, [ %i1 + 0x30 ] the_watchdog->user_data = user_data; 2016a5c: f6 26 60 34 st %i3, [ %i1 + 0x34 ] case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 2016a60: e4 26 60 1c st %l2, [ %i1 + 0x1c ] (*timer_server->schedule_operation)( timer_server, the_timer ); 2016a64: 9f c0 40 00 call %g1 2016a68: b0 10 20 00 clr %i0 _Thread_Enable_dispatch(); 2016a6c: 40 00 0d 1c call 2019edc <_Thread_Enable_dispatch> 2016a70: 01 00 00 00 nop return RTEMS_SUCCESSFUL; 2016a74: 81 c7 e0 08 ret 2016a78: 81 e8 00 00 restore case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 2016a7c: 81 c7 e0 08 ret 2016a80: 81 e8 00 00 restore =============================================================================== 02006ba0 : #include int sched_get_priority_max( int policy ) { 2006ba0: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 2006ba4: 80 a6 20 04 cmp %i0, 4 2006ba8: 18 80 00 06 bgu 2006bc0 2006bac: 82 10 20 01 mov 1, %g1 2006bb0: b1 28 40 18 sll %g1, %i0, %i0 2006bb4: 80 8e 20 17 btst 0x17, %i0 2006bb8: 12 80 00 08 bne 2006bd8 <== ALWAYS TAKEN 2006bbc: 03 00 80 73 sethi %hi(0x201cc00), %g1 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 2006bc0: 40 00 23 a3 call 200fa4c <__errno> 2006bc4: b0 10 3f ff mov -1, %i0 2006bc8: 82 10 20 16 mov 0x16, %g1 2006bcc: c2 22 00 00 st %g1, [ %o0 ] 2006bd0: 81 c7 e0 08 ret 2006bd4: 81 e8 00 00 restore } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 2006bd8: f0 08 60 08 ldub [ %g1 + 8 ], %i0 } 2006bdc: 81 c7 e0 08 ret 2006be0: 91 ee 3f ff restore %i0, -1, %o0 =============================================================================== 02006be4 : #include int sched_get_priority_min( int policy ) { 2006be4: 9d e3 bf a0 save %sp, -96, %sp switch ( policy ) { 2006be8: 80 a6 20 04 cmp %i0, 4 2006bec: 18 80 00 06 bgu 2006c04 2006bf0: 82 10 20 01 mov 1, %g1 2006bf4: 83 28 40 18 sll %g1, %i0, %g1 2006bf8: 80 88 60 17 btst 0x17, %g1 2006bfc: 12 80 00 06 bne 2006c14 <== ALWAYS TAKEN 2006c00: b0 10 20 01 mov 1, %i0 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 2006c04: 40 00 23 92 call 200fa4c <__errno> 2006c08: b0 10 3f ff mov -1, %i0 2006c0c: 82 10 20 16 mov 0x16, %g1 2006c10: c2 22 00 00 st %g1, [ %o0 ] } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 2006c14: 81 c7 e0 08 ret 2006c18: 81 e8 00 00 restore =============================================================================== 02006c1c : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 2006c1c: 9d e3 bf a0 save %sp, -96, %sp /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 2006c20: 80 a6 20 00 cmp %i0, 0 2006c24: 02 80 00 0b be 2006c50 <== NEVER TAKEN 2006c28: 80 a6 60 00 cmp %i1, 0 2006c2c: 7f ff f2 20 call 20034ac 2006c30: 01 00 00 00 nop 2006c34: 80 a6 00 08 cmp %i0, %o0 2006c38: 02 80 00 06 be 2006c50 2006c3c: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( ESRCH ); 2006c40: 40 00 23 83 call 200fa4c <__errno> 2006c44: 01 00 00 00 nop 2006c48: 10 80 00 07 b 2006c64 2006c4c: 82 10 20 03 mov 3, %g1 ! 3 if ( !interval ) 2006c50: 12 80 00 08 bne 2006c70 2006c54: 03 00 80 75 sethi %hi(0x201d400), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 2006c58: 40 00 23 7d call 200fa4c <__errno> 2006c5c: 01 00 00 00 nop 2006c60: 82 10 20 16 mov 0x16, %g1 ! 16 2006c64: c2 22 00 00 st %g1, [ %o0 ] 2006c68: 81 c7 e0 08 ret 2006c6c: 91 e8 3f ff restore %g0, -1, %o0 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 2006c70: d0 00 62 58 ld [ %g1 + 0x258 ], %o0 2006c74: 92 10 00 19 mov %i1, %o1 2006c78: 40 00 0e 52 call 200a5c0 <_Timespec_From_ticks> 2006c7c: b0 10 20 00 clr %i0 return 0; } 2006c80: 81 c7 e0 08 ret 2006c84: 81 e8 00 00 restore =============================================================================== 02009550 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 2009550: 9d e3 bf 90 save %sp, -112, %sp rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 2009554: 03 00 80 89 sethi %hi(0x2022400), %g1 2009558: c4 00 63 08 ld [ %g1 + 0x308 ], %g2 ! 2022708 <_Thread_Dispatch_disable_level> Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); 200955c: f4 27 a0 4c st %i2, [ %fp + 0x4c ] 2009560: 84 00 a0 01 inc %g2 2009564: f6 27 a0 50 st %i3, [ %fp + 0x50 ] 2009568: f8 27 a0 54 st %i4, [ %fp + 0x54 ] 200956c: fa 27 a0 58 st %i5, [ %fp + 0x58 ] 2009570: c4 20 63 08 st %g2, [ %g1 + 0x308 ] POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 2009574: a2 8e 62 00 andcc %i1, 0x200, %l1 2009578: 02 80 00 05 be 200958c 200957c: a0 10 20 00 clr %l0 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 2009580: e0 07 a0 50 ld [ %fp + 0x50 ], %l0 2009584: 82 07 a0 54 add %fp, 0x54, %g1 2009588: c2 27 bf fc st %g1, [ %fp + -4 ] va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 200958c: 90 10 00 18 mov %i0, %o0 2009590: 40 00 1a b9 call 2010074 <_POSIX_Semaphore_Name_to_id> 2009594: 92 07 bf f8 add %fp, -8, %o1 * and we can just return a pointer to the id. Otherwise we may * need to check to see if this is a "semaphore does not exist" * or some other miscellaneous error on the name. */ if ( status ) { 2009598: a4 92 20 00 orcc %o0, 0, %l2 200959c: 22 80 00 0e be,a 20095d4 20095a0: 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) ) ) { 20095a4: 80 a4 a0 02 cmp %l2, 2 20095a8: 12 80 00 04 bne 20095b8 <== NEVER TAKEN 20095ac: 80 a4 60 00 cmp %l1, 0 20095b0: 12 80 00 21 bne 2009634 20095b4: 94 10 00 10 mov %l0, %o2 _Thread_Enable_dispatch(); 20095b8: 40 00 0a df call 200c134 <_Thread_Enable_dispatch> 20095bc: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 20095c0: 40 00 26 9c call 2013030 <__errno> 20095c4: 01 00 00 00 nop 20095c8: e4 22 00 00 st %l2, [ %o0 ] 20095cc: 81 c7 e0 08 ret 20095d0: 81 e8 00 00 restore /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 20095d4: 80 a6 6a 00 cmp %i1, 0xa00 20095d8: 12 80 00 0a bne 2009600 20095dc: d2 07 bf f8 ld [ %fp + -8 ], %o1 _Thread_Enable_dispatch(); 20095e0: 40 00 0a d5 call 200c134 <_Thread_Enable_dispatch> 20095e4: b0 10 3f ff mov -1, %i0 rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 20095e8: 40 00 26 92 call 2013030 <__errno> 20095ec: 01 00 00 00 nop 20095f0: 82 10 20 11 mov 0x11, %g1 ! 11 20095f4: c2 22 00 00 st %g1, [ %o0 ] 20095f8: 81 c7 e0 08 ret 20095fc: 81 e8 00 00 restore 2009600: 94 07 bf f0 add %fp, -16, %o2 2009604: 11 00 80 8a sethi %hi(0x2022800), %o0 2009608: 40 00 08 6b call 200b7b4 <_Objects_Get> 200960c: 90 12 22 20 or %o0, 0x220, %o0 ! 2022a20 <_POSIX_Semaphore_Information> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 2009610: c2 02 20 18 ld [ %o0 + 0x18 ], %g1 if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); 2009614: d0 27 bf f4 st %o0, [ %fp + -12 ] the_semaphore->open_count += 1; 2009618: 82 00 60 01 inc %g1 _Thread_Enable_dispatch(); 200961c: 40 00 0a c6 call 200c134 <_Thread_Enable_dispatch> 2009620: c2 22 20 18 st %g1, [ %o0 + 0x18 ] _Thread_Enable_dispatch(); 2009624: 40 00 0a c4 call 200c134 <_Thread_Enable_dispatch> 2009628: 01 00 00 00 nop goto return_id; 200962c: 10 80 00 0c b 200965c 2009630: f0 07 bf f4 ld [ %fp + -12 ], %i0 /* * At this point, the semaphore does not exist and everything has been * checked. We should go ahead and create a semaphore. */ status =_POSIX_Semaphore_Create_support( 2009634: 90 10 00 18 mov %i0, %o0 2009638: 92 10 20 00 clr %o1 200963c: 40 00 1a 37 call 200ff18 <_POSIX_Semaphore_Create_support> 2009640: 96 07 bf f4 add %fp, -12, %o3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 2009644: 40 00 0a bc call 200c134 <_Thread_Enable_dispatch> 2009648: a0 10 00 08 mov %o0, %l0 if ( status == -1 ) 200964c: 80 a4 3f ff cmp %l0, -1 2009650: 02 bf ff ea be 20095f8 2009654: b0 10 3f ff mov -1, %i0 return_id: #if defined(RTEMS_USE_16_BIT_OBJECT) the_semaphore->Semaphore_id = the_semaphore->Object.id; id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; 2009658: f0 07 bf f4 ld [ %fp + -12 ], %i0 200965c: b0 06 20 08 add %i0, 8, %i0 #endif return id; } 2009660: 81 c7 e0 08 ret 2009664: 81 e8 00 00 restore =============================================================================== 02006b20 : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 2006b20: 9d e3 bf a0 save %sp, -96, %sp ISR_Level level; if ( oact ) 2006b24: 90 96 a0 00 orcc %i2, 0, %o0 2006b28: 02 80 00 0a be 2006b50 2006b2c: a0 10 00 18 mov %i0, %l0 *oact = _POSIX_signals_Vectors[ sig ]; 2006b30: 83 2e 20 02 sll %i0, 2, %g1 2006b34: 85 2e 20 04 sll %i0, 4, %g2 2006b38: 82 20 80 01 sub %g2, %g1, %g1 2006b3c: 13 00 80 7b sethi %hi(0x201ec00), %o1 2006b40: 94 10 20 0c mov 0xc, %o2 2006b44: 92 12 61 b8 or %o1, 0x1b8, %o1 2006b48: 40 00 27 31 call 201080c 2006b4c: 92 02 40 01 add %o1, %g1, %o1 if ( !sig ) 2006b50: 80 a4 20 00 cmp %l0, 0 2006b54: 02 80 00 09 be 2006b78 2006b58: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 2006b5c: 82 04 3f ff add %l0, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 2006b60: 80 a0 60 1f cmp %g1, 0x1f 2006b64: 18 80 00 05 bgu 2006b78 2006b68: 01 00 00 00 nop * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 2006b6c: 80 a4 20 09 cmp %l0, 9 2006b70: 12 80 00 08 bne 2006b90 2006b74: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 2006b78: 40 00 24 c6 call 200fe90 <__errno> 2006b7c: b0 10 3f ff mov -1, %i0 2006b80: 82 10 20 16 mov 0x16, %g1 2006b84: c2 22 00 00 st %g1, [ %o0 ] 2006b88: 81 c7 e0 08 ret 2006b8c: 81 e8 00 00 restore /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 2006b90: 02 bf ff fe be 2006b88 <== NEVER TAKEN 2006b94: b0 10 20 00 clr %i0 /* * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); 2006b98: 7f ff ef 1c call 2002808 2006b9c: 01 00 00 00 nop 2006ba0: a2 10 00 08 mov %o0, %l1 if ( act->sa_handler == SIG_DFL ) { 2006ba4: c2 06 60 08 ld [ %i1 + 8 ], %g1 2006ba8: 25 00 80 7b sethi %hi(0x201ec00), %l2 2006bac: 80 a0 60 00 cmp %g1, 0 2006bb0: a4 14 a1 b8 or %l2, 0x1b8, %l2 2006bb4: a7 2c 20 02 sll %l0, 2, %l3 2006bb8: 12 80 00 08 bne 2006bd8 2006bbc: a9 2c 20 04 sll %l0, 4, %l4 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 2006bc0: a6 25 00 13 sub %l4, %l3, %l3 2006bc4: 13 00 80 74 sethi %hi(0x201d000), %o1 2006bc8: 90 04 80 13 add %l2, %l3, %o0 2006bcc: 92 12 62 40 or %o1, 0x240, %o1 2006bd0: 10 80 00 07 b 2006bec 2006bd4: 92 02 40 13 add %o1, %l3, %o1 } else { _POSIX_signals_Clear_process_signals( sig ); 2006bd8: 40 00 18 76 call 200cdb0 <_POSIX_signals_Clear_process_signals> 2006bdc: 90 10 00 10 mov %l0, %o0 _POSIX_signals_Vectors[ sig ] = *act; 2006be0: a6 25 00 13 sub %l4, %l3, %l3 2006be4: 92 10 00 19 mov %i1, %o1 2006be8: 90 04 80 13 add %l2, %l3, %o0 2006bec: 40 00 27 08 call 201080c 2006bf0: 94 10 20 0c mov 0xc, %o2 * now (signals not posted when SIG_IGN). * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; 2006bf4: b0 10 20 00 clr %i0 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); _POSIX_signals_Vectors[ sig ] = *act; } _ISR_Enable( level ); 2006bf8: 7f ff ef 08 call 2002818 2006bfc: 90 10 00 11 mov %l1, %o0 * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; } 2006c00: 81 c7 e0 08 ret 2006c04: 81 e8 00 00 restore =============================================================================== 02008eb0 : #include int sigsuspend( const sigset_t *sigmask ) { 2008eb0: 9d e3 bf 98 save %sp, -104, %sp int status; POSIX_API_Control *api; api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; status = sigprocmask( SIG_BLOCK, sigmask, &saved_signals_blocked ); 2008eb4: 90 10 20 01 mov 1, %o0 2008eb8: 92 10 00 18 mov %i0, %o1 2008ebc: a0 07 bf fc add %fp, -4, %l0 2008ec0: 7f ff ff f1 call 2008e84 2008ec4: 94 10 00 10 mov %l0, %o2 (void) sigfillset( &all_signals ); 2008ec8: a2 07 bf f8 add %fp, -8, %l1 2008ecc: 7f ff ff b6 call 2008da4 2008ed0: 90 10 00 11 mov %l1, %o0 status = sigtimedwait( &all_signals, NULL, NULL ); 2008ed4: 90 10 00 11 mov %l1, %o0 2008ed8: 92 10 20 00 clr %o1 2008edc: 40 00 00 28 call 2008f7c 2008ee0: 94 10 20 00 clr %o2 (void) sigprocmask( SIG_SETMASK, &saved_signals_blocked, NULL ); 2008ee4: 92 10 00 10 mov %l0, %o1 status = sigprocmask( SIG_BLOCK, sigmask, &saved_signals_blocked ); (void) sigfillset( &all_signals ); status = sigtimedwait( &all_signals, NULL, NULL ); 2008ee8: a2 10 00 08 mov %o0, %l1 (void) sigprocmask( SIG_SETMASK, &saved_signals_blocked, NULL ); 2008eec: 94 10 20 00 clr %o2 2008ef0: 7f ff ff e5 call 2008e84 2008ef4: 90 10 20 00 clr %o0 /* * sigtimedwait() returns the signal number while sigsuspend() * is supposed to return -1 and EINTR when a signal is caught. */ if ( status != -1 ) 2008ef8: 80 a4 7f ff cmp %l1, -1 2008efc: 02 80 00 06 be 2008f14 <== NEVER TAKEN 2008f00: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINTR ); 2008f04: 40 00 24 a2 call 201218c <__errno> 2008f08: 01 00 00 00 nop 2008f0c: 82 10 20 04 mov 4, %g1 ! 4 2008f10: c2 22 00 00 st %g1, [ %o0 ] return status; } 2008f14: 81 c7 e0 08 ret 2008f18: 91 e8 3f ff restore %g0, -1, %o0 =============================================================================== 02006fe0 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 2006fe0: 9d e3 bf 90 save %sp, -112, %sp ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 2006fe4: 80 a6 20 00 cmp %i0, 0 2006fe8: 02 80 00 0f be 2007024 2006fec: 01 00 00 00 nop /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 2006ff0: 80 a6 a0 00 cmp %i2, 0 2006ff4: 02 80 00 12 be 200703c 2006ff8: a8 10 20 00 clr %l4 if ( !_Timespec_Is_valid( timeout ) ) 2006ffc: 40 00 0e 6a call 200a9a4 <_Timespec_Is_valid> 2007000: 90 10 00 1a mov %i2, %o0 2007004: 80 8a 20 ff btst 0xff, %o0 2007008: 02 80 00 07 be 2007024 200700c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 2007010: 40 00 0e 88 call 200aa30 <_Timespec_To_ticks> 2007014: 90 10 00 1a mov %i2, %o0 if ( !interval ) 2007018: a8 92 20 00 orcc %o0, 0, %l4 200701c: 12 80 00 09 bne 2007040 <== ALWAYS TAKEN 2007020: 80 a6 60 00 cmp %i1, 0 rtems_set_errno_and_return_minus_one( EINVAL ); 2007024: 40 00 25 5c call 2010594 <__errno> 2007028: b0 10 3f ff mov -1, %i0 200702c: 82 10 20 16 mov 0x16, %g1 2007030: c2 22 00 00 st %g1, [ %o0 ] 2007034: 81 c7 e0 08 ret 2007038: 81 e8 00 00 restore /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 200703c: 80 a6 60 00 cmp %i1, 0 2007040: 22 80 00 02 be,a 2007048 2007044: b2 07 bf f4 add %fp, -12, %i1 the_thread = _Thread_Executing; 2007048: 21 00 80 7c sethi %hi(0x201f000), %l0 200704c: e6 04 20 c8 ld [ %l0 + 0xc8 ], %l3 ! 201f0c8 <_Thread_Executing> * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 2007050: 7f ff ee c9 call 2002b74 2007054: e4 04 e1 6c ld [ %l3 + 0x16c ], %l2 2007058: a2 10 00 08 mov %o0, %l1 if ( *set & api->signals_pending ) { 200705c: c4 06 00 00 ld [ %i0 ], %g2 2007060: c2 04 a0 d0 ld [ %l2 + 0xd0 ], %g1 2007064: 80 88 80 01 btst %g2, %g1 2007068: 22 80 00 13 be,a 20070b4 200706c: 03 00 80 7d sethi %hi(0x201f400), %g1 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_highest( api->signals_pending ); 2007070: 7f ff ff c4 call 2006f80 <_POSIX_signals_Get_highest> 2007074: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( 2007078: 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_highest( api->signals_pending ); 200707c: 92 10 00 08 mov %o0, %o1 2007080: d0 26 40 00 st %o0, [ %i1 ] _POSIX_signals_Clear_signals( 2007084: 96 10 20 00 clr %o3 2007088: 90 10 00 12 mov %l2, %o0 200708c: 40 00 19 3b call 200d578 <_POSIX_signals_Clear_signals> 2007090: 98 10 20 00 clr %o4 the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 2007094: 7f ff ee bc call 2002b84 2007098: 90 10 00 11 mov %l1, %o0 the_info->si_code = SI_USER; 200709c: 82 10 20 01 mov 1, %g1 the_info->si_value.sival_int = 0; 20070a0: c0 26 60 08 clr [ %i1 + 8 ] false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; 20070a4: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; return the_info->si_signo; 20070a8: f0 06 40 00 ld [ %i1 ], %i0 20070ac: 81 c7 e0 08 ret 20070b0: 81 e8 00 00 restore } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 20070b4: c2 00 63 8c ld [ %g1 + 0x38c ], %g1 20070b8: 80 88 80 01 btst %g2, %g1 20070bc: 22 80 00 13 be,a 2007108 20070c0: 82 10 3f ff mov -1, %g1 signo = _POSIX_signals_Get_highest( _POSIX_signals_Pending ); 20070c4: 7f ff ff af call 2006f80 <_POSIX_signals_Get_highest> 20070c8: 90 10 00 01 mov %g1, %o0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 20070cc: 94 10 00 19 mov %i1, %o2 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_highest( _POSIX_signals_Pending ); 20070d0: b0 10 00 08 mov %o0, %i0 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 20070d4: 96 10 20 01 mov 1, %o3 20070d8: 90 10 00 12 mov %l2, %o0 20070dc: 92 10 00 18 mov %i0, %o1 20070e0: 40 00 19 26 call 200d578 <_POSIX_signals_Clear_signals> 20070e4: 98 10 20 00 clr %o4 _ISR_Enable( level ); 20070e8: 7f ff ee a7 call 2002b84 20070ec: 90 10 00 11 mov %l1, %o0 the_info->si_signo = signo; the_info->si_code = SI_USER; 20070f0: 82 10 20 01 mov 1, %g1 if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_highest( _POSIX_signals_Pending ); _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); _ISR_Enable( level ); the_info->si_signo = signo; 20070f4: f0 26 40 00 st %i0, [ %i1 ] the_info->si_code = SI_USER; 20070f8: c2 26 60 04 st %g1, [ %i1 + 4 ] the_info->si_value.sival_int = 0; 20070fc: c0 26 60 08 clr [ %i1 + 8 ] return signo; 2007100: 81 c7 e0 08 ret 2007104: 81 e8 00 00 restore } the_info->si_signo = -1; 2007108: c2 26 40 00 st %g1, [ %i1 ] 200710c: 03 00 80 7c sethi %hi(0x201f000), %g1 2007110: c4 00 60 08 ld [ %g1 + 8 ], %g2 ! 201f008 <_Thread_Dispatch_disable_level> 2007114: 84 00 a0 01 inc %g2 2007118: c4 20 60 08 st %g2, [ %g1 + 8 ] _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 200711c: 82 10 20 04 mov 4, %g1 2007120: c2 24 e0 34 st %g1, [ %l3 + 0x34 ] the_thread->Wait.option = *set; 2007124: c2 06 00 00 ld [ %i0 ], %g1 the_thread->Wait.return_argument = the_info; 2007128: f2 24 e0 28 st %i1, [ %l3 + 0x28 ] the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; 200712c: c2 24 e0 30 st %g1, [ %l3 + 0x30 ] } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 2007130: 23 00 80 7d sethi %hi(0x201f400), %l1 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; 2007134: 82 10 20 01 mov 1, %g1 2007138: a2 14 63 24 or %l1, 0x324, %l1 200713c: e2 24 e0 44 st %l1, [ %l3 + 0x44 ] 2007140: c2 24 60 30 st %g1, [ %l1 + 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 ); 2007144: 7f ff ee 90 call 2002b84 2007148: 01 00 00 00 nop _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 200714c: 90 10 00 11 mov %l1, %o0 2007150: 92 10 00 14 mov %l4, %o1 2007154: 15 00 80 28 sethi %hi(0x200a000), %o2 2007158: 40 00 0b c3 call 200a064 <_Thread_queue_Enqueue_with_handler> 200715c: 94 12 a3 e4 or %o2, 0x3e4, %o2 ! 200a3e4 <_Thread_queue_Timeout> _Thread_Enable_dispatch(); 2007160: 40 00 0a 65 call 2009af4 <_Thread_Enable_dispatch> 2007164: 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 ); 2007168: d2 06 40 00 ld [ %i1 ], %o1 200716c: 94 10 00 19 mov %i1, %o2 2007170: 96 10 20 00 clr %o3 2007174: 98 10 20 00 clr %o4 2007178: 40 00 19 00 call 200d578 <_POSIX_signals_Clear_signals> 200717c: 90 10 00 12 mov %l2, %o0 errno = _Thread_Executing->Wait.return_code; 2007180: 40 00 25 05 call 2010594 <__errno> 2007184: 01 00 00 00 nop 2007188: c2 04 20 c8 ld [ %l0 + 0xc8 ], %g1 200718c: c2 00 60 34 ld [ %g1 + 0x34 ], %g1 2007190: c2 22 00 00 st %g1, [ %o0 ] return the_info->si_signo; 2007194: f0 06 40 00 ld [ %i1 ], %i0 } 2007198: 81 c7 e0 08 ret 200719c: 81 e8 00 00 restore =============================================================================== 02009150 : int sigwait( const sigset_t *set, int *sig ) { 2009150: 9d e3 bf a0 save %sp, -96, %sp int status; status = sigtimedwait( set, NULL, NULL ); 2009154: 92 10 20 00 clr %o1 2009158: 90 10 00 18 mov %i0, %o0 200915c: 7f ff ff 88 call 2008f7c 2009160: 94 10 20 00 clr %o2 if ( status != -1 ) { 2009164: 80 a2 3f ff cmp %o0, -1 2009168: 02 80 00 07 be 2009184 200916c: 80 a6 60 00 cmp %i1, 0 if ( sig ) 2009170: 02 80 00 03 be 200917c <== NEVER TAKEN 2009174: b0 10 20 00 clr %i0 *sig = status; 2009178: d0 26 40 00 st %o0, [ %i1 ] 200917c: 81 c7 e0 08 ret 2009180: 81 e8 00 00 restore return 0; } return errno; 2009184: 40 00 24 02 call 201218c <__errno> 2009188: 01 00 00 00 nop 200918c: f0 02 00 00 ld [ %o0 ], %i0 } 2009190: 81 c7 e0 08 ret 2009194: 81 e8 00 00 restore =============================================================================== 02005e70 : */ long sysconf( int name ) { 2005e70: 9d e3 bf a0 save %sp, -96, %sp if ( name == _SC_CLK_TCK ) 2005e74: 80 a6 20 02 cmp %i0, 2 2005e78: 12 80 00 09 bne 2005e9c 2005e7c: 80 a6 20 04 cmp %i0, 4 return (TOD_MICROSECONDS_PER_SECOND / 2005e80: 03 00 80 5a sethi %hi(0x2016800), %g1 2005e84: d2 00 61 98 ld [ %g1 + 0x198 ], %o1 ! 2016998 2005e88: 11 00 03 d0 sethi %hi(0xf4000), %o0 2005e8c: 40 00 34 26 call 2012f24 <.udiv> 2005e90: 90 12 22 40 or %o0, 0x240, %o0 ! f4240 2005e94: 81 c7 e0 08 ret 2005e98: 91 e8 00 08 restore %g0, %o0, %o0 rtems_configuration_get_microseconds_per_tick()); if ( name == _SC_OPEN_MAX ) 2005e9c: 12 80 00 05 bne 2005eb0 2005ea0: 80 a6 20 33 cmp %i0, 0x33 return rtems_libio_number_iops; 2005ea4: 03 00 80 5a sethi %hi(0x2016800), %g1 2005ea8: 10 80 00 0f b 2005ee4 2005eac: d0 00 60 b4 ld [ %g1 + 0xb4 ], %o0 ! 20168b4 if ( name == _SC_GETPW_R_SIZE_MAX ) 2005eb0: 02 80 00 0d be 2005ee4 2005eb4: 90 10 24 00 mov 0x400, %o0 return 1024; if ( name == _SC_PAGESIZE ) 2005eb8: 80 a6 20 08 cmp %i0, 8 2005ebc: 02 80 00 0a be 2005ee4 2005ec0: 90 02 2c 00 add %o0, 0xc00, %o0 return PAGE_SIZE; #if defined(__sparc__) if ( name == 515 ) /* Solaris _SC_STACK_PROT */ 2005ec4: 80 a6 22 03 cmp %i0, 0x203 2005ec8: 02 80 00 07 be 2005ee4 <== NEVER TAKEN 2005ecc: 90 10 20 00 clr %o0 return 0; #endif rtems_set_errno_and_return_minus_one( EINVAL ); 2005ed0: 40 00 24 bc call 200f1c0 <__errno> 2005ed4: 01 00 00 00 nop 2005ed8: 82 10 20 16 mov 0x16, %g1 ! 16 2005edc: c2 22 00 00 st %g1, [ %o0 ] 2005ee0: 90 10 3f ff mov -1, %o0 } 2005ee4: b0 10 00 08 mov %o0, %i0 2005ee8: 81 c7 e0 08 ret 2005eec: 81 e8 00 00 restore =============================================================================== 020061d8 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 20061d8: 9d e3 bf a0 save %sp, -96, %sp POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 20061dc: 80 a6 20 01 cmp %i0, 1 20061e0: 12 80 00 15 bne 2006234 20061e4: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 20061e8: 80 a6 a0 00 cmp %i2, 0 20061ec: 02 80 00 12 be 2006234 20061f0: 01 00 00 00 nop /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 20061f4: 80 a6 60 00 cmp %i1, 0 20061f8: 02 80 00 13 be 2006244 20061fc: 03 00 80 75 sethi %hi(0x201d400), %g1 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 2006200: c2 06 40 00 ld [ %i1 ], %g1 2006204: 82 00 7f ff add %g1, -1, %g1 2006208: 80 a0 60 01 cmp %g1, 1 200620c: 18 80 00 0a bgu 2006234 <== NEVER TAKEN 2006210: 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 ) 2006214: c2 06 60 04 ld [ %i1 + 4 ], %g1 2006218: 80 a0 60 00 cmp %g1, 0 200621c: 02 80 00 06 be 2006234 <== NEVER TAKEN 2006220: 01 00 00 00 nop static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 2006224: 82 00 7f ff add %g1, -1, %g1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 2006228: 80 a0 60 1f cmp %g1, 0x1f 200622c: 28 80 00 06 bleu,a 2006244 <== ALWAYS TAKEN 2006230: 03 00 80 75 sethi %hi(0x201d400), %g1 rtems_set_errno_and_return_minus_one( EINVAL ); 2006234: 40 00 25 f1 call 200f9f8 <__errno> 2006238: 01 00 00 00 nop 200623c: 10 80 00 10 b 200627c 2006240: 82 10 20 16 mov 0x16, %g1 ! 16 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 2006244: c4 00 63 68 ld [ %g1 + 0x368 ], %g2 2006248: 84 00 a0 01 inc %g2 200624c: c4 20 63 68 st %g2, [ %g1 + 0x368 ] * 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 ); 2006250: 11 00 80 76 sethi %hi(0x201d800), %o0 2006254: 40 00 07 ec call 2008204 <_Objects_Allocate> 2006258: 90 12 22 c0 or %o0, 0x2c0, %o0 ! 201dac0 <_POSIX_Timer_Information> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 200625c: 80 a2 20 00 cmp %o0, 0 2006260: 12 80 00 0a bne 2006288 2006264: 82 10 20 02 mov 2, %g1 _Thread_Enable_dispatch(); 2006268: 40 00 0b 72 call 2009030 <_Thread_Enable_dispatch> 200626c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EAGAIN ); 2006270: 40 00 25 e2 call 200f9f8 <__errno> 2006274: 01 00 00 00 nop 2006278: 82 10 20 0b mov 0xb, %g1 ! b 200627c: c2 22 00 00 st %g1, [ %o0 ] 2006280: 81 c7 e0 08 ret 2006284: 91 e8 3f ff restore %g0, -1, %o0 } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 2006288: c2 2a 20 3c stb %g1, [ %o0 + 0x3c ] ptimer->thread_id = _Thread_Executing->Object.id; 200628c: 03 00 80 76 sethi %hi(0x201d800), %g1 2006290: c2 00 60 28 ld [ %g1 + 0x28 ], %g1 ! 201d828 <_Thread_Executing> if ( evp != NULL ) { 2006294: 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; 2006298: c2 00 60 08 ld [ %g1 + 8 ], %g1 if ( evp != NULL ) { 200629c: 02 80 00 08 be 20062bc 20062a0: c2 22 20 38 st %g1, [ %o0 + 0x38 ] ptimer->inf.sigev_notify = evp->sigev_notify; 20062a4: c2 06 40 00 ld [ %i1 ], %g1 20062a8: c2 22 20 40 st %g1, [ %o0 + 0x40 ] ptimer->inf.sigev_signo = evp->sigev_signo; 20062ac: c2 06 60 04 ld [ %i1 + 4 ], %g1 20062b0: c2 22 20 44 st %g1, [ %o0 + 0x44 ] ptimer->inf.sigev_value = evp->sigev_value; 20062b4: c2 06 60 08 ld [ %i1 + 8 ], %g1 20062b8: c2 22 20 48 st %g1, [ %o0 + 0x48 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 20062bc: c4 12 20 0a lduh [ %o0 + 0xa ], %g2 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 20062c0: 07 00 80 76 sethi %hi(0x201d800), %g3 20062c4: c6 00 e2 dc ld [ %g3 + 0x2dc ], %g3 ! 201dadc <_POSIX_Timer_Information+0x1c> } ptimer->overrun = 0; 20062c8: c0 22 20 68 clr [ %o0 + 0x68 ] ptimer->timer_data.it_value.tv_sec = 0; 20062cc: c0 22 20 5c clr [ %o0 + 0x5c ] ptimer->timer_data.it_value.tv_nsec = 0; 20062d0: c0 22 20 60 clr [ %o0 + 0x60 ] ptimer->timer_data.it_interval.tv_sec = 0; 20062d4: c0 22 20 54 clr [ %o0 + 0x54 ] ptimer->timer_data.it_interval.tv_nsec = 0; 20062d8: c0 22 20 58 clr [ %o0 + 0x58 ] Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 20062dc: c0 22 20 18 clr [ %o0 + 0x18 ] the_watchdog->routine = routine; 20062e0: c0 22 20 2c clr [ %o0 + 0x2c ] the_watchdog->id = id; 20062e4: c0 22 20 30 clr [ %o0 + 0x30 ] the_watchdog->user_data = user_data; 20062e8: c0 22 20 34 clr [ %o0 + 0x34 ] Objects_Information *information, Objects_Control *the_object, uint32_t name ) { _Objects_Set_local_object( 20062ec: c2 02 20 08 ld [ %o0 + 8 ], %g1 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 20062f0: 85 28 a0 02 sll %g2, 2, %g2 20062f4: 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; 20062f8: 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; 20062fc: c2 26 80 00 st %g1, [ %i2 ] _Thread_Enable_dispatch(); 2006300: 40 00 0b 4c call 2009030 <_Thread_Enable_dispatch> 2006304: b0 10 20 00 clr %i0 return 0; } 2006308: 81 c7 e0 08 ret 200630c: 81 e8 00 00 restore =============================================================================== 02006310 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 2006310: 9d e3 bf 80 save %sp, -128, %sp Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 2006314: 80 a6 a0 00 cmp %i2, 0 2006318: 02 80 00 22 be 20063a0 <== NEVER TAKEN 200631c: 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) ) ) { 2006320: 40 00 0f 01 call 2009f24 <_Timespec_Is_valid> 2006324: 90 06 a0 08 add %i2, 8, %o0 2006328: 80 8a 20 ff btst 0xff, %o0 200632c: 02 80 00 1d be 20063a0 2006330: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 2006334: 40 00 0e fc call 2009f24 <_Timespec_Is_valid> 2006338: 90 10 00 1a mov %i2, %o0 200633c: 80 8a 20 ff btst 0xff, %o0 2006340: 02 80 00 18 be 20063a0 <== NEVER TAKEN 2006344: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 2006348: 80 a6 60 00 cmp %i1, 0 200634c: 02 80 00 05 be 2006360 2006350: 90 07 bf e4 add %fp, -28, %o0 2006354: 80 a6 60 04 cmp %i1, 4 2006358: 12 80 00 12 bne 20063a0 200635c: 01 00 00 00 nop rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 2006360: 92 10 00 1a mov %i2, %o1 2006364: 40 00 28 19 call 20103c8 2006368: 94 10 20 10 mov 0x10, %o2 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 200636c: 80 a6 60 04 cmp %i1, 4 2006370: 12 80 00 16 bne 20063c8 2006374: 92 10 00 18 mov %i0, %o1 struct timespec now; _TOD_Get( &now ); 2006378: b2 07 bf f4 add %fp, -12, %i1 200637c: 40 00 06 2b call 2007c28 <_TOD_Get> 2006380: 90 10 00 19 mov %i1, %o0 /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 2006384: a0 07 bf ec add %fp, -20, %l0 2006388: 90 10 00 19 mov %i1, %o0 200638c: 40 00 0e d5 call 2009ee0 <_Timespec_Greater_than> 2006390: 92 10 00 10 mov %l0, %o1 2006394: 80 8a 20 ff btst 0xff, %o0 2006398: 02 80 00 08 be 20063b8 200639c: 90 10 00 19 mov %i1, %o0 rtems_set_errno_and_return_minus_one( EINVAL ); 20063a0: 40 00 25 96 call 200f9f8 <__errno> 20063a4: b0 10 3f ff mov -1, %i0 20063a8: 82 10 20 16 mov 0x16, %g1 20063ac: c2 22 00 00 st %g1, [ %o0 ] 20063b0: 81 c7 e0 08 ret 20063b4: 81 e8 00 00 restore _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 20063b8: 92 10 00 10 mov %l0, %o1 20063bc: 40 00 0e eb call 2009f68 <_Timespec_Subtract> 20063c0: 94 10 00 10 mov %l0, %o2 timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) _Objects_Get( &_POSIX_Timer_Information, (Objects_Id) id, location ); 20063c4: 92 10 00 18 mov %i0, %o1 20063c8: 11 00 80 76 sethi %hi(0x201d800), %o0 20063cc: 94 07 bf fc add %fp, -4, %o2 20063d0: 40 00 08 ca call 20086f8 <_Objects_Get> 20063d4: 90 12 22 c0 or %o0, 0x2c0, %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 ) { 20063d8: c2 07 bf fc ld [ %fp + -4 ], %g1 20063dc: 80 a0 60 00 cmp %g1, 0 20063e0: 12 80 00 39 bne 20064c4 20063e4: b0 10 00 08 mov %o0, %i0 case OBJECTS_LOCAL: /* First, it verifies if the timer must be stopped */ if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) { 20063e8: c2 07 bf ec ld [ %fp + -20 ], %g1 20063ec: 80 a0 60 00 cmp %g1, 0 20063f0: 12 80 00 14 bne 2006440 20063f4: c2 07 bf f0 ld [ %fp + -16 ], %g1 20063f8: 80 a0 60 00 cmp %g1, 0 20063fc: 12 80 00 11 bne 2006440 2006400: 01 00 00 00 nop /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 2006404: 40 00 10 0c call 200a434 <_Watchdog_Remove> 2006408: 90 02 20 10 add %o0, 0x10, %o0 /* The old data of the timer are returned */ if ( ovalue ) 200640c: 80 a6 e0 00 cmp %i3, 0 2006410: 02 80 00 05 be 2006424 2006414: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 2006418: 92 06 20 54 add %i0, 0x54, %o1 200641c: 40 00 27 eb call 20103c8 2006420: 94 10 20 10 mov 0x10, %o2 /* The new data are set */ ptimer->timer_data = normalize; 2006424: 90 06 20 54 add %i0, 0x54, %o0 2006428: 92 07 bf e4 add %fp, -28, %o1 200642c: 40 00 27 e7 call 20103c8 2006430: 94 10 20 10 mov 0x10, %o2 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 2006434: 82 10 20 04 mov 4, %g1 2006438: 10 80 00 1f b 20064b4 200643c: c2 2e 20 3c stb %g1, [ %i0 + 0x3c ] _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); 2006440: 40 00 0e dc call 2009fb0 <_Timespec_To_ticks> 2006444: 90 10 00 1a mov %i2, %o0 2006448: d0 26 20 64 st %o0, [ %i0 + 0x64 ] initial_period = _Timespec_To_ticks( &normalize.it_value ); 200644c: 40 00 0e d9 call 2009fb0 <_Timespec_To_ticks> 2006450: 90 07 bf ec add %fp, -20, %o0 activated = _POSIX_Timer_Insert_helper( 2006454: d4 06 20 08 ld [ %i0 + 8 ], %o2 return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); initial_period = _Timespec_To_ticks( &normalize.it_value ); 2006458: 92 10 00 08 mov %o0, %o1 activated = _POSIX_Timer_Insert_helper( 200645c: 17 00 80 19 sethi %hi(0x2006400), %o3 2006460: 90 06 20 10 add %i0, 0x10, %o0 2006464: 96 12 e0 dc or %o3, 0xdc, %o3 2006468: 40 00 1a 47 call 200cd84 <_POSIX_Timer_Insert_helper> 200646c: 98 10 00 18 mov %i0, %o4 initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 2006470: 80 8a 20 ff btst 0xff, %o0 2006474: 02 80 00 10 be 20064b4 2006478: 01 00 00 00 nop /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 200647c: 80 a6 e0 00 cmp %i3, 0 2006480: 02 80 00 05 be 2006494 2006484: 90 10 00 1b mov %i3, %o0 *ovalue = ptimer->timer_data; 2006488: 92 06 20 54 add %i0, 0x54, %o1 200648c: 40 00 27 cf call 20103c8 2006490: 94 10 20 10 mov 0x10, %o2 ptimer->timer_data = normalize; 2006494: 90 06 20 54 add %i0, 0x54, %o0 2006498: 92 07 bf e4 add %fp, -28, %o1 200649c: 40 00 27 cb call 20103c8 20064a0: 94 10 20 10 mov 0x10, %o2 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 20064a4: 82 10 20 03 mov 3, %g1 _TOD_Get( &ptimer->time ); 20064a8: 90 06 20 6c add %i0, 0x6c, %o0 20064ac: 40 00 05 df call 2007c28 <_TOD_Get> 20064b0: c2 2e 20 3c stb %g1, [ %i0 + 0x3c ] _Thread_Enable_dispatch(); 20064b4: 40 00 0a df call 2009030 <_Thread_Enable_dispatch> 20064b8: b0 10 20 00 clr %i0 return 0; 20064bc: 81 c7 e0 08 ret 20064c0: 81 e8 00 00 restore #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 20064c4: 40 00 25 4d call 200f9f8 <__errno> 20064c8: b0 10 3f ff mov -1, %i0 20064cc: 82 10 20 16 mov 0x16, %g1 20064d0: c2 22 00 00 st %g1, [ %o0 ] } 20064d4: 81 c7 e0 08 ret 20064d8: 81 e8 00 00 restore =============================================================================== 02006114 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 2006114: 9d e3 bf 98 save %sp, -104, %sp /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 2006118: 23 00 80 63 sethi %hi(0x2018c00), %l1 200611c: a2 14 60 50 or %l1, 0x50, %l1 ! 2018c50 <_POSIX_signals_Ualarm_timer> 2006120: c2 04 60 1c ld [ %l1 + 0x1c ], %g1 2006124: 80 a0 60 00 cmp %g1, 0 2006128: 12 80 00 0a bne 2006150 200612c: a0 10 00 18 mov %i0, %l0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 2006130: 03 00 80 18 sethi %hi(0x2006000), %g1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 2006134: c0 24 60 08 clr [ %l1 + 8 ] the_watchdog->routine = routine; 2006138: 82 10 60 e4 or %g1, 0xe4, %g1 the_watchdog->id = id; 200613c: c0 24 60 20 clr [ %l1 + 0x20 ] Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 2006140: c2 24 60 1c st %g1, [ %l1 + 0x1c ] the_watchdog->id = id; the_watchdog->user_data = user_data; 2006144: c0 24 60 24 clr [ %l1 + 0x24 ] useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 2006148: 10 80 00 1b b 20061b4 200614c: b0 10 20 00 clr %i0 if ( !the_timer->routine ) { _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 2006150: 40 00 0f 9e call 2009fc8 <_Watchdog_Remove> 2006154: 90 10 00 11 mov %l1, %o0 if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 2006158: 90 02 3f fe add %o0, -2, %o0 200615c: 80 a2 20 01 cmp %o0, 1 2006160: 18 80 00 15 bgu 20061b4 <== NEVER TAKEN 2006164: 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); 2006168: c2 04 60 0c ld [ %l1 + 0xc ], %g1 200616c: d0 04 60 14 ld [ %l1 + 0x14 ], %o0 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 2006170: 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); 2006174: 90 02 00 01 add %o0, %g1, %o0 2006178: c2 04 60 18 ld [ %l1 + 0x18 ], %g1 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 200617c: 40 00 0e 23 call 2009a08 <_Timespec_From_ticks> 2006180: 90 22 00 01 sub %o0, %g1, %o0 remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 2006184: c2 07 bf f8 ld [ %fp + -8 ], %g1 remaining += tp.tv_nsec / 1000; 2006188: 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; 200618c: b1 28 60 08 sll %g1, 8, %i0 2006190: 85 28 60 03 sll %g1, 3, %g2 2006194: 84 26 00 02 sub %i0, %g2, %g2 remaining += tp.tv_nsec / 1000; 2006198: 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; 200619c: b1 28 a0 06 sll %g2, 6, %i0 20061a0: b0 26 00 02 sub %i0, %g2, %i0 remaining += tp.tv_nsec / 1000; 20061a4: 40 00 38 5e call 201431c <.div> 20061a8: 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; 20061ac: b1 2e 20 06 sll %i0, 6, %i0 remaining += tp.tv_nsec / 1000; 20061b0: b0 02 00 18 add %o0, %i0, %i0 /* * If useconds is non-zero, then the caller wants to schedule * the alarm repeatedly at that interval. If the interval is * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { 20061b4: 80 a4 20 00 cmp %l0, 0 20061b8: 02 80 00 1a be 2006220 20061bc: 23 00 03 d0 sethi %hi(0xf4000), %l1 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 20061c0: 90 10 00 10 mov %l0, %o0 20061c4: 40 00 38 54 call 2014314 <.udiv> 20061c8: 92 14 62 40 or %l1, 0x240, %o1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 20061cc: 92 14 62 40 or %l1, 0x240, %o1 * less than a single clock tick, then fudge it to a clock tick. */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 20061d0: d0 27 bf f8 st %o0, [ %fp + -8 ] tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 20061d4: 40 00 38 fc call 20145c4 <.urem> 20061d8: 90 10 00 10 mov %l0, %o0 20061dc: 85 2a 20 07 sll %o0, 7, %g2 20061e0: 83 2a 20 02 sll %o0, 2, %g1 20061e4: 82 20 80 01 sub %g2, %g1, %g1 20061e8: 90 00 40 08 add %g1, %o0, %o0 20061ec: 91 2a 20 03 sll %o0, 3, %o0 ticks = _Timespec_To_ticks( &tp ); 20061f0: a0 07 bf f8 add %fp, -8, %l0 */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 20061f4: d0 27 bf fc st %o0, [ %fp + -4 ] ticks = _Timespec_To_ticks( &tp ); 20061f8: 40 00 0e 2b call 2009aa4 <_Timespec_To_ticks> 20061fc: 90 10 00 10 mov %l0, %o0 if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 2006200: 40 00 0e 29 call 2009aa4 <_Timespec_To_ticks> 2006204: 90 10 00 10 mov %l0, %o0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 2006208: 13 00 80 63 sethi %hi(0x2018c00), %o1 200620c: 92 12 60 50 or %o1, 0x50, %o1 ! 2018c50 <_POSIX_signals_Ualarm_timer> 2006210: d0 22 60 0c st %o0, [ %o1 + 0xc ] _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 2006214: 11 00 80 61 sethi %hi(0x2018400), %o0 2006218: 40 00 0f 11 call 2009e5c <_Watchdog_Insert> 200621c: 90 12 20 28 or %o0, 0x28, %o0 ! 2018428 <_Watchdog_Ticks_chain> } return remaining; } 2006220: 81 c7 e0 08 ret 2006224: 81 e8 00 00 restore