0800532c <_CORE_RWLock_Obtain_for_reading>: Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_RWLock_API_mp_support_callout api_rwlock_mp_support ) { 800532c: 37 9c ff e4 addi sp,sp,-28 8005330: 5b 8b 00 1c sw (sp+28),r11 8005334: 5b 8c 00 18 sw (sp+24),r12 8005338: 5b 8d 00 14 sw (sp+20),r13 800533c: 5b 8e 00 10 sw (sp+16),r14 8005340: 5b 8f 00 0c sw (sp+12),r15 8005344: 5b 90 00 08 sw (sp+8),r16 8005348: 5b 9d 00 04 sw (sp+4),ra ISR_Level level; Thread_Control *executing = _Thread_Executing; 800534c: 78 05 08 02 mvhi r5,0x802 8005350: 38 a5 19 38 ori r5,r5,0x1938 8005354: 28 ac 00 00 lw r12,(r5+0) Objects_Id id, bool wait, Watchdog_Interval timeout, CORE_RWLock_API_mp_support_callout api_rwlock_mp_support ) { 8005358: b8 20 58 00 mv r11,r1 800535c: b8 40 78 00 mv r15,r2 8005360: b8 80 70 00 mv r14,r4 8005364: 20 70 00 ff andi r16,r3,0xff * 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 ); 8005368: 90 00 68 00 rcsr r13,IE 800536c: 34 01 ff fe mvi r1,-2 8005370: a1 a1 08 00 and r1,r13,r1 8005374: d0 01 00 00 wcsr IE,r1 switch ( the_rwlock->current_state ) { 8005378: 29 61 00 44 lw r1,(r11+68) 800537c: 44 20 00 04 be r1,r0,800538c <_CORE_RWLock_Obtain_for_reading+0x60> 8005380: 34 02 00 01 mvi r2,1 8005384: 5c 22 00 12 bne r1,r2,80053cc <_CORE_RWLock_Obtain_for_reading+0xa0> 8005388: e0 00 00 08 bi 80053a8 <_CORE_RWLock_Obtain_for_reading+0x7c> case CORE_RWLOCK_UNLOCKED: the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; the_rwlock->number_of_readers += 1; 800538c: 29 61 00 48 lw r1,(r11+72) */ _ISR_Disable( level ); switch ( the_rwlock->current_state ) { case CORE_RWLOCK_UNLOCKED: the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 8005390: 34 02 00 01 mvi r2,1 8005394: 59 62 00 44 sw (r11+68),r2 the_rwlock->number_of_readers += 1; 8005398: b4 22 08 00 add r1,r1,r2 800539c: 59 61 00 48 sw (r11+72),r1 _ISR_Enable( level ); 80053a0: d0 0d 00 00 wcsr IE,r13 80053a4: e0 00 00 08 bi 80053c4 <_CORE_RWLock_Obtain_for_reading+0x98> 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 ); 80053a8: b9 60 08 00 mv r1,r11 80053ac: f8 00 08 27 calli 8007448 <_Thread_queue_First> if ( !waiter ) { 80053b0: 5c 20 00 07 bne r1,r0,80053cc <_CORE_RWLock_Obtain_for_reading+0xa0><== NEVER TAKEN the_rwlock->number_of_readers += 1; 80053b4: 29 61 00 48 lw r1,(r11+72) 80053b8: 34 21 00 01 addi r1,r1,1 80053bc: 59 61 00 48 sw (r11+72),r1 _ISR_Enable( level ); 80053c0: d0 0d 00 00 wcsr IE,r13 executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 80053c4: 34 01 00 00 mvi r1,0 80053c8: e0 00 00 05 bi 80053dc <_CORE_RWLock_Obtain_for_reading+0xb0> /* * If the thread is not willing to wait, then return immediately. */ if ( !wait ) { 80053cc: 34 01 00 00 mvi r1,0 80053d0: 5e 01 00 05 bne r16,r1,80053e4 <_CORE_RWLock_Obtain_for_reading+0xb8> _ISR_Enable( level ); 80053d4: d0 0d 00 00 wcsr IE,r13 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 80053d8: 34 01 00 02 mvi r1,2 80053dc: 59 81 00 34 sw (r12+52),r1 return; 80053e0: e0 00 00 0d bi 8005414 <_CORE_RWLock_Obtain_for_reading+0xe8> 80053e4: 34 02 00 01 mvi r2,1 _Thread_queue_Enter_critical_section( &the_rwlock->Wait_queue ); executing->Wait.queue = &the_rwlock->Wait_queue; executing->Wait.id = id; executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_READ; executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 80053e8: 59 81 00 34 sw (r12+52),r1 80053ec: 59 62 00 30 sw (r11+48),r2 * 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; executing->Wait.id = id; 80053f0: 59 8f 00 20 sw (r12+32),r15 /* * 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; 80053f4: 59 8b 00 44 sw (r12+68),r11 executing->Wait.id = id; executing->Wait.option = CORE_RWLOCK_THREAD_WAITING_FOR_READ; 80053f8: 59 81 00 30 sw (r12+48),r1 executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; _ISR_Enable( level ); 80053fc: d0 0d 00 00 wcsr IE,r13 _Thread_queue_Enqueue_with_handler( 8005400: 78 03 08 00 mvhi r3,0x800 8005404: b9 60 08 00 mv r1,r11 8005408: b9 c0 10 00 mv r2,r14 800540c: 38 63 55 c8 ori r3,r3,0x55c8 8005410: f8 00 07 1e calli 8007088 <_Thread_queue_Enqueue_with_handler> timeout, _CORE_RWLock_Timeout ); /* return to API level so it can dispatch and we block */ } 8005414: 2b 9d 00 04 lw ra,(sp+4) 8005418: 2b 8b 00 1c lw r11,(sp+28) 800541c: 2b 8c 00 18 lw r12,(sp+24) 8005420: 2b 8d 00 14 lw r13,(sp+20) 8005424: 2b 8e 00 10 lw r14,(sp+16) 8005428: 2b 8f 00 0c lw r15,(sp+12) 800542c: 2b 90 00 08 lw r16,(sp+8) 8005430: 37 9c 00 1c addi sp,sp,28 8005434: c3 a0 00 00 ret 080054cc <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 80054cc: 37 9c ff f4 addi sp,sp,-12 80054d0: 5b 8b 00 0c sw (sp+12),r11 80054d4: 5b 8c 00 08 sw (sp+8),r12 80054d8: 5b 9d 00 04 sw (sp+4),ra ISR_Level level; Thread_Control *executing = _Thread_Executing; 80054dc: 78 02 08 02 mvhi r2,0x802 80054e0: 38 42 19 38 ori r2,r2,0x1938 80054e4: 28 43 00 00 lw r3,(r2+0) */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 80054e8: b8 20 58 00 mv r11,r1 * 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 ); 80054ec: 90 00 08 00 rcsr r1,IE 80054f0: 34 02 ff fe mvi r2,-2 80054f4: a0 22 10 00 and r2,r1,r2 80054f8: d0 02 00 00 wcsr IE,r2 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 80054fc: 29 62 00 44 lw r2,(r11+68) 8005500: 5c 40 00 05 bne r2,r0,8005514 <_CORE_RWLock_Release+0x48> _ISR_Enable( level ); 8005504: d0 01 00 00 wcsr IE,r1 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 8005508: 34 01 00 02 mvi r1,2 800550c: 58 61 00 34 sw (r3+52),r1 return CORE_RWLOCK_SUCCESSFUL; 8005510: e0 00 00 28 bi 80055b0 <_CORE_RWLock_Release+0xe4> } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 8005514: 34 04 00 01 mvi r4,1 8005518: 5c 44 00 07 bne r2,r4,8005534 <_CORE_RWLock_Release+0x68> the_rwlock->number_of_readers -= 1; 800551c: 29 62 00 48 lw r2,(r11+72) 8005520: 34 42 ff ff addi r2,r2,-1 8005524: 59 62 00 48 sw (r11+72),r2 if ( the_rwlock->number_of_readers != 0 ) { 8005528: 44 40 00 03 be r2,r0,8005534 <_CORE_RWLock_Release+0x68> /* must be unlocked again */ _ISR_Enable( level ); 800552c: d0 01 00 00 wcsr IE,r1 return CORE_RWLOCK_SUCCESSFUL; 8005530: e0 00 00 20 bi 80055b0 <_CORE_RWLock_Release+0xe4> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 8005534: 34 02 00 00 mvi r2,0 8005538: 58 62 00 34 sw (r3+52),r2 /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; 800553c: 59 62 00 44 sw (r11+68),r2 _ISR_Enable( level ); 8005540: d0 01 00 00 wcsr IE,r1 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 8005544: b9 60 08 00 mv r1,r11 8005548: f8 00 06 63 calli 8006ed4 <_Thread_queue_Dequeue> if ( next ) { 800554c: 44 20 00 19 be r1,r0,80055b0 <_CORE_RWLock_Release+0xe4> if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 8005550: 28 22 00 30 lw r2,(r1+48) 8005554: 34 01 00 01 mvi r1,1 8005558: 5c 41 00 04 bne r2,r1,8005568 <_CORE_RWLock_Release+0x9c> the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 800555c: 34 01 00 02 mvi r1,2 8005560: 59 61 00 44 sw (r11+68),r1 return CORE_RWLOCK_SUCCESSFUL; 8005564: e0 00 00 13 bi 80055b0 <_CORE_RWLock_Release+0xe4> } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 8005568: 29 62 00 48 lw r2,(r11+72) the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 800556c: 59 61 00 44 sw (r11+68),r1 * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); if ( !next || next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) 8005570: b8 20 60 00 mv r12,r1 } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 8005574: 34 42 00 01 addi r2,r2,1 8005578: 59 62 00 48 sw (r11+72),r2 /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); 800557c: b9 60 08 00 mv r1,r11 8005580: f8 00 07 b2 calli 8007448 <_Thread_queue_First> 8005584: b8 20 18 00 mv r3,r1 if ( !next || next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 8005588: b8 20 10 00 mv r2,r1 800558c: b9 60 08 00 mv r1,r11 /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); if ( !next || 8005590: 44 60 00 08 be r3,r0,80055b0 <_CORE_RWLock_Release+0xe4> next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) 8005594: 28 63 00 30 lw r3,(r3+48) 8005598: 44 6c 00 06 be r3,r12,80055b0 <_CORE_RWLock_Release+0xe4> <== NEVER TAKEN return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; 800559c: 29 63 00 48 lw r3,(r11+72) 80055a0: 34 63 00 01 addi r3,r3,1 80055a4: 59 63 00 48 sw (r11+72),r3 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 80055a8: f8 00 07 60 calli 8007328 <_Thread_queue_Extract> } 80055ac: e3 ff ff f4 bi 800557c <_CORE_RWLock_Release+0xb0> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 80055b0: 34 01 00 00 mvi r1,0 80055b4: 2b 9d 00 04 lw ra,(sp+4) 80055b8: 2b 8b 00 0c lw r11,(sp+12) 80055bc: 2b 8c 00 08 lw r12,(sp+8) 80055c0: 37 9c 00 0c addi sp,sp,12 80055c4: c3 a0 00 00 ret 080055c8 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 80055c8: 37 9c ff f8 addi sp,sp,-8 80055cc: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 80055d0: 37 82 00 08 addi r2,sp,8 80055d4: f8 00 05 33 calli 8006aa0 <_Thread_Get> switch ( location ) { 80055d8: 2b 82 00 08 lw r2,(sp+8) 80055dc: 5c 40 00 07 bne r2,r0,80055f8 <_CORE_RWLock_Timeout+0x30> <== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 80055e0: f8 00 07 d5 calli 8007534 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 80055e4: 78 01 08 02 mvhi r1,0x802 80055e8: 38 21 18 7c ori r1,r1,0x187c 80055ec: 28 22 00 00 lw r2,(r1+0) 80055f0: 34 42 ff ff addi r2,r2,-1 80055f4: 58 22 00 00 sw (r1+0),r2 _Thread_Unnest_dispatch(); break; } } 80055f8: 2b 9d 00 04 lw ra,(sp+4) 80055fc: 37 9c 00 08 addi sp,sp,8 8005600: c3 a0 00 00 ret 08014ecc <_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 ) { 8014ecc: 37 9c ff e4 addi sp,sp,-28 8014ed0: 5b 8b 00 1c sw (sp+28),r11 8014ed4: 5b 8c 00 18 sw (sp+24),r12 8014ed8: 5b 8d 00 14 sw (sp+20),r13 8014edc: 5b 8e 00 10 sw (sp+16),r14 8014ee0: 5b 8f 00 0c sw (sp+12),r15 8014ee4: 5b 90 00 08 sw (sp+8),r16 8014ee8: 5b 9d 00 04 sw (sp+4),ra 8014eec: b8 20 58 00 mv r11,r1 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 8014ef0: 28 21 00 4c lw r1,(r1+76) Objects_Id id __attribute__((unused)), CORE_message_queue_API_mp_support_callout api_message_queue_mp_support __attribute__((unused)), #endif uint32_t *count ) { 8014ef4: b8 60 70 00 mv r14,r3 8014ef8: b8 40 80 00 mv r16,r2 8014efc: b8 c0 78 00 mv r15,r6 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 8014f00: 50 23 00 03 bgeu r1,r3,8014f0c <_CORE_message_queue_Broadcast+0x40><== ALWAYS TAKEN 8014f04: 34 01 00 01 mvi r1,1 <== NOT EXECUTED 8014f08: e0 00 00 13 bi 8014f54 <_CORE_message_queue_Broadcast+0x88><== NOT EXECUTED * 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 ) { 8014f0c: 29 63 00 48 lw r3,(r11+72) 8014f10: 34 01 00 00 mvi r1,0 * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 8014f14: b8 60 68 00 mv r13,r3 * 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 ) { 8014f18: 44 61 00 08 be r3,r1,8014f38 <_CORE_message_queue_Broadcast+0x6c> *count = 0; 8014f1c: 58 c1 00 00 sw (r6+0),r1 return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 8014f20: e0 00 00 0d bi 8014f54 <_CORE_message_queue_Broadcast+0x88> const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 8014f24: 29 81 00 2c lw r1,(r12+44) */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 8014f28: 35 ad 00 01 addi r13,r13,1 8014f2c: f8 00 2c 6e calli 80200e4 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 8014f30: 29 81 00 28 lw r1,(r12+40) 8014f34: 58 2e 00 00 sw (r1+0),r14 * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { 8014f38: b9 60 08 00 mv r1,r11 8014f3c: f8 00 0c 27 calli 8017fd8 <_Thread_queue_Dequeue> 8014f40: b8 20 60 00 mv r12,r1 8014f44: ba 00 10 00 mv r2,r16 8014f48: b9 c0 18 00 mv r3,r14 /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 8014f4c: 5c 20 ff f6 bne r1,r0,8014f24 <_CORE_message_queue_Broadcast+0x58> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 8014f50: 59 ed 00 00 sw (r15+0),r13 return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; } 8014f54: 2b 9d 00 04 lw ra,(sp+4) 8014f58: 2b 8b 00 1c lw r11,(sp+28) 8014f5c: 2b 8c 00 18 lw r12,(sp+24) 8014f60: 2b 8d 00 14 lw r13,(sp+20) 8014f64: 2b 8e 00 10 lw r14,(sp+16) 8014f68: 2b 8f 00 0c lw r15,(sp+12) 8014f6c: 2b 90 00 08 lw r16,(sp+8) 8014f70: 37 9c 00 1c addi sp,sp,28 8014f74: c3 a0 00 00 ret 0800d828 <_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 ) { 800d828: 37 9c ff e8 addi sp,sp,-24 800d82c: 5b 8b 00 18 sw (sp+24),r11 800d830: 5b 8c 00 14 sw (sp+20),r12 800d834: 5b 8d 00 10 sw (sp+16),r13 800d838: 5b 8e 00 0c sw (sp+12),r14 800d83c: 5b 8f 00 08 sw (sp+8),r15 800d840: 5b 9d 00 04 sw (sp+4),ra 800d844: b8 20 58 00 mv r11,r1 size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; the_message_queue->number_of_pending_messages = 0; 800d848: 34 01 00 00 mvi r1,0 CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; the_message_queue->notify_argument = the_argument; 800d84c: 59 61 00 64 sw (r11+100),r1 800d850: 59 61 00 48 sw (r11+72),r1 CORE_message_queue_Control *the_message_queue, CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; 800d854: 59 61 00 60 sw (r11+96),r1 ) { size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; 800d858: 59 63 00 44 sw (r11+68),r3 the_message_queue->number_of_pending_messages = 0; the_message_queue->maximum_message_size = maximum_message_size; 800d85c: 59 64 00 4c sw (r11+76),r4 /* * 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)) { 800d860: 20 81 00 03 andi r1,r4,0x3 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 ) { 800d864: b8 60 68 00 mv r13,r3 800d868: b8 40 78 00 mv r15,r2 /* * 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)) { 800d86c: b8 80 60 00 mv r12,r4 800d870: 44 20 00 05 be r1,r0,800d884 <_CORE_message_queue_Initialize+0x5c> allocated_message_size += sizeof(uint32_t); 800d874: 34 8c 00 04 addi r12,r4,4 allocated_message_size &= ~(sizeof(uint32_t) - 1); 800d878: 34 01 ff fc mvi r1,-4 800d87c: a1 81 60 00 and r12,r12,r1 } if (allocated_message_size < maximum_message_size) 800d880: 54 8c 00 1c bgu r4,r12,800d8f0 <_CORE_message_queue_Initialize+0xc8><== NEVER TAKEN /* * 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)); 800d884: 35 8e 00 14 addi r14,r12,20 /* * 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 * 800d888: b9 c0 08 00 mv r1,r14 800d88c: b9 a0 10 00 mv r2,r13 800d890: f8 00 6a 94 calli 80282e0 <__mulsi3> (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 800d894: 55 81 00 17 bgu r12,r1,800d8f0 <_CORE_message_queue_Initialize+0xc8><== NEVER TAKEN return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 800d898: f8 00 0d f7 calli 8011074 <_Workspace_Allocate> 800d89c: 59 61 00 5c sw (r11+92),r1 _Workspace_Allocate( message_buffering_required ); if (the_message_queue->message_buffers == 0) 800d8a0: 44 20 00 14 be r1,r0,800d8f0 <_CORE_message_queue_Initialize+0xc8> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 800d8a4: b8 20 10 00 mv r2,r1 800d8a8: b9 a0 18 00 mv r3,r13 800d8ac: b9 c0 20 00 mv r4,r14 800d8b0: 35 61 00 68 addi r1,r11,104 800d8b4: f8 00 18 89 calli 8013ad8 <_Chain_Initialize> allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 800d8b8: 29 e2 00 00 lw r2,(r15+0) */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 800d8bc: 35 63 00 54 addi r3,r11,84 the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 800d8c0: 35 61 00 50 addi r1,r11,80 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 800d8c4: 59 63 00 50 sw (r11+80),r3 800d8c8: 64 42 00 01 cmpei r2,r2,1 the_chain->permanent_null = NULL; 800d8cc: 34 03 00 00 mvi r3,0 800d8d0: 59 63 00 54 sw (r11+84),r3 the_chain->last = _Chain_Head(the_chain); 800d8d4: 59 61 00 58 sw (r11+88),r1 800d8d8: 34 03 00 80 mvi r3,128 800d8dc: b9 60 08 00 mv r1,r11 800d8e0: 34 04 00 06 mvi r4,6 800d8e4: f8 00 0a 6d calli 8010298 <_Thread_queue_Initialize> 800d8e8: 34 01 00 01 mvi r1,1 THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 800d8ec: e0 00 00 02 bi 800d8f4 <_CORE_message_queue_Initialize+0xcc> 800d8f0: 34 01 00 00 mvi r1,0 } 800d8f4: 2b 9d 00 04 lw ra,(sp+4) 800d8f8: 2b 8b 00 18 lw r11,(sp+24) 800d8fc: 2b 8c 00 14 lw r12,(sp+20) 800d900: 2b 8d 00 10 lw r13,(sp+16) 800d904: 2b 8e 00 0c lw r14,(sp+12) 800d908: 2b 8f 00 08 lw r15,(sp+8) 800d90c: 37 9c 00 18 addi sp,sp,24 800d910: c3 a0 00 00 ret 0800d914 <_CORE_message_queue_Seize>: void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 800d914: 37 9c ff f0 addi sp,sp,-16 800d918: 5b 8b 00 10 sw (sp+16),r11 800d91c: 5b 8c 00 0c sw (sp+12),r12 800d920: 5b 8d 00 08 sw (sp+8),r13 800d924: 5b 9d 00 04 sw (sp+4),ra ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 800d928: 78 07 08 02 mvhi r7,0x802 800d92c: 38 e7 cb 08 ori r7,r7,0xcb08 800d930: 28 e7 00 00 lw r7,(r7+0) void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 800d934: b8 20 58 00 mv r11,r1 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; 800d938: 34 01 00 00 mvi r1,0 800d93c: 58 e1 00 34 sw (r7+52),r1 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 800d940: 20 a5 00 ff andi r5,r5,0xff 800d944: b8 60 08 00 mv r1,r3 CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; _ISR_Disable( level ); 800d948: 90 00 40 00 rcsr r8,IE 800d94c: 34 03 ff fe mvi r3,-2 800d950: a1 03 18 00 and r3,r8,r3 800d954: d0 03 00 00 wcsr IE,r3 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 800d958: 29 6c 00 50 lw r12,(r11+80) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 800d95c: 35 63 00 54 addi r3,r11,84 800d960: 5d 83 00 03 bne r12,r3,800d96c <_CORE_message_queue_Seize+0x58> 800d964: 34 0c 00 00 mvi r12,0 800d968: e0 00 00 28 bi 800da08 <_CORE_message_queue_Seize+0xf4> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 800d96c: 29 83 00 00 lw r3,(r12+0) the_chain->first = new_first; new_first->previous = _Chain_Head(the_chain); 800d970: 35 69 00 50 addi r9,r11,80 Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; the_chain->first = new_first; 800d974: 59 63 00 50 sw (r11+80),r3 new_first->previous = _Chain_Head(the_chain); 800d978: 58 69 00 04 sw (r3+4),r9 the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { 800d97c: 45 80 00 23 be r12,r0,800da08 <_CORE_message_queue_Seize+0xf4><== NEVER TAKEN the_message_queue->number_of_pending_messages -= 1; 800d980: 29 62 00 48 lw r2,(r11+72) 800d984: 34 42 ff ff addi r2,r2,-1 800d988: 59 62 00 48 sw (r11+72),r2 _ISR_Enable( level ); 800d98c: d0 08 00 00 wcsr IE,r8 *size_p = the_message->Contents.size; 800d990: 29 83 00 0c lw r3,(r12+12) _Thread_Executing->Wait.count = 800d994: 78 02 08 02 mvhi r2,0x802 800d998: 38 42 cb 08 ori r2,r2,0xcb08 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; 800d99c: 58 83 00 00 sw (r4+0),r3 _Thread_Executing->Wait.count = 800d9a0: 29 84 00 08 lw r4,(r12+8) 800d9a4: 28 42 00 00 lw r2,(r2+0) _CORE_message_queue_Get_message_priority( the_message ); _CORE_message_queue_Copy_buffer( the_message->Contents.buffer, 800d9a8: 35 8d 00 10 addi r13,r12,16 if ( the_message != NULL ) { the_message_queue->number_of_pending_messages -= 1; _ISR_Enable( level ); *size_p = the_message->Contents.size; _Thread_Executing->Wait.count = 800d9ac: 58 44 00 24 sw (r2+36),r4 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 800d9b0: b9 a0 10 00 mv r2,r13 800d9b4: f8 00 28 1a calli 8017a1c * 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 ); 800d9b8: b9 60 08 00 mv r1,r11 800d9bc: f8 00 09 02 calli 800fdc4 <_Thread_queue_Dequeue> 800d9c0: b8 20 20 00 mv r4,r1 if ( !the_thread ) { 800d9c4: 5c 20 00 05 bne r1,r0,800d9d8 <_CORE_message_queue_Seize+0xc4> 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 ); 800d9c8: 35 61 00 68 addi r1,r11,104 800d9cc: b9 80 10 00 mv r2,r12 800d9d0: fb ff ff 66 calli 800d768 <_Chain_Append> _CORE_message_queue_Free_message_buffer( the_message_queue, the_message ); return; 800d9d4: e0 00 00 1e bi 800da4c <_CORE_message_queue_Seize+0x138> */ _CORE_message_queue_Set_message_priority( the_message, the_thread->Wait.count ); the_message->Contents.size = (size_t) the_thread->Wait.option; 800d9d8: 28 23 00 30 lw r3,(r1+48) CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 800d9dc: 28 21 00 24 lw r1,(r1+36) 800d9e0: 59 83 00 0c sw (r12+12),r3 800d9e4: 59 81 00 08 sw (r12+8),r1 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 800d9e8: 28 82 00 2c lw r2,(r4+44) 800d9ec: b9 a0 08 00 mv r1,r13 800d9f0: f8 00 28 0b calli 8017a1c the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 800d9f4: 29 83 00 08 lw r3,(r12+8) 800d9f8: b9 60 08 00 mv r1,r11 800d9fc: b9 80 10 00 mv r2,r12 800da00: f8 00 18 44 calli 8013b10 <_CORE_message_queue_Insert_message> the_message_queue, the_message, _CORE_message_queue_Get_message_priority( the_message ) ); return; 800da04: e0 00 00 12 bi 800da4c <_CORE_message_queue_Seize+0x138> } #endif } if ( !wait ) { 800da08: 5c ac 00 05 bne r5,r12,800da1c <_CORE_message_queue_Seize+0x108> _ISR_Enable( level ); 800da0c: d0 08 00 00 wcsr IE,r8 executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 800da10: 34 01 00 04 mvi r1,4 800da14: 58 e1 00 34 sw (r7+52),r1 return; 800da18: e0 00 00 0d bi 800da4c <_CORE_message_queue_Seize+0x138> 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; 800da1c: 34 03 00 01 mvi r3,1 800da20: 59 63 00 30 sw (r11+48),r3 _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; 800da24: 58 e4 00 28 sw (r7+40),r4 return; } _Thread_queue_Enter_critical_section( &the_message_queue->Wait_queue ); executing->Wait.queue = &the_message_queue->Wait_queue; executing->Wait.id = id; 800da28: 58 e2 00 20 sw (r7+32),r2 executing->Wait.return_argument_second.mutable_object = buffer; 800da2c: 58 e1 00 2c sw (r7+44),r1 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; 800da30: 58 eb 00 44 sw (r7+68),r11 executing->Wait.id = id; executing->Wait.return_argument_second.mutable_object = buffer; executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 800da34: d0 08 00 00 wcsr IE,r8 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 800da38: 78 03 08 01 mvhi r3,0x801 800da3c: b9 60 08 00 mv r1,r11 800da40: b8 c0 10 00 mv r2,r6 800da44: 38 63 03 78 ori r3,r3,0x378 800da48: f8 00 09 4c calli 800ff78 <_Thread_queue_Enqueue_with_handler> } 800da4c: 2b 9d 00 04 lw ra,(sp+4) 800da50: 2b 8b 00 10 lw r11,(sp+16) 800da54: 2b 8c 00 0c lw r12,(sp+12) 800da58: 2b 8d 00 08 lw r13,(sp+8) 800da5c: 37 9c 00 10 addi sp,sp,16 800da60: c3 a0 00 00 ret 08004fc0 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 8004fc0: 37 9c ff e8 addi sp,sp,-24 8004fc4: 5b 8b 00 14 sw (sp+20),r11 8004fc8: 5b 8c 00 10 sw (sp+16),r12 8004fcc: 5b 8d 00 0c sw (sp+12),r13 8004fd0: 5b 8e 00 08 sw (sp+8),r14 8004fd4: 5b 9d 00 04 sw (sp+4),ra _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 8004fd8: 78 06 08 02 mvhi r6,0x802 8004fdc: 38 c6 59 44 ori r6,r6,0x5944 8004fe0: 28 c6 00 00 lw r6,(r6+0) Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 8004fe4: 5b 85 00 18 sw (sp+24),r5 8004fe8: b8 20 58 00 mv r11,r1 8004fec: b8 40 70 00 mv r14,r2 8004ff0: b8 80 68 00 mv r13,r4 8004ff4: 20 6c 00 ff andi r12,r3,0xff _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 8004ff8: 44 c0 00 0b be r6,r0,8005024 <_CORE_mutex_Seize+0x64> 8004ffc: 45 80 00 0a be r12,r0,8005024 <_CORE_mutex_Seize+0x64> <== NEVER TAKEN 8005000: 78 01 08 02 mvhi r1,0x802 8005004: 38 21 5a e0 ori r1,r1,0x5ae0 8005008: 28 21 00 00 lw r1,(r1+0) 800500c: 34 02 00 01 mvi r2,1 8005010: 50 41 00 05 bgeu r2,r1,8005024 <_CORE_mutex_Seize+0x64> 8005014: 34 01 00 00 mvi r1,0 8005018: b8 20 10 00 mv r2,r1 800501c: 34 03 00 13 mvi r3,19 8005020: f8 00 01 f2 calli 80057e8 <_Internal_error_Occurred> 8005024: b9 60 08 00 mv r1,r11 8005028: 37 82 00 18 addi r2,sp,24 800502c: f8 00 28 32 calli 800f0f4 <_CORE_mutex_Seize_interrupt_trylock> 8005030: 44 20 00 19 be r1,r0,8005094 <_CORE_mutex_Seize+0xd4> 8005034: 78 01 08 02 mvhi r1,0x802 8005038: 38 21 5a 00 ori r1,r1,0x5a00 800503c: 5d 80 00 07 bne r12,r0,8005058 <_CORE_mutex_Seize+0x98> 8005040: 2b 82 00 18 lw r2,(sp+24) 8005044: d0 02 00 00 wcsr IE,r2 8005048: 28 21 00 00 lw r1,(r1+0) 800504c: 34 02 00 01 mvi r2,1 8005050: 58 22 00 34 sw (r1+52),r2 8005054: e0 00 00 10 bi 8005094 <_CORE_mutex_Seize+0xd4> 8005058: 28 23 00 00 lw r3,(r1+0) rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 800505c: 78 01 08 02 mvhi r1,0x802 8005060: 38 21 59 44 ori r1,r1,0x5944 8005064: 58 6e 00 20 sw (r3+32),r14 8005068: 28 22 00 00 lw r2,(r1+0) 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; 800506c: 34 04 00 01 mvi r4,1 8005070: 59 64 00 30 sw (r11+48),r4 8005074: b4 44 10 00 add r2,r2,r4 8005078: 58 22 00 00 sw (r1+0),r2 800507c: 58 6b 00 44 sw (r3+68),r11 8005080: 2b 81 00 18 lw r1,(sp+24) 8005084: d0 01 00 00 wcsr IE,r1 8005088: b9 60 08 00 mv r1,r11 800508c: b9 a0 10 00 mv r2,r13 8005090: fb ff ff ab calli 8004f3c <_CORE_mutex_Seize_interrupt_blocking> } 8005094: 2b 9d 00 04 lw ra,(sp+4) 8005098: 2b 8b 00 14 lw r11,(sp+20) 800509c: 2b 8c 00 10 lw r12,(sp+16) 80050a0: 2b 8d 00 0c lw r13,(sp+12) 80050a4: 2b 8e 00 08 lw r14,(sp+8) 80050a8: 37 9c 00 18 addi sp,sp,24 80050ac: c3 a0 00 00 ret 08005240 <_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 ) { 8005240: 37 9c ff f8 addi sp,sp,-8 8005244: 5b 8b 00 08 sw (sp+8),r11 8005248: 5b 9d 00 04 sw (sp+4),ra 800524c: b8 20 58 00 mv r11,r1 ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 8005250: f8 00 06 92 calli 8006c98 <_Thread_queue_Dequeue> 8005254: 34 02 00 00 mvi r2,0 8005258: 5c 22 00 0e bne r1,r2,8005290 <_CORE_semaphore_Surrender+0x50> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 800525c: 90 00 08 00 rcsr r1,IE 8005260: 34 02 ff fe mvi r2,-2 8005264: a0 22 10 00 and r2,r1,r2 8005268: d0 02 00 00 wcsr IE,r2 if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 800526c: 29 62 00 48 lw r2,(r11+72) 8005270: 29 63 00 40 lw r3,(r11+64) 8005274: 54 62 00 03 bgu r3,r2,8005280 <_CORE_semaphore_Surrender+0x40><== ALWAYS TAKEN 8005278: 34 02 00 04 mvi r2,4 <== NOT EXECUTED 800527c: e0 00 00 04 bi 800528c <_CORE_semaphore_Surrender+0x4c> <== NOT EXECUTED the_semaphore->count += 1; 8005280: 34 42 00 01 addi r2,r2,1 8005284: 59 62 00 48 sw (r11+72),r2 8005288: 34 02 00 00 mvi r2,0 else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 800528c: d0 01 00 00 wcsr IE,r1 } return status; } 8005290: b8 40 08 00 mv r1,r2 8005294: 2b 9d 00 04 lw ra,(sp+4) 8005298: 2b 8b 00 08 lw r11,(sp+8) 800529c: 37 9c 00 08 addi sp,sp,8 80052a0: c3 a0 00 00 ret 0800e1dc <_Event_Seize>: rtems_event_set event_in, rtems_option option_set, rtems_interval ticks, rtems_event_set *event_out ) { 800e1dc: 37 9c ff f8 addi sp,sp,-8 800e1e0: 5b 8b 00 08 sw (sp+8),r11 800e1e4: 5b 9d 00 04 sw (sp+4),ra rtems_event_set pending_events; ISR_Level level; RTEMS_API_Control *api; Thread_blocking_operation_States sync_state; executing = _Thread_Executing; 800e1e8: 78 05 08 02 mvhi r5,0x802 800e1ec: 38 a5 5a 00 ori r5,r5,0x5a00 800e1f0: 28 ab 00 00 lw r11,(r5+0) executing->Wait.return_code = RTEMS_SUCCESSFUL; 800e1f4: 34 05 00 00 mvi r5,0 800e1f8: 59 65 00 34 sw (r11+52),r5 api = executing->API_Extensions[ THREAD_API_RTEMS ]; 800e1fc: 29 67 01 28 lw r7,(r11+296) _ISR_Disable( level ); 800e200: 90 00 30 00 rcsr r6,IE 800e204: 34 05 ff fe mvi r5,-2 800e208: a0 c5 28 00 and r5,r6,r5 800e20c: d0 05 00 00 wcsr IE,r5 pending_events = api->pending_events; 800e210: 28 e8 00 00 lw r8,(r7+0) RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Get( rtems_event_set the_event_set, rtems_event_set the_event_condition ) { return ( the_event_set & the_event_condition ); 800e214: a0 28 28 00 and r5,r1,r8 seized_events = _Event_sets_Get( pending_events, event_in ); if ( !_Event_sets_Is_empty( seized_events ) && 800e218: 44 a0 00 09 be r5,r0,800e23c <_Event_Seize+0x60> 800e21c: 44 a1 00 03 be r5,r1,800e228 <_Event_Seize+0x4c> 800e220: 20 49 00 02 andi r9,r2,0x2 800e224: 45 20 00 06 be r9,r0,800e23c <_Event_Seize+0x60> <== NEVER TAKEN (seized_events == event_in || _Options_Is_any( option_set )) ) { api->pending_events = 800e228: a4 a0 08 00 not r1,r5 800e22c: a0 28 40 00 and r8,r1,r8 800e230: 58 e8 00 00 sw (r7+0),r8 _Event_sets_Clear( pending_events, seized_events ); _ISR_Enable( level ); 800e234: d0 06 00 00 wcsr IE,r6 800e238: e0 00 00 06 bi 800e250 <_Event_Seize+0x74> *event_out = seized_events; return; } if ( _Options_Is_no_wait( option_set ) ) { 800e23c: 20 47 00 01 andi r7,r2,0x1 800e240: 44 e0 00 06 be r7,r0,800e258 <_Event_Seize+0x7c> _ISR_Enable( level ); 800e244: d0 06 00 00 wcsr IE,r6 executing->Wait.return_code = RTEMS_UNSATISFIED; 800e248: 34 01 00 0d mvi r1,13 800e24c: 59 61 00 34 sw (r11+52),r1 *event_out = seized_events; 800e250: 58 85 00 00 sw (r4+0),r5 return; 800e254: e0 00 00 29 bi 800e2f8 <_Event_Seize+0x11c> */ executing->Wait.option = (uint32_t) option_set; executing->Wait.count = (uint32_t) event_in; executing->Wait.return_argument = event_out; _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 800e258: 78 05 08 02 mvhi r5,0x802 800e25c: 38 a5 62 ec ori r5,r5,0x62ec 800e260: 34 07 00 01 mvi r7,1 800e264: 58 a7 00 00 sw (r5+0),r7 * set properly when we are marked as in the event critical section. * * 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; 800e268: 59 62 00 30 sw (r11+48),r2 executing->Wait.count = (uint32_t) event_in; 800e26c: 59 61 00 24 sw (r11+36),r1 executing->Wait.return_argument = event_out; 800e270: 59 64 00 28 sw (r11+40),r4 _Event_Sync_state = THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; _ISR_Enable( level ); 800e274: d0 06 00 00 wcsr IE,r6 if ( ticks ) { 800e278: 34 04 00 00 mvi r4,0 800e27c: 44 64 00 0d be r3,r4,800e2b0 <_Event_Seize+0xd4> _Watchdog_Initialize( 800e280: 29 65 00 08 lw r5,(r11+8) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 800e284: 78 02 08 00 mvhi r2,0x800 800e288: 38 42 e4 c4 ori r2,r2,0xe4c4 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 800e28c: 78 01 08 02 mvhi r1,0x802 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 800e290: 59 62 00 64 sw (r11+100),r2 the_watchdog->id = id; 800e294: 59 65 00 68 sw (r11+104),r5 the_watchdog->user_data = user_data; 800e298: 59 64 00 6c sw (r11+108),r4 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 800e29c: 59 63 00 54 sw (r11+84),r3 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 800e2a0: 59 64 00 50 sw (r11+80),r4 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 800e2a4: 38 21 5a 20 ori r1,r1,0x5a20 800e2a8: 35 62 00 48 addi r2,r11,72 800e2ac: fb ff e6 09 calli 8007ad0 <_Watchdog_Insert> NULL ); _Watchdog_Insert_ticks( &executing->Timer, ticks ); } _Thread_Set_state( executing, STATES_WAITING_FOR_EVENT ); 800e2b0: b9 60 08 00 mv r1,r11 800e2b4: 34 02 01 00 mvi r2,256 800e2b8: fb ff e4 12 calli 8007300 <_Thread_Set_state> _ISR_Disable( level ); 800e2bc: 90 00 18 00 rcsr r3,IE 800e2c0: 34 01 ff fe mvi r1,-2 800e2c4: a0 61 08 00 and r1,r3,r1 800e2c8: d0 01 00 00 wcsr IE,r1 sync_state = _Event_Sync_state; 800e2cc: 78 02 08 02 mvhi r2,0x802 800e2d0: 38 42 62 ec ori r2,r2,0x62ec 800e2d4: 28 41 00 00 lw r1,(r2+0) _Event_Sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 800e2d8: 34 04 00 00 mvi r4,0 800e2dc: 58 44 00 00 sw (r2+0),r4 if ( sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) { 800e2e0: 34 02 00 01 mvi r2,1 800e2e4: 5c 22 00 03 bne r1,r2,800e2f0 <_Event_Seize+0x114> _ISR_Enable( level ); 800e2e8: d0 03 00 00 wcsr IE,r3 return; 800e2ec: e0 00 00 03 bi 800e2f8 <_Event_Seize+0x11c> * 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 ); 800e2f0: b9 60 10 00 mv r2,r11 800e2f4: f8 00 05 b5 calli 800f9c8 <_Thread_blocking_operation_Cancel> } 800e2f8: 2b 9d 00 04 lw ra,(sp+4) 800e2fc: 2b 8b 00 08 lw r11,(sp+8) 800e300: 37 9c 00 08 addi sp,sp,8 800e304: c3 a0 00 00 ret 0800e370 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 800e370: 37 9c ff f8 addi sp,sp,-8 800e374: 5b 8b 00 08 sw (sp+8),r11 800e378: 5b 9d 00 04 sw (sp+4),ra 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 ]; 800e37c: 28 24 01 28 lw r4,(r1+296) option_set = (rtems_option) the_thread->Wait.option; 800e380: 28 28 00 30 lw r8,(r1+48) */ void _Event_Surrender( Thread_Control *the_thread ) { 800e384: b8 20 58 00 mv r11,r1 api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; option_set = (rtems_option) the_thread->Wait.option; _ISR_Disable( level ); 800e388: 90 00 08 00 rcsr r1,IE 800e38c: 34 07 ff fe mvi r7,-2 800e390: a0 27 38 00 and r7,r1,r7 800e394: d0 07 00 00 wcsr IE,r7 pending_events = api->pending_events; 800e398: 28 85 00 00 lw r5,(r4+0) event_condition = (rtems_event_set) the_thread->Wait.count; 800e39c: 29 66 00 24 lw r6,(r11+36) RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Get( rtems_event_set the_event_set, rtems_event_set the_event_condition ) { return ( the_event_set & the_event_condition ); 800e3a0: a0 c5 10 00 and r2,r6,r5 seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { 800e3a4: 5c 40 00 03 bne r2,r0,800e3b0 <_Event_Surrender+0x40> _ISR_Enable( level ); 800e3a8: d0 01 00 00 wcsr IE,r1 return; 800e3ac: e0 00 00 42 bi 800e4b4 <_Event_Surrender+0x144> /* * 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() && 800e3b0: 78 03 08 02 mvhi r3,0x802 800e3b4: 38 63 59 dc ori r3,r3,0x59dc 800e3b8: 28 63 00 00 lw r3,(r3+0) 800e3bc: 44 60 00 1d be r3,r0,800e430 <_Event_Surrender+0xc0> 800e3c0: 78 03 08 02 mvhi r3,0x802 800e3c4: 38 63 5a 00 ori r3,r3,0x5a00 800e3c8: 28 63 00 00 lw r3,(r3+0) 800e3cc: 5d 63 00 19 bne r11,r3,800e430 <_Event_Surrender+0xc0> _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 800e3d0: 78 03 08 02 mvhi r3,0x802 800e3d4: 38 63 62 ec ori r3,r3,0x62ec 800e3d8: 28 6a 00 00 lw r10,(r3+0) /* * 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() && 800e3dc: 34 09 00 02 mvi r9,2 800e3e0: 45 49 00 04 be r10,r9,800e3f0 <_Event_Surrender+0x80> <== NEVER TAKEN _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 800e3e4: 28 69 00 00 lw r9,(r3+0) /* * 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() && 800e3e8: 34 03 00 01 mvi r3,1 800e3ec: 5d 23 00 11 bne r9,r3,800e430 <_Event_Surrender+0xc0> _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) ) { 800e3f0: 44 46 00 03 be r2,r6,800e3fc <_Event_Surrender+0x8c> <== ALWAYS TAKEN 800e3f4: 21 08 00 02 andi r8,r8,0x2 <== NOT EXECUTED 800e3f8: 45 00 00 0c be r8,r0,800e428 <_Event_Surrender+0xb8> <== NOT EXECUTED api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 800e3fc: a4 40 18 00 not r3,r2 800e400: a0 65 28 00 and r5,r3,r5 the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 800e404: 29 66 00 28 lw r6,(r11+40) if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); 800e408: 58 85 00 00 sw (r4+0),r5 the_thread->Wait.count = 0; 800e40c: 34 04 00 00 mvi r4,0 *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 800e410: 78 03 08 02 mvhi r3,0x802 _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; 800e414: 59 64 00 24 sw (r11+36),r4 *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 800e418: 38 63 62 ec ori r3,r3,0x62ec ((_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; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 800e41c: 58 c2 00 00 sw (r6+0),r2 _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 800e420: 34 02 00 03 mvi r2,3 800e424: 58 62 00 00 sw (r3+0),r2 } _ISR_Enable( level ); 800e428: d0 01 00 00 wcsr IE,r1 return; 800e42c: e0 00 00 22 bi 800e4b4 <_Event_Surrender+0x144> } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 800e430: 29 63 00 10 lw r3,(r11+16) 800e434: 20 63 01 00 andi r3,r3,0x100 800e438: 44 60 00 1e be r3,r0,800e4b0 <_Event_Surrender+0x140> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 800e43c: 44 46 00 03 be r2,r6,800e448 <_Event_Surrender+0xd8> 800e440: 21 08 00 02 andi r8,r8,0x2 800e444: 45 00 00 1b be r8,r0,800e4b0 <_Event_Surrender+0x140> <== NEVER TAKEN api->pending_events = _Event_sets_Clear( pending_events, seized_events ); 800e448: a4 40 18 00 not r3,r2 800e44c: a0 65 28 00 and r5,r3,r5 the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 800e450: 29 66 00 28 lw r6,(r11+40) /* * 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 ); 800e454: 58 85 00 00 sw (r4+0),r5 the_thread->Wait.count = 0; 800e458: 34 03 00 00 mvi r3,0 800e45c: 59 63 00 24 sw (r11+36),r3 *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 800e460: 58 c2 00 00 sw (r6+0),r2 _ISR_Flash( level ); 800e464: d0 01 00 00 wcsr IE,r1 800e468: d0 07 00 00 wcsr IE,r7 if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 800e46c: 29 63 00 50 lw r3,(r11+80) 800e470: 34 02 00 02 mvi r2,2 800e474: 44 62 00 05 be r3,r2,800e488 <_Event_Surrender+0x118> _ISR_Enable( level ); 800e478: d0 01 00 00 wcsr IE,r1 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 800e47c: 78 02 10 03 mvhi r2,0x1003 800e480: b9 60 08 00 mv r1,r11 800e484: e0 00 00 08 bi 800e4a4 <_Event_Surrender+0x134> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 800e488: 34 02 00 03 mvi r2,3 800e48c: 59 62 00 50 sw (r11+80),r2 _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 800e490: d0 01 00 00 wcsr IE,r1 (void) _Watchdog_Remove( &the_thread->Timer ); 800e494: 35 61 00 48 addi r1,r11,72 800e498: fb ff e5 ed calli 8007c4c <_Watchdog_Remove> 800e49c: b9 60 08 00 mv r1,r11 800e4a0: 78 02 10 03 mvhi r2,0x1003 800e4a4: 38 42 ff f8 ori r2,r2,0xfff8 800e4a8: f8 00 05 60 calli 800fa28 <_Thread_Clear_state> 800e4ac: e0 00 00 02 bi 800e4b4 <_Event_Surrender+0x144> _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 800e4b0: d0 01 00 00 wcsr IE,r1 } 800e4b4: 2b 9d 00 04 lw ra,(sp+4) 800e4b8: 2b 8b 00 08 lw r11,(sp+8) 800e4bc: 37 9c 00 08 addi sp,sp,8 800e4c0: c3 a0 00 00 ret 0800e4c4 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 800e4c4: 37 9c ff f8 addi sp,sp,-8 800e4c8: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 800e4cc: 37 82 00 08 addi r2,sp,8 800e4d0: fb ff e0 e5 calli 8006864 <_Thread_Get> switch ( location ) { 800e4d4: 2b 82 00 08 lw r2,(sp+8) 800e4d8: 5c 40 00 1d bne r2,r0,800e54c <_Event_Timeout+0x88> <== NEVER TAKEN * * 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 ); 800e4dc: 90 00 18 00 rcsr r3,IE 800e4e0: 34 02 ff fe mvi r2,-2 800e4e4: a0 62 10 00 and r2,r3,r2 800e4e8: d0 02 00 00 wcsr IE,r2 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 800e4ec: 78 02 08 02 mvhi r2,0x802 800e4f0: 38 42 5a 00 ori r2,r2,0x5a00 800e4f4: 28 42 00 00 lw r2,(r2+0) _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; 800e4f8: 34 04 00 00 mvi r4,0 800e4fc: 58 24 00 24 sw (r1+36),r4 if ( _Thread_Is_executing( the_thread ) ) { 800e500: 5c 22 00 08 bne r1,r2,800e520 <_Event_Timeout+0x5c> <== ALWAYS TAKEN if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 800e504: 78 02 08 02 mvhi r2,0x802 <== NOT EXECUTED 800e508: 38 42 62 ec ori r2,r2,0x62ec <== NOT EXECUTED 800e50c: 28 45 00 00 lw r5,(r2+0) <== NOT EXECUTED 800e510: 34 04 00 01 mvi r4,1 <== NOT EXECUTED 800e514: 5c a4 00 03 bne r5,r4,800e520 <_Event_Timeout+0x5c> <== NOT EXECUTED _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 800e518: 34 04 00 02 mvi r4,2 <== NOT EXECUTED 800e51c: 58 44 00 00 sw (r2+0),r4 <== NOT EXECUTED } the_thread->Wait.return_code = RTEMS_TIMEOUT; 800e520: 34 02 00 06 mvi r2,6 800e524: 58 22 00 34 sw (r1+52),r2 _ISR_Enable( level ); 800e528: d0 03 00 00 wcsr IE,r3 800e52c: 78 02 10 03 mvhi r2,0x1003 800e530: 38 42 ff f8 ori r2,r2,0xfff8 800e534: f8 00 05 3d calli 800fa28 <_Thread_Clear_state> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 800e538: 78 01 08 02 mvhi r1,0x802 800e53c: 38 21 59 44 ori r1,r1,0x5944 800e540: 28 22 00 00 lw r2,(r1+0) 800e544: 34 42 ff ff addi r2,r2,-1 800e548: 58 22 00 00 sw (r1+0),r2 case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } 800e54c: 2b 9d 00 04 lw ra,(sp+4) 800e550: 37 9c 00 08 addi sp,sp,8 800e554: c3 a0 00 00 ret 0800f2d8 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 800f2d8: 37 9c ff b4 addi sp,sp,-76 800f2dc: 5b 8b 00 44 sw (sp+68),r11 800f2e0: 5b 8c 00 40 sw (sp+64),r12 800f2e4: 5b 8d 00 3c sw (sp+60),r13 800f2e8: 5b 8e 00 38 sw (sp+56),r14 800f2ec: 5b 8f 00 34 sw (sp+52),r15 800f2f0: 5b 90 00 30 sw (sp+48),r16 800f2f4: 5b 91 00 2c sw (sp+44),r17 800f2f8: 5b 92 00 28 sw (sp+40),r18 800f2fc: 5b 93 00 24 sw (sp+36),r19 800f300: 5b 94 00 20 sw (sp+32),r20 800f304: 5b 95 00 1c sw (sp+28),r21 800f308: 5b 96 00 18 sw (sp+24),r22 800f30c: 5b 97 00 14 sw (sp+20),r23 800f310: 5b 98 00 10 sw (sp+16),r24 800f314: 5b 99 00 0c sw (sp+12),r25 800f318: 5b 9b 00 08 sw (sp+8),fp 800f31c: 5b 9d 00 04 sw (sp+4),ra 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 - HEAP_BLOCK_SIZE_OFFSET; 800f320: 34 55 00 04 addi r21,r2,4 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { 800f324: b8 40 68 00 mv r13,r2 800f328: b8 20 60 00 mv r12,r1 800f32c: b8 60 78 00 mv r15,r3 800f330: b8 80 90 00 mv r18,r4 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 800f334: 28 2e 00 08 lw r14,(r1+8) 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 - HEAP_BLOCK_SIZE_OFFSET; uintptr_t const page_size = heap->page_size; 800f338: 28 33 00 10 lw r19,(r1+16) uintptr_t alloc_begin = 0; uint32_t search_count = 0; if ( block_size_floor < alloc_size ) { 800f33c: 54 55 00 59 bgu r2,r21,800f4a0 <_Heap_Allocate_aligned_with_boundary+0x1c8> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { 800f340: 44 80 00 04 be r4,r0,800f350 <_Heap_Allocate_aligned_with_boundary+0x78> if ( boundary < alloc_size ) { 800f344: 54 44 00 57 bgu r2,r4,800f4a0 <_Heap_Allocate_aligned_with_boundary+0x1c8> return NULL; } if ( alignment == 0 ) { 800f348: 5c 60 00 02 bne r3,r0,800f350 <_Heap_Allocate_aligned_with_boundary+0x78> 800f34c: ba 60 78 00 mv r15,r19 uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; uintptr_t alloc_begin = alloc_end - alloc_size; 800f350: 34 01 00 04 mvi r1,4 800f354: c8 2d 08 00 sub r1,r1,r13 800f358: 5b 81 00 4c sw (sp+76),r1 if ( boundary != 0 ) { if ( boundary < alloc_size ) { return NULL; } if ( alignment == 0 ) { 800f35c: 34 11 00 00 mvi r17,0 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; 800f360: 34 1b ff fe mvi fp,-2 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; 800f364: 36 79 00 07 addi r25,r19,7 /* Ensure that the we have a valid new block at the beginning */ if ( alloc_begin >= alloc_begin_floor ) { uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; 800f368: 34 18 ff f8 mvi r24,-8 800f36c: e0 00 00 3d bi 800f460 <_Heap_Allocate_aligned_with_boundary+0x188> /* * 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 ) { 800f370: 29 d0 00 04 lw r16,(r14+4) while ( block != free_list_tail ) { _HAssert( _Heap_Is_prev_used( block ) ); /* Statistics */ ++search_count; 800f374: 36 31 00 01 addi r17,r17,1 /* * 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 ) { 800f378: 52 b0 00 39 bgeu r21,r16,800f45c <_Heap_Allocate_aligned_with_boundary+0x184> 800f37c: 35 d4 00 08 addi r20,r14,8 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; 800f380: ba 80 58 00 mv r11,r20 if ( alignment == 0 ) { 800f384: 45 e0 00 35 be r15,r0,800f458 <_Heap_Allocate_aligned_with_boundary+0x180> uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; uintptr_t alloc_begin = alloc_end - alloc_size; 800f388: 2b 81 00 4c lw r1,(sp+76) 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; 800f38c: a2 1b 80 00 and r16,r16,fp uintptr_t alignment, uintptr_t boundary ) { uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; 800f390: 29 96 00 14 lw r22,(r12+20) 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; 800f394: b5 d0 80 00 add r16,r14,r16 uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_BLOCK_SIZE_OFFSET; uintptr_t alloc_begin = alloc_end - alloc_size; 800f398: b4 30 58 00 add r11,r1,r16 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; 800f39c: cb 36 18 00 sub r3,r25,r22 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 800f3a0: b9 60 08 00 mv r1,r11 800f3a4: b9 e0 10 00 mv r2,r15 800f3a8: b4 70 80 00 add r16,r3,r16 800f3ac: f8 00 4a 82 calli 8021db4 <__umodsi3> 800f3b0: c9 61 58 00 sub r11,r11,r1 uintptr_t alloc_begin = alloc_end - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { 800f3b4: 52 0b 00 05 bgeu r16,r11,800f3c8 <_Heap_Allocate_aligned_with_boundary+0xf0> 800f3b8: ba 00 08 00 mv r1,r16 800f3bc: b9 e0 10 00 mv r2,r15 800f3c0: f8 00 4a 7d calli 8021db4 <__umodsi3> 800f3c4: ca 01 58 00 sub r11,r16,r1 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { 800f3c8: 46 40 00 19 be r18,r0,800f42c <_Heap_Allocate_aligned_with_boundary+0x154> /* 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; 800f3cc: b5 6d 80 00 add r16,r11,r13 800f3d0: ba 00 08 00 mv r1,r16 800f3d4: ba 40 10 00 mv r2,r18 800f3d8: f8 00 4a 77 calli 8021db4 <__umodsi3> 800f3dc: ca 01 18 00 sub r3,r16,r1 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; 800f3e0: b6 8d 20 00 add r4,r20,r13 800f3e4: e0 00 00 0b bi 800f410 <_Heap_Allocate_aligned_with_boundary+0x138> uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { 800f3e8: 54 83 00 1d bgu r4,r3,800f45c <_Heap_Allocate_aligned_with_boundary+0x184> 800f3ec: 5b 84 00 48 sw (sp+72),r4 800f3f0: f8 00 4a 71 calli 8021db4 <__umodsi3> 800f3f4: ca e1 58 00 sub r11,r23,r1 return 0; } alloc_begin = boundary_line - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; 800f3f8: b5 6d 80 00 add r16,r11,r13 800f3fc: ba 00 08 00 mv r1,r16 800f400: ba 40 10 00 mv r2,r18 800f404: f8 00 4a 6c calli 8021db4 <__umodsi3> 800f408: 2b 84 00 48 lw r4,(sp+72) 800f40c: ca 01 18 00 sub r3,r16,r1 /* 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 ) { 800f410: f6 03 80 00 cmpgu r16,r16,r3 800f414: f4 6b 28 00 cmpgu r5,r3,r11 if ( boundary_line < boundary_floor ) { return 0; } alloc_begin = boundary_line - alloc_size; 800f418: c8 6d b8 00 sub r23,r3,r13 /* 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 ) { 800f41c: a2 05 80 00 and r16,r16,r5 800f420: b9 e0 10 00 mv r2,r15 800f424: ba e0 08 00 mv r1,r23 800f428: 5e 00 ff f0 bne r16,r0,800f3e8 <_Heap_Allocate_aligned_with_boundary+0x110> 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 ) { 800f42c: 56 8b 00 0c bgu r20,r11,800f45c <_Heap_Allocate_aligned_with_boundary+0x184> 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; 800f430: cb 0e 80 00 sub r16,r24,r14 800f434: b9 60 08 00 mv r1,r11 800f438: ba 60 10 00 mv r2,r19 800f43c: b6 0b 80 00 add r16,r16,r11 800f440: f8 00 4a 5d calli 8021db4 <__umodsi3> 800f444: ca 01 08 00 sub r1,r16,r1 if ( free_size >= min_block_size || free_size == 0 ) { 800f448: f0 36 b0 00 cmpgeu r22,r1,r22 800f44c: 64 21 00 00 cmpei r1,r1,0 800f450: b8 36 08 00 or r1,r1,r22 800f454: 44 20 00 02 be r1,r0,800f45c <_Heap_Allocate_aligned_with_boundary+0x184> boundary ); } } if ( alloc_begin != 0 ) { 800f458: 5d 60 00 05 bne r11,r0,800f46c <_Heap_Allocate_aligned_with_boundary+0x194><== ALWAYS TAKEN break; } block = block->next; 800f45c: 29 ce 00 08 lw r14,(r14+8) if ( alignment == 0 ) { alignment = page_size; } } while ( block != free_list_tail ) { 800f460: 5d cc ff c4 bne r14,r12,800f370 <_Heap_Allocate_aligned_with_boundary+0x98> 800f464: 34 0b 00 00 mvi r11,0 800f468: e0 00 00 09 bi 800f48c <_Heap_Allocate_aligned_with_boundary+0x1b4> block = block->next; } if ( alloc_begin != 0 ) { /* Statistics */ stats->searches += search_count; 800f46c: 29 81 00 4c lw r1,(r12+76) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 800f470: b9 c0 10 00 mv r2,r14 800f474: b9 a0 20 00 mv r4,r13 block = block->next; } if ( alloc_begin != 0 ) { /* Statistics */ stats->searches += search_count; 800f478: b4 31 08 00 add r1,r1,r17 800f47c: 59 81 00 4c sw (r12+76),r1 block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); 800f480: b9 60 18 00 mv r3,r11 800f484: b9 80 08 00 mv r1,r12 800f488: fb ff d8 76 calli 8005660 <_Heap_Block_allocate> uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { Heap_Statistics *const stats = &heap->stats; 800f48c: 29 81 00 44 lw r1,(r12+68) 800f490: 50 31 00 02 bgeu r1,r17,800f498 <_Heap_Allocate_aligned_with_boundary+0x1c0> ); } /* Statistics */ if ( stats->max_search < search_count ) { stats->max_search = search_count; 800f494: 59 91 00 44 sw (r12+68),r17 } return (void *) alloc_begin; 800f498: b9 60 08 00 mv r1,r11 800f49c: e0 00 00 02 bi 800f4a4 <_Heap_Allocate_aligned_with_boundary+0x1cc> 800f4a0: 34 01 00 00 mvi r1,0 } 800f4a4: 2b 9d 00 04 lw ra,(sp+4) 800f4a8: 2b 8b 00 44 lw r11,(sp+68) 800f4ac: 2b 8c 00 40 lw r12,(sp+64) 800f4b0: 2b 8d 00 3c lw r13,(sp+60) 800f4b4: 2b 8e 00 38 lw r14,(sp+56) 800f4b8: 2b 8f 00 34 lw r15,(sp+52) 800f4bc: 2b 90 00 30 lw r16,(sp+48) 800f4c0: 2b 91 00 2c lw r17,(sp+44) 800f4c4: 2b 92 00 28 lw r18,(sp+40) 800f4c8: 2b 93 00 24 lw r19,(sp+36) 800f4cc: 2b 94 00 20 lw r20,(sp+32) 800f4d0: 2b 95 00 1c lw r21,(sp+28) 800f4d4: 2b 96 00 18 lw r22,(sp+24) 800f4d8: 2b 97 00 14 lw r23,(sp+20) 800f4dc: 2b 98 00 10 lw r24,(sp+16) 800f4e0: 2b 99 00 0c lw r25,(sp+12) 800f4e4: 2b 9b 00 08 lw fp,(sp+8) 800f4e8: 37 9c 00 4c addi sp,sp,76 800f4ec: c3 a0 00 00 ret 0800ecd8 <_Heap_Extend>: Heap_Control *heap, void *area_begin_ptr, uintptr_t area_size, uintptr_t *amount_extended ) { 800ecd8: 37 9c ff e8 addi sp,sp,-24 800ecdc: 5b 8b 00 18 sw (sp+24),r11 800ece0: 5b 8c 00 14 sw (sp+20),r12 800ece4: 5b 8d 00 10 sw (sp+16),r13 800ece8: 5b 8e 00 0c sw (sp+12),r14 800ecec: 5b 8f 00 08 sw (sp+8),r15 800ecf0: 5b 9d 00 04 sw (sp+4),ra Heap_Statistics *const stats = &heap->stats; uintptr_t const area_begin = (uintptr_t) area_begin_ptr; uintptr_t const heap_area_begin = heap->area_begin; 800ecf4: 28 2d 00 18 lw r13,(r1+24) uintptr_t const heap_area_end = heap->area_end; 800ecf8: 28 25 00 1c lw r5,(r1+28) Heap_Control *heap, void *area_begin_ptr, uintptr_t area_size, uintptr_t *amount_extended ) { 800ecfc: b8 20 58 00 mv r11,r1 Heap_Statistics *const stats = &heap->stats; uintptr_t const area_begin = (uintptr_t) area_begin_ptr; uintptr_t const heap_area_begin = heap->area_begin; 800ed00: f0 4d 68 00 cmpgeu r13,r2,r13 * 5. non-contiguous higher address (NOT SUPPORTED) * * As noted, this code only supports (4). */ if ( area_begin >= heap_area_begin && area_begin < heap_area_end ) { 800ed04: f4 a2 08 00 cmpgu r1,r5,r2 Heap_Control *heap, void *area_begin_ptr, uintptr_t area_size, uintptr_t *amount_extended ) { 800ed08: b8 80 78 00 mv r15,r4 Heap_Statistics *const stats = &heap->stats; uintptr_t const area_begin = (uintptr_t) area_begin_ptr; uintptr_t const heap_area_begin = heap->area_begin; 800ed0c: a0 2d 68 00 and r13,r1,r13 uintptr_t const heap_area_end = heap->area_end; uintptr_t const new_heap_area_end = heap_area_end + area_size; uintptr_t extend_size = 0; Heap_Block *const last_block = heap->last_block; 800ed10: 29 6c 00 24 lw r12,(r11+36) uintptr_t *amount_extended ) { Heap_Statistics *const stats = &heap->stats; uintptr_t const area_begin = (uintptr_t) area_begin_ptr; uintptr_t const heap_area_begin = heap->area_begin; 800ed14: 34 01 00 01 mvi r1,1 800ed18: 5d a0 00 26 bne r13,r0,800edb0 <_Heap_Extend+0xd8> * As noted, this code only supports (4). */ if ( area_begin >= heap_area_begin && area_begin < heap_area_end ) { return HEAP_EXTEND_ERROR; /* case 3 */ } else if ( area_begin != heap_area_end ) { 800ed1c: 34 01 00 02 mvi r1,2 800ed20: 5c 45 00 24 bne r2,r5,800edb0 <_Heap_Extend+0xd8> { Heap_Statistics *const stats = &heap->stats; uintptr_t const area_begin = (uintptr_t) area_begin_ptr; uintptr_t const heap_area_begin = heap->area_begin; uintptr_t const heap_area_end = heap->area_end; uintptr_t const new_heap_area_end = heap_area_end + area_size; 800ed24: b4 62 18 00 add r3,r3,r2 * block and free it. */ heap->area_end = new_heap_area_end; extend_size = new_heap_area_end 800ed28: c8 6c 70 00 sub r14,r3,r12 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 800ed2c: 29 62 00 10 lw r2,(r11+16) 800ed30: 35 ce ff f8 addi r14,r14,-8 * Currently only case 4 should make it to this point. * The basic trick is to make the extend area look like a used * block and free it. */ heap->area_end = new_heap_area_end; 800ed34: 59 63 00 1c sw (r11+28),r3 800ed38: b9 c0 08 00 mv r1,r14 800ed3c: fb ff d5 8b calli 8004368 <__umodsi3> 800ed40: c9 c1 08 00 sub r1,r14,r1 extend_size = new_heap_area_end - (uintptr_t) last_block - HEAP_BLOCK_HEADER_SIZE; extend_size = _Heap_Align_down( extend_size, heap->page_size ); *amount_extended = extend_size; 800ed44: 59 e1 00 00 sw (r15+0),r1 if( extend_size >= heap->min_block_size ) { 800ed48: 29 62 00 14 lw r2,(r11+20) 800ed4c: 50 22 00 02 bgeu r1,r2,800ed54 <_Heap_Extend+0x7c> <== ALWAYS TAKEN 800ed50: e0 00 00 17 bi 800edac <_Heap_Extend+0xd4> <== NOT EXECUTED uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; block->size_and_flag = size | flag; 800ed54: 29 84 00 04 lw r4,(r12+4) Heap_Block *const new_last_block = _Heap_Block_at( last_block, extend_size ); _Heap_Block_set_size( last_block, extend_size ); new_last_block->size_and_flag = 800ed58: 29 63 00 20 lw r3,(r11+32) RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800ed5c: b4 2c 10 00 add r2,r1,r12 uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; block->size_and_flag = size | flag; 800ed60: 20 84 00 01 andi r4,r4,0x1 800ed64: b8 24 20 00 or r4,r1,r4 800ed68: c8 62 18 00 sub r3,r3,r2 800ed6c: 59 84 00 04 sw (r12+4),r4 800ed70: 38 63 00 01 ori r3,r3,0x1 800ed74: 58 43 00 04 sw (r2+4),r3 | HEAP_PREV_BLOCK_USED; heap->last_block = new_last_block; /* Statistics */ stats->size += extend_size; 800ed78: 29 65 00 2c lw r5,(r11+44) ++stats->used_blocks; 800ed7c: 29 64 00 40 lw r4,(r11+64) --stats->frees; /* Do not count subsequent call as actual free() */ 800ed80: 29 63 00 50 lw r3,(r11+80) | HEAP_PREV_BLOCK_USED; heap->last_block = new_last_block; /* Statistics */ stats->size += extend_size; 800ed84: b4 a1 08 00 add r1,r5,r1 ++stats->used_blocks; 800ed88: 34 84 00 01 addi r4,r4,1 --stats->frees; /* Do not count subsequent call as actual free() */ 800ed8c: 34 63 ff ff addi r3,r3,-1 new_last_block->size_and_flag = ((uintptr_t) heap->first_block - (uintptr_t) new_last_block) | HEAP_PREV_BLOCK_USED; heap->last_block = new_last_block; 800ed90: 59 62 00 24 sw (r11+36),r2 /* Statistics */ stats->size += extend_size; 800ed94: 59 61 00 2c sw (r11+44),r1 ++stats->used_blocks; 800ed98: 59 64 00 40 sw (r11+64),r4 --stats->frees; /* Do not count subsequent call as actual free() */ 800ed9c: 59 63 00 50 sw (r11+80),r3 _Heap_Free( heap, (void *) _Heap_Alloc_area_of_block( last_block )); 800eda0: b9 60 08 00 mv r1,r11 800eda4: 35 82 00 08 addi r2,r12,8 800eda8: fb ff e5 74 calli 8008378 <_Heap_Free> 800edac: b9 a0 08 00 mv r1,r13 } return HEAP_EXTEND_SUCCESSFUL; } 800edb0: 2b 9d 00 04 lw ra,(sp+4) 800edb4: 2b 8b 00 18 lw r11,(sp+24) 800edb8: 2b 8c 00 14 lw r12,(sp+20) 800edbc: 2b 8d 00 10 lw r13,(sp+16) 800edc0: 2b 8e 00 0c lw r14,(sp+12) 800edc4: 2b 8f 00 08 lw r15,(sp+8) 800edc8: 37 9c 00 18 addi sp,sp,24 800edcc: c3 a0 00 00 ret 0800f4f0 <_Heap_Free>: #include #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 800f4f0: 37 9c ff f4 addi sp,sp,-12 800f4f4: 5b 8b 00 0c sw (sp+12),r11 800f4f8: 5b 8c 00 08 sw (sp+8),r12 800f4fc: 5b 9d 00 04 sw (sp+4),ra 800f500: b8 40 18 00 mv r3,r2 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 ) 800f504: 28 22 00 10 lw r2,(r1+16) 800f508: b8 20 58 00 mv r11,r1 800f50c: b8 60 08 00 mv r1,r3 800f510: 34 6c ff f8 addi r12,r3,-8 800f514: f8 00 4a 28 calli 8021db4 <__umodsi3> 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; 800f518: 29 66 00 20 lw r6,(r11+32) 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 ) 800f51c: c9 81 08 00 sub r1,r12,r1 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 800f520: 50 26 00 03 bgeu r1,r6,800f52c <_Heap_Free+0x3c> 800f524: 34 02 00 00 mvi r2,0 800f528: e0 00 00 03 bi 800f534 <_Heap_Free+0x44> 800f52c: 29 62 00 24 lw r2,(r11+36) 800f530: f0 41 10 00 cmpgeu r2,r2,r1 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 ) ) { 800f534: 44 40 00 66 be r2,r0,800f6cc <_Heap_Free+0x1dc> - 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; 800f538: 28 25 00 04 lw r5,(r1+4) 800f53c: 34 02 ff fe mvi r2,-2 800f540: a0 a2 10 00 and r2,r5,r2 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800f544: b4 22 18 00 add r3,r1,r2 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 800f548: 50 66 00 03 bgeu r3,r6,800f554 <_Heap_Free+0x64> <== ALWAYS TAKEN 800f54c: 34 04 00 00 mvi r4,0 <== NOT EXECUTED 800f550: e0 00 00 03 bi 800f55c <_Heap_Free+0x6c> <== NOT EXECUTED 800f554: 29 64 00 24 lw r4,(r11+36) 800f558: f0 83 20 00 cmpgeu r4,r4,r3 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 800f55c: 44 80 00 5c be r4,r0,800f6cc <_Heap_Free+0x1dc> <== NEVER TAKEN 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; 800f560: 28 64 00 04 lw r4,(r3+4) _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 800f564: 20 87 00 01 andi r7,r4,0x1 800f568: 44 e0 00 59 be r7,r0,800f6cc <_Heap_Free+0x1dc> <== NEVER TAKEN 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 )); 800f56c: 29 68 00 24 lw r8,(r11+36) - 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; 800f570: 34 07 ff fe mvi r7,-2 800f574: a0 87 20 00 and r4,r4,r7 _HAssert( false ); return false; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 800f578: 34 07 00 00 mvi r7,0 800f57c: 45 03 00 05 be r8,r3,800f590 <_Heap_Free+0xa0> 800f580: b4 64 38 00 add r7,r3,r4 800f584: 28 e7 00 04 lw r7,(r7+4) 800f588: 20 e7 00 01 andi r7,r7,0x1 800f58c: 18 e7 00 01 xori r7,r7,0x1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { 800f590: 20 a5 00 01 andi r5,r5,0x1 _HAssert( false ); return false; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 800f594: 20 e7 00 ff andi r7,r7,0xff && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { 800f598: 5c a0 00 23 bne r5,r0,800f624 <_Heap_Free+0x134> uintptr_t const prev_size = block->prev_size; 800f59c: 28 25 00 00 lw r5,(r1+0) RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800f5a0: c8 25 08 00 sub r1,r1,r5 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 800f5a4: f0 26 30 00 cmpgeu r6,r1,r6 800f5a8: f1 01 40 00 cmpgeu r8,r8,r1 800f5ac: c8 06 30 00 sub r6,r0,r6 Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { 800f5b0: a1 06 40 00 and r8,r8,r6 800f5b4: 45 00 00 46 be r8,r0,800f6cc <_Heap_Free+0x1dc> <== NEVER TAKEN 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) ) { 800f5b8: 28 26 00 04 lw r6,(r1+4) 800f5bc: 20 c6 00 01 andi r6,r6,0x1 800f5c0: 44 c0 00 43 be r6,r0,800f6cc <_Heap_Free+0x1dc> <== NEVER TAKEN _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 800f5c4: 44 e0 00 0f be r7,r0,800f600 <_Heap_Free+0x110> uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 800f5c8: 29 68 00 38 lw r8,(r11+56) } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; 800f5cc: 28 66 00 0c lw r6,(r3+12) return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 800f5d0: 28 67 00 08 lw r7,(r3+8) _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; 800f5d4: b4 44 20 00 add r4,r2,r4 800f5d8: b4 85 28 00 add r5,r4,r5 _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 800f5dc: 35 03 ff ff addi r3,r8,-1 800f5e0: 59 63 00 38 sw (r11+56),r3 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; 800f5e4: b4 25 20 00 add r4,r1,r5 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; 800f5e8: 38 a3 00 01 ori r3,r5,0x1 Heap_Block *prev = block->prev; prev->next = next; next->prev = prev; 800f5ec: 58 e6 00 0c sw (r7+12),r6 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 800f5f0: 58 85 00 00 sw (r4+0),r5 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; 800f5f4: 58 23 00 04 sw (r1+4),r3 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 800f5f8: 58 c7 00 08 sw (r6+8),r7 800f5fc: e0 00 00 29 bi 800f6a0 <_Heap_Free+0x1b0> 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; 800f600: b4 45 28 00 add r5,r2,r5 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 800f604: 38 a4 00 01 ori r4,r5,0x1 800f608: 58 24 00 04 sw (r1+4),r4 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 800f60c: 28 64 00 04 lw r4,(r3+4) 800f610: 34 01 ff fe mvi r1,-2 next_block->prev_size = size; 800f614: 58 65 00 00 sw (r3+0),r5 _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; 800f618: a0 81 08 00 and r1,r4,r1 800f61c: 58 61 00 04 sw (r3+4),r1 800f620: e0 00 00 20 bi 800f6a0 <_Heap_Free+0x1b0> next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 800f624: 44 e0 00 0d be r7,r0,800f658 <_Heap_Free+0x168> Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; 800f628: 28 65 00 0c lw r5,(r3+12) RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace( Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; 800f62c: 28 66 00 08 lw r6,(r3+8) uintptr_t const size = block_size + next_block_size; 800f630: b4 82 18 00 add r3,r4,r2 Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; 800f634: 58 25 00 0c sw (r1+12),r5 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; 800f638: 58 26 00 08 sw (r1+8),r6 _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 800f63c: b4 23 38 00 add r7,r1,r3 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; 800f640: 38 64 00 01 ori r4,r3,0x1 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 800f644: 58 e3 00 00 sw (r7+0),r3 new_block->prev = prev; next->prev = new_block; 800f648: 58 c1 00 0c sw (r6+12),r1 prev->next = new_block; 800f64c: 58 a1 00 08 sw (r5+8),r1 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; 800f650: 58 24 00 04 sw (r1+4),r4 800f654: e0 00 00 13 bi 800f6a0 <_Heap_Free+0x1b0> 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; 800f658: 38 44 00 01 ori r4,r2,0x1 800f65c: 58 24 00 04 sw (r1+4),r4 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 800f660: 28 65 00 04 lw r5,(r3+4) 800f664: 34 04 ff fe mvi r4,-2 next_block->prev_size = block_size; 800f668: 58 62 00 00 sw (r3+0),r2 } 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; 800f66c: a0 a4 20 00 and r4,r5,r4 800f670: 58 64 00 04 sw (r3+4),r4 next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 800f674: 29 63 00 38 lw r3,(r11+56) RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; 800f678: 29 64 00 08 lw r4,(r11+8) #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { Heap_Statistics *const stats = &heap->stats; 800f67c: 29 65 00 3c lw r5,(r11+60) new_block->next = next; new_block->prev = block_before; 800f680: 58 2b 00 0c sw (r1+12),r11 Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 800f684: 58 24 00 08 sw (r1+8),r4 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; 800f688: 34 63 00 01 addi r3,r3,1 new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 800f68c: 58 81 00 0c sw (r4+12),r1 { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; 800f690: 59 61 00 08 sw (r11+8),r1 800f694: 59 63 00 38 sw (r11+56),r3 #include #include bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { Heap_Statistics *const stats = &heap->stats; 800f698: 50 a3 00 02 bgeu r5,r3,800f6a0 <_Heap_Free+0x1b0> next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { stats->max_free_blocks = stats->free_blocks; 800f69c: 59 63 00 3c sw (r11+60),r3 } } /* Statistics */ --stats->used_blocks; 800f6a0: 29 63 00 40 lw r3,(r11+64) ++stats->frees; 800f6a4: 29 61 00 50 lw r1,(r11+80) stats->free_size += block_size; 800f6a8: 29 64 00 30 lw r4,(r11+48) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 800f6ac: 34 63 ff ff addi r3,r3,-1 ++stats->frees; 800f6b0: 34 21 00 01 addi r1,r1,1 stats->free_size += block_size; 800f6b4: b4 82 10 00 add r2,r4,r2 } } /* Statistics */ --stats->used_blocks; ++stats->frees; 800f6b8: 59 61 00 50 sw (r11+80),r1 stats->free_size += block_size; 800f6bc: 59 62 00 30 sw (r11+48),r2 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; 800f6c0: 59 63 00 40 sw (r11+64),r3 ++stats->frees; stats->free_size += block_size; 800f6c4: 34 01 00 01 mvi r1,1 return( true ); 800f6c8: e0 00 00 02 bi 800f6d0 <_Heap_Free+0x1e0> 800f6cc: 34 01 00 00 mvi r1,0 } 800f6d0: 2b 9d 00 04 lw ra,(sp+4) 800f6d4: 2b 8b 00 0c lw r11,(sp+12) 800f6d8: 2b 8c 00 08 lw r12,(sp+8) 800f6dc: 37 9c 00 0c addi sp,sp,12 800f6e0: c3 a0 00 00 ret 0800f848 <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 800f848: 37 9c ff f0 addi sp,sp,-16 800f84c: 5b 8b 00 10 sw (sp+16),r11 800f850: 5b 8c 00 0c sw (sp+12),r12 800f854: 5b 8d 00 08 sw (sp+8),r13 800f858: 5b 9d 00 04 sw (sp+4),ra 800f85c: b8 40 60 00 mv r12,r2 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 ) 800f860: 28 22 00 10 lw r2,(r1+16) 800f864: b8 20 58 00 mv r11,r1 800f868: b9 80 08 00 mv r1,r12 800f86c: b8 60 68 00 mv r13,r3 800f870: f8 00 49 51 calli 8021db4 <__umodsi3> 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; 800f874: 29 62 00 20 lw r2,(r11+32) 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 ) 800f878: 35 84 ff f8 addi r4,r12,-8 800f87c: c8 81 20 00 sub r4,r4,r1 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 800f880: 50 82 00 03 bgeu r4,r2,800f88c <_Heap_Size_of_alloc_area+0x44> 800f884: 34 01 00 00 mvi r1,0 800f888: e0 00 00 03 bi 800f894 <_Heap_Size_of_alloc_area+0x4c> 800f88c: 29 61 00 24 lw r1,(r11+36) 800f890: f0 24 08 00 cmpgeu r1,r1,r4 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 ) ) { 800f894: 44 20 00 13 be r1,r0,800f8e0 <_Heap_Size_of_alloc_area+0x98> RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800f898: 28 83 00 04 lw r3,(r4+4) 800f89c: 34 01 ff fe mvi r1,-2 800f8a0: a0 61 08 00 and r1,r3,r1 800f8a4: b4 81 20 00 add r4,r4,r1 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 800f8a8: 50 82 00 03 bgeu r4,r2,800f8b4 <_Heap_Size_of_alloc_area+0x6c><== ALWAYS TAKEN 800f8ac: 34 01 00 00 mvi r1,0 <== NOT EXECUTED 800f8b0: e0 00 00 03 bi 800f8bc <_Heap_Size_of_alloc_area+0x74> <== NOT EXECUTED 800f8b4: 29 61 00 24 lw r1,(r11+36) 800f8b8: f0 24 08 00 cmpgeu r1,r1,r4 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 800f8bc: 44 20 00 09 be r1,r0,800f8e0 <_Heap_Size_of_alloc_area+0x98><== NEVER TAKEN 800f8c0: 28 81 00 04 lw r1,(r4+4) 800f8c4: 20 21 00 01 andi r1,r1,0x1 800f8c8: 44 20 00 06 be r1,r0,800f8e0 <_Heap_Size_of_alloc_area+0x98><== NEVER TAKEN || !_Heap_Is_prev_used( next_block ) ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_BLOCK_SIZE_OFFSET - alloc_begin; 800f8cc: c8 8c 20 00 sub r4,r4,r12 800f8d0: 34 84 00 04 addi r4,r4,4 800f8d4: 59 a4 00 00 sw (r13+0),r4 800f8d8: 34 01 00 01 mvi r1,1 return true; 800f8dc: e0 00 00 02 bi 800f8e4 <_Heap_Size_of_alloc_area+0x9c> 800f8e0: 34 01 00 00 mvi r1,0 } 800f8e4: 2b 9d 00 04 lw ra,(sp+4) 800f8e8: 2b 8b 00 10 lw r11,(sp+16) 800f8ec: 2b 8c 00 0c lw r12,(sp+12) 800f8f0: 2b 8d 00 08 lw r13,(sp+8) 800f8f4: 37 9c 00 10 addi sp,sp,16 800f8f8: c3 a0 00 00 ret 08003c44 <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 8003c44: 37 9c ff ac addi sp,sp,-84 8003c48: 5b 8b 00 50 sw (sp+80),r11 8003c4c: 5b 8c 00 4c sw (sp+76),r12 8003c50: 5b 8d 00 48 sw (sp+72),r13 8003c54: 5b 8e 00 44 sw (sp+68),r14 8003c58: 5b 8f 00 40 sw (sp+64),r15 8003c5c: 5b 90 00 3c sw (sp+60),r16 8003c60: 5b 91 00 38 sw (sp+56),r17 8003c64: 5b 92 00 34 sw (sp+52),r18 8003c68: 5b 93 00 30 sw (sp+48),r19 8003c6c: 5b 94 00 2c sw (sp+44),r20 8003c70: 5b 95 00 28 sw (sp+40),r21 8003c74: 5b 96 00 24 sw (sp+36),r22 8003c78: 5b 97 00 20 sw (sp+32),r23 8003c7c: 5b 98 00 1c sw (sp+28),r24 8003c80: 5b 99 00 18 sw (sp+24),r25 8003c84: 5b 9b 00 14 sw (sp+20),fp 8003c88: 5b 9d 00 10 sw (sp+16),ra 8003c8c: 20 63 00 ff andi r3,r3,0xff 8003c90: b8 20 68 00 mv r13,r1 8003c94: b8 40 70 00 mv r14,r2 uintptr_t const page_size = heap->page_size; 8003c98: 28 2f 00 10 lw r15,(r1+16) uintptr_t const min_block_size = heap->min_block_size; 8003c9c: 28 33 00 14 lw r19,(r1+20) Heap_Block *const last_block = heap->last_block; 8003ca0: 28 32 00 24 lw r18,(r1+36) Heap_Block *block = heap->first_block; 8003ca4: 28 2b 00 20 lw r11,(r1+32) Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 8003ca8: 5c 60 00 04 bne r3,r0,8003cb8 <_Heap_Walk+0x74> 8003cac: 78 0c 08 00 mvhi r12,0x800 8003cb0: 39 8c 3c 20 ori r12,r12,0x3c20 8003cb4: e0 00 00 03 bi 8003cc0 <_Heap_Walk+0x7c> 8003cb8: 78 0c 08 00 mvhi r12,0x800 8003cbc: 39 8c 41 70 ori r12,r12,0x4170 if ( !_System_state_Is_up( _System_state_Get() ) ) { 8003cc0: 78 02 08 02 mvhi r2,0x802 8003cc4: 38 42 0a 88 ori r2,r2,0xa88 8003cc8: 28 42 00 00 lw r2,(r2+0) 8003ccc: 34 01 00 03 mvi r1,3 8003cd0: 5c 41 01 0c bne r2,r1,8004100 <_Heap_Walk+0x4bc> <== NEVER TAKEN 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)( 8003cd4: 29 a1 00 08 lw r1,(r13+8) 8003cd8: 29 a6 00 18 lw r6,(r13+24) 8003cdc: 29 a7 00 1c lw r7,(r13+28) 8003ce0: 5b 81 00 08 sw (sp+8),r1 8003ce4: 29 a1 00 0c lw r1,(r13+12) 8003ce8: 78 03 08 01 mvhi r3,0x801 8003cec: 5b 92 00 04 sw (sp+4),r18 8003cf0: 5b 81 00 0c sw (sp+12),r1 8003cf4: 38 63 cc c4 ori r3,r3,0xccc4 8003cf8: b9 c0 08 00 mv r1,r14 8003cfc: 34 02 00 00 mvi r2,0 8003d00: b9 e0 20 00 mv r4,r15 8003d04: ba 60 28 00 mv r5,r19 8003d08: b9 60 40 00 mv r8,r11 8003d0c: d9 80 00 00 call r12 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 8003d10: 5d e0 00 05 bne r15,r0,8003d24 <_Heap_Walk+0xe0> (*printer)( source, true, "page size is zero\n" ); 8003d14: 78 03 08 01 mvhi r3,0x801 8003d18: b9 c0 08 00 mv r1,r14 8003d1c: 38 63 cd 58 ori r3,r3,0xcd58 8003d20: e0 00 00 3b bi 8003e0c <_Heap_Walk+0x1c8> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 8003d24: 21 f0 00 07 andi r16,r15,0x7 8003d28: 46 00 00 06 be r16,r0,8003d40 <_Heap_Walk+0xfc> (*printer)( 8003d2c: 78 03 08 01 mvhi r3,0x801 8003d30: b9 c0 08 00 mv r1,r14 8003d34: 38 63 cd 6c ori r3,r3,0xcd6c 8003d38: b9 e0 20 00 mv r4,r15 8003d3c: e0 00 01 09 bi 8004160 <_Heap_Walk+0x51c> ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 8003d40: ba 60 08 00 mv r1,r19 8003d44: b9 e0 10 00 mv r2,r15 8003d48: fb ff f3 de calli 8000cc0 <__umodsi3> 8003d4c: b8 20 88 00 mv r17,r1 8003d50: 44 30 00 08 be r1,r16,8003d70 <_Heap_Walk+0x12c> (*printer)( 8003d54: 78 03 08 01 mvhi r3,0x801 8003d58: b9 c0 08 00 mv r1,r14 8003d5c: 38 63 cd 8c ori r3,r3,0xcd8c 8003d60: ba 60 20 00 mv r4,r19 8003d64: 34 02 00 01 mvi r2,1 8003d68: d9 80 00 00 call r12 8003d6c: e0 00 00 5a bi 8003ed4 <_Heap_Walk+0x290> ); return false; } if ( 8003d70: 35 61 00 08 addi r1,r11,8 8003d74: b9 e0 10 00 mv r2,r15 8003d78: fb ff f3 d2 calli 8000cc0 <__umodsi3> 8003d7c: b8 20 80 00 mv r16,r1 8003d80: 44 31 00 08 be r1,r17,8003da0 <_Heap_Walk+0x15c> !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 8003d84: 78 03 08 01 mvhi r3,0x801 8003d88: b9 c0 08 00 mv r1,r14 8003d8c: 38 63 cd b0 ori r3,r3,0xcdb0 8003d90: b9 60 20 00 mv r4,r11 8003d94: 34 02 00 01 mvi r2,1 8003d98: d9 80 00 00 call r12 8003d9c: e0 00 00 92 bi 8003fe4 <_Heap_Walk+0x3a0> ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 8003da0: 29 71 00 04 lw r17,(r11+4) 8003da4: 22 31 00 01 andi r17,r17,0x1 8003da8: 5e 21 00 07 bne r17,r1,8003dc4 <_Heap_Walk+0x180> (*printer)( 8003dac: 78 03 08 01 mvhi r3,0x801 8003db0: b9 c0 08 00 mv r1,r14 8003db4: 38 63 cd e4 ori r3,r3,0xcde4 8003db8: 34 02 00 01 mvi r2,1 8003dbc: d9 80 00 00 call r12 8003dc0: e0 00 00 89 bi 8003fe4 <_Heap_Walk+0x3a0> ); return false; } if ( first_block->prev_size != page_size ) { 8003dc4: 29 79 00 00 lw r25,(r11+0) 8003dc8: 47 2f 00 07 be r25,r15,8003de4 <_Heap_Walk+0x1a0> (*printer)( 8003dcc: 78 03 08 01 mvhi r3,0x801 8003dd0: b9 c0 08 00 mv r1,r14 8003dd4: 38 63 ce 14 ori r3,r3,0xce14 8003dd8: bb 20 20 00 mv r4,r25 8003ddc: b9 e0 28 00 mv r5,r15 8003de0: e0 00 00 3b bi 8003ecc <_Heap_Walk+0x288> ); return false; } if ( _Heap_Is_free( last_block ) ) { 8003de4: 2a 41 00 04 lw r1,(r18+4) 8003de8: 34 02 ff fe mvi r2,-2 8003dec: a0 22 08 00 and r1,r1,r2 8003df0: b6 41 08 00 add r1,r18,r1 8003df4: 28 2f 00 04 lw r15,(r1+4) 8003df8: 21 ef 00 01 andi r15,r15,0x1 8003dfc: 5d f0 00 07 bne r15,r16,8003e18 <_Heap_Walk+0x1d4> (*printer)( 8003e00: 78 03 08 01 mvhi r3,0x801 8003e04: b9 c0 08 00 mv r1,r14 8003e08: 38 63 ce 40 ori r3,r3,0xce40 8003e0c: 34 02 00 01 mvi r2,1 8003e10: d9 80 00 00 call r12 8003e14: e0 00 00 a5 bi 80040a8 <_Heap_Walk+0x464> return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 8003e18: 29 a4 00 08 lw r4,(r13+8) ); return false; } if ( _Heap_Is_used( free_block ) ) { 8003e1c: b8 40 a8 00 mv r21,r2 int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 8003e20: 29 b4 00 10 lw r20,(r13+16) 8003e24: b9 a0 88 00 mv r17,r13 8003e28: b8 80 b0 00 mv r22,r4 8003e2c: e0 00 00 2e bi 8003ee4 <_Heap_Walk+0x2a0> 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 8003e30: 29 a1 00 20 lw r1,(r13+32) 8003e34: 34 0f 00 00 mvi r15,0 8003e38: 52 c1 00 02 bgeu r22,r1,8003e40 <_Heap_Walk+0x1fc> 8003e3c: e0 00 00 03 bi 8003e48 <_Heap_Walk+0x204> 8003e40: 29 af 00 24 lw r15,(r13+36) 8003e44: f1 f6 78 00 cmpgeu r15,r15,r22 ); return false; } if ( 8003e48: 36 c1 00 08 addi r1,r22,8 8003e4c: ba 80 10 00 mv r2,r20 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 ) ) { 8003e50: 5d e0 00 06 bne r15,r0,8003e68 <_Heap_Walk+0x224> (*printer)( 8003e54: 78 03 08 01 mvhi r3,0x801 8003e58: ba c0 20 00 mv r4,r22 8003e5c: b9 c0 08 00 mv r1,r14 8003e60: 38 63 ce 58 ori r3,r3,0xce58 8003e64: e0 00 00 8f bi 80040a0 <_Heap_Walk+0x45c> ); return false; } if ( 8003e68: fb ff f3 96 calli 8000cc0 <__umodsi3> 8003e6c: 44 20 00 06 be r1,r0,8003e84 <_Heap_Walk+0x240> !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 8003e70: 78 03 08 01 mvhi r3,0x801 8003e74: ba c0 20 00 mv r4,r22 8003e78: b9 c0 08 00 mv r1,r14 8003e7c: 38 63 ce 78 ori r3,r3,0xce78 8003e80: e0 00 00 b8 bi 8004160 <_Heap_Walk+0x51c> ); return false; } if ( _Heap_Is_used( free_block ) ) { 8003e84: 2a c3 00 04 lw r3,(r22+4) 8003e88: a0 75 18 00 and r3,r3,r21 8003e8c: b6 c3 18 00 add r3,r22,r3 8003e90: 28 70 00 04 lw r16,(r3+4) 8003e94: 22 10 00 01 andi r16,r16,0x1 8003e98: 46 01 00 07 be r16,r1,8003eb4 <_Heap_Walk+0x270> (*printer)( 8003e9c: 78 03 08 01 mvhi r3,0x801 8003ea0: b8 20 78 00 mv r15,r1 8003ea4: ba c0 20 00 mv r4,r22 8003ea8: b9 c0 08 00 mv r1,r14 8003eac: 38 63 ce a8 ori r3,r3,0xcea8 8003eb0: e0 00 00 7c bi 80040a0 <_Heap_Walk+0x45c> ); return false; } if ( free_block->prev != prev_block ) { 8003eb4: 2a c5 00 0c lw r5,(r22+12) 8003eb8: 44 b1 00 09 be r5,r17,8003edc <_Heap_Walk+0x298> (*printer)( 8003ebc: 78 03 08 01 mvhi r3,0x801 8003ec0: ba c0 20 00 mv r4,r22 8003ec4: b9 c0 08 00 mv r1,r14 8003ec8: 38 63 ce c4 ori r3,r3,0xcec4 8003ecc: 34 02 00 01 mvi r2,1 8003ed0: d9 80 00 00 call r12 8003ed4: ba 00 08 00 mv r1,r16 8003ed8: e0 00 00 8b bi 8004104 <_Heap_Walk+0x4c0> return false; } prev_block = free_block; free_block = free_block->next; 8003edc: ba c0 88 00 mv r17,r22 8003ee0: 2a d6 00 08 lw r22,(r22+8) 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 ) { 8003ee4: 5e cd ff d3 bne r22,r13,8003e30 <_Heap_Walk+0x1ec> 8003ee8: e0 00 00 7a bi 80040d0 <_Heap_Walk+0x48c> - 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; 8003eec: 29 6f 00 04 lw r15,(r11+4) 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; if ( prev_used ) { 8003ef0: 21 e2 00 01 andi r2,r15,0x1 8003ef4: a1 fb 78 00 and r15,r15,fp RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 8003ef8: b5 6f 80 00 add r16,r11,r15 8003efc: 44 40 00 09 be r2,r0,8003f20 <_Heap_Walk+0x2dc> (*printer)( 8003f00: 78 03 08 01 mvhi r3,0x801 8003f04: b9 c0 08 00 mv r1,r14 8003f08: 34 02 00 00 mvi r2,0 8003f0c: 38 63 ce f8 ori r3,r3,0xcef8 8003f10: b9 60 20 00 mv r4,r11 8003f14: b9 e0 28 00 mv r5,r15 8003f18: d9 80 00 00 call r12 8003f1c: e0 00 00 08 bi 8003f3c <_Heap_Walk+0x2f8> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 8003f20: 29 66 00 00 lw r6,(r11+0) 8003f24: 78 03 08 01 mvhi r3,0x801 8003f28: b9 c0 08 00 mv r1,r14 8003f2c: 38 63 cf 10 ori r3,r3,0xcf10 8003f30: b9 60 20 00 mv r4,r11 8003f34: b9 e0 28 00 mv r5,r15 8003f38: d9 80 00 00 call r12 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 8003f3c: 29 a1 00 20 lw r1,(r13+32) 8003f40: 52 01 00 03 bgeu r16,r1,8003f4c <_Heap_Walk+0x308> <== ALWAYS TAKEN 8003f44: 34 11 00 00 mvi r17,0 <== NOT EXECUTED 8003f48: e0 00 00 03 bi 8003f54 <_Heap_Walk+0x310> <== NOT EXECUTED 8003f4c: 29 b1 00 24 lw r17,(r13+36) 8003f50: f2 30 88 00 cmpgeu r17,r17,r16 block_size, block->prev_size ); } if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 8003f54: 5e 20 00 05 bne r17,r0,8003f68 <_Heap_Walk+0x324> (*printer)( 8003f58: 78 03 08 01 mvhi r3,0x801 8003f5c: b9 c0 08 00 mv r1,r14 8003f60: 38 63 cf 38 ori r3,r3,0xcf38 8003f64: e0 00 00 1c bi 8003fd4 <_Heap_Walk+0x390> ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) ) { 8003f68: b9 e0 08 00 mv r1,r15 8003f6c: bb 20 10 00 mv r2,r25 8003f70: fb ff f3 54 calli 8000cc0 <__umodsi3> 8003f74: b8 20 88 00 mv r17,r1 8003f78: 44 20 00 09 be r1,r0,8003f9c <_Heap_Walk+0x358> (*printer)( 8003f7c: 78 03 08 01 mvhi r3,0x801 8003f80: b9 c0 08 00 mv r1,r14 8003f84: 38 63 cf 68 ori r3,r3,0xcf68 8003f88: b9 60 20 00 mv r4,r11 8003f8c: b9 e0 28 00 mv r5,r15 8003f90: 34 02 00 01 mvi r2,1 8003f94: d9 80 00 00 call r12 8003f98: e0 00 00 74 bi 8004168 <_Heap_Walk+0x524> ); return false; } if ( block_size < min_block_size ) { 8003f9c: 51 f3 00 0a bgeu r15,r19,8003fc4 <_Heap_Walk+0x380> (*printer)( 8003fa0: 78 03 08 01 mvhi r3,0x801 8003fa4: b9 c0 08 00 mv r1,r14 8003fa8: 38 63 cf 98 ori r3,r3,0xcf98 8003fac: b9 60 20 00 mv r4,r11 8003fb0: b9 e0 28 00 mv r5,r15 8003fb4: ba 60 30 00 mv r6,r19 8003fb8: 34 02 00 01 mvi r2,1 8003fbc: d9 80 00 00 call r12 8003fc0: e0 00 00 09 bi 8003fe4 <_Heap_Walk+0x3a0> ); return false; } if ( next_block_begin <= block_begin ) { 8003fc4: 56 0b 00 0a bgu r16,r11,8003fec <_Heap_Walk+0x3a8> (*printer)( 8003fc8: 78 03 08 01 mvhi r3,0x801 8003fcc: b9 c0 08 00 mv r1,r14 8003fd0: 38 63 cf c4 ori r3,r3,0xcfc4 8003fd4: b9 60 20 00 mv r4,r11 8003fd8: ba 00 28 00 mv r5,r16 8003fdc: 34 02 00 01 mvi r2,1 8003fe0: d9 80 00 00 call r12 8003fe4: ba 20 08 00 mv r1,r17 "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; 8003fe8: e0 00 00 47 bi 8004104 <_Heap_Walk+0x4c0> } if ( !_Heap_Is_prev_used( next_block ) ) { 8003fec: 2a 03 00 04 lw r3,(r16+4) 8003ff0: 20 63 00 01 andi r3,r3,0x1 8003ff4: 5c 60 00 35 bne r3,r0,80040c8 <_Heap_Walk+0x484> 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; 8003ff8: 29 6f 00 04 lw r15,(r11+4) 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)( 8003ffc: 29 65 00 0c lw r5,(r11+12) return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 8004000: 29 a1 00 08 lw r1,(r13+8) - 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; 8004004: a1 fb 88 00 and r17,r15,fp return _Heap_Free_list_head(heap)->next; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_last( Heap_Control *heap ) { return _Heap_Free_list_tail(heap)->prev; 8004008: 29 a3 00 0c lw r3,(r13+12) RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800400c: b5 71 50 00 add r10,r11,r17 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; 8004010: ba a0 30 00 mv r6,r21 8004014: 44 a1 00 04 be r5,r1,8004024 <_Heap_Walk+0x3e0> "block 0x%08x: prev 0x%08x%s, next 0x%08x%s\n", block, block->prev, block->prev == first_free_block ? " (= first)" : (block->prev == free_list_head ? " (= head)" : ""), 8004018: ba 80 30 00 mv r6,r20 800401c: 5c ad 00 02 bne r5,r13,8004024 <_Heap_Walk+0x3e0> 8004020: ba c0 30 00 mv r6,r22 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)( 8004024: 29 67 00 08 lw r7,(r11+8) 8004028: ba e0 40 00 mv r8,r23 800402c: 44 e3 00 04 be r7,r3,800403c <_Heap_Walk+0x3f8> " (= first)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last)" : (block->next == free_list_tail ? " (= tail)" : "") 8004030: ba 80 40 00 mv r8,r20 8004034: 5c ed 00 02 bne r7,r13,800403c <_Heap_Walk+0x3f8> 8004038: bb 00 40 00 mv r8,r24 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)( 800403c: 78 03 08 01 mvhi r3,0x801 8004040: 5b 8a 00 54 sw (sp+84),r10 8004044: b9 c0 08 00 mv r1,r14 8004048: 34 02 00 00 mvi r2,0 800404c: 38 63 d0 28 ori r3,r3,0xd028 8004050: b9 60 20 00 mv r4,r11 8004054: d9 80 00 00 call r12 block->next == last_free_block ? " (= last)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 8004058: 2b 8a 00 54 lw r10,(sp+84) 800405c: 29 46 00 00 lw r6,(r10+0) 8004060: 46 26 00 0a be r17,r6,8004088 <_Heap_Walk+0x444> (*printer)( 8004064: 78 03 08 01 mvhi r3,0x801 8004068: b9 c0 08 00 mv r1,r14 800406c: 38 63 d0 54 ori r3,r3,0xd054 8004070: b9 60 20 00 mv r4,r11 8004074: ba 20 28 00 mv r5,r17 8004078: b9 40 38 00 mv r7,r10 800407c: 34 02 00 01 mvi r2,1 8004080: d9 80 00 00 call r12 8004084: e0 00 00 39 bi 8004168 <_Heap_Walk+0x524> ); return false; } if ( !prev_used ) { 8004088: 21 ef 00 01 andi r15,r15,0x1 800408c: 5d e0 00 09 bne r15,r0,80040b0 <_Heap_Walk+0x46c> (*printer)( 8004090: 78 03 08 01 mvhi r3,0x801 8004094: b9 c0 08 00 mv r1,r14 8004098: 38 63 d0 90 ori r3,r3,0xd090 800409c: b9 60 20 00 mv r4,r11 80040a0: 34 02 00 01 mvi r2,1 80040a4: d9 80 00 00 call r12 80040a8: b9 e0 08 00 mv r1,r15 80040ac: e0 00 00 16 bi 8004104 <_Heap_Walk+0x4c0> 80040b0: 29 a3 00 08 lw r3,(r13+8) 80040b4: e0 00 00 03 bi 80040c0 <_Heap_Walk+0x47c> { 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 ) { 80040b8: 44 6b 00 04 be r3,r11,80040c8 <_Heap_Walk+0x484> return true; } free_block = free_block->next; 80040bc: 28 63 00 08 lw r3,(r3+8) ) { 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 ) { 80040c0: 5c 6d ff fe bne r3,r13,80040b8 <_Heap_Walk+0x474> 80040c4: e0 00 00 23 bi 8004150 <_Heap_Walk+0x50c> 80040c8: ba 00 58 00 mv r11,r16 80040cc: e0 00 00 0c bi 80040fc <_Heap_Walk+0x4b8> " (= first)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last)" : (block->next == free_list_tail ? " (= tail)" : "") 80040d0: 78 18 08 01 mvhi r24,0x801 80040d4: 78 14 08 01 mvhi r20,0x801 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)( 80040d8: 78 17 08 01 mvhi r23,0x801 "block 0x%08x: prev 0x%08x%s, next 0x%08x%s\n", block, block->prev, block->prev == first_free_block ? " (= first)" : (block->prev == free_list_head ? " (= head)" : ""), 80040dc: 78 16 08 01 mvhi r22,0x801 80040e0: 78 15 08 01 mvhi r21,0x801 block->next, block->next == last_free_block ? " (= last)" : (block->next == free_list_tail ? " (= tail)" : "") 80040e4: 3b 18 d0 1c ori r24,r24,0xd01c 80040e8: 3a 94 d0 8c ori r20,r20,0xd08c 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)( 80040ec: 3a f7 d0 10 ori r23,r23,0xd010 "block 0x%08x: prev 0x%08x%s, next 0x%08x%s\n", block, block->prev, block->prev == first_free_block ? " (= first)" : (block->prev == free_list_head ? " (= head)" : ""), 80040f0: 3a d6 d0 04 ori r22,r22,0xd004 80040f4: 3a b5 cf f8 ori r21,r21,0xcff8 - 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; 80040f8: 34 1b ff fe mvi fp,-2 if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; } while ( block != last_block ) { 80040fc: 5d 72 ff 7c bne r11,r18,8003eec <_Heap_Walk+0x2a8> <== NEVER TAKEN 8004100: 34 01 00 01 mvi r1,1 block = next_block; } return true; } 8004104: 2b 9d 00 10 lw ra,(sp+16) 8004108: 2b 8b 00 50 lw r11,(sp+80) 800410c: 2b 8c 00 4c lw r12,(sp+76) 8004110: 2b 8d 00 48 lw r13,(sp+72) 8004114: 2b 8e 00 44 lw r14,(sp+68) 8004118: 2b 8f 00 40 lw r15,(sp+64) 800411c: 2b 90 00 3c lw r16,(sp+60) 8004120: 2b 91 00 38 lw r17,(sp+56) 8004124: 2b 92 00 34 lw r18,(sp+52) 8004128: 2b 93 00 30 lw r19,(sp+48) 800412c: 2b 94 00 2c lw r20,(sp+44) 8004130: 2b 95 00 28 lw r21,(sp+40) 8004134: 2b 96 00 24 lw r22,(sp+36) 8004138: 2b 97 00 20 lw r23,(sp+32) 800413c: 2b 98 00 1c lw r24,(sp+28) 8004140: 2b 99 00 18 lw r25,(sp+24) 8004144: 2b 9b 00 14 lw fp,(sp+20) 8004148: 37 9c 00 54 addi sp,sp,84 800414c: c3 a0 00 00 ret return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 8004150: 78 03 08 01 mvhi r3,0x801 8004154: b9 c0 08 00 mv r1,r14 8004158: 38 63 d0 c0 ori r3,r3,0xd0c0 800415c: b9 60 20 00 mv r4,r11 8004160: 34 02 00 01 mvi r2,1 8004164: d9 80 00 00 call r12 8004168: 34 01 00 00 mvi r1,0 800416c: e3 ff ff e6 bi 8004104 <_Heap_Walk+0x4c0> 08004860 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { 8004860: 37 9c ff e8 addi sp,sp,-24 8004864: 5b 8b 00 18 sw (sp+24),r11 8004868: 5b 8c 00 14 sw (sp+20),r12 800486c: 5b 8d 00 10 sw (sp+16),r13 8004870: 5b 8e 00 0c sw (sp+12),r14 8004874: 5b 8f 00 08 sw (sp+8),r15 8004878: 5b 9d 00 04 sw (sp+4),ra uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; 800487c: 78 01 08 02 mvhi r1,0x802 8004880: 38 21 50 ac ori r1,r1,0x50ac drivers_in_table = Configuration.number_of_device_drivers; number_of_drivers = Configuration.maximum_drivers; 8004884: 28 2b 00 2c lw r11,(r1+44) rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; drivers_in_table = Configuration.number_of_device_drivers; 8004888: 28 2d 00 30 lw r13,(r1+48) uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; 800488c: 28 2f 00 34 lw r15,(r1+52) /* * If the user claims there are less drivers than are actually in * the table, then let's just go with the table's count. */ if ( number_of_drivers <= drivers_in_table ) 8004890: 51 ab 00 02 bgeu r13,r11,8004898 <_IO_Manager_initialization+0x38> /* * If the maximum number of driver is the same as the number in the * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { 8004894: 5d 6d 00 08 bne r11,r13,80048b4 <_IO_Manager_initialization+0x54><== ALWAYS TAKEN _IO_Driver_address_table = driver_table; 8004898: 78 02 08 02 mvhi r2,0x802 _IO_Number_of_drivers = number_of_drivers; 800489c: 78 01 08 02 mvhi r1,0x802 * If the maximum number of driver is the same as the number in the * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { _IO_Driver_address_table = driver_table; 80048a0: 38 42 62 a8 ori r2,r2,0x62a8 _IO_Number_of_drivers = number_of_drivers; 80048a4: 38 21 62 a4 ori r1,r1,0x62a4 * If the maximum number of driver is the same as the number in the * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { _IO_Driver_address_table = driver_table; 80048a8: 58 4f 00 00 sw (r2+0),r15 _IO_Number_of_drivers = number_of_drivers; 80048ac: 58 2d 00 00 sw (r1+0),r13 return; 80048b0: e0 00 00 1b bi 800491c <_IO_Manager_initialization+0xbc> * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) 80048b4: b5 6b 08 00 add r1,r11,r11 80048b8: 34 02 00 03 mvi r2,3 80048bc: b4 2b 08 00 add r1,r1,r11 80048c0: fb ff f0 c3 calli 8000bcc <__ashlsi3> 80048c4: b8 20 60 00 mv r12,r1 /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 80048c8: f8 00 0d 0d calli 8007cfc <_Workspace_Allocate_or_fatal_error> 80048cc: 78 04 08 02 mvhi r4,0x802 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 80048d0: 78 05 08 02 mvhi r5,0x802 /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 80048d4: 38 84 62 a8 ori r4,r4,0x62a8 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 80048d8: 38 a5 62 a4 ori r5,r5,0x62a4 memset( 80048dc: 34 02 00 00 mvi r2,0 80048e0: b9 80 18 00 mv r3,r12 _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 80048e4: 58 ab 00 00 sw (r5+0),r11 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) _IO_Driver_address_table[index] = driver_table[index]; 80048e8: b8 40 60 00 mv r12,r2 /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) 80048ec: 58 81 00 00 sw (r4+0),r1 80048f0: b8 20 70 00 mv r14,r1 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) _IO_Driver_address_table[index] = driver_table[index]; 80048f4: b9 80 58 00 mv r11,r12 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 80048f8: f8 00 3b dc calli 8013868 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 80048fc: e0 00 00 04 bi 800490c <_IO_Manager_initialization+0xac> _IO_Driver_address_table[index] = driver_table[index]; 8004900: f8 00 3b 7c calli 80136f0 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 8004904: 35 6b 00 01 addi r11,r11,1 8004908: 35 8c 00 18 addi r12,r12,24 _IO_Driver_address_table[index] = driver_table[index]; 800490c: b5 cc 08 00 add r1,r14,r12 8004910: b5 ec 10 00 add r2,r15,r12 8004914: 34 03 00 18 mvi r3,24 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 8004918: 55 ab ff fa bgu r13,r11,8004900 <_IO_Manager_initialization+0xa0> _IO_Driver_address_table[index] = driver_table[index]; number_of_drivers = drivers_in_table; } 800491c: 2b 9d 00 04 lw ra,(sp+4) 8004920: 2b 8b 00 18 lw r11,(sp+24) 8004924: 2b 8c 00 14 lw r12,(sp+20) 8004928: 2b 8d 00 10 lw r13,(sp+16) 800492c: 2b 8e 00 0c lw r14,(sp+12) 8004930: 2b 8f 00 08 lw r15,(sp+8) 8004934: 37 9c 00 18 addi sp,sp,24 8004938: c3 a0 00 00 ret 08005824 <_ISR_Handler_initialization>: * * Output parameters: NONE */ void _ISR_Handler_initialization( void ) { 8005824: 37 9c ff f4 addi sp,sp,-12 8005828: 5b 8b 00 0c sw (sp+12),r11 800582c: 5b 8c 00 08 sw (sp+8),r12 8005830: 5b 9d 00 04 sw (sp+4),ra _ISR_Signals_to_thread_executing = false; 8005834: 78 03 08 02 mvhi r3,0x802 _ISR_Nest_level = 0; 8005838: 78 02 08 02 mvhi r2,0x802 * Output parameters: NONE */ void _ISR_Handler_initialization( void ) { _ISR_Signals_to_thread_executing = false; 800583c: 34 04 00 00 mvi r4,0 8005840: 38 63 5a 98 ori r3,r3,0x5a98 _ISR_Nest_level = 0; 8005844: 38 42 59 dc ori r2,r2,0x59dc * Output parameters: NONE */ void _ISR_Handler_initialization( void ) { _ISR_Signals_to_thread_executing = false; 8005848: 30 64 00 00 sb (r3+0),r4 _ISR_Nest_level = 0; 800584c: 58 44 00 00 sw (r2+0),r4 #if (CPU_SIMPLE_VECTORED_INTERRUPTS == TRUE) _ISR_Vector_table = _Workspace_Allocate_or_fatal_error( 8005850: 34 01 00 80 mvi r1,128 void _ISR_Handler_initialization( void ) { _ISR_Signals_to_thread_executing = false; _ISR_Nest_level = 0; 8005854: b8 80 60 00 mv r12,r4 #if (CPU_SIMPLE_VECTORED_INTERRUPTS == TRUE) _ISR_Vector_table = _Workspace_Allocate_or_fatal_error( 8005858: f8 00 09 29 calli 8007cfc <_Workspace_Allocate_or_fatal_error> _CPU_Initialize_vectors(); #if ( CPU_ALLOCATE_INTERRUPT_STACK == TRUE ) if ( !_Stack_Is_enough(Configuration.interrupt_stack_size) ) 800585c: 78 0b 08 02 mvhi r11,0x802 8005860: 78 02 08 02 mvhi r2,0x802 8005864: 38 42 50 a4 ori r2,r2,0x50a4 8005868: 39 6b 50 ac ori r11,r11,0x50ac 800586c: 28 44 00 00 lw r4,(r2+0) 8005870: 29 63 00 1c lw r3,(r11+28) _ISR_Signals_to_thread_executing = false; _ISR_Nest_level = 0; #if (CPU_SIMPLE_VECTORED_INTERRUPTS == TRUE) _ISR_Vector_table = _Workspace_Allocate_or_fatal_error( 8005874: 78 02 08 02 mvhi r2,0x802 8005878: 38 42 59 c0 ori r2,r2,0x59c0 800587c: 58 41 00 00 sw (r2+0),r1 _CPU_Initialize_vectors(); #if ( CPU_ALLOCATE_INTERRUPT_STACK == TRUE ) if ( !_Stack_Is_enough(Configuration.interrupt_stack_size) ) 8005880: 50 64 00 05 bgeu r3,r4,8005894 <_ISR_Handler_initialization+0x70><== ALWAYS TAKEN _Internal_error_Occurred( 8005884: b9 80 08 00 mv r1,r12 <== NOT EXECUTED 8005888: 34 02 00 01 mvi r2,1 <== NOT EXECUTED 800588c: 34 03 00 05 mvi r3,5 <== NOT EXECUTED 8005890: fb ff ff d6 calli 80057e8 <_Internal_error_Occurred> <== NOT EXECUTED INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_INTERRUPT_STACK_TOO_SMALL ); _CPU_Interrupt_stack_low = _Workspace_Allocate_or_fatal_error( 8005894: b8 60 08 00 mv r1,r3 8005898: f8 00 09 19 calli 8007cfc <_Workspace_Allocate_or_fatal_error> Configuration.interrupt_stack_size ); _CPU_Interrupt_stack_high = _Addresses_Add_offset( 800589c: 29 64 00 1c lw r4,(r11+28) INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_INTERRUPT_STACK_TOO_SMALL ); _CPU_Interrupt_stack_low = _Workspace_Allocate_or_fatal_error( 80058a0: 78 02 08 02 mvhi r2,0x802 Configuration.interrupt_stack_size ); _CPU_Interrupt_stack_high = _Addresses_Add_offset( 80058a4: 78 03 08 02 mvhi r3,0x802 80058a8: b4 24 20 00 add r4,r1,r4 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_INTERRUPT_STACK_TOO_SMALL ); _CPU_Interrupt_stack_low = _Workspace_Allocate_or_fatal_error( 80058ac: 38 42 59 54 ori r2,r2,0x5954 Configuration.interrupt_stack_size ); _CPU_Interrupt_stack_high = _Addresses_Add_offset( 80058b0: 38 63 58 d8 ori r3,r3,0x58d8 80058b4: 58 64 00 00 sw (r3+0),r4 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_INTERRUPT_STACK_TOO_SMALL ); _CPU_Interrupt_stack_low = _Workspace_Allocate_or_fatal_error( 80058b8: 58 41 00 00 sw (r2+0),r1 #if ( CPU_HAS_HARDWARE_INTERRUPT_STACK == TRUE ) _CPU_Install_interrupt_stack(); #endif } 80058bc: 2b 9d 00 04 lw ra,(sp+4) 80058c0: 2b 8b 00 0c lw r11,(sp+12) 80058c4: 2b 8c 00 08 lw r12,(sp+8) 80058c8: 37 9c 00 0c addi sp,sp,12 80058cc: c3 a0 00 00 ret 080058d0 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 80058d0: 37 9c ff ec addi sp,sp,-20 80058d4: 5b 8b 00 14 sw (sp+20),r11 80058d8: 5b 8c 00 10 sw (sp+16),r12 80058dc: 5b 8d 00 0c sw (sp+12),r13 80058e0: 5b 8e 00 08 sw (sp+8),r14 80058e4: 5b 9d 00 04 sw (sp+4),ra 80058e8: b8 20 58 00 mv r11,r1 * 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 ) 80058ec: 28 21 00 18 lw r1,(r1+24) 80058f0: b8 20 60 00 mv r12,r1 80058f4: 44 20 00 20 be r1,r0,8005974 <_Objects_Allocate+0xa4> <== NEVER TAKEN /* * 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 ); 80058f8: 35 6d 00 20 addi r13,r11,32 80058fc: b9 a0 08 00 mv r1,r13 8005900: fb ff fd 45 calli 8004e14 <_Chain_Get> 8005904: b8 20 60 00 mv r12,r1 if ( information->auto_extend ) { 8005908: 41 61 00 12 lbu r1,(r11+18) /* * 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 ); 800590c: b9 80 70 00 mv r14,r12 if ( information->auto_extend ) { 8005910: 44 20 00 19 be r1,r0,8005974 <_Objects_Allocate+0xa4> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { 8005914: 5d 80 00 07 bne r12,r0,8005930 <_Objects_Allocate+0x60> _Objects_Extend_information( information ); 8005918: b9 60 08 00 mv r1,r11 800591c: f8 00 00 36 calli 80059f4 <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 8005920: b9 a0 08 00 mv r1,r13 8005924: fb ff fd 3c calli 8004e14 <_Chain_Get> 8005928: b8 20 60 00 mv r12,r1 } if ( the_object ) { 800592c: 44 2e 00 12 be r1,r14,8005974 <_Objects_Allocate+0xa4> uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 8005930: 29 83 00 08 lw r3,(r12+8) 8005934: 29 61 00 08 lw r1,(r11+8) _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 8005938: 2d 62 00 14 lhu r2,(r11+20) } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 800593c: 20 63 ff ff andi r3,r3,0xffff 8005940: 20 21 ff ff andi r1,r1,0xffff _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 8005944: c8 61 08 00 sub r1,r3,r1 8005948: f8 00 71 0b calli 8021d74 <__udivsi3> 800594c: 34 02 00 02 mvi r2,2 8005950: fb ff ec 9f calli 8000bcc <__ashlsi3> 8005954: 29 62 00 30 lw r2,(r11+48) information->inactive--; 8005958: 2d 63 00 2c lhu r3,(r11+44) block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 800595c: b4 41 08 00 add r1,r2,r1 8005960: 28 22 00 00 lw r2,(r1+0) information->inactive--; 8005964: 34 63 ff ff addi r3,r3,-1 8005968: 0d 63 00 2c sh (r11+44),r3 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; 800596c: 34 42 ff ff addi r2,r2,-1 8005970: 58 22 00 00 sw (r1+0),r2 information->inactive--; } } return the_object; } 8005974: b9 80 08 00 mv r1,r12 8005978: 2b 9d 00 04 lw ra,(sp+4) 800597c: 2b 8b 00 14 lw r11,(sp+20) 8005980: 2b 8c 00 10 lw r12,(sp+16) 8005984: 2b 8d 00 0c lw r13,(sp+12) 8005988: 2b 8e 00 08 lw r14,(sp+8) 800598c: 37 9c 00 14 addi sp,sp,20 8005990: c3 a0 00 00 ret 080059f4 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { 80059f4: 37 9c ff c4 addi sp,sp,-60 80059f8: 5b 8b 00 30 sw (sp+48),r11 80059fc: 5b 8c 00 2c sw (sp+44),r12 8005a00: 5b 8d 00 28 sw (sp+40),r13 8005a04: 5b 8e 00 24 sw (sp+36),r14 8005a08: 5b 8f 00 20 sw (sp+32),r15 8005a0c: 5b 90 00 1c sw (sp+28),r16 8005a10: 5b 91 00 18 sw (sp+24),r17 8005a14: 5b 92 00 14 sw (sp+20),r18 8005a18: 5b 93 00 10 sw (sp+16),r19 8005a1c: 5b 94 00 0c sw (sp+12),r20 8005a20: 5b 95 00 08 sw (sp+8),r21 8005a24: 5b 9d 00 04 sw (sp+4),ra /* * Search for a free block of indexes. The block variable ends up set * to block_count + 1 if the table needs to be extended. */ minimum_index = _Objects_Get_index( information->minimum_id ); 8005a28: 28 2e 00 08 lw r14,(r1+8) index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 8005a2c: 28 2f 00 34 lw r15,(r1+52) */ void _Objects_Extend_information( Objects_Information *information ) { 8005a30: b8 20 58 00 mv r11,r1 /* * Search for a free block of indexes. The block variable ends up set * to block_count + 1 if the table needs to be extended. */ minimum_index = _Objects_Get_index( information->minimum_id ); 8005a34: 21 ce ff ff andi r14,r14,0xffff index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) 8005a38: b9 e0 68 00 mv r13,r15 8005a3c: b9 c0 60 00 mv r12,r14 8005a40: b9 e0 88 00 mv r17,r15 8005a44: 45 e0 00 0f be r15,r0,8005a80 <_Objects_Extend_information+0x8c> block_count = 0; else { block_count = information->maximum / information->allocation_size; 8005a48: 2c 30 00 14 lhu r16,(r1+20) 8005a4c: 2c 21 00 10 lhu r1,(r1+16) 8005a50: 34 0d 00 00 mvi r13,0 8005a54: ba 00 10 00 mv r2,r16 8005a58: f8 00 70 c7 calli 8021d74 <__udivsi3> 8005a5c: 20 31 ff ff andi r17,r1,0xffff 8005a60: b9 e0 08 00 mv r1,r15 for ( ; block < block_count; block++ ) { 8005a64: e0 00 00 06 bi 8005a7c <_Objects_Extend_information+0x88> if ( information->object_blocks[ block ] == NULL ) 8005a68: 28 22 00 00 lw r2,(r1+0) 8005a6c: 34 21 00 04 addi r1,r1,4 8005a70: 44 40 00 04 be r2,r0,8005a80 <_Objects_Extend_information+0x8c> 8005a74: b5 90 60 00 add r12,r12,r16 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { 8005a78: 35 ad 00 01 addi r13,r13,1 8005a7c: 56 2d ff fb bgu r17,r13,8005a68 <_Objects_Extend_information+0x74> else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 8005a80: 2d 61 00 14 lhu r1,(r11+20) 8005a84: 2d 74 00 10 lhu r20,(r11+16) /* * We need to limit the number of objects to the maximum number * representable in the index portion of the object Id. In the * case of 16-bit Ids, this is only 256 object instances. */ if ( maximum > OBJECTS_ID_FINAL_INDEX ) { 8005a88: 38 02 ff ff mvu r2,0xffff else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; 8005a8c: b4 34 a0 00 add r20,r1,r20 /* * We need to limit the number of objects to the maximum number * representable in the index portion of the object Id. In the * case of 16-bit Ids, this is only 256 object instances. */ if ( maximum > OBJECTS_ID_FINAL_INDEX ) { 8005a90: 56 82 00 97 bgu r20,r2,8005cec <_Objects_Extend_information+0x2f8><== NEVER TAKEN /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; 8005a94: 29 62 00 18 lw r2,(r11+24) 8005a98: f8 00 70 38 calli 8021b78 <__mulsi3> if ( information->auto_extend ) { 8005a9c: 41 62 00 12 lbu r2,(r11+18) 8005aa0: 44 40 00 05 be r2,r0,8005ab4 <_Objects_Extend_information+0xc0> new_object_block = _Workspace_Allocate( block_size ); 8005aa4: f8 00 08 a5 calli 8007d38 <_Workspace_Allocate> 8005aa8: b8 20 78 00 mv r15,r1 if ( !new_object_block ) 8005aac: 5c 20 00 04 bne r1,r0,8005abc <_Objects_Extend_information+0xc8> 8005ab0: e0 00 00 8f bi 8005cec <_Objects_Extend_information+0x2f8> return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); 8005ab4: f8 00 08 92 calli 8007cfc <_Workspace_Allocate_or_fatal_error> 8005ab8: b8 20 78 00 mv r15,r1 } /* * If the index_base is the maximum we need to grow the tables. */ if (index_base >= information->maximum ) { 8005abc: 2d 61 00 10 lhu r1,(r11+16) 8005ac0: 54 2c 00 60 bgu r1,r12,8005c40 <_Objects_Extend_information+0x24c> */ /* * Up the block count and maximum */ block_count++; 8005ac4: 36 32 00 01 addi r18,r17,1 * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); 8005ac8: b6 52 08 00 add r1,r18,r18 8005acc: b6 8e 10 00 add r2,r20,r14 8005ad0: b4 32 08 00 add r1,r1,r18 8005ad4: b4 41 08 00 add r1,r2,r1 8005ad8: 34 02 00 02 mvi r2,2 8005adc: fb ff ec 3c calli 8000bcc <__ashlsi3> 8005ae0: f8 00 08 96 calli 8007d38 <_Workspace_Allocate> 8005ae4: b8 20 80 00 mv r16,r1 if ( !object_blocks ) { 8005ae8: 5c 20 00 04 bne r1,r0,8005af8 <_Objects_Extend_information+0x104> _Workspace_Free( new_object_block ); 8005aec: b9 e0 08 00 mv r1,r15 8005af0: f8 00 08 9d calli 8007d64 <_Workspace_Free> return; 8005af4: e0 00 00 7e bi 8005cec <_Objects_Extend_information+0x2f8> } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( 8005af8: ba 40 08 00 mv r1,r18 8005afc: 34 02 00 02 mvi r2,2 8005b00: fb ff ec 33 calli 8000bcc <__ashlsi3> * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { 8005b04: 2d 62 00 10 lhu r2,(r11+16) RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); 8005b08: b6 01 98 00 add r19,r16,r1 8005b0c: b6 61 90 00 add r18,r19,r1 8005b10: 54 4e 00 05 bgu r2,r14,8005b24 <_Objects_Extend_information+0x130> 8005b14: 34 01 00 00 mvi r1,0 8005b18: ba 40 10 00 mv r2,r18 /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { local_table[ index ] = NULL; 8005b1c: b8 20 18 00 mv r3,r1 8005b20: e0 00 00 19 bi 8005b84 <_Objects_Extend_information+0x190> * separate parts as size of each block has changed. */ memcpy( object_blocks, information->object_blocks, block_count * sizeof(void*) ); 8005b24: ba 20 08 00 mv r1,r17 8005b28: 34 02 00 02 mvi r2,2 8005b2c: fb ff ec 28 calli 8000bcc <__ashlsi3> /* * Copy each section of the table over. This has to be performed as * separate parts as size of each block has changed. */ memcpy( object_blocks, 8005b30: 29 62 00 34 lw r2,(r11+52) information->object_blocks, block_count * sizeof(void*) ); 8005b34: b8 20 a8 00 mv r21,r1 /* * Copy each section of the table over. This has to be performed as * separate parts as size of each block has changed. */ memcpy( object_blocks, 8005b38: ba a0 18 00 mv r3,r21 8005b3c: ba 00 08 00 mv r1,r16 8005b40: f8 00 36 ec calli 80136f0 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, 8005b44: 29 62 00 30 lw r2,(r11+48) 8005b48: ba a0 18 00 mv r3,r21 8005b4c: ba 60 08 00 mv r1,r19 8005b50: f8 00 36 e8 calli 80136f0 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, 8005b54: 2d 61 00 10 lhu r1,(r11+16) 8005b58: 34 02 00 02 mvi r2,2 8005b5c: b5 c1 08 00 add r1,r14,r1 8005b60: fb ff ec 1b calli 8000bcc <__ashlsi3> 8005b64: 29 62 00 1c lw r2,(r11+28) 8005b68: b8 20 18 00 mv r3,r1 8005b6c: ba 40 08 00 mv r1,r18 8005b70: f8 00 36 e0 calli 80136f0 8005b74: e0 00 00 05 bi 8005b88 <_Objects_Extend_information+0x194> /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { local_table[ index ] = NULL; 8005b78: 58 43 00 00 sw (r2+0),r3 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { 8005b7c: 34 21 00 01 addi r1,r1,1 8005b80: 34 42 00 04 addi r2,r2,4 8005b84: 55 c1 ff fd bgu r14,r1,8005b78 <_Objects_Extend_information+0x184> } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 8005b88: ba 20 08 00 mv r1,r17 8005b8c: 34 02 00 02 mvi r2,2 8005b90: fb ff ec 0f calli 8000bcc <__ashlsi3> inactive_per_block[block_count] = 0; 8005b94: b6 61 10 00 add r2,r19,r1 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 8005b98: 34 0e 00 00 mvi r14,0 8005b9c: b6 01 08 00 add r1,r16,r1 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); 8005ba0: 2d 71 00 14 lhu r17,(r11+20) } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; 8005ba4: 58 2e 00 00 sw (r1+0),r14 inactive_per_block[block_count] = 0; 8005ba8: 58 4e 00 00 sw (r2+0),r14 for ( index=index_base ; index < ( information->allocation_size + index_base ); 8005bac: b9 80 08 00 mv r1,r12 8005bb0: 34 02 00 02 mvi r2,2 8005bb4: fb ff ec 06 calli 8000bcc <__ashlsi3> 8005bb8: b5 91 88 00 add r17,r12,r17 8005bbc: b6 41 08 00 add r1,r18,r1 8005bc0: b9 80 10 00 mv r2,r12 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 8005bc4: e0 00 00 04 bi 8005bd4 <_Objects_Extend_information+0x1e0> index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; 8005bc8: 58 2e 00 00 sw (r1+0),r14 object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { 8005bcc: 34 42 00 01 addi r2,r2,1 8005bd0: 34 21 00 04 addi r1,r1,4 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; 8005bd4: 56 22 ff fd bgu r17,r2,8005bc8 <_Objects_Extend_information+0x1d4> index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; } _ISR_Disable( level ); 8005bd8: 90 00 88 00 rcsr r17,IE 8005bdc: 34 01 ff fe mvi r1,-2 8005be0: a2 21 08 00 and r1,r17,r1 8005be4: d0 01 00 00 wcsr IE,r1 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 8005be8: 29 61 00 00 lw r1,(r11+0) old_tables = information->object_blocks; information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; 8005bec: 22 94 ff ff andi r20,r20,0xffff 8005bf0: 0d 74 00 10 sh (r11+16),r20 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; 8005bf4: 59 73 00 30 sw (r11+48),r19 information->local_table = local_table; 8005bf8: 59 72 00 1c sw (r11+28),r18 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; 8005bfc: 29 6e 00 34 lw r14,(r11+52) information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 8005c00: 34 02 00 18 mvi r2,24 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; 8005c04: 59 70 00 34 sw (r11+52),r16 information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( 8005c08: fb ff eb f1 calli 8000bcc <__ashlsi3> 8005c0c: 78 02 00 01 mvhi r2,0x1 8005c10: 38 42 00 00 ori r2,r2,0x0 8005c14: b8 22 80 00 or r16,r1,r2 8005c18: 2d 61 00 04 lhu r1,(r11+4) 8005c1c: 34 02 00 1b mvi r2,27 8005c20: fb ff eb eb calli 8000bcc <__ashlsi3> 8005c24: ba 01 08 00 or r1,r16,r1 8005c28: b8 34 a0 00 or r20,r1,r20 8005c2c: 59 74 00 0c sw (r11+12),r20 information->the_class, _Objects_Local_node, information->maximum ); _ISR_Enable( level ); 8005c30: d0 11 00 00 wcsr IE,r17 if ( old_tables ) 8005c34: 45 c0 00 03 be r14,r0,8005c40 <_Objects_Extend_information+0x24c> _Workspace_Free( old_tables ); 8005c38: b9 c0 08 00 mv r1,r14 8005c3c: f8 00 08 4a calli 8007d64 <_Workspace_Free> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 8005c40: b9 a0 08 00 mv r1,r13 8005c44: 34 02 00 02 mvi r2,2 8005c48: fb ff eb e1 calli 8000bcc <__ashlsi3> 8005c4c: b8 20 80 00 mv r16,r1 8005c50: 29 61 00 34 lw r1,(r11+52) /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 8005c54: 2d 63 00 14 lhu r3,(r11+20) 8005c58: 29 64 00 18 lw r4,(r11+24) } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 8005c5c: b4 30 08 00 add r1,r1,r16 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 8005c60: 37 8e 00 34 addi r14,sp,52 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; 8005c64: 58 2f 00 00 sw (r1+0),r15 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 8005c68: b9 e0 10 00 mv r2,r15 8005c6c: b9 c0 08 00 mv r1,r14 */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { the_object->id = _Objects_Build_id( 8005c70: 78 0d 00 01 mvhi r13,0x1 information->object_blocks[ block ] = new_object_block; /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( 8005c74: f8 00 24 cc calli 800efa4 <_Chain_Initialize> /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 8005c78: b9 c0 88 00 mv r17,r14 the_object->id = _Objects_Build_id( 8005c7c: 39 ad 00 00 ori r13,r13,0x0 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 8005c80: 35 6f 00 20 addi r15,r11,32 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 8005c84: e0 00 00 0e bi 8005cbc <_Objects_Extend_information+0x2c8> the_object->id = _Objects_Build_id( 8005c88: 29 61 00 00 lw r1,(r11+0) 8005c8c: fb ff eb d0 calli 8000bcc <__ashlsi3> 8005c90: b8 2d 90 00 or r18,r1,r13 8005c94: 2d 61 00 04 lhu r1,(r11+4) 8005c98: 34 02 00 1b mvi r2,27 8005c9c: fb ff eb cc calli 8000bcc <__ashlsi3> 8005ca0: ba 41 10 00 or r2,r18,r1 8005ca4: b8 4c 10 00 or r2,r2,r12 8005ca8: 59 c2 00 08 sw (r14+8),r2 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); 8005cac: b9 e0 08 00 mv r1,r15 8005cb0: b9 c0 10 00 mv r2,r14 8005cb4: fb ff fc 42 calli 8004dbc <_Chain_Append> index++; 8005cb8: 35 8c 00 01 addi r12,r12,1 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 8005cbc: ba 20 08 00 mv r1,r17 8005cc0: fb ff fc 55 calli 8004e14 <_Chain_Get> 8005cc4: b8 20 70 00 mv r14,r1 the_object->id = _Objects_Build_id( 8005cc8: 34 02 00 18 mvi r2,24 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { 8005ccc: 5c 20 ff ef bne r1,r0,8005c88 <_Objects_Extend_information+0x294> _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 8005cd0: 2d 62 00 14 lhu r2,(r11+20) information->inactive = 8005cd4: 2d 61 00 2c lhu r1,(r11+44) _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 8005cd8: 29 63 00 30 lw r3,(r11+48) information->inactive = 8005cdc: b4 41 08 00 add r1,r2,r1 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 8005ce0: b4 70 80 00 add r16,r3,r16 information->inactive = 8005ce4: 0d 61 00 2c sh (r11+44),r1 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; 8005ce8: 5a 02 00 00 sw (r16+0),r2 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); } 8005cec: 2b 9d 00 04 lw ra,(sp+4) 8005cf0: 2b 8b 00 30 lw r11,(sp+48) 8005cf4: 2b 8c 00 2c lw r12,(sp+44) 8005cf8: 2b 8d 00 28 lw r13,(sp+40) 8005cfc: 2b 8e 00 24 lw r14,(sp+36) 8005d00: 2b 8f 00 20 lw r15,(sp+32) 8005d04: 2b 90 00 1c lw r16,(sp+28) 8005d08: 2b 91 00 18 lw r17,(sp+24) 8005d0c: 2b 92 00 14 lw r18,(sp+20) 8005d10: 2b 93 00 10 lw r19,(sp+16) 8005d14: 2b 94 00 0c lw r20,(sp+12) 8005d18: 2b 95 00 08 lw r21,(sp+8) 8005d1c: 37 9c 00 3c addi sp,sp,60 8005d20: c3 a0 00 00 ret 0800f948 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint32_t the_class ) { 800f948: 37 9c ff f4 addi sp,sp,-12 800f94c: 5b 8b 00 0c sw (sp+12),r11 800f950: 5b 8c 00 08 sw (sp+8),r12 800f954: 5b 9d 00 04 sw (sp+4),ra 800f958: b8 40 58 00 mv r11,r2 800f95c: b8 20 60 00 mv r12,r1 Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 800f960: 44 40 00 14 be r2,r0,800f9b0 <_Objects_Get_information+0x68> /* * 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 ); 800f964: f8 00 0b ed calli 8012918 <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) 800f968: 44 20 00 12 be r1,r0,800f9b0 <_Objects_Get_information+0x68> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 800f96c: 55 61 00 11 bgu r11,r1,800f9b0 <_Objects_Get_information+0x68> return NULL; if ( !_Objects_Information_table[ the_api ] ) 800f970: b9 80 08 00 mv r1,r12 800f974: 34 02 00 02 mvi r2,2 800f978: 78 0c 08 02 mvhi r12,0x802 800f97c: 39 8c 58 dc ori r12,r12,0x58dc 800f980: fb ff c4 93 calli 8000bcc <__ashlsi3> 800f984: b5 81 08 00 add r1,r12,r1 800f988: 28 2c 00 00 lw r12,(r1+0) 800f98c: 45 80 00 09 be r12,r0,800f9b0 <_Objects_Get_information+0x68><== NEVER TAKEN return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 800f990: b9 60 08 00 mv r1,r11 800f994: 34 02 00 02 mvi r2,2 800f998: fb ff c4 8d calli 8000bcc <__ashlsi3> 800f99c: b5 81 08 00 add r1,r12,r1 800f9a0: 28 21 00 00 lw r1,(r1+0) if ( !info ) 800f9a4: 44 20 00 04 be r1,r0,800f9b4 <_Objects_Get_information+0x6c><== NEVER TAKEN * 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 ) 800f9a8: 2c 22 00 10 lhu r2,(r1+16) 800f9ac: 5c 40 00 02 bne r2,r0,800f9b4 <_Objects_Get_information+0x6c> 800f9b0: 34 01 00 00 mvi r1,0 return NULL; #endif return info; } 800f9b4: 2b 9d 00 04 lw ra,(sp+4) 800f9b8: 2b 8b 00 0c lw r11,(sp+12) 800f9bc: 2b 8c 00 08 lw r12,(sp+8) 800f9c0: 37 9c 00 0c addi sp,sp,12 800f9c4: c3 a0 00 00 ret 080058ec <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { 80058ec: 37 9c ff e0 addi sp,sp,-32 80058f0: 5b 8b 00 14 sw (sp+20),r11 80058f4: 5b 8c 00 10 sw (sp+16),r12 80058f8: 5b 8d 00 0c sw (sp+12),r13 80058fc: 5b 8e 00 08 sw (sp+8),r14 8005900: 5b 9d 00 04 sw (sp+4),ra 8005904: b8 40 68 00 mv r13,r2 8005908: b8 60 58 00 mv r11,r3 char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) 800590c: 44 40 00 3e be r2,r0,8005a04 <_Objects_Get_name_as_string+0x118><== NEVER TAKEN return NULL; if ( name == NULL ) 8005910: 44 60 00 3e be r3,r0,8005a08 <_Objects_Get_name_as_string+0x11c><== NEVER TAKEN return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 8005914: b8 20 60 00 mv r12,r1 8005918: 5c 20 00 05 bne r1,r0,800592c <_Objects_Get_name_as_string+0x40> 800591c: 78 01 08 02 mvhi r1,0x802 8005920: 38 21 c7 68 ori r1,r1,0xc768 8005924: 28 21 00 00 lw r1,(r1+0) 8005928: 28 2c 00 08 lw r12,(r1+8) information = _Objects_Get_information_id( tmpId ); 800592c: b9 80 08 00 mv r1,r12 8005930: fb ff ff bc calli 8005820 <_Objects_Get_information_id> 8005934: b8 20 70 00 mv r14,r1 if ( !information ) 8005938: 44 20 00 33 be r1,r0,8005a04 <_Objects_Get_name_as_string+0x118><== NEVER TAKEN return NULL; the_object = _Objects_Get( information, tmpId, &location ); 800593c: b9 80 10 00 mv r2,r12 8005940: 37 83 00 20 addi r3,sp,32 8005944: f8 00 00 39 calli 8005a28 <_Objects_Get> switch ( location ) { 8005948: 2b 82 00 20 lw r2,(sp+32) 800594c: 5c 40 00 2e bne r2,r0,8005a04 <_Objects_Get_name_as_string+0x118><== NEVER TAKEN return NULL; case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 8005950: 41 ce 00 38 lbu r14,(r14+56) 8005954: 45 c2 00 05 be r14,r2,8005968 <_Objects_Get_name_as_string+0x7c> s = the_object->name.name_p; 8005958: 28 26 00 0c lw r6,(r1+12) lname[ 4 ] = '\0'; s = lname; } d = name; if ( s ) { 800595c: b9 60 08 00 mv r1,r11 8005960: 5c c0 00 12 bne r6,r0,80059a8 <_Objects_Get_name_as_string+0xbc> 8005964: e0 00 00 24 bi 80059f4 <_Objects_Get_name_as_string+0x108> if ( information->is_string ) { s = the_object->name.name_p; } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; 8005968: 28 2c 00 0c lw r12,(r1+12) lname[ 0 ] = (u32_name >> 24) & 0xff; 800596c: 34 02 00 18 mvi r2,24 8005970: b9 80 08 00 mv r1,r12 8005974: fb ff ee 55 calli 80012c8 <__lshrsi3> 8005978: 33 81 00 18 sb (sp+24),r1 lname[ 1 ] = (u32_name >> 16) & 0xff; 800597c: 34 02 00 10 mvi r2,16 8005980: b9 80 08 00 mv r1,r12 8005984: fb ff ee 51 calli 80012c8 <__lshrsi3> 8005988: 33 81 00 19 sb (sp+25),r1 lname[ 2 ] = (u32_name >> 8) & 0xff; 800598c: 34 02 00 08 mvi r2,8 8005990: b9 80 08 00 mv r1,r12 8005994: fb ff ee 4d calli 80012c8 <__lshrsi3> 8005998: 33 81 00 1a sb (sp+26),r1 lname[ 3 ] = (u32_name >> 0) & 0xff; 800599c: 33 8c 00 1b sb (sp+27),r12 lname[ 4 ] = '\0'; 80059a0: 33 8e 00 1c sb (sp+28),r14 80059a4: 37 86 00 18 addi r6,sp,24 } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { *d = (isprint((unsigned char)*s)) ? *s : '*'; 80059a8: 78 04 08 02 mvhi r4,0x802 s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 80059ac: 35 ad ff ff addi r13,r13,-1 *d = (isprint((unsigned char)*s)) ? *s : '*'; 80059b0: 38 84 41 f8 ori r4,r4,0x41f8 lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; 80059b4: b9 60 08 00 mv r1,r11 80059b8: 34 03 00 00 mvi r3,0 80059bc: e0 00 00 09 bi 80059e0 <_Objects_Get_name_as_string+0xf4> } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { *d = (isprint((unsigned char)*s)) ? *s : '*'; 80059c0: 28 82 00 00 lw r2,(r4+0) 80059c4: b4 45 10 00 add r2,r2,r5 80059c8: 40 42 00 01 lbu r2,(r2+1) 80059cc: 20 42 00 97 andi r2,r2,0x97 80059d0: 5c 40 00 02 bne r2,r0,80059d8 <_Objects_Get_name_as_string+0xec> 80059d4: 34 05 00 2a mvi r5,42 80059d8: 30 25 00 00 sb (r1+0),r5 s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { 80059dc: 34 21 00 01 addi r1,r1,1 80059e0: b4 c3 10 00 add r2,r6,r3 80059e4: 50 6d 00 04 bgeu r3,r13,80059f4 <_Objects_Get_name_as_string+0x108> 80059e8: 40 45 00 00 lbu r5,(r2+0) 80059ec: 34 63 00 01 addi r3,r3,1 80059f0: 5c a0 ff f4 bne r5,r0,80059c0 <_Objects_Get_name_as_string+0xd4> *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; 80059f4: 34 02 00 00 mvi r2,0 80059f8: 30 22 00 00 sb (r1+0),r2 _Thread_Enable_dispatch(); 80059fc: f8 00 02 07 calli 8006218 <_Thread_Enable_dispatch> return name; 8005a00: e0 00 00 02 bi 8005a08 <_Objects_Get_name_as_string+0x11c> 8005a04: 34 0b 00 00 mvi r11,0 } return NULL; /* unreachable path */ } 8005a08: b9 60 08 00 mv r1,r11 8005a0c: 2b 9d 00 04 lw ra,(sp+4) 8005a10: 2b 8b 00 14 lw r11,(sp+20) 8005a14: 2b 8c 00 10 lw r12,(sp+16) 8005a18: 2b 8d 00 0c lw r13,(sp+12) 8005a1c: 2b 8e 00 08 lw r14,(sp+8) 8005a20: 37 9c 00 20 addi sp,sp,32 8005a24: c3 a0 00 00 ret 08016ee8 <_Objects_Get_no_protection>: Objects_Control *_Objects_Get_no_protection( Objects_Information *information, Objects_Id id, Objects_Locations *location ) { 8016ee8: 37 9c ff f4 addi sp,sp,-12 8016eec: 5b 8b 00 0c sw (sp+12),r11 8016ef0: 5b 8c 00 08 sw (sp+8),r12 8016ef4: 5b 9d 00 04 sw (sp+4),ra 8016ef8: b8 20 20 00 mv r4,r1 /* * 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; 8016efc: 28 21 00 08 lw r1,(r1+8) if ( information->maximum >= index ) { 8016f00: 2c 85 00 10 lhu r5,(r4+16) Objects_Control *_Objects_Get_no_protection( Objects_Information *information, Objects_Id id, Objects_Locations *location ) { 8016f04: b8 60 58 00 mv r11,r3 /* * 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; 8016f08: c8 41 08 00 sub r1,r2,r1 8016f0c: 34 21 00 01 addi r1,r1,1 if ( information->maximum >= index ) { 8016f10: 54 25 00 0a bgu r1,r5,8016f38 <_Objects_Get_no_protection+0x50> if ( (the_object = information->local_table[ index ]) != NULL ) { 8016f14: 28 8c 00 1c lw r12,(r4+28) 8016f18: 34 02 00 02 mvi r2,2 8016f1c: fb ff db df calli 800de98 <__ashlsi3> 8016f20: b5 81 08 00 add r1,r12,r1 8016f24: 28 21 00 00 lw r1,(r1+0) 8016f28: 44 20 00 04 be r1,r0,8016f38 <_Objects_Get_no_protection+0x50><== NEVER TAKEN *location = OBJECTS_LOCAL; 8016f2c: 34 02 00 00 mvi r2,0 8016f30: 59 62 00 00 sw (r11+0),r2 return the_object; 8016f34: e0 00 00 04 bi 8016f44 <_Objects_Get_no_protection+0x5c> /* * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; 8016f38: 34 01 00 01 mvi r1,1 8016f3c: 59 61 00 00 sw (r11+0),r1 8016f40: 34 01 00 00 mvi r1,0 return NULL; } 8016f44: 2b 9d 00 04 lw ra,(sp+4) 8016f48: 2b 8b 00 0c lw r11,(sp+12) 8016f4c: 2b 8c 00 08 lw r12,(sp+8) 8016f50: 37 9c 00 0c addi sp,sp,12 8016f54: c3 a0 00 00 ret 080053e4 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 80053e4: 37 9c ff ec addi sp,sp,-20 80053e8: 5b 8b 00 10 sw (sp+16),r11 80053ec: 5b 8c 00 0c sw (sp+12),r12 80053f0: 5b 8d 00 08 sw (sp+8),r13 80053f4: 5b 9d 00 04 sw (sp+4),ra 80053f8: b8 40 68 00 mv r13,r2 /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 80053fc: b8 20 58 00 mv r11,r1 8005400: 5c 20 00 05 bne r1,r0,8005414 <_Objects_Id_to_name+0x30> 8005404: 78 01 08 02 mvhi r1,0x802 8005408: 38 21 39 c0 ori r1,r1,0x39c0 800540c: 28 21 00 00 lw r1,(r1+0) 8005410: 28 2b 00 08 lw r11,(r1+8) */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); 8005414: 34 02 00 18 mvi r2,24 8005418: b9 60 08 00 mv r1,r11 800541c: fb ff f0 98 calli 800167c <__lshrsi3> 8005420: 20 21 00 07 andi r1,r1,0x7 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) 8005424: 34 23 ff ff addi r3,r1,-1 8005428: 34 02 00 03 mvi r2,3 800542c: 54 62 00 15 bgu r3,r2,8005480 <_Objects_Id_to_name+0x9c> 8005430: e0 00 00 1b bi 800549c <_Objects_Id_to_name+0xb8> if ( !_Objects_Information_table[ the_api ] ) return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 8005434: 34 02 00 1b mvi r2,27 8005438: b9 60 08 00 mv r1,r11 800543c: fb ff f0 90 calli 800167c <__lshrsi3> 8005440: 34 02 00 02 mvi r2,2 8005444: fb ff f0 66 calli 80015dc <__ashlsi3> 8005448: b5 81 08 00 add r1,r12,r1 800544c: 28 21 00 00 lw r1,(r1+0) if ( !information ) 8005450: 44 20 00 0c be r1,r0,8005480 <_Objects_Id_to_name+0x9c> <== NEVER TAKEN return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 8005454: 40 2c 00 38 lbu r12,(r1+56) 8005458: 5d 80 00 0a bne r12,r0,8005480 <_Objects_Id_to_name+0x9c> <== NEVER TAKEN return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 800545c: b9 60 10 00 mv r2,r11 8005460: 37 83 00 14 addi r3,sp,20 8005464: f8 00 17 15 calli 800b0b8 <_Objects_Get> if ( !the_object ) 8005468: 44 2c 00 06 be r1,r12,8005480 <_Objects_Id_to_name+0x9c> return OBJECTS_INVALID_ID; *name = the_object->name; 800546c: 28 21 00 0c lw r1,(r1+12) 8005470: 59 a1 00 00 sw (r13+0),r1 _Thread_Enable_dispatch(); 8005474: f8 00 02 4e calli 8005dac <_Thread_Enable_dispatch> 8005478: b9 80 08 00 mv r1,r12 return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 800547c: e0 00 00 02 bi 8005484 <_Objects_Id_to_name+0xa0> 8005480: 34 01 00 03 mvi r1,3 } 8005484: 2b 9d 00 04 lw ra,(sp+4) 8005488: 2b 8b 00 10 lw r11,(sp+16) 800548c: 2b 8c 00 0c lw r12,(sp+12) 8005490: 2b 8d 00 08 lw r13,(sp+8) 8005494: 37 9c 00 14 addi sp,sp,20 8005498: c3 a0 00 00 ret the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) 800549c: 78 0c 08 02 mvhi r12,0x802 80054a0: 34 02 00 02 mvi r2,2 80054a4: 39 8c 38 9c ori r12,r12,0x389c 80054a8: fb ff f0 4d calli 80015dc <__ashlsi3> 80054ac: b5 81 08 00 add r1,r12,r1 80054b0: 28 2c 00 00 lw r12,(r1+0) 80054b4: 5d 80 ff e0 bne r12,r0,8005434 <_Objects_Id_to_name+0x50> 80054b8: e3 ff ff f2 bi 8005480 <_Objects_Id_to_name+0x9c> 08003ec0 <_Objects_Set_name>: bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 8003ec0: 37 9c ff e4 addi sp,sp,-28 8003ec4: 5b 8b 00 1c sw (sp+28),r11 8003ec8: 5b 8c 00 18 sw (sp+24),r12 8003ecc: 5b 8d 00 14 sw (sp+20),r13 8003ed0: 5b 8e 00 10 sw (sp+16),r14 8003ed4: 5b 8f 00 0c sw (sp+12),r15 8003ed8: 5b 90 00 08 sw (sp+8),r16 8003edc: 5b 9d 00 04 sw (sp+4),ra 8003ee0: b8 40 70 00 mv r14,r2 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 8003ee4: 2c 22 00 3a lhu r2,(r1+58) bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 8003ee8: b8 20 68 00 mv r13,r1 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 8003eec: b8 60 08 00 mv r1,r3 bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 8003ef0: b8 60 58 00 mv r11,r3 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 8003ef4: f8 00 2a ce calli 800ea2c 8003ef8: b8 20 60 00 mv r12,r1 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 8003efc: 41 a1 00 38 lbu r1,(r13+56) 8003f00: 44 20 00 13 be r1,r0,8003f4c <_Objects_Set_name+0x8c> char *d; d = _Workspace_Allocate( length + 1 ); 8003f04: 35 81 00 01 addi r1,r12,1 8003f08: f8 00 04 22 calli 8004f90 <_Workspace_Allocate> 8003f0c: b8 20 68 00 mv r13,r1 if ( !d ) 8003f10: 45 a0 00 28 be r13,r0,8003fb0 <_Objects_Set_name+0xf0> <== NEVER TAKEN return false; if ( the_object->name.name_p ) { 8003f14: 29 c1 00 0c lw r1,(r14+12) 8003f18: 44 20 00 04 be r1,r0,8003f28 <_Objects_Set_name+0x68> _Workspace_Free( (void *)the_object->name.name_p ); 8003f1c: f8 00 04 28 calli 8004fbc <_Workspace_Free> the_object->name.name_p = NULL; 8003f20: 34 01 00 00 mvi r1,0 8003f24: 59 c1 00 0c sw (r14+12),r1 } strncpy( d, name, length ); 8003f28: b9 80 18 00 mv r3,r12 8003f2c: b9 60 10 00 mv r2,r11 8003f30: b9 a0 08 00 mv r1,r13 8003f34: f8 00 2a 8c calli 800e964 d[length] = '\0'; 8003f38: b5 ac 60 00 add r12,r13,r12 8003f3c: 34 01 00 00 mvi r1,0 8003f40: 31 81 00 00 sb (r12+0),r1 the_object->name.name_p = d; 8003f44: 59 cd 00 0c sw (r14+12),r13 8003f48: e0 00 00 19 bi 8003fac <_Objects_Set_name+0xec> } else #endif { the_object->name.name_u32 = _Objects_Build_name( 8003f4c: 34 01 00 01 mvi r1,1 8003f50: 41 70 00 00 lbu r16,(r11+0) 8003f54: 50 2c 00 20 bgeu r1,r12,8003fd4 <_Objects_Set_name+0x114> 8003f58: 41 61 00 01 lbu r1,(r11+1) 8003f5c: 34 02 00 10 mvi r2,16 8003f60: fb ff f1 2a calli 8000408 <__ashlsi3> 8003f64: b8 20 68 00 mv r13,r1 8003f68: 34 01 00 02 mvi r1,2 8003f6c: 50 2c 00 1c bgeu r1,r12,8003fdc <_Objects_Set_name+0x11c> 8003f70: 41 61 00 02 lbu r1,(r11+2) 8003f74: 34 02 00 08 mvi r2,8 8003f78: fb ff f1 24 calli 8000408 <__ashlsi3> 8003f7c: b8 20 78 00 mv r15,r1 8003f80: 34 01 00 03 mvi r1,3 8003f84: 55 81 00 02 bgu r12,r1,8003f8c <_Objects_Set_name+0xcc> 8003f88: e0 00 00 16 bi 8003fe0 <_Objects_Set_name+0x120> 8003f8c: 41 6b 00 03 lbu r11,(r11+3) 8003f90: ba 00 08 00 mv r1,r16 8003f94: 34 02 00 18 mvi r2,24 8003f98: fb ff f1 1c calli 8000408 <__ashlsi3> 8003f9c: b9 a1 68 00 or r13,r13,r1 8003fa0: b9 af 68 00 or r13,r13,r15 8003fa4: b9 ab 58 00 or r11,r13,r11 8003fa8: 59 cb 00 0c sw (r14+12),r11 8003fac: 34 01 00 01 mvi r1,1 ); } return true; } 8003fb0: 2b 9d 00 04 lw ra,(sp+4) 8003fb4: 2b 8b 00 1c lw r11,(sp+28) 8003fb8: 2b 8c 00 18 lw r12,(sp+24) 8003fbc: 2b 8d 00 14 lw r13,(sp+20) 8003fc0: 2b 8e 00 10 lw r14,(sp+16) 8003fc4: 2b 8f 00 0c lw r15,(sp+12) 8003fc8: 2b 90 00 08 lw r16,(sp+8) 8003fcc: 37 9c 00 1c addi sp,sp,28 8003fd0: c3 a0 00 00 ret d[length] = '\0'; the_object->name.name_p = d; } else #endif { the_object->name.name_u32 = _Objects_Build_name( 8003fd4: 78 0d 00 20 mvhi r13,0x20 8003fd8: 39 ad 00 00 ori r13,r13,0x0 8003fdc: 34 0f 20 00 mvi r15,8192 8003fe0: 34 0b 00 20 mvi r11,32 8003fe4: e3 ff ff eb bi 8003f90 <_Objects_Set_name+0xd0> 080039a0 <_POSIX_Condition_variables_Wait_support>: pthread_cond_t *cond, pthread_mutex_t *mutex, Watchdog_Interval timeout, bool already_timedout ) { 80039a0: 37 9c ff e0 addi sp,sp,-32 80039a4: 5b 8b 00 1c sw (sp+28),r11 80039a8: 5b 8c 00 18 sw (sp+24),r12 80039ac: 5b 8d 00 14 sw (sp+20),r13 80039b0: 5b 8e 00 10 sw (sp+16),r14 80039b4: 5b 8f 00 0c sw (sp+12),r15 80039b8: 5b 90 00 08 sw (sp+8),r16 80039bc: 5b 9d 00 04 sw (sp+4),ra 80039c0: b8 40 60 00 mv r12,r2 80039c4: b8 20 78 00 mv r15,r1 register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 80039c8: 37 82 00 20 addi r2,sp,32 80039cc: b9 80 08 00 mv r1,r12 pthread_cond_t *cond, pthread_mutex_t *mutex, Watchdog_Interval timeout, bool already_timedout ) { 80039d0: b8 60 80 00 mv r16,r3 80039d4: 20 8e 00 ff andi r14,r4,0xff register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 80039d8: f8 00 00 84 calli 8003be8 <_POSIX_Mutex_Get> 80039dc: 44 20 00 33 be r1,r0,8003aa8 <_POSIX_Condition_variables_Wait_support+0x108> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 80039e0: 78 05 08 02 mvhi r5,0x802 80039e4: 38 a5 08 74 ori r5,r5,0x874 80039e8: 28 a3 00 00 lw r3,(r5+0) return EINVAL; } _Thread_Unnest_dispatch(); the_cond = _POSIX_Condition_variables_Get( cond, &location ); 80039ec: b9 e0 08 00 mv r1,r15 80039f0: 37 82 00 20 addi r2,sp,32 80039f4: 34 63 ff ff addi r3,r3,-1 80039f8: 58 a3 00 00 sw (r5+0),r3 80039fc: fb ff ff 49 calli 8003720 <_POSIX_Condition_variables_Get> switch ( location ) { 8003a00: 2b 84 00 20 lw r4,(sp+32) return EINVAL; } _Thread_Unnest_dispatch(); the_cond = _POSIX_Condition_variables_Get( cond, &location ); 8003a04: b8 20 68 00 mv r13,r1 switch ( location ) { 8003a08: 5c 80 00 28 bne r4,r0,8003aa8 <_POSIX_Condition_variables_Wait_support+0x108> case OBJECTS_LOCAL: if ( the_cond->Mutex && ( the_cond->Mutex != *mutex ) ) { 8003a0c: 28 21 00 14 lw r1,(r1+20) 8003a10: 44 24 00 05 be r1,r4,8003a24 <_POSIX_Condition_variables_Wait_support+0x84> 8003a14: 29 82 00 00 lw r2,(r12+0) 8003a18: 44 22 00 03 be r1,r2,8003a24 <_POSIX_Condition_variables_Wait_support+0x84> _Thread_Enable_dispatch(); 8003a1c: f8 00 0b eb calli 80069c8 <_Thread_Enable_dispatch> 8003a20: e0 00 00 22 bi 8003aa8 <_POSIX_Condition_variables_Wait_support+0x108> return EINVAL; } (void) pthread_mutex_unlock( mutex ); 8003a24: b9 80 08 00 mv r1,r12 8003a28: f8 00 01 1e calli 8003ea0 _Thread_Enable_dispatch(); return EINVAL; } */ if ( !already_timedout ) { 8003a2c: 5d c0 00 1a bne r14,r0,8003a94 <_POSIX_Condition_variables_Wait_support+0xf4> the_cond->Mutex = *mutex; _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 8003a30: 78 0b 08 02 mvhi r11,0x802 return EINVAL; } */ if ( !already_timedout ) { the_cond->Mutex = *mutex; 8003a34: 29 81 00 00 lw r1,(r12+0) _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 8003a38: 39 6b 09 30 ori r11,r11,0x930 8003a3c: 29 64 00 00 lw r4,(r11+0) return EINVAL; } */ if ( !already_timedout ) { the_cond->Mutex = *mutex; 8003a40: 59 a1 00 14 sw (r13+20),r1 _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; _Thread_Executing->Wait.queue = &the_cond->Wait_queue; 8003a44: 35 a5 00 18 addi r5,r13,24 if ( !already_timedout ) { the_cond->Mutex = *mutex; _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 8003a48: 58 8e 00 34 sw (r4+52),r14 _Thread_Executing->Wait.queue = &the_cond->Wait_queue; _Thread_Executing->Wait.id = *cond; 8003a4c: 29 ef 00 00 lw r15,(r15+0) 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; 8003a50: 34 01 00 01 mvi r1,1 _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 8003a54: 78 03 08 00 mvhi r3,0x800 8003a58: ba 00 10 00 mv r2,r16 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; _Thread_Executing->Wait.id = *cond; 8003a5c: 58 8f 00 20 sw (r4+32),r15 8003a60: 59 a1 00 48 sw (r13+72),r1 _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 8003a64: 38 63 73 90 ori r3,r3,0x7390 8003a68: b8 a0 08 00 mv r1,r5 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; 8003a6c: 58 85 00 44 sw (r4+68),r5 _Thread_Executing->Wait.id = *cond; _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 8003a70: f8 00 0d 21 calli 8006ef4 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); 8003a74: f8 00 0b d5 calli 80069c8 <_Thread_Enable_dispatch> /* * Switch ourself out because we blocked as a result of the * _Thread_queue_Enqueue. */ status = _Thread_Executing->Wait.return_code; 8003a78: 29 61 00 00 lw r1,(r11+0) 8003a7c: 28 2b 00 34 lw r11,(r1+52) if ( status && status != ETIMEDOUT ) 8003a80: 7d 62 00 74 cmpnei r2,r11,116 8003a84: 7d 61 00 00 cmpnei r1,r11,0 8003a88: a0 41 08 00 and r1,r2,r1 8003a8c: 44 2e 00 04 be r1,r14,8003a9c <_POSIX_Condition_variables_Wait_support+0xfc><== ALWAYS TAKEN 8003a90: e0 00 00 07 bi 8003aac <_POSIX_Condition_variables_Wait_support+0x10c><== NOT EXECUTED return status; } else { _Thread_Enable_dispatch(); 8003a94: f8 00 0b cd calli 80069c8 <_Thread_Enable_dispatch> 8003a98: 34 0b 00 74 mvi r11,116 /* * When we get here the dispatch disable level is 0. */ mutex_status = pthread_mutex_lock( mutex ); 8003a9c: b9 80 08 00 mv r1,r12 8003aa0: f8 00 00 ce calli 8003dd8 if ( mutex_status ) 8003aa4: 44 20 00 02 be r1,r0,8003aac <_POSIX_Condition_variables_Wait_support+0x10c> 8003aa8: 34 0b 00 16 mvi r11,22 case OBJECTS_ERROR: break; } return EINVAL; } 8003aac: b9 60 08 00 mv r1,r11 8003ab0: 2b 9d 00 04 lw ra,(sp+4) 8003ab4: 2b 8b 00 1c lw r11,(sp+28) 8003ab8: 2b 8c 00 18 lw r12,(sp+24) 8003abc: 2b 8d 00 14 lw r13,(sp+20) 8003ac0: 2b 8e 00 10 lw r14,(sp+16) 8003ac4: 2b 8f 00 0c lw r15,(sp+12) 8003ac8: 2b 90 00 08 lw r16,(sp+8) 8003acc: 37 9c 00 20 addi sp,sp,32 8003ad0: c3 a0 00 00 ret 08008744 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 8008744: 37 9c ff d8 addi sp,sp,-40 8008748: 5b 8b 00 20 sw (sp+32),r11 800874c: 5b 8c 00 1c sw (sp+28),r12 8008750: 5b 8d 00 18 sw (sp+24),r13 8008754: 5b 8e 00 14 sw (sp+20),r14 8008758: 5b 8f 00 10 sw (sp+16),r15 800875c: 5b 90 00 0c sw (sp+12),r16 8008760: 5b 91 00 08 sw (sp+8),r17 8008764: 5b 9d 00 04 sw (sp+4),ra 8008768: b8 20 68 00 mv r13,r1 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( 800876c: 78 01 08 02 mvhi r1,0x802 8008770: b8 40 80 00 mv r16,r2 8008774: b8 60 88 00 mv r17,r3 8008778: b9 a0 10 00 mv r2,r13 800877c: 38 21 92 40 ori r1,r1,0x9240 8008780: 37 83 00 28 addi r3,sp,40 8008784: b8 80 70 00 mv r14,r4 8008788: b8 c0 78 00 mv r15,r6 800878c: 20 ab 00 ff andi r11,r5,0xff 8008790: f8 00 0b ab calli 800b63c <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 8008794: 2b 82 00 28 lw r2,(sp+40) 8008798: 5c 40 00 34 bne r2,r0,8008868 <_POSIX_Message_queue_Receive_support+0x124> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 800879c: 28 27 00 14 lw r7,(r1+20) 80087a0: 34 02 00 01 mvi r2,1 80087a4: 20 e3 00 03 andi r3,r7,0x3 80087a8: 5c 62 00 03 bne r3,r2,80087b4 <_POSIX_Message_queue_Receive_support+0x70> _Thread_Enable_dispatch(); 80087ac: f8 00 0e 2e calli 800c064 <_Thread_Enable_dispatch> 80087b0: e0 00 00 2e bi 8008868 <_POSIX_Message_queue_Receive_support+0x124> rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 80087b4: 28 2c 00 10 lw r12,(r1+16) if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 80087b8: 29 81 00 68 lw r1,(r12+104) 80087bc: 52 21 00 05 bgeu r17,r1,80087d0 <_POSIX_Message_queue_Receive_support+0x8c> _Thread_Enable_dispatch(); 80087c0: f8 00 0e 29 calli 800c064 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); 80087c4: f8 00 2e c7 calli 80142e0 <__errno> 80087c8: 34 02 00 7a mvi r2,122 80087cc: e0 00 00 29 bi 8008870 <_POSIX_Message_queue_Receive_support+0x12c> length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 80087d0: b9 60 28 00 mv r5,r11 80087d4: 45 60 00 06 be r11,r0,80087ec <_POSIX_Message_queue_Receive_support+0xa8><== NEVER TAKEN do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 80087d8: b8 e0 08 00 mv r1,r7 80087dc: 34 02 00 0e mvi r2,14 80087e0: fb ff f7 3f calli 80064dc <__lshrsi3> 80087e4: 18 21 00 01 xori r1,r1,0x1 80087e8: 20 25 00 01 andi r5,r1,0x1 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 80087ec: 78 0b 08 02 mvhi r11,0x802 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 80087f0: 35 81 00 1c addi r1,r12,28 80087f4: b9 a0 10 00 mv r2,r13 80087f8: ba 00 18 00 mv r3,r16 80087fc: b9 e0 30 00 mv r6,r15 8008800: 37 84 00 24 addi r4,sp,36 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 8008804: 39 6b 8e 70 ori r11,r11,0x8e70 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 8008808: 34 0d ff ff mvi r13,-1 800880c: 5b 8d 00 24 sw (sp+36),r13 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 8008810: f8 00 06 b6 calli 800a2e8 <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 8008814: f8 00 0e 14 calli 800c064 <_Thread_Enable_dispatch> *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 8008818: 29 6c 00 00 lw r12,(r11+0) do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = 800881c: 34 02 00 1f mvi r2,31 8008820: 29 81 00 24 lw r1,(r12+36) 8008824: fb ff f7 56 calli 800657c <__ashrsi3> 8008828: 29 83 00 24 lw r3,(r12+36) _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) 800882c: 29 82 00 34 lw r2,(r12+52) do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = 8008830: 98 23 18 00 xor r3,r1,r3 8008834: c8 61 08 00 sub r1,r3,r1 8008838: 59 c1 00 00 sw (r14+0),r1 _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) 800883c: 5c 40 00 03 bne r2,r0,8008848 <_POSIX_Message_queue_Receive_support+0x104> return length_out; 8008840: 2b 81 00 24 lw r1,(sp+36) 8008844: e0 00 00 0d bi 8008878 <_POSIX_Message_queue_Receive_support+0x134> rtems_set_errno_and_return_minus_one( 8008848: f8 00 2e a6 calli 80142e0 <__errno> 800884c: b8 20 60 00 mv r12,r1 8008850: 29 61 00 00 lw r1,(r11+0) 8008854: 28 21 00 34 lw r1,(r1+52) 8008858: f8 00 00 c0 calli 8008b58 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 800885c: 59 81 00 00 sw (r12+0),r1 8008860: b9 a0 08 00 mv r1,r13 8008864: e0 00 00 05 bi 8008878 <_POSIX_Message_queue_Receive_support+0x134> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 8008868: f8 00 2e 9e calli 80142e0 <__errno> 800886c: 34 02 00 09 mvi r2,9 8008870: 58 22 00 00 sw (r1+0),r2 8008874: 34 01 ff ff mvi r1,-1 } 8008878: 2b 9d 00 04 lw ra,(sp+4) 800887c: 2b 8b 00 20 lw r11,(sp+32) 8008880: 2b 8c 00 1c lw r12,(sp+28) 8008884: 2b 8d 00 18 lw r13,(sp+24) 8008888: 2b 8e 00 14 lw r14,(sp+20) 800888c: 2b 8f 00 10 lw r15,(sp+16) 8008890: 2b 90 00 0c lw r16,(sp+12) 8008894: 2b 91 00 08 lw r17,(sp+8) 8008898: 37 9c 00 28 addi sp,sp,40 800889c: c3 a0 00 00 ret 08006b20 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>: #include void _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( Thread_Control *the_thread ) { 8006b20: 37 9c ff fc addi sp,sp,-4 8006b24: 5b 9d 00 04 sw (sp+4),ra POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8006b28: 28 22 01 2c lw r2,(r1+300) if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 8006b2c: 28 43 00 d4 lw r3,(r2+212) 8006b30: 5c 60 00 0e bne r3,r0,8006b68 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x48><== NEVER TAKEN thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 8006b34: 28 44 00 d8 lw r4,(r2+216) 8006b38: 34 03 00 01 mvi r3,1 8006b3c: 5c 83 00 0b bne r4,r3,8006b68 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x48> thread_support->cancelation_requested ) { 8006b40: 28 42 00 dc lw r2,(r2+220) 8006b44: 44 40 00 09 be r2,r0,8006b68 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x48> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 8006b48: 78 03 08 01 mvhi r3,0x801 8006b4c: 38 63 e8 6c ori r3,r3,0xe86c 8006b50: 28 64 00 00 lw r4,(r3+0) _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 8006b54: 34 02 ff ff mvi r2,-1 8006b58: b4 82 20 00 add r4,r4,r2 8006b5c: 58 64 00 00 sw (r3+0),r4 8006b60: f8 00 01 e5 calli 80072f4 <_POSIX_Thread_Exit> { POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 8006b64: e0 00 00 02 bi 8006b6c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x4c> thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); } else _Thread_Enable_dispatch(); 8006b68: fb ff f4 d0 calli 8003ea8 <_Thread_Enable_dispatch> } 8006b6c: 2b 9d 00 04 lw ra,(sp+4) 8006b70: 37 9c 00 04 addi sp,sp,4 8006b74: c3 a0 00 00 ret 080090c8 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 80090c8: 37 9c ff ec addi sp,sp,-20 80090cc: 5b 8b 00 14 sw (sp+20),r11 80090d0: 5b 8c 00 10 sw (sp+16),r12 80090d4: 5b 8d 00 0c sw (sp+12),r13 80090d8: 5b 8e 00 08 sw (sp+8),r14 80090dc: 5b 9d 00 04 sw (sp+4),ra 80090e0: b8 20 60 00 mv r12,r1 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 80090e4: 28 41 00 00 lw r1,(r2+0) int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 80090e8: b8 40 58 00 mv r11,r2 80090ec: b8 60 68 00 mv r13,r3 80090f0: b8 80 70 00 mv r14,r4 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 80090f4: fb ff ff ed calli 80090a8 <_POSIX_Priority_Is_valid> 80090f8: 34 02 00 00 mvi r2,0 80090fc: 44 22 00 2b be r1,r2,80091a8 <_POSIX_Thread_Translate_sched_param+0xe0><== NEVER TAKEN return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 8009100: 59 a2 00 00 sw (r13+0),r2 *budget_callout = NULL; 8009104: 59 c2 00 00 sw (r14+0),r2 if ( policy == SCHED_OTHER ) { 8009108: 5d 82 00 05 bne r12,r2,800911c <_POSIX_Thread_Translate_sched_param+0x54> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 800910c: 34 01 00 01 mvi r1,1 8009110: 59 a1 00 00 sw (r13+0),r1 8009114: b9 80 08 00 mv r1,r12 return 0; 8009118: e0 00 00 25 bi 80091ac <_POSIX_Thread_Translate_sched_param+0xe4> } if ( policy == SCHED_FIFO ) { 800911c: 34 01 00 01 mvi r1,1 8009120: 5d 81 00 03 bne r12,r1,800912c <_POSIX_Thread_Translate_sched_param+0x64> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 8009124: 59 a2 00 00 sw (r13+0),r2 8009128: e0 00 00 04 bi 8009138 <_POSIX_Thread_Translate_sched_param+0x70> return 0; } if ( policy == SCHED_RR ) { 800912c: 34 01 00 02 mvi r1,2 8009130: 5d 81 00 04 bne r12,r1,8009140 <_POSIX_Thread_Translate_sched_param+0x78> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 8009134: 59 ac 00 00 sw (r13+0),r12 8009138: b8 40 08 00 mv r1,r2 return 0; 800913c: e0 00 00 1c bi 80091ac <_POSIX_Thread_Translate_sched_param+0xe4> } if ( policy == SCHED_SPORADIC ) { 8009140: 34 01 00 04 mvi r1,4 8009144: 5d 81 00 19 bne r12,r1,80091a8 <_POSIX_Thread_Translate_sched_param+0xe0> if ( (param->sched_ss_repl_period.tv_sec == 0) && 8009148: 29 61 00 08 lw r1,(r11+8) 800914c: 5c 20 00 03 bne r1,r0,8009158 <_POSIX_Thread_Translate_sched_param+0x90> (param->sched_ss_repl_period.tv_nsec == 0) ) 8009150: 29 62 00 0c lw r2,(r11+12) 8009154: 44 41 00 15 be r2,r1,80091a8 <_POSIX_Thread_Translate_sched_param+0xe0> return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 8009158: 29 61 00 10 lw r1,(r11+16) 800915c: 5c 20 00 03 bne r1,r0,8009168 <_POSIX_Thread_Translate_sched_param+0xa0> (param->sched_ss_init_budget.tv_nsec == 0) ) 8009160: 29 62 00 14 lw r2,(r11+20) 8009164: 44 41 00 11 be r2,r1,80091a8 <_POSIX_Thread_Translate_sched_param+0xe0> return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 8009168: 35 61 00 08 addi r1,r11,8 800916c: fb ff f4 a8 calli 800640c <_Timespec_To_ticks> 8009170: b8 20 60 00 mv r12,r1 8009174: 35 61 00 10 addi r1,r11,16 8009178: fb ff f4 a5 calli 800640c <_Timespec_To_ticks> 800917c: 54 2c 00 0b bgu r1,r12,80091a8 <_POSIX_Thread_Translate_sched_param+0xe0> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) 8009180: 29 61 00 04 lw r1,(r11+4) 8009184: fb ff ff c9 calli 80090a8 <_POSIX_Priority_Is_valid> 8009188: 44 20 00 08 be r1,r0,80091a8 <_POSIX_Thread_Translate_sched_param+0xe0> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 800918c: 78 01 08 00 mvhi r1,0x800 8009190: 38 21 2f c8 ori r1,r1,0x2fc8 return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 8009194: 34 02 00 03 mvi r2,3 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 8009198: 59 c1 00 00 sw (r14+0),r1 return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 800919c: 59 a2 00 00 sw (r13+0),r2 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 80091a0: 34 01 00 00 mvi r1,0 return 0; 80091a4: e0 00 00 02 bi 80091ac <_POSIX_Thread_Translate_sched_param+0xe4> 80091a8: 34 01 00 16 mvi r1,22 } return EINVAL; } 80091ac: 2b 9d 00 04 lw ra,(sp+4) 80091b0: 2b 8b 00 14 lw r11,(sp+20) 80091b4: 2b 8c 00 10 lw r12,(sp+16) 80091b8: 2b 8d 00 0c lw r13,(sp+12) 80091bc: 2b 8e 00 08 lw r14,(sp+8) 80091c0: 37 9c 00 14 addi sp,sp,20 80091c4: c3 a0 00 00 ret 08002c84 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 8002c84: 37 9c ff ac addi sp,sp,-84 8002c88: 5b 8b 00 14 sw (sp+20),r11 8002c8c: 5b 8c 00 10 sw (sp+16),r12 8002c90: 5b 8d 00 0c sw (sp+12),r13 8002c94: 5b 8e 00 08 sw (sp+8),r14 8002c98: 5b 9d 00 04 sw (sp+4),ra 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; 8002c9c: 78 01 08 01 mvhi r1,0x801 8002ca0: 38 21 e0 a8 ori r1,r1,0xe0a8 maximum = Configuration_POSIX_API.number_of_initialization_threads; 8002ca4: 28 2e 00 30 lw r14,(r1+48) 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; 8002ca8: 28 2c 00 34 lw r12,(r1+52) maximum = Configuration_POSIX_API.number_of_initialization_threads; if ( !user_threads || maximum == 0 ) 8002cac: 65 cd 00 00 cmpei r13,r14,0 8002cb0: 65 81 00 00 cmpei r1,r12,0 8002cb4: b9 a1 68 00 or r13,r13,r1 8002cb8: 5d a0 00 17 bne r13,r0,8002d14 <_POSIX_Threads_Initialize_user_threads_body+0x90><== NEVER TAKEN for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); 8002cbc: 37 8b 00 18 addi r11,sp,24 8002cc0: b9 60 08 00 mv r1,r11 8002cc4: f8 00 19 41 calli 80091c8 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 8002cc8: 34 02 00 02 mvi r2,2 8002ccc: b9 60 08 00 mv r1,r11 8002cd0: f8 00 19 4b calli 80091fc (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 8002cd4: 29 82 00 04 lw r2,(r12+4) 8002cd8: b9 60 08 00 mv r1,r11 8002cdc: f8 00 19 55 calli 8009230 status = pthread_create( 8002ce0: 29 83 00 00 lw r3,(r12+0) 8002ce4: 37 81 00 54 addi r1,sp,84 8002ce8: b9 60 10 00 mv r2,r11 8002cec: 34 04 00 00 mvi r4,0 8002cf0: fb ff ff 12 calli 8002938 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 8002cf4: 44 20 00 05 be r1,r0,8002d08 <_POSIX_Threads_Initialize_user_threads_body+0x84> _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 8002cf8: b8 20 18 00 mv r3,r1 8002cfc: 34 02 00 01 mvi r2,1 8002d00: 34 01 00 02 mvi r1,2 8002d04: f8 00 06 19 calli 8004568 <_Internal_error_Occurred> * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { 8002d08: 35 ad 00 01 addi r13,r13,1 8002d0c: 35 8c 00 08 addi r12,r12,8 8002d10: 55 cd ff ec bgu r14,r13,8002cc0 <_POSIX_Threads_Initialize_user_threads_body+0x3c><== NEVER TAKEN NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); } } 8002d14: 2b 9d 00 04 lw ra,(sp+4) 8002d18: 2b 8b 00 14 lw r11,(sp+20) 8002d1c: 2b 8c 00 10 lw r12,(sp+16) 8002d20: 2b 8d 00 0c lw r13,(sp+12) 8002d24: 2b 8e 00 08 lw r14,(sp+8) 8002d28: 37 9c 00 54 addi sp,sp,84 8002d2c: c3 a0 00 00 ret 0800dd18 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 800dd18: 37 9c ff f4 addi sp,sp,-12 800dd1c: 5b 8b 00 0c sw (sp+12),r11 800dd20: 5b 8c 00 08 sw (sp+8),r12 800dd24: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; POSIX_API_Control *api; the_thread = argument; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 800dd28: 28 4c 01 2c lw r12,(r2+300) */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 800dd2c: b8 40 58 00 mv r11,r2 the_thread = argument; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); 800dd30: 35 81 00 94 addi r1,r12,148 800dd34: f8 00 08 d4 calli 8010084 <_Timespec_To_ticks> 800dd38: 78 02 08 02 mvhi r2,0x802 800dd3c: 38 42 50 a8 ori r2,r2,0x50a8 the_thread->cpu_time_budget = ticks; 800dd40: 59 61 00 78 sw (r11+120),r1 800dd44: 40 41 00 00 lbu r1,(r2+0) 800dd48: 29 82 00 84 lw r2,(r12+132) */ #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 ) { 800dd4c: 29 63 00 1c lw r3,(r11+28) 800dd50: c8 22 10 00 sub r2,r1,r2 ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); the_thread->cpu_time_budget = ticks; new_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); the_thread->real_priority = new_priority; 800dd54: 59 62 00 18 sw (r11+24),r2 */ #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 ) { 800dd58: 5c 60 00 06 bne r3,r0,800dd70 <_POSIX_Threads_Sporadic_budget_TSR+0x58><== NEVER TAKEN /* * If this would make them less important, then do not change it. */ if ( the_thread->current_priority > new_priority ) { 800dd5c: 29 61 00 14 lw r1,(r11+20) 800dd60: 50 41 00 04 bgeu r2,r1,800dd70 <_POSIX_Threads_Sporadic_budget_TSR+0x58> _Thread_Change_priority( the_thread, new_priority, true ); 800dd64: b9 60 08 00 mv r1,r11 800dd68: 34 03 00 01 mvi r3,1 800dd6c: fb ff e1 76 calli 8006344 <_Thread_Change_priority> #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); 800dd70: 35 81 00 8c addi r1,r12,140 800dd74: f8 00 08 c4 calli 8010084 <_Timespec_To_ticks> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 800dd78: 59 81 00 b0 sw (r12+176),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 800dd7c: 78 01 08 02 mvhi r1,0x802 800dd80: 38 21 5a 20 ori r1,r1,0x5a20 800dd84: 35 82 00 a4 addi r2,r12,164 800dd88: fb ff e7 52 calli 8007ad0 <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } 800dd8c: 2b 9d 00 04 lw ra,(sp+4) 800dd90: 2b 8b 00 0c lw r11,(sp+12) 800dd94: 2b 8c 00 08 lw r12,(sp+8) 800dd98: 37 9c 00 0c addi sp,sp,12 800dd9c: c3 a0 00 00 ret 0800dcc8 <_POSIX_Threads_Sporadic_budget_callout>: * _POSIX_Threads_Sporadic_budget_callout */ void _POSIX_Threads_Sporadic_budget_callout( Thread_Control *the_thread ) { 800dcc8: 37 9c ff fc addi sp,sp,-4 800dccc: 5b 9d 00 04 sw (sp+4),ra POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 800dcd0: 28 25 01 2c lw r5,(r1+300) /* * 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 */ 800dcd4: 34 04 ff ff mvi r4,-1 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 800dcd8: 78 02 08 02 mvhi r2,0x802 800dcdc: 38 42 50 a8 ori r2,r2,0x50a8 800dce0: 58 24 00 78 sw (r1+120),r4 800dce4: 40 44 00 00 lbu r4,(r2+0) 800dce8: 28 a2 00 88 lw r2,(r5+136) */ #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 ) { 800dcec: 28 25 00 1c lw r5,(r1+28) 800dcf0: c8 82 10 00 sub r2,r4,r2 * while at low priority. */ the_thread->cpu_time_budget = 0xFFFFFFFF; /* XXX should be based on MAX_U32 */ new_priority = _POSIX_Priority_To_core(api->schedparam.sched_ss_low_priority); the_thread->real_priority = new_priority; 800dcf4: 58 22 00 18 sw (r1+24),r2 */ #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 ) { 800dcf8: 5c a0 00 05 bne r5,r0,800dd0c <_POSIX_Threads_Sporadic_budget_callout+0x44><== NEVER TAKEN /* * 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 ) { 800dcfc: 28 23 00 14 lw r3,(r1+20) 800dd00: 50 62 00 03 bgeu r3,r2,800dd0c <_POSIX_Threads_Sporadic_budget_callout+0x44><== NEVER TAKEN _Thread_Change_priority( the_thread, new_priority, true ); 800dd04: 34 03 00 01 mvi r3,1 800dd08: fb ff e1 8f calli 8006344 <_Thread_Change_priority> #if 0 printk( "lower priority\n" ); #endif } } } 800dd0c: 2b 9d 00 04 lw ra,(sp+4) 800dd10: 37 9c 00 04 addi sp,sp,4 800dd14: c3 a0 00 00 ret 080028fc <_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) { 80028fc: 37 9c ff f8 addi sp,sp,-8 8002900: 5b 8b 00 08 sw (sp+8),r11 8002904: 5b 9d 00 04 sw (sp+4),ra 8002908: b8 40 58 00 mv r11,r2 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 800290c: 28 42 00 68 lw r2,(r2+104) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 8002910: 29 61 00 54 lw r1,(r11+84) bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 8002914: 34 42 00 01 addi r2,r2,1 8002918: 59 62 00 68 sw (r11+104),r2 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 800291c: 5c 20 00 03 bne r1,r0,8002928 <_POSIX_Timer_TSR+0x2c> ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { 8002920: 29 62 00 58 lw r2,(r11+88) 8002924: 44 41 00 0d be r2,r1,8002958 <_POSIX_Timer_TSR+0x5c> <== NEVER TAKEN activated = _POSIX_Timer_Insert_helper( 8002928: 29 62 00 64 lw r2,(r11+100) 800292c: 29 63 00 08 lw r3,(r11+8) 8002930: 78 04 08 00 mvhi r4,0x800 8002934: 38 84 28 fc ori r4,r4,0x28fc 8002938: 35 61 00 10 addi r1,r11,16 800293c: b9 60 28 00 mv r5,r11 8002940: f8 00 15 8a calli 8007f68 <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 8002944: 44 20 00 0c be r1,r0,8002974 <_POSIX_Timer_TSR+0x78> <== NEVER TAKEN return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 8002948: 35 61 00 6c addi r1,r11,108 800294c: f8 00 03 1e calli 80035c4 <_TOD_Get> /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 8002950: 34 01 00 03 mvi r1,3 8002954: e0 00 00 02 bi 800295c <_POSIX_Timer_TSR+0x60> } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 8002958: 34 01 00 04 mvi r1,4 <== NOT EXECUTED 800295c: 31 61 00 3c sb (r11+60),r1 /* * 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 ) ) { 8002960: 29 62 00 44 lw r2,(r11+68) 8002964: 29 61 00 38 lw r1,(r11+56) 8002968: f8 00 14 2a calli 8007a10 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 800296c: 34 01 00 00 mvi r1,0 8002970: 59 61 00 68 sw (r11+104),r1 } 8002974: 2b 9d 00 04 lw ra,(sp+4) 8002978: 2b 8b 00 08 lw r11,(sp+8) 800297c: 37 9c 00 08 addi sp,sp,8 8002980: c3 a0 00 00 ret 08012008 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 8012008: 37 9c ff e0 addi sp,sp,-32 801200c: 5b 8b 00 14 sw (sp+20),r11 8012010: 5b 8c 00 10 sw (sp+16),r12 8012014: 5b 8d 00 0c sw (sp+12),r13 8012018: 5b 8e 00 08 sw (sp+8),r14 801201c: 5b 9d 00 04 sw (sp+4),ra siginfo_t siginfo_struct; sigset_t saved_signals_blocked; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 8012020: 37 8e 00 18 addi r14,sp,24 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 8012024: 20 64 00 ff andi r4,r3,0xff siginfo_t siginfo_struct; sigset_t saved_signals_blocked; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 8012028: 34 05 00 01 mvi r5,1 801202c: b9 c0 18 00 mv r3,r14 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 8012030: b8 20 60 00 mv r12,r1 8012034: b8 40 58 00 mv r11,r2 siginfo_t siginfo_struct; sigset_t saved_signals_blocked; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 8012038: f8 00 00 25 calli 80120cc <_POSIX_signals_Clear_signals> 801203c: 44 20 00 1c be r1,r0,80120ac <_POSIX_signals_Check_signal+0xa4> #endif /* * Just to prevent sending a signal which is currently being ignored. */ if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN ) 8012040: b5 6b 08 00 add r1,r11,r11 8012044: b4 2b 08 00 add r1,r1,r11 8012048: 78 0d 08 02 mvhi r13,0x802 801204c: 34 02 00 02 mvi r2,2 8012050: fb ff ba df calli 8000bcc <__ashlsi3> 8012054: 39 ad 5e 44 ori r13,r13,0x5e44 8012058: b5 a1 20 00 add r4,r13,r1 801205c: 28 85 00 08 lw r5,(r4+8) 8012060: 34 01 00 01 mvi r1,1 8012064: 44 a1 00 12 be r5,r1,80120ac <_POSIX_signals_Check_signal+0xa4><== NEVER TAKEN return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 8012068: 29 8d 00 cc lw r13,(r12+204) api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 801206c: 28 81 00 04 lw r1,(r4+4) /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 8012070: 28 82 00 00 lw r2,(r4+0) /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 8012074: b8 2d 08 00 or r1,r1,r13 8012078: 59 81 00 cc sw (r12+204),r1 /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 801207c: 34 01 00 02 mvi r1,2 8012080: 5c 41 00 06 bne r2,r1,8012098 <_POSIX_signals_Check_signal+0x90> case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 8012084: b9 60 08 00 mv r1,r11 8012088: b9 c0 10 00 mv r2,r14 801208c: 34 03 00 00 mvi r3,0 8012090: d8 a0 00 00 call r5 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 8012094: e0 00 00 03 bi 80120a0 <_POSIX_signals_Check_signal+0x98> default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 8012098: b9 60 08 00 mv r1,r11 801209c: d8 a0 00 00 call r5 } /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 80120a0: 59 8d 00 cc sw (r12+204),r13 80120a4: 34 01 00 01 mvi r1,1 return true; 80120a8: e0 00 00 02 bi 80120b0 <_POSIX_signals_Check_signal+0xa8> 80120ac: 34 01 00 00 mvi r1,0 } 80120b0: 2b 9d 00 04 lw ra,(sp+4) 80120b4: 2b 8b 00 14 lw r11,(sp+20) 80120b8: 2b 8c 00 10 lw r12,(sp+16) 80120bc: 2b 8d 00 0c lw r13,(sp+12) 80120c0: 2b 8e 00 08 lw r14,(sp+8) 80120c4: 37 9c 00 20 addi sp,sp,32 80120c8: c3 a0 00 00 ret 08012a8c <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 8012a8c: 37 9c ff f0 addi sp,sp,-16 8012a90: 5b 8b 00 10 sw (sp+16),r11 8012a94: 5b 8c 00 0c sw (sp+12),r12 8012a98: 5b 8d 00 08 sw (sp+8),r13 8012a9c: 5b 9d 00 04 sw (sp+4),ra 8012aa0: b8 20 58 00 mv r11,r1 clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 8012aa4: 90 00 68 00 rcsr r13,IE 8012aa8: 34 01 ff fe mvi r1,-2 8012aac: a1 a1 08 00 and r1,r13,r1 8012ab0: d0 01 00 00 wcsr IE,r1 if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 8012ab4: b5 6b 08 00 add r1,r11,r11 8012ab8: 34 02 00 02 mvi r2,2 8012abc: b4 2b 08 00 add r1,r1,r11 8012ac0: 78 0c 08 02 mvhi r12,0x802 8012ac4: fb ff b8 42 calli 8000bcc <__ashlsi3> 8012ac8: 39 8c 5e 44 ori r12,r12,0x5e44 8012acc: b5 81 60 00 add r12,r12,r1 8012ad0: 29 83 00 00 lw r3,(r12+0) 8012ad4: 34 02 00 02 mvi r2,2 8012ad8: 5c 62 00 07 bne r3,r2,8012af4 <_POSIX_signals_Clear_process_signals+0x68> if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 8012adc: 78 02 08 02 mvhi r2,0x802 8012ae0: 38 42 60 3c ori r2,r2,0x603c 8012ae4: b4 22 10 00 add r2,r1,r2 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 8012ae8: 28 41 00 00 lw r1,(r2+0) 8012aec: 34 42 00 04 addi r2,r2,4 8012af0: 5c 22 00 10 bne r1,r2,8012b30 <_POSIX_signals_Clear_process_signals+0xa4><== NEVER TAKEN clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 8012af4: 35 62 ff ff addi r2,r11,-1 8012af8: 34 01 00 01 mvi r1,1 8012afc: fb ff b8 34 calli 8000bcc <__ashlsi3> 8012b00: 78 02 08 02 mvhi r2,0x802 8012b04: 38 42 60 38 ori r2,r2,0x6038 8012b08: 28 43 00 00 lw r3,(r2+0) 8012b0c: a4 20 08 00 not r1,r1 8012b10: a0 23 08 00 and r1,r1,r3 8012b14: 58 41 00 00 sw (r2+0),r1 if ( !_POSIX_signals_Pending ) 8012b18: 5c 20 00 06 bne r1,r0,8012b30 <_POSIX_signals_Clear_process_signals+0xa4><== NEVER TAKEN _Thread_Do_post_task_switch_extension--; 8012b1c: 78 01 08 02 mvhi r1,0x802 8012b20: 38 21 59 e4 ori r1,r1,0x59e4 8012b24: 28 22 00 00 lw r2,(r1+0) 8012b28: 34 42 ff ff addi r2,r2,-1 8012b2c: 58 22 00 00 sw (r1+0),r2 } _ISR_Enable( level ); 8012b30: d0 0d 00 00 wcsr IE,r13 } 8012b34: 2b 9d 00 04 lw ra,(sp+4) 8012b38: 2b 8b 00 10 lw r11,(sp+16) 8012b3c: 2b 8c 00 0c lw r12,(sp+12) 8012b40: 2b 8d 00 08 lw r13,(sp+8) 8012b44: 37 9c 00 10 addi sp,sp,16 8012b48: c3 a0 00 00 ret 0800357c <_POSIX_signals_Get_highest>: #include int _POSIX_signals_Get_highest( sigset_t set ) { 800357c: 37 9c ff f0 addi sp,sp,-16 8003580: 5b 8b 00 10 sw (sp+16),r11 8003584: 5b 8c 00 0c sw (sp+12),r12 8003588: 5b 8d 00 08 sw (sp+8),r13 800358c: 5b 9d 00 04 sw (sp+4),ra 8003590: 34 0b 00 1b mvi r11,27 8003594: b8 20 60 00 mv r12,r1 int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 8003598: 34 0d 00 20 mvi r13,32 if ( set & signo_to_mask( signo ) ) { 800359c: 35 62 ff ff addi r2,r11,-1 80035a0: 34 01 00 01 mvi r1,1 80035a4: fb ff f5 de calli 8000d1c <__ashlsi3> 80035a8: a0 2c 08 00 and r1,r1,r12 80035ac: 5c 20 00 0c bne r1,r0,80035dc <_POSIX_signals_Get_highest+0x60><== NEVER TAKEN sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 80035b0: 35 6b 00 01 addi r11,r11,1 80035b4: 5d 6d ff fa bne r11,r13,800359c <_POSIX_signals_Get_highest+0x20> 80035b8: 34 0b 00 01 mvi r11,1 */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 80035bc: 34 0d 00 1b mvi r13,27 if ( set & signo_to_mask( signo ) ) { 80035c0: 35 62 ff ff addi r2,r11,-1 80035c4: 34 01 00 01 mvi r1,1 80035c8: fb ff f5 d5 calli 8000d1c <__ashlsi3> 80035cc: a0 2c 08 00 and r1,r1,r12 80035d0: 5c 20 00 03 bne r1,r0,80035dc <_POSIX_signals_Get_highest+0x60> */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 80035d4: 35 6b 00 01 addi r11,r11,1 80035d8: 5d 6d ff fa bne r11,r13,80035c0 <_POSIX_signals_Get_highest+0x44><== ALWAYS TAKEN * a return 0. This routine will NOT be called unless a signal * is pending in the set passed in. */ found_it: return signo; } 80035dc: b9 60 08 00 mv r1,r11 80035e0: 2b 9d 00 04 lw ra,(sp+4) 80035e4: 2b 8b 00 10 lw r11,(sp+16) 80035e8: 2b 8c 00 0c lw r12,(sp+12) 80035ec: 2b 8d 00 08 lw r13,(sp+8) 80035f0: 37 9c 00 10 addi sp,sp,16 80035f4: c3 a0 00 00 ret 0801227c <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 801227c: 37 9c ff f0 addi sp,sp,-16 8012280: 5b 8b 00 10 sw (sp+16),r11 8012284: 5b 8c 00 0c sw (sp+12),r12 8012288: 5b 8d 00 08 sw (sp+8),r13 801228c: 5b 9d 00 04 sw (sp+4),ra 8012290: b8 20 58 00 mv r11,r1 8012294: b8 40 68 00 mv r13,r2 8012298: 34 01 00 01 mvi r1,1 801229c: 34 42 ff ff addi r2,r2,-1 80122a0: b8 60 60 00 mv r12,r3 80122a4: fb ff ba 4a calli 8000bcc <__ashlsi3> /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 80122a8: 29 64 00 10 lw r4,(r11+16) 80122ac: 78 05 10 00 mvhi r5,0x1000 80122b0: 38 a5 80 00 ori r5,r5,0x8000 80122b4: a0 85 10 00 and r2,r4,r5 { POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 80122b8: 29 63 01 2c lw r3,(r11+300) /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 80122bc: 5c 45 00 18 bne r2,r5,801231c <_POSIX_signals_Unblock_thread+0xa0> if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 80122c0: 29 62 00 30 lw r2,(r11+48) 80122c4: a0 22 10 00 and r2,r1,r2 80122c8: 5c 40 00 05 bne r2,r0,80122dc <_POSIX_signals_Unblock_thread+0x60> 80122cc: 28 63 00 cc lw r3,(r3+204) 80122d0: a4 60 18 00 not r3,r3 80122d4: a0 23 08 00 and r1,r1,r3 80122d8: 44 22 00 37 be r1,r2,80123b4 <_POSIX_signals_Unblock_thread+0x138> the_thread->Wait.return_code = EINTR; 80122dc: 34 01 00 04 mvi r1,4 80122e0: 59 61 00 34 sw (r11+52),r1 the_info = (siginfo_t *) the_thread->Wait.return_argument; 80122e4: 29 61 00 28 lw r1,(r11+40) if ( !info ) { 80122e8: 5d 80 00 06 bne r12,r0,8012300 <_POSIX_signals_Unblock_thread+0x84> the_info->si_signo = signo; the_info->si_code = SI_USER; 80122ec: 34 02 00 01 mvi r2,1 the_info->si_value.sival_int = 0; 80122f0: 58 2c 00 08 sw (r1+8),r12 the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; 80122f4: 58 2d 00 00 sw (r1+0),r13 the_info->si_code = SI_USER; 80122f8: 58 22 00 04 sw (r1+4),r2 80122fc: e0 00 00 04 bi 801230c <_POSIX_signals_Unblock_thread+0x90> the_info->si_value.sival_int = 0; } else { *the_info = *info; 8012300: b9 80 10 00 mv r2,r12 8012304: 34 03 00 0c mvi r3,12 8012308: f8 00 04 fa calli 80136f0 } _Thread_queue_Extract_with_proxy( the_thread ); 801230c: b9 60 08 00 mv r1,r11 8012310: fb ff f6 d2 calli 800fe58 <_Thread_queue_Extract_with_proxy> 8012314: 34 01 00 01 mvi r1,1 return true; 8012318: e0 00 00 28 bi 80123b8 <_POSIX_signals_Unblock_thread+0x13c> } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 801231c: 28 62 00 cc lw r2,(r3+204) 8012320: a4 40 10 00 not r2,r2 8012324: a0 22 08 00 and r1,r1,r2 8012328: 44 20 00 23 be r1,r0,80123b4 <_POSIX_signals_Unblock_thread+0x138> * + Any other combination, do nothing. */ the_thread->do_post_task_switch_extension = true; if ( the_thread->current_state & STATES_INTERRUPTIBLE_BY_SIGNAL ) { 801232c: 78 01 10 00 mvhi r1,0x1000 8012330: 38 21 00 00 ori r1,r1,0x0 * it is not blocked, THEN * we need to dispatch at the end of this ISR. * + Any other combination, do nothing. */ the_thread->do_post_task_switch_extension = true; 8012334: 34 02 00 01 mvi r2,1 8012338: 31 62 00 74 sb (r11+116),r2 if ( the_thread->current_state & STATES_INTERRUPTIBLE_BY_SIGNAL ) { 801233c: a0 81 08 00 and r1,r4,r1 8012340: 44 20 00 0f be r1,r0,801237c <_POSIX_signals_Unblock_thread+0x100> the_thread->Wait.return_code = EINTR; 8012344: 34 01 00 04 mvi r1,4 8012348: 59 61 00 34 sw (r11+52),r1 #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) ){ 801234c: 20 84 00 08 andi r4,r4,0x8 8012350: 44 80 00 19 be r4,r0,80123b4 <_POSIX_signals_Unblock_thread+0x138><== NEVER TAKEN if ( _Watchdog_Is_active( &the_thread->Timer ) ) 8012354: 29 62 00 50 lw r2,(r11+80) 8012358: 34 01 00 02 mvi r1,2 801235c: 5c 41 00 03 bne r2,r1,8012368 <_POSIX_signals_Unblock_thread+0xec><== NEVER TAKEN (void) _Watchdog_Remove( &the_thread->Timer ); 8012360: 35 61 00 48 addi r1,r11,72 8012364: fb ff d6 3a calli 8007c4c <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 8012368: 78 02 10 03 mvhi r2,0x1003 801236c: b9 60 08 00 mv r1,r11 8012370: 38 42 ff f8 ori r2,r2,0xfff8 8012374: fb ff f5 ad calli 800fa28 <_Thread_Clear_state> 8012378: e0 00 00 0f bi 80123b4 <_POSIX_signals_Unblock_thread+0x138> _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 801237c: 5c 81 00 0e bne r4,r1,80123b4 <_POSIX_signals_Unblock_thread+0x138><== NEVER TAKEN if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 8012380: 78 01 08 02 mvhi r1,0x802 8012384: 38 21 59 dc ori r1,r1,0x59dc 8012388: 28 21 00 00 lw r1,(r1+0) 801238c: 44 24 00 0a be r1,r4,80123b4 <_POSIX_signals_Unblock_thread+0x138> 8012390: 78 01 08 02 mvhi r1,0x802 8012394: 38 21 5a 00 ori r1,r1,0x5a00 8012398: 28 21 00 00 lw r1,(r1+0) 801239c: 5d 61 00 06 bne r11,r1,80123b4 <_POSIX_signals_Unblock_thread+0x138><== NEVER TAKEN _ISR_Signals_to_thread_executing = true; 80123a0: 78 01 08 02 mvhi r1,0x802 80123a4: 38 21 5a 98 ori r1,r1,0x5a98 80123a8: 30 22 00 00 sb (r1+0),r2 80123ac: b8 80 08 00 mv r1,r4 80123b0: e0 00 00 02 bi 80123b8 <_POSIX_signals_Unblock_thread+0x13c> 80123b4: 34 01 00 00 mvi r1,0 } } return false; } 80123b8: 2b 9d 00 04 lw ra,(sp+4) 80123bc: 2b 8b 00 10 lw r11,(sp+16) 80123c0: 2b 8c 00 0c lw r12,(sp+12) 80123c4: 2b 8d 00 08 lw r13,(sp+8) 80123c8: 37 9c 00 10 addi sp,sp,16 80123cc: c3 a0 00 00 ret 0800ec24 <_RTEMS_tasks_Post_switch_extension>: */ void _RTEMS_tasks_Post_switch_extension( Thread_Control *executing ) { 800ec24: 37 9c ff f0 addi sp,sp,-16 800ec28: 5b 8b 00 0c sw (sp+12),r11 800ec2c: 5b 8c 00 08 sw (sp+8),r12 800ec30: 5b 9d 00 04 sw (sp+4),ra RTEMS_API_Control *api; ASR_Information *asr; rtems_signal_set signal_set; Modes_Control prev_mode; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 800ec34: 28 2b 01 28 lw r11,(r1+296) if ( !api ) 800ec38: 45 60 00 1b be r11,r0,800eca4 <_RTEMS_tasks_Post_switch_extension+0x80><== NEVER TAKEN * Signal Processing */ asr = &api->Signal; _ISR_Disable( level ); 800ec3c: 90 00 08 00 rcsr r1,IE 800ec40: 34 02 ff fe mvi r2,-2 800ec44: a0 22 10 00 and r2,r1,r2 800ec48: d0 02 00 00 wcsr IE,r2 signal_set = asr->signals_posted; asr->signals_posted = 0; 800ec4c: 34 02 00 00 mvi r2,0 */ asr = &api->Signal; _ISR_Disable( level ); signal_set = asr->signals_posted; 800ec50: 29 6c 00 14 lw r12,(r11+20) asr->signals_posted = 0; 800ec54: 59 62 00 14 sw (r11+20),r2 _ISR_Enable( level ); 800ec58: d0 01 00 00 wcsr IE,r1 if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ 800ec5c: 45 80 00 12 be r12,r0,800eca4 <_RTEMS_tasks_Post_switch_extension+0x80> return; asr->nest_level += 1; 800ec60: 29 63 00 1c lw r3,(r11+28) rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 800ec64: 29 61 00 10 lw r1,(r11+16) 800ec68: 38 02 ff ff mvu r2,0xffff if ( !signal_set ) /* similar to _ASR_Are_signals_pending( asr ) */ return; asr->nest_level += 1; 800ec6c: 34 63 00 01 addi r3,r3,1 800ec70: 59 63 00 1c sw (r11+28),r3 rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); 800ec74: 37 83 00 10 addi r3,sp,16 800ec78: fb ff ff 46 calli 800e990 (*asr->handler)( signal_set ); 800ec7c: 29 62 00 0c lw r2,(r11+12) 800ec80: b9 80 08 00 mv r1,r12 800ec84: d8 40 00 00 call r2 asr->nest_level -= 1; 800ec88: 29 63 00 1c lw r3,(r11+28) rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 800ec8c: 2b 81 00 10 lw r1,(sp+16) 800ec90: 38 02 ff ff mvu r2,0xffff asr->nest_level += 1; rtems_task_mode( asr->mode_set, RTEMS_ALL_MODE_MASKS, &prev_mode ); (*asr->handler)( signal_set ); asr->nest_level -= 1; 800ec94: 34 63 ff ff addi r3,r3,-1 800ec98: 59 63 00 1c sw (r11+28),r3 rtems_task_mode( prev_mode, RTEMS_ALL_MODE_MASKS, &prev_mode ); 800ec9c: 37 83 00 10 addi r3,sp,16 800eca0: fb ff ff 3c calli 800e990 } 800eca4: 2b 9d 00 04 lw ra,(sp+4) 800eca8: 2b 8b 00 0c lw r11,(sp+12) 800ecac: 2b 8c 00 08 lw r12,(sp+8) 800ecb0: 37 9c 00 10 addi sp,sp,16 800ecb4: c3 a0 00 00 ret 08003c38 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 8003c38: 37 9c ff f4 addi sp,sp,-12 8003c3c: 5b 8b 00 08 sw (sp+8),r11 8003c40: 5b 9d 00 04 sw (sp+4),ra 8003c44: b8 20 10 00 mv r2,r1 8003c48: 78 01 08 02 mvhi r1,0x802 8003c4c: 38 21 38 94 ori r1,r1,0x3894 8003c50: 37 83 00 0c addi r3,sp,12 8003c54: f8 00 07 d3 calli 8005ba0 <_Objects_Get> /* * 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 ) { 8003c58: 2b 82 00 0c lw r2,(sp+12) 8003c5c: b8 20 58 00 mv r11,r1 8003c60: 5c 40 00 21 bne r2,r0,8003ce4 <_Rate_monotonic_Timeout+0xac><== NEVER TAKEN case OBJECTS_LOCAL: the_thread = the_period->owner; 8003c64: 28 21 00 40 lw r1,(r1+64) if ( _States_Is_waiting_for_period( the_thread->current_state ) && 8003c68: 28 23 00 10 lw r3,(r1+16) 8003c6c: 20 63 40 00 andi r3,r3,0x4000 8003c70: 44 62 00 08 be r3,r2,8003c90 <_Rate_monotonic_Timeout+0x58> the_thread->Wait.id == the_period->Object.id ) { 8003c74: 28 23 00 20 lw r3,(r1+32) 8003c78: 29 62 00 08 lw r2,(r11+8) 8003c7c: 5c 62 00 05 bne r3,r2,8003c90 <_Rate_monotonic_Timeout+0x58> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 8003c80: 78 02 10 03 mvhi r2,0x1003 8003c84: 38 42 ff f8 ori r2,r2,0xfff8 8003c88: f8 00 09 2d calli 800613c <_Thread_Clear_state> 8003c8c: e0 00 00 06 bi 8003ca4 <_Rate_monotonic_Timeout+0x6c> _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 ) { 8003c90: 29 62 00 38 lw r2,(r11+56) 8003c94: 34 01 00 01 mvi r1,1 8003c98: 5c 41 00 0c bne r2,r1,8003cc8 <_Rate_monotonic_Timeout+0x90><== ALWAYS TAKEN the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 8003c9c: 34 01 00 03 mvi r1,3 <== NOT EXECUTED 8003ca0: 59 61 00 38 sw (r11+56),r1 <== NOT EXECUTED _Rate_monotonic_Initiate_statistics( the_period ); 8003ca4: b9 60 08 00 mv r1,r11 8003ca8: fb ff fd f3 calli 8003474 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8003cac: 29 61 00 3c lw r1,(r11+60) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8003cb0: 35 62 00 10 addi r2,r11,16 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8003cb4: 59 61 00 1c sw (r11+28),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8003cb8: 78 01 08 02 mvhi r1,0x802 8003cbc: 38 21 3a a8 ori r1,r1,0x3aa8 8003cc0: f8 00 0f d7 calli 8007c1c <_Watchdog_Insert> 8003cc4: e0 00 00 03 bi 8003cd0 <_Rate_monotonic_Timeout+0x98> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 8003cc8: 34 01 00 04 mvi r1,4 8003ccc: 59 61 00 38 sw (r11+56),r1 */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 8003cd0: 78 01 08 02 mvhi r1,0x802 8003cd4: 38 21 39 cc ori r1,r1,0x39cc 8003cd8: 28 22 00 00 lw r2,(r1+0) 8003cdc: 34 42 ff ff addi r2,r2,-1 8003ce0: 58 22 00 00 sw (r1+0),r2 case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } 8003ce4: 2b 9d 00 04 lw ra,(sp+4) 8003ce8: 2b 8b 00 08 lw r11,(sp+8) 8003cec: 37 9c 00 0c addi sp,sp,12 8003cf0: c3 a0 00 00 ret 080035ec <_Rate_monotonic_Update_statistics>: } void _Rate_monotonic_Update_statistics( Rate_monotonic_Control *the_period ) { 80035ec: 37 9c ff e4 addi sp,sp,-28 80035f0: 5b 8b 00 0c sw (sp+12),r11 80035f4: 5b 8c 00 08 sw (sp+8),r12 80035f8: 5b 9d 00 04 sw (sp+4),ra 80035fc: b8 20 58 00 mv r11,r1 /* * Update the counts. */ stats = &the_period->Statistics; stats->count++; 8003600: 28 21 00 54 lw r1,(r1+84) if ( the_period->state == RATE_MONOTONIC_EXPIRED ) 8003604: 29 62 00 38 lw r2,(r11+56) /* * Update the counts. */ stats = &the_period->Statistics; stats->count++; 8003608: 34 21 00 01 addi r1,r1,1 800360c: 59 61 00 54 sw (r11+84),r1 if ( the_period->state == RATE_MONOTONIC_EXPIRED ) 8003610: 34 01 00 04 mvi r1,4 8003614: 5c 41 00 04 bne r2,r1,8003624 <_Rate_monotonic_Update_statistics+0x38> stats->missed_count++; 8003618: 29 61 00 58 lw r1,(r11+88) 800361c: 34 21 00 01 addi r1,r1,1 8003620: 59 61 00 58 sw (r11+88),r1 /* * Grab status for time statistics. */ valid_status = _Rate_monotonic_Get_status( the_period, &since_last_period, &executed ); 8003624: 37 8c 00 18 addi r12,sp,24 8003628: b9 60 08 00 mv r1,r11 800362c: 37 82 00 10 addi r2,sp,16 8003630: b9 80 18 00 mv r3,r12 8003634: fb ff ff b5 calli 8003508 <_Rate_monotonic_Get_status> if (!valid_status) 8003638: 44 20 00 28 be r1,r0,80036d8 <_Rate_monotonic_Update_statistics+0xec><== NEVER TAKEN /* * Update CPU time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_cpu_time, &executed ); 800363c: b9 80 10 00 mv r2,r12 8003640: 35 61 00 6c addi r1,r11,108 8003644: f8 00 10 25 calli 80076d8 <_Timespec_Add_to> if ( _Timestamp_Less_than( &executed, &stats->min_cpu_time ) ) 8003648: b9 80 08 00 mv r1,r12 800364c: 35 62 00 5c addi r2,r11,92 8003650: f8 00 10 7f calli 800784c <_Timespec_Less_than> 8003654: 44 20 00 05 be r1,r0,8003668 <_Rate_monotonic_Update_statistics+0x7c> stats->min_cpu_time = executed; 8003658: 2b 81 00 18 lw r1,(sp+24) 800365c: 59 61 00 5c sw (r11+92),r1 8003660: 2b 81 00 1c lw r1,(sp+28) 8003664: 59 61 00 60 sw (r11+96),r1 if ( _Timestamp_Greater_than( &executed, &stats->max_cpu_time ) ) 8003668: 37 81 00 18 addi r1,sp,24 800366c: 35 62 00 64 addi r2,r11,100 8003670: f8 00 10 6b calli 800781c <_Timespec_Greater_than> 8003674: 44 20 00 05 be r1,r0,8003688 <_Rate_monotonic_Update_statistics+0x9c> stats->max_cpu_time = executed; 8003678: 2b 81 00 18 lw r1,(sp+24) 800367c: 59 61 00 64 sw (r11+100),r1 8003680: 2b 81 00 1c lw r1,(sp+28) 8003684: 59 61 00 68 sw (r11+104),r1 /* * Update Wall time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_wall_time, &since_last_period ); 8003688: 37 8c 00 10 addi r12,sp,16 800368c: b9 80 10 00 mv r2,r12 8003690: 35 61 00 84 addi r1,r11,132 8003694: f8 00 10 11 calli 80076d8 <_Timespec_Add_to> if ( _Timestamp_Less_than( &since_last_period, &stats->min_wall_time ) ) 8003698: b9 80 08 00 mv r1,r12 800369c: 35 62 00 74 addi r2,r11,116 80036a0: f8 00 10 6b calli 800784c <_Timespec_Less_than> 80036a4: 44 20 00 05 be r1,r0,80036b8 <_Rate_monotonic_Update_statistics+0xcc> stats->min_wall_time = since_last_period; 80036a8: 2b 81 00 10 lw r1,(sp+16) 80036ac: 59 61 00 74 sw (r11+116),r1 80036b0: 2b 81 00 14 lw r1,(sp+20) 80036b4: 59 61 00 78 sw (r11+120),r1 if ( _Timestamp_Greater_than( &since_last_period, &stats->max_wall_time ) ) 80036b8: 37 81 00 10 addi r1,sp,16 80036bc: 35 62 00 7c addi r2,r11,124 80036c0: f8 00 10 57 calli 800781c <_Timespec_Greater_than> 80036c4: 44 20 00 05 be r1,r0,80036d8 <_Rate_monotonic_Update_statistics+0xec> stats->max_wall_time = since_last_period; 80036c8: 2b 81 00 14 lw r1,(sp+20) 80036cc: 59 61 00 80 sw (r11+128),r1 80036d0: 2b 81 00 10 lw r1,(sp+16) 80036d4: 59 61 00 7c sw (r11+124),r1 stats->min_wall_time = since_last_period; if ( since_last_period > stats->max_wall_time ) stats->max_wall_time = since_last_period; #endif } 80036d8: 2b 9d 00 04 lw ra,(sp+4) 80036dc: 2b 8b 00 0c lw r11,(sp+12) 80036e0: 2b 8c 00 08 lw r12,(sp+8) 80036e4: 37 9c 00 1c addi sp,sp,28 80036e8: c3 a0 00 00 ret 080052a4 <_TOD_Get>: */ void _TOD_Get( struct timespec *time ) { 80052a4: 37 9c ff e4 addi sp,sp,-28 80052a8: 5b 8b 00 0c sw (sp+12),r11 80052ac: 5b 8c 00 08 sw (sp+8),r12 80052b0: 5b 9d 00 04 sw (sp+4),ra 80052b4: b8 20 58 00 mv r11,r1 /* assume time checked for NULL by caller */ /* _TOD_Now is the native current time */ nanoseconds = 0; _ISR_Disable( level ); 80052b8: 90 00 60 00 rcsr r12,IE 80052bc: 34 01 ff fe mvi r1,-2 80052c0: a1 81 08 00 and r1,r12,r1 80052c4: d0 01 00 00 wcsr IE,r1 now = _TOD_Now; 80052c8: 78 02 08 02 mvhi r2,0x802 80052cc: 38 42 59 d4 ori r2,r2,0x59d4 if ( _Watchdog_Nanoseconds_since_tick_handler ) 80052d0: 78 03 08 02 mvhi r3,0x802 /* assume time checked for NULL by caller */ /* _TOD_Now is the native current time */ nanoseconds = 0; _ISR_Disable( level ); now = _TOD_Now; 80052d4: 28 41 00 04 lw r1,(r2+4) if ( _Watchdog_Nanoseconds_since_tick_handler ) 80052d8: 38 63 5a e4 ori r3,r3,0x5ae4 /* assume time checked for NULL by caller */ /* _TOD_Now is the native current time */ nanoseconds = 0; _ISR_Disable( level ); now = _TOD_Now; 80052dc: 28 42 00 00 lw r2,(r2+0) if ( _Watchdog_Nanoseconds_since_tick_handler ) 80052e0: 28 63 00 00 lw r3,(r3+0) /* assume time checked for NULL by caller */ /* _TOD_Now is the native current time */ nanoseconds = 0; _ISR_Disable( level ); now = _TOD_Now; 80052e4: 5b 81 00 14 sw (sp+20),r1 80052e8: 5b 82 00 10 sw (sp+16),r2 if ( _Watchdog_Nanoseconds_since_tick_handler ) 80052ec: b8 60 20 00 mv r4,r3 80052f0: 44 60 00 03 be r3,r0,80052fc <_TOD_Get+0x58> <== ALWAYS TAKEN nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); 80052f4: d8 60 00 00 call r3 <== NOT EXECUTED 80052f8: b8 20 20 00 mv r4,r1 <== NOT EXECUTED _ISR_Enable( level ); 80052fc: d0 0c 00 00 wcsr IE,r12 _Timestamp_Set( &offset, 0, nanoseconds ); 8005300: 34 03 00 00 mvi r3,0 _Timestamp_Add_to( &now, &offset ); 8005304: 37 81 00 10 addi r1,sp,16 8005308: 37 82 00 18 addi r2,sp,24 now = _TOD_Now; if ( _Watchdog_Nanoseconds_since_tick_handler ) nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); _ISR_Enable( level ); _Timestamp_Set( &offset, 0, nanoseconds ); 800530c: 5b 83 00 18 sw (sp+24),r3 8005310: 5b 84 00 1c sw (sp+28),r4 _Timestamp_Add_to( &now, &offset ); 8005314: f8 00 08 f0 calli 80076d4 <_Timespec_Add_to> _Timestamp_To_timespec( &now, time ); 8005318: 2b 81 00 14 lw r1,(sp+20) 800531c: 59 61 00 04 sw (r11+4),r1 8005320: 2b 81 00 10 lw r1,(sp+16) 8005324: 59 61 00 00 sw (r11+0),r1 } 8005328: 2b 9d 00 04 lw ra,(sp+4) 800532c: 2b 8b 00 0c lw r11,(sp+12) 8005330: 2b 8c 00 08 lw r12,(sp+8) 8005334: 37 9c 00 1c addi sp,sp,28 8005338: c3 a0 00 00 ret 0800f240 <_TOD_Get_uptime>: */ void _TOD_Get_uptime( Timestamp_Control *uptime ) { 800f240: 37 9c ff e4 addi sp,sp,-28 800f244: 5b 8b 00 0c sw (sp+12),r11 800f248: 5b 8c 00 08 sw (sp+8),r12 800f24c: 5b 9d 00 04 sw (sp+4),ra 800f250: b8 20 58 00 mv r11,r1 /* assume time checked for NULL by caller */ /* _TOD_Uptime is in native timestamp format */ nanoseconds = 0; _ISR_Disable( level ); 800f254: 90 00 60 00 rcsr r12,IE 800f258: 34 01 ff fe mvi r1,-2 800f25c: a1 81 08 00 and r1,r12,r1 800f260: d0 01 00 00 wcsr IE,r1 up = _TOD_Uptime; 800f264: 78 02 08 02 mvhi r2,0x802 800f268: 38 42 59 c4 ori r2,r2,0x59c4 if ( _Watchdog_Nanoseconds_since_tick_handler ) 800f26c: 78 03 08 02 mvhi r3,0x802 /* assume time checked for NULL by caller */ /* _TOD_Uptime is in native timestamp format */ nanoseconds = 0; _ISR_Disable( level ); up = _TOD_Uptime; 800f270: 28 41 00 04 lw r1,(r2+4) if ( _Watchdog_Nanoseconds_since_tick_handler ) 800f274: 38 63 5a e4 ori r3,r3,0x5ae4 /* assume time checked for NULL by caller */ /* _TOD_Uptime is in native timestamp format */ nanoseconds = 0; _ISR_Disable( level ); up = _TOD_Uptime; 800f278: 28 42 00 00 lw r2,(r2+0) if ( _Watchdog_Nanoseconds_since_tick_handler ) 800f27c: 28 63 00 00 lw r3,(r3+0) /* assume time checked for NULL by caller */ /* _TOD_Uptime is in native timestamp format */ nanoseconds = 0; _ISR_Disable( level ); up = _TOD_Uptime; 800f280: 5b 81 00 14 sw (sp+20),r1 800f284: 5b 82 00 10 sw (sp+16),r2 if ( _Watchdog_Nanoseconds_since_tick_handler ) 800f288: b8 60 20 00 mv r4,r3 800f28c: 44 60 00 03 be r3,r0,800f298 <_TOD_Get_uptime+0x58> <== ALWAYS TAKEN nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); 800f290: d8 60 00 00 call r3 <== NOT EXECUTED 800f294: b8 20 20 00 mv r4,r1 <== NOT EXECUTED _ISR_Enable( level ); 800f298: d0 0c 00 00 wcsr IE,r12 _Timestamp_Set( &offset, 0, nanoseconds ); 800f29c: 34 03 00 00 mvi r3,0 _Timestamp_Add_to( &up, &offset ); 800f2a0: 37 81 00 10 addi r1,sp,16 800f2a4: 37 82 00 18 addi r2,sp,24 up = _TOD_Uptime; if ( _Watchdog_Nanoseconds_since_tick_handler ) nanoseconds = (*_Watchdog_Nanoseconds_since_tick_handler)(); _ISR_Enable( level ); _Timestamp_Set( &offset, 0, nanoseconds ); 800f2a8: 5b 83 00 18 sw (sp+24),r3 800f2ac: 5b 84 00 1c sw (sp+28),r4 _Timestamp_Add_to( &up, &offset ); 800f2b0: fb ff e1 09 calli 80076d4 <_Timespec_Add_to> *uptime = up; 800f2b4: 2b 81 00 14 lw r1,(sp+20) 800f2b8: 59 61 00 04 sw (r11+4),r1 800f2bc: 2b 81 00 10 lw r1,(sp+16) 800f2c0: 59 61 00 00 sw (r11+0),r1 } 800f2c4: 2b 9d 00 04 lw ra,(sp+4) 800f2c8: 2b 8b 00 0c lw r11,(sp+12) 800f2cc: 2b 8c 00 08 lw r12,(sp+8) 800f2d0: 37 9c 00 1c addi sp,sp,28 800f2d4: c3 a0 00 00 ret 0800380c <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 800380c: 37 9c ff f4 addi sp,sp,-12 8003810: 5b 8b 00 0c sw (sp+12),r11 8003814: 5b 8c 00 08 sw (sp+8),r12 8003818: 5b 9d 00 04 sw (sp+4),ra uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 800381c: 78 02 08 02 mvhi r2,0x802 8003820: 38 42 40 c4 ori r2,r2,0x40c4 */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 8003824: b8 20 58 00 mv r11,r1 uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); 8003828: 28 42 00 0c lw r2,(r2+12) if ((!the_tod) || 800382c: 44 20 00 22 be r1,r0,80038b4 <_TOD_Validate+0xa8> <== NEVER TAKEN (the_tod->ticks >= ticks_per_second) || 8003830: 78 01 00 0f mvhi r1,0xf 8003834: 38 21 42 40 ori r1,r1,0x4240 8003838: f8 00 70 25 calli 801f8cc <__udivsi3> 800383c: 29 62 00 18 lw r2,(r11+24) 8003840: 50 41 00 1d bgeu r2,r1,80038b4 <_TOD_Validate+0xa8> (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 8003844: 29 62 00 14 lw r2,(r11+20) 8003848: 34 01 00 3b mvi r1,59 800384c: 54 41 00 1a bgu r2,r1,80038b4 <_TOD_Validate+0xa8> (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 8003850: 29 62 00 10 lw r2,(r11+16) 8003854: 54 41 00 18 bgu r2,r1,80038b4 <_TOD_Validate+0xa8> (the_tod->hour >= TOD_HOURS_PER_DAY) || 8003858: 29 62 00 0c lw r2,(r11+12) 800385c: 34 01 00 17 mvi r1,23 8003860: 54 41 00 15 bgu r2,r1,80038b4 <_TOD_Validate+0xa8> (the_tod->month == 0) || 8003864: 29 61 00 04 lw r1,(r11+4) uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 8003868: 44 20 00 13 be r1,r0,80038b4 <_TOD_Validate+0xa8> <== NEVER TAKEN 800386c: 34 02 00 0c mvi r2,12 8003870: 54 22 00 11 bgu r1,r2,80038b4 <_TOD_Validate+0xa8> (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) || 8003874: 29 62 00 00 lw r2,(r11+0) uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 8003878: 34 03 07 c3 mvi r3,1987 800387c: 50 62 00 0e bgeu r3,r2,80038b4 <_TOD_Validate+0xa8> (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) || (the_tod->day == 0) ) 8003880: 29 6c 00 08 lw r12,(r11+8) uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 8003884: 45 80 00 0c be r12,r0,80038b4 <_TOD_Validate+0xa8> <== NEVER TAKEN 8003888: 78 0b 08 02 mvhi r11,0x802 (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 800388c: 20 42 00 03 andi r2,r2,0x3 8003890: 39 6b 13 c0 ori r11,r11,0x13c0 8003894: 5c 40 00 02 bne r2,r0,800389c <_TOD_Validate+0x90> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 8003898: 34 21 00 0d addi r1,r1,13 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 800389c: 34 02 00 02 mvi r2,2 80038a0: fb ff f6 62 calli 8001228 <__ashlsi3> 80038a4: b5 61 08 00 add r1,r11,r1 80038a8: 28 21 00 00 lw r1,(r1+0) * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 80038ac: f0 2c 08 00 cmpgeu r1,r1,r12 80038b0: e0 00 00 02 bi 80038b8 <_TOD_Validate+0xac> 80038b4: 34 01 00 00 mvi r1,0 if ( the_tod->day > days_in_month ) return false; return true; } 80038b8: 2b 9d 00 04 lw ra,(sp+4) 80038bc: 2b 8b 00 0c lw r11,(sp+12) 80038c0: 2b 8c 00 08 lw r12,(sp+8) 80038c4: 37 9c 00 0c addi sp,sp,12 80038c8: c3 a0 00 00 ret 08006344 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 8006344: 37 9c ff ec addi sp,sp,-20 8006348: 5b 8b 00 14 sw (sp+20),r11 800634c: 5b 8c 00 10 sw (sp+16),r12 8006350: 5b 8d 00 0c sw (sp+12),r13 8006354: 5b 8e 00 08 sw (sp+8),r14 8006358: 5b 9d 00 04 sw (sp+4),ra 800635c: b8 20 58 00 mv r11,r1 */ /* * Save original state */ original_state = the_thread->current_state; 8006360: 28 2e 00 10 lw r14,(r1+16) void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 8006364: b8 40 60 00 mv r12,r2 8006368: 20 6d 00 ff andi r13,r3,0xff /* * 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 ); 800636c: f8 00 04 5b calli 80074d8 <_Thread_Set_transient> /* * Do not bother recomputing all the priority related information if * we are not REALLY changing priority. */ if ( the_thread->current_priority != new_priority ) 8006370: 29 61 00 14 lw r1,(r11+20) 8006374: 44 2c 00 04 be r1,r12,8006384 <_Thread_Change_priority+0x40> _Thread_Set_priority( the_thread, new_priority ); 8006378: b9 80 10 00 mv r2,r12 800637c: b9 60 08 00 mv r1,r11 8006380: f8 00 03 b3 calli 800724c <_Thread_Set_priority> _ISR_Disable( level ); 8006384: 90 00 60 00 rcsr r12,IE 8006388: 34 05 ff fe mvi r5,-2 800638c: a1 85 28 00 and r5,r12,r5 8006390: d0 05 00 00 wcsr IE,r5 /* * 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; 8006394: 29 64 00 10 lw r4,(r11+16) if ( state != STATES_TRANSIENT ) { 8006398: 34 01 00 04 mvi r1,4 800639c: 21 c2 00 04 andi r2,r14,0x4 80063a0: 44 81 00 0e be r4,r1,80063d8 <_Thread_Change_priority+0x94> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 80063a4: 5c 40 00 04 bne r2,r0,80063b4 <_Thread_Change_priority+0x70><== NEVER TAKEN the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 80063a8: 34 01 ff fb mvi r1,-5 80063ac: a0 81 08 00 and r1,r4,r1 80063b0: 59 61 00 10 sw (r11+16),r1 _ISR_Enable( level ); 80063b4: d0 0c 00 00 wcsr IE,r12 if ( _States_Is_waiting_on_thread_queue( state ) ) { 80063b8: 78 01 00 03 mvhi r1,0x3 80063bc: 38 21 be e0 ori r1,r1,0xbee0 80063c0: a0 81 08 00 and r1,r4,r1 80063c4: 44 20 00 5f be r1,r0,8006540 <_Thread_Change_priority+0x1fc> _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 80063c8: 29 61 00 44 lw r1,(r11+68) 80063cc: b9 60 10 00 mv r2,r11 80063d0: f8 00 03 6c calli 8007180 <_Thread_queue_Requeue> 80063d4: e0 00 00 5b bi 8006540 <_Thread_Change_priority+0x1fc> } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { 80063d8: 5c 40 00 1c bne r2,r0,8006448 <_Thread_Change_priority+0x104><== NEVER TAKEN RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 80063dc: 29 61 00 90 lw r1,(r11+144) 80063e0: 2d 63 00 96 lhu r3,(r11+150) _Priority_Major_bit_map |= the_priority_map->ready_major; 80063e4: 78 04 08 02 mvhi r4,0x802 RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 80063e8: 2c 26 00 00 lhu r6,(r1+0) _Priority_Major_bit_map |= the_priority_map->ready_major; 80063ec: 38 84 59 f4 ori r4,r4,0x59f4 * 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 ); 80063f0: 59 62 00 10 sw (r11+16),r2 RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 80063f4: b8 c3 18 00 or r3,r6,r3 80063f8: 0c 23 00 00 sh (r1+0),r3 _Priority_Major_bit_map |= the_priority_map->ready_major; 80063fc: 2c 83 00 00 lhu r3,(r4+0) 8006400: 2d 66 00 94 lhu r6,(r11+148) 8006404: 29 61 00 8c lw r1,(r11+140) 8006408: b8 c3 18 00 or r3,r6,r3 800640c: 20 63 ff ff andi r3,r3,0xffff 8006410: 0c 83 00 00 sh (r4+0),r3 _Priority_Add_to_bit_map( &the_thread->Priority_map ); if ( prepend_it ) 8006414: 45 a2 00 07 be r13,r2,8006430 <_Thread_Change_priority+0xec> ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 8006418: 28 22 00 00 lw r2,(r1+0) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 800641c: 59 61 00 04 sw (r11+4),r1 before_node = after_node->next; after_node->next = the_node; 8006420: 58 2b 00 00 sw (r1+0),r11 the_node->next = before_node; before_node->previous = the_node; 8006424: 58 4b 00 04 sw (r2+4),r11 Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; 8006428: 59 62 00 00 sw (r11+0),r2 800642c: e0 00 00 07 bi 8006448 <_Thread_Change_priority+0x104> Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 8006430: 34 22 00 04 addi r2,r1,4 8006434: 59 62 00 00 sw (r11+0),r2 old_last_node = the_chain->last; 8006438: 28 22 00 08 lw r2,(r1+8) the_chain->last = the_node; 800643c: 58 2b 00 08 sw (r1+8),r11 old_last_node->next = the_node; the_node->previous = old_last_node; 8006440: 59 62 00 04 sw (r11+4),r2 Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 8006444: 58 4b 00 00 sw (r2+0),r11 _Chain_Prepend_unprotected( the_thread->ready, &the_thread->Object.Node ); else _Chain_Append_unprotected( the_thread->ready, &the_thread->Object.Node ); } _ISR_Flash( level ); 8006448: d0 0c 00 00 wcsr IE,r12 800644c: d0 05 00 00 wcsr IE,r5 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 ); 8006450: 78 01 08 02 mvhi r1,0x802 8006454: 38 21 59 f4 ori r1,r1,0x59f4 8006458: 2c 21 00 00 lhu r1,(r1+0) */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) _Thread_Ready_chain[ _Priority_Get_highest() ].first; 800645c: 78 02 08 02 mvhi r2,0x802 8006460: 38 42 58 d0 ori r2,r2,0x58d0 8006464: 78 0b 08 02 mvhi r11,0x802 8006468: 28 4e 00 00 lw r14,(r2+0) 800646c: 20 21 ff ff andi r1,r1,0xffff 8006470: 34 02 00 ff mvi r2,255 8006474: 39 6b 2d 84 ori r11,r11,0x2d84 8006478: 54 22 00 05 bgu r1,r2,800648c <_Thread_Change_priority+0x148> 800647c: b5 61 58 00 add r11,r11,r1 8006480: 41 6d 00 00 lbu r13,(r11+0) 8006484: 35 ad 00 08 addi r13,r13,8 8006488: e0 00 00 05 bi 800649c <_Thread_Change_priority+0x158> 800648c: 34 02 00 08 mvi r2,8 8006490: fb ff e9 f7 calli 8000c6c <__lshrsi3> 8006494: b5 61 58 00 add r11,r11,r1 8006498: 41 6d 00 00 lbu r13,(r11+0) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 800649c: 78 02 08 02 mvhi r2,0x802 80064a0: b5 ad 08 00 add r1,r13,r13 80064a4: 38 42 5a 70 ori r2,r2,0x5a70 80064a8: b4 41 10 00 add r2,r2,r1 80064ac: 2c 41 00 00 lhu r1,(r2+0) 80064b0: 78 0b 08 02 mvhi r11,0x802 80064b4: 34 02 00 ff mvi r2,255 80064b8: 39 6b 2d 84 ori r11,r11,0x2d84 80064bc: 54 22 00 05 bgu r1,r2,80064d0 <_Thread_Change_priority+0x18c> 80064c0: b5 61 58 00 add r11,r11,r1 80064c4: 41 6b 00 00 lbu r11,(r11+0) 80064c8: 35 6b 00 08 addi r11,r11,8 80064cc: e0 00 00 05 bi 80064e0 <_Thread_Change_priority+0x19c> 80064d0: 34 02 00 08 mvi r2,8 80064d4: fb ff e9 e6 calli 8000c6c <__lshrsi3> 80064d8: b5 61 58 00 add r11,r11,r1 80064dc: 41 6b 00 00 lbu r11,(r11+0) * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 80064e0: 34 02 00 04 mvi r2,4 80064e4: b9 a0 08 00 mv r1,r13 80064e8: fb ff e9 b9 calli 8000bcc <__ashlsi3> 80064ec: b5 61 08 00 add r1,r11,r1 80064f0: b4 21 10 00 add r2,r1,r1 80064f4: b4 41 08 00 add r1,r2,r1 80064f8: 34 02 00 02 mvi r2,2 80064fc: fb ff e9 b4 calli 8000bcc <__ashlsi3> 8006500: b5 c1 08 00 add r1,r14,r1 * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 8006504: 78 02 08 02 mvhi r2,0x802 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 8006508: 28 23 00 00 lw r3,(r1+0) * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 800650c: 38 42 5a 00 ori r2,r2,0x5a00 * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 8006510: 78 01 08 02 mvhi r1,0x802 * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 8006514: 28 42 00 00 lw r2,(r2+0) * ready thread. */ RTEMS_INLINE_ROUTINE void _Thread_Calculate_heir( void ) { _Thread_Heir = (Thread_Control *) 8006518: 38 21 59 d0 ori r1,r1,0x59d0 800651c: 58 23 00 00 sw (r1+0),r3 * 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() && 8006520: 44 43 00 07 be r2,r3,800653c <_Thread_Change_priority+0x1f8> _Thread_Executing->is_preemptible ) 8006524: 40 41 00 75 lbu r1,(r2+117) 8006528: 44 20 00 05 be r1,r0,800653c <_Thread_Change_priority+0x1f8> _Context_Switch_necessary = true; 800652c: 78 01 08 02 mvhi r1,0x802 8006530: 38 21 5a 10 ori r1,r1,0x5a10 8006534: 34 02 00 01 mvi r2,1 8006538: 30 22 00 00 sb (r1+0),r2 _ISR_Enable( level ); 800653c: d0 0c 00 00 wcsr IE,r12 } 8006540: 2b 9d 00 04 lw ra,(sp+4) 8006544: 2b 8b 00 14 lw r11,(sp+20) 8006548: 2b 8c 00 10 lw r12,(sp+16) 800654c: 2b 8d 00 0c lw r13,(sp+12) 8006550: 2b 8e 00 08 lw r14,(sp+8) 8006554: 37 9c 00 14 addi sp,sp,20 8006558: c3 a0 00 00 ret 0800fa28 <_Thread_Clear_state>: ) { ISR_Level level; States_Control current_state; _ISR_Disable( level ); 800fa28: 90 00 18 00 rcsr r3,IE 800fa2c: 34 05 ff fe mvi r5,-2 800fa30: a0 65 28 00 and r5,r3,r5 800fa34: d0 05 00 00 wcsr IE,r5 current_state = the_thread->current_state; 800fa38: 28 24 00 10 lw r4,(r1+16) if ( current_state & state ) { 800fa3c: a0 44 30 00 and r6,r2,r4 800fa40: 44 c0 00 2b be r6,r0,800faec <_Thread_Clear_state+0xc4> RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); 800fa44: a4 40 10 00 not r2,r2 800fa48: a0 44 10 00 and r2,r2,r4 current_state = 800fa4c: 58 22 00 10 sw (r1+16),r2 the_thread->current_state = _States_Clear( state, current_state ); if ( _States_Is_ready( current_state ) ) { 800fa50: 5c 40 00 27 bne r2,r0,800faec <_Thread_Clear_state+0xc4> RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 800fa54: 28 26 00 90 lw r6,(r1+144) 800fa58: 2c 27 00 96 lhu r7,(r1+150) _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node); 800fa5c: 28 24 00 8c lw r4,(r1+140) 800fa60: 2c c8 00 00 lhu r8,(r6+0) _Priority_Major_bit_map |= the_priority_map->ready_major; 800fa64: 78 02 08 02 mvhi r2,0x802 800fa68: 38 42 59 f4 ori r2,r2,0x59f4 RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 800fa6c: b9 07 38 00 or r7,r8,r7 800fa70: 0c c7 00 00 sh (r6+0),r7 _Priority_Major_bit_map |= the_priority_map->ready_major; 800fa74: 2c 47 00 00 lhu r7,(r2+0) 800fa78: 2c 28 00 94 lhu r8,(r1+148) Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 800fa7c: 34 86 00 04 addi r6,r4,4 800fa80: 58 26 00 00 sw (r1+0),r6 old_last_node = the_chain->last; 800fa84: 28 86 00 08 lw r6,(r4+8) 800fa88: b9 07 38 00 or r7,r8,r7 the_chain->last = the_node; 800fa8c: 58 81 00 08 sw (r4+8),r1 800fa90: 20 e4 ff ff andi r4,r7,0xffff 800fa94: 0c 44 00 00 sh (r2+0),r4 old_last_node->next = the_node; the_node->previous = old_last_node; 800fa98: 58 26 00 04 sw (r1+4),r6 Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 800fa9c: 58 c1 00 00 sw (r6+0),r1 _ISR_Flash( level ); 800faa0: d0 03 00 00 wcsr IE,r3 800faa4: d0 05 00 00 wcsr IE,r5 * 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 ) { 800faa8: 78 02 08 02 mvhi r2,0x802 800faac: 38 42 59 d0 ori r2,r2,0x59d0 800fab0: 28 44 00 00 lw r4,(r2+0) 800fab4: 28 25 00 14 lw r5,(r1+20) 800fab8: 28 84 00 14 lw r4,(r4+20) 800fabc: 50 a4 00 0c bgeu r5,r4,800faec <_Thread_Clear_state+0xc4> _Thread_Heir = the_thread; if ( _Thread_Executing->is_preemptible || 800fac0: 78 04 08 02 mvhi r4,0x802 800fac4: 38 84 5a 00 ori r4,r4,0x5a00 800fac8: 28 84 00 00 lw r4,(r4+0) * 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 ) { _Thread_Heir = the_thread; 800facc: 58 41 00 00 sw (r2+0),r1 if ( _Thread_Executing->is_preemptible || 800fad0: 40 81 00 75 lbu r1,(r4+117) 800fad4: 5c 20 00 02 bne r1,r0,800fadc <_Thread_Clear_state+0xb4> 800fad8: 5c a1 00 05 bne r5,r1,800faec <_Thread_Clear_state+0xc4> <== ALWAYS TAKEN the_thread->current_priority == 0 ) _Context_Switch_necessary = true; 800fadc: 78 01 08 02 mvhi r1,0x802 800fae0: 38 21 5a 10 ori r1,r1,0x5a10 800fae4: 34 02 00 01 mvi r2,1 800fae8: 30 22 00 00 sb (r1+0),r2 } } } _ISR_Enable( level ); 800faec: d0 03 00 00 wcsr IE,r3 } 800faf0: c3 a0 00 00 ret 0800bbe4 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 800bbe4: 37 9c ff f8 addi sp,sp,-8 800bbe8: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 800bbec: 37 82 00 08 addi r2,sp,8 800bbf0: f8 00 00 a2 calli 800be78 <_Thread_Get> switch ( location ) { 800bbf4: 2b 82 00 08 lw r2,(sp+8) 800bbf8: 5c 40 00 09 bne r2,r0,800bc1c <_Thread_Delay_ended+0x38> <== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 800bbfc: 78 02 10 00 mvhi r2,0x1000 800bc00: 38 42 00 18 ori r2,r2,0x18 800bc04: fb ff ff 4e calli 800b93c <_Thread_Clear_state> 800bc08: 78 01 08 02 mvhi r1,0x802 800bc0c: 38 21 aa 34 ori r1,r1,0xaa34 800bc10: 28 22 00 00 lw r2,(r1+0) 800bc14: 34 42 ff ff addi r2,r2,-1 800bc18: 58 22 00 00 sw (r1+0),r2 | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Thread_Unnest_dispatch(); break; } } 800bc1c: 2b 9d 00 04 lw ra,(sp+4) 800bc20: 37 9c 00 08 addi sp,sp,8 800bc24: c3 a0 00 00 ret 08006660 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 8006660: 37 9c ff b0 addi sp,sp,-80 8006664: 5b 8b 00 40 sw (sp+64),r11 8006668: 5b 8c 00 3c sw (sp+60),r12 800666c: 5b 8d 00 38 sw (sp+56),r13 8006670: 5b 8e 00 34 sw (sp+52),r14 8006674: 5b 8f 00 30 sw (sp+48),r15 8006678: 5b 90 00 2c sw (sp+44),r16 800667c: 5b 91 00 28 sw (sp+40),r17 8006680: 5b 92 00 24 sw (sp+36),r18 8006684: 5b 93 00 20 sw (sp+32),r19 8006688: 5b 94 00 1c sw (sp+28),r20 800668c: 5b 95 00 18 sw (sp+24),r21 8006690: 5b 96 00 14 sw (sp+20),r22 8006694: 5b 97 00 10 sw (sp+16),r23 8006698: 5b 98 00 0c sw (sp+12),r24 800669c: 5b 99 00 08 sw (sp+8),r25 80066a0: 5b 9d 00 04 sw (sp+4),ra Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 80066a4: 78 01 08 02 mvhi r1,0x802 80066a8: 38 21 5a 00 ori r1,r1,0x5a00 80066ac: 28 2b 00 00 lw r11,(r1+0) _ISR_Disable( level ); 80066b0: 90 00 20 00 rcsr r4,IE 80066b4: 34 01 ff fe mvi r1,-2 80066b8: a0 81 08 00 and r1,r4,r1 80066bc: d0 01 00 00 wcsr IE,r1 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 80066c0: 78 14 08 02 mvhi r20,0x802 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 80066c4: 78 0f 08 02 mvhi r15,0x802 80066c8: 78 0d 08 02 mvhi r13,0x802 heir = _Thread_Heir; 80066cc: 78 12 08 02 mvhi r18,0x802 _Thread_Dispatch_disable_level = 1; _Context_Switch_necessary = false; _Thread_Executing = heir; 80066d0: 78 0e 08 02 mvhi r14,0x802 #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; 80066d4: 78 11 08 02 mvhi r17,0x802 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 80066d8: 78 10 08 02 mvhi r16,0x802 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 80066dc: ba 80 98 00 mv r19,r20 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 80066e0: 39 ef 5a 10 ori r15,r15,0x5a10 80066e4: 39 ad 59 44 ori r13,r13,0x5944 heir = _Thread_Heir; 80066e8: 3a 52 59 d0 ori r18,r18,0x59d0 _Thread_Dispatch_disable_level = 1; _Context_Switch_necessary = false; _Thread_Executing = heir; 80066ec: 39 ce 5a 00 ori r14,r14,0x5a00 #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; 80066f0: 3a 31 58 d4 ori r17,r17,0x58d4 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 80066f4: 3a 10 59 cc ori r16,r16,0x59cc Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 80066f8: 34 19 00 00 mvi r25,0 heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 80066fc: 34 17 00 01 mvi r23,1 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 8006700: 37 96 00 4c addi r22,sp,76 _Timestamp_Subtract( 8006704: 37 95 00 44 addi r21,sp,68 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 8006708: 3a 73 5a 08 ori r19,r19,0x5a08 #endif #endif executing = _Thread_Executing; _ISR_Disable( level ); 800670c: 34 18 ff fe mvi r24,-2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 8006710: e0 00 00 28 bi 80067b0 <_Thread_Dispatch+0x150> heir = _Thread_Heir; 8006714: 2a 4c 00 00 lw r12,(r18+0) _Thread_Dispatch_disable_level = 1; 8006718: 59 b7 00 00 sw (r13+0),r23 _Context_Switch_necessary = false; 800671c: 31 f9 00 00 sb (r15+0),r25 _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 ) 8006720: 29 81 00 7c lw r1,(r12+124) _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; _Context_Switch_necessary = false; _Thread_Executing = heir; 8006724: 59 cc 00 00 sw (r14+0),r12 #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 ) 8006728: 5c 37 00 03 bne r1,r23,8006734 <_Thread_Dispatch+0xd4> heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 800672c: 2a 21 00 00 lw r1,(r17+0) 8006730: 59 81 00 78 sw (r12+120),r1 _ISR_Enable( level ); 8006734: d0 04 00 00 wcsr IE,r4 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 8006738: ba c0 08 00 mv r1,r22 800673c: f8 00 22 c1 calli 800f240 <_TOD_Get_uptime> _Timestamp_Subtract( 8006740: ba 80 08 00 mv r1,r20 8006744: ba a0 18 00 mv r3,r21 8006748: 38 21 5a 08 ori r1,r1,0x5a08 800674c: ba c0 10 00 mv r2,r22 8006750: f8 00 03 f8 calli 8007730 <_Timespec_Subtract> &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 8006754: ba a0 10 00 mv r2,r21 8006758: 35 61 00 84 addi r1,r11,132 800675c: f8 00 03 de calli 80076d4 <_Timespec_Add_to> _Thread_Time_of_last_context_switch = uptime; 8006760: 2b 83 00 4c lw r3,(sp+76) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 8006764: 2a 04 00 00 lw r4,(r16+0) executing->libc_reent = *_Thread_libc_reent; *_Thread_libc_reent = heir->libc_reent; } _User_extensions_Thread_switch( executing, heir ); 8006768: b9 60 08 00 mv r1,r11 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 800676c: 5a 63 00 00 sw (r19+0),r3 8006770: 2b 83 00 50 lw r3,(sp+80) if ( _Thread_libc_reent ) { executing->libc_reent = *_Thread_libc_reent; *_Thread_libc_reent = heir->libc_reent; } _User_extensions_Thread_switch( executing, heir ); 8006774: b9 80 10 00 mv r2,r12 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 8006778: 5a 63 00 04 sw (r19+4),r3 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 800677c: 44 80 00 05 be r4,r0,8006790 <_Thread_Dispatch+0x130> <== NEVER TAKEN executing->libc_reent = *_Thread_libc_reent; 8006780: 28 83 00 00 lw r3,(r4+0) 8006784: 59 63 01 24 sw (r11+292),r3 *_Thread_libc_reent = heir->libc_reent; 8006788: 29 83 01 24 lw r3,(r12+292) 800678c: 58 83 00 00 sw (r4+0),r3 } _User_extensions_Thread_switch( executing, heir ); 8006790: f8 00 04 b6 calli 8007a68 <_User_extensions_Thread_switch> if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 8006794: 35 61 00 d0 addi r1,r11,208 8006798: 35 82 00 d0 addi r2,r12,208 800679c: f8 00 05 98 calli 8007dfc <_CPU_Context_switch> if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; 80067a0: 29 cb 00 00 lw r11,(r14+0) _ISR_Disable( level ); 80067a4: 90 00 20 00 rcsr r4,IE 80067a8: a0 98 08 00 and r1,r4,r24 80067ac: d0 01 00 00 wcsr IE,r1 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Context_Switch_necessary == true ) { 80067b0: 41 e5 00 00 lbu r5,(r15+0) 80067b4: 20 a5 00 ff andi r5,r5,0xff 80067b8: 5c a0 ff d7 bne r5,r0,8006714 <_Thread_Dispatch+0xb4> executing = _Thread_Executing; _ISR_Disable( level ); } _Thread_Dispatch_disable_level = 0; 80067bc: 59 a5 00 00 sw (r13+0),r5 _ISR_Enable( level ); 80067c0: d0 04 00 00 wcsr IE,r4 if ( _Thread_Do_post_task_switch_extension || 80067c4: 78 01 08 02 mvhi r1,0x802 80067c8: 38 21 59 e4 ori r1,r1,0x59e4 80067cc: 28 21 00 00 lw r1,(r1+0) 80067d0: 5c 20 00 03 bne r1,r0,80067dc <_Thread_Dispatch+0x17c> executing->do_post_task_switch_extension ) { 80067d4: 41 62 00 74 lbu r2,(r11+116) 80067d8: 44 41 00 04 be r2,r1,80067e8 <_Thread_Dispatch+0x188> executing->do_post_task_switch_extension = false; 80067dc: 34 01 00 00 mvi r1,0 80067e0: 31 61 00 74 sb (r11+116),r1 _API_extensions_Run_postswitch(); 80067e4: fb ff f9 22 calli 8004c6c <_API_extensions_Run_postswitch> } } 80067e8: 2b 9d 00 04 lw ra,(sp+4) 80067ec: 2b 8b 00 40 lw r11,(sp+64) 80067f0: 2b 8c 00 3c lw r12,(sp+60) 80067f4: 2b 8d 00 38 lw r13,(sp+56) 80067f8: 2b 8e 00 34 lw r14,(sp+52) 80067fc: 2b 8f 00 30 lw r15,(sp+48) 8006800: 2b 90 00 2c lw r16,(sp+44) 8006804: 2b 91 00 28 lw r17,(sp+40) 8006808: 2b 92 00 24 lw r18,(sp+36) 800680c: 2b 93 00 20 lw r19,(sp+32) 8006810: 2b 94 00 1c lw r20,(sp+28) 8006814: 2b 95 00 18 lw r21,(sp+24) 8006818: 2b 96 00 14 lw r22,(sp+20) 800681c: 2b 97 00 10 lw r23,(sp+16) 8006820: 2b 98 00 0c lw r24,(sp+12) 8006824: 2b 99 00 08 lw r25,(sp+8) 8006828: 37 9c 00 50 addi sp,sp,80 800682c: c3 a0 00 00 ret 0800fbcc <_Thread_Evaluate_mode>: bool _Thread_Evaluate_mode( void ) { Thread_Control *executing; executing = _Thread_Executing; 800fbcc: 78 01 08 02 mvhi r1,0x802 800fbd0: 38 21 5a 00 ori r1,r1,0x5a00 800fbd4: 28 21 00 00 lw r1,(r1+0) if ( !_States_Is_ready( executing->current_state ) || 800fbd8: 28 22 00 10 lw r2,(r1+16) 800fbdc: 5c 40 00 07 bne r2,r0,800fbf8 <_Thread_Evaluate_mode+0x2c> <== NEVER TAKEN 800fbe0: 78 02 08 02 mvhi r2,0x802 800fbe4: 38 42 59 d0 ori r2,r2,0x59d0 800fbe8: 28 42 00 00 lw r2,(r2+0) 800fbec: 44 22 00 09 be r1,r2,800fc10 <_Thread_Evaluate_mode+0x44> ( !_Thread_Is_heir( executing ) && executing->is_preemptible ) ) { 800fbf0: 40 21 00 75 lbu r1,(r1+117) 800fbf4: 44 20 00 07 be r1,r0,800fc10 <_Thread_Evaluate_mode+0x44> <== NEVER TAKEN _Context_Switch_necessary = true; 800fbf8: 78 01 08 02 mvhi r1,0x802 800fbfc: 38 21 5a 10 ori r1,r1,0x5a10 800fc00: 34 02 00 01 mvi r2,1 800fc04: 30 22 00 00 sb (r1+0),r2 800fc08: b8 40 08 00 mv r1,r2 return true; 800fc0c: c3 a0 00 00 ret 800fc10: 34 01 00 00 mvi r1,0 } return false; } 800fc14: c3 a0 00 00 ret 08012960 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 8012960: 37 9c ff f4 addi sp,sp,-12 8012964: 5b 8b 00 0c sw (sp+12),r11 8012968: 5b 8c 00 08 sw (sp+8),r12 801296c: 5b 9d 00 04 sw (sp+4),ra #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 8012970: 78 01 08 02 mvhi r1,0x802 8012974: 38 21 5a 00 ori r1,r1,0x5a00 8012978: 28 2b 00 00 lw r11,(r1+0) /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 801297c: 29 61 00 b8 lw r1,(r11+184) _ISR_Set_level(level); 8012980: 64 21 00 00 cmpei r1,r1,0 8012984: d0 01 00 00 wcsr IE,r1 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 8012988: 78 02 08 02 mvhi r2,0x802 801298c: 38 42 57 82 ori r2,r2,0x5782 8012990: 40 4c 00 00 lbu r12,(r2+0) doneConstructors = 1; 8012994: 34 03 00 01 mvi r3,1 /* * 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 ); 8012998: b9 60 08 00 mv r1,r11 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; doneConstructors = 1; 801299c: 30 43 00 00 sb (r2+0),r3 /* * 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 ); 80129a0: fb ff d3 ab calli 800784c <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 80129a4: fb ff cf a3 calli 8006830 <_Thread_Enable_dispatch> /* * _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) */ { 80129a8: 5d 80 00 02 bne r12,r0,80129b0 <_Thread_Handler+0x50> INIT_NAME (); 80129ac: fb ff b5 95 calli 8000000 } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 80129b0: 29 61 00 a0 lw r1,(r11+160) 80129b4: 5c 20 00 04 bne r1,r0,80129c4 <_Thread_Handler+0x64> executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 80129b8: 29 62 00 9c lw r2,(r11+156) 80129bc: 29 61 00 a8 lw r1,(r11+168) 80129c0: e0 00 00 05 bi 80129d4 <_Thread_Handler+0x74> executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { 80129c4: 34 02 00 01 mvi r2,1 80129c8: 5c 22 00 05 bne r1,r2,80129dc <_Thread_Handler+0x7c> <== NEVER TAKEN executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 80129cc: 29 62 00 9c lw r2,(r11+156) 80129d0: 29 61 00 a4 lw r1,(r11+164) 80129d4: d8 40 00 00 call r2 executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = 80129d8: 59 61 00 28 sw (r11+40),r1 * 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 ); 80129dc: b9 60 08 00 mv r1,r11 80129e0: fb ff d3 b2 calli 80078a8 <_User_extensions_Thread_exitted> _Internal_error_Occurred( 80129e4: 34 01 00 00 mvi r1,0 80129e8: 34 02 00 01 mvi r2,1 80129ec: 34 03 00 06 mvi r3,6 80129f0: fb ff cb 7e calli 80057e8 <_Internal_error_Occurred> 08006b74 <_Thread_Handler_initialization>: * * Output parameters: NONE */ void _Thread_Handler_initialization(void) { 8006b74: 37 9c ff f0 addi sp,sp,-16 8006b78: 5b 8b 00 10 sw (sp+16),r11 8006b7c: 5b 8c 00 0c sw (sp+12),r12 8006b80: 5b 8d 00 08 sw (sp+8),r13 8006b84: 5b 9d 00 04 sw (sp+4),ra uint32_t maximum_extensions; #if defined(RTEMS_MULTIPROCESSING) uint32_t maximum_proxies; #endif ticks_per_timeslice = Configuration.ticks_per_timeslice; 8006b88: 78 01 08 02 mvhi r1,0x802 8006b8c: 38 21 50 ac ori r1,r1,0x50ac #endif /* * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) 8006b90: 28 22 00 20 lw r2,(r1+32) 8006b94: 28 29 00 24 lw r9,(r1+36) uint32_t maximum_extensions; #if defined(RTEMS_MULTIPROCESSING) uint32_t maximum_proxies; #endif ticks_per_timeslice = Configuration.ticks_per_timeslice; 8006b98: 28 2a 00 10 lw r10,(r1+16) #endif /* * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) 8006b9c: 64 42 00 00 cmpei r2,r2,0 8006ba0: 65 29 00 00 cmpei r9,r9,0 #if defined(RTEMS_MULTIPROCESSING) uint32_t maximum_proxies; #endif ticks_per_timeslice = Configuration.ticks_per_timeslice; maximum_extensions = Configuration.maximum_extensions; 8006ba4: 28 2d 00 08 lw r13,(r1+8) #endif /* * BOTH stacks hooks must be set or both must be NULL. * Do not allow mixture. */ if ( !( (!Configuration.stack_allocate_hook) 8006ba8: 99 22 48 00 xor r9,r9,r2 8006bac: b9 20 58 00 mv r11,r9 8006bb0: 45 20 00 05 be r9,r0,8006bc4 <_Thread_Handler_initialization+0x50><== ALWAYS TAKEN == (!Configuration.stack_free_hook) ) ) _Internal_error_Occurred( 8006bb4: 34 01 00 00 mvi r1,0 <== NOT EXECUTED 8006bb8: 34 02 00 01 mvi r2,1 <== NOT EXECUTED 8006bbc: 34 03 00 0f mvi r3,15 <== NOT EXECUTED 8006bc0: fb ff fb 0a calli 80057e8 <_Internal_error_Occurred> <== NOT EXECUTED _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; _Thread_Ready_chain = (Chain_Control *) _Workspace_Allocate_or_fatal_error( 8006bc4: 78 0c 08 02 mvhi r12,0x802 8006bc8: 39 8c 50 a8 ori r12,r12,0x50a8 8006bcc: 41 81 00 00 lbu r1,(r12+0) INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_BAD_STACK_HOOK ); _Context_Switch_necessary = false; 8006bd0: 78 08 08 02 mvhi r8,0x802 _Thread_Executing = NULL; 8006bd4: 78 05 08 02 mvhi r5,0x802 _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; _Thread_Ready_chain = (Chain_Control *) _Workspace_Allocate_or_fatal_error( 8006bd8: 34 21 00 01 addi r1,r1,1 INTERNAL_ERROR_BAD_STACK_HOOK ); _Context_Switch_necessary = false; _Thread_Executing = NULL; _Thread_Heir = NULL; 8006bdc: 78 04 08 02 mvhi r4,0x802 #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Thread_Allocated_fp = NULL; #endif _Thread_Do_post_task_switch_extension = 0; 8006be0: 78 03 08 02 mvhi r3,0x802 _Thread_Maximum_extensions = maximum_extensions; 8006be4: 78 07 08 02 mvhi r7,0x802 _Thread_Ticks_per_timeslice = ticks_per_timeslice; 8006be8: 78 06 08 02 mvhi r6,0x802 _Thread_Heir = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Thread_Allocated_fp = NULL; #endif _Thread_Do_post_task_switch_extension = 0; 8006bec: 38 63 59 e4 ori r3,r3,0x59e4 _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; 8006bf0: 38 c6 58 d4 ori r6,r6,0x58d4 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_BAD_STACK_HOOK ); _Context_Switch_necessary = false; 8006bf4: 39 08 5a 10 ori r8,r8,0x5a10 _Thread_Executing = NULL; 8006bf8: 38 a5 5a 00 ori r5,r5,0x5a00 _Thread_Heir = NULL; 8006bfc: 38 84 59 d0 ori r4,r4,0x59d0 _Thread_Allocated_fp = NULL; #endif _Thread_Do_post_task_switch_extension = 0; _Thread_Maximum_extensions = maximum_extensions; 8006c00: 38 e7 59 e0 ori r7,r7,0x59e0 _Thread_Ticks_per_timeslice = ticks_per_timeslice; _Thread_Ready_chain = (Chain_Control *) _Workspace_Allocate_or_fatal_error( 8006c04: b4 21 10 00 add r2,r1,r1 _Thread_Do_post_task_switch_extension = 0; _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; 8006c08: 58 ca 00 00 sw (r6+0),r10 _Thread_Heir = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Thread_Allocated_fp = NULL; #endif _Thread_Do_post_task_switch_extension = 0; 8006c0c: 58 69 00 00 sw (r3+0),r9 _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; _Thread_Ready_chain = (Chain_Control *) _Workspace_Allocate_or_fatal_error( 8006c10: b4 41 08 00 add r1,r2,r1 INTERNAL_ERROR_CORE, true, INTERNAL_ERROR_BAD_STACK_HOOK ); _Context_Switch_necessary = false; 8006c14: 31 09 00 00 sb (r8+0),r9 _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; _Thread_Ready_chain = (Chain_Control *) _Workspace_Allocate_or_fatal_error( 8006c18: 34 02 00 02 mvi r2,2 _Thread_Allocated_fp = NULL; #endif _Thread_Do_post_task_switch_extension = 0; _Thread_Maximum_extensions = maximum_extensions; 8006c1c: 58 ed 00 00 sw (r7+0),r13 true, INTERNAL_ERROR_BAD_STACK_HOOK ); _Context_Switch_necessary = false; _Thread_Executing = NULL; 8006c20: 58 a9 00 00 sw (r5+0),r9 _Thread_Heir = NULL; 8006c24: 58 89 00 00 sw (r4+0),r9 _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; _Thread_Ready_chain = (Chain_Control *) _Workspace_Allocate_or_fatal_error( 8006c28: fb ff e7 e9 calli 8000bcc <__ashlsi3> 8006c2c: f8 00 04 34 calli 8007cfc <_Workspace_Allocate_or_fatal_error> 8006c30: 78 02 08 02 mvhi r2,0x802 (PRIORITY_MAXIMUM + 1) * sizeof(Chain_Control) ); for ( index=0; index <= PRIORITY_MAXIMUM ; index++ ) 8006c34: 41 83 00 00 lbu r3,(r12+0) _Thread_Maximum_extensions = maximum_extensions; _Thread_Ticks_per_timeslice = ticks_per_timeslice; _Thread_Ready_chain = (Chain_Control *) _Workspace_Allocate_or_fatal_error( 8006c38: 38 42 58 d0 ori r2,r2,0x58d0 8006c3c: 58 41 00 00 sw (r2+0),r1 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 8006c40: b9 60 30 00 mv r6,r11 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 8006c44: 34 22 00 04 addi r2,r1,4 8006c48: 58 22 00 00 sw (r1+0),r2 the_chain->permanent_null = NULL; 8006c4c: 58 26 00 04 sw (r1+4),r6 the_chain->last = _Chain_Head(the_chain); 8006c50: 58 21 00 08 sw (r1+8),r1 (PRIORITY_MAXIMUM + 1) * sizeof(Chain_Control) ); for ( index=0; index <= PRIORITY_MAXIMUM ; index++ ) 8006c54: 35 6b 00 01 addi r11,r11,1 8006c58: 34 21 00 0c addi r1,r1,12 8006c5c: 50 6b ff fa bgeu r3,r11,8006c44 <_Thread_Handler_initialization+0xd0> /* * Initialize this class of objects. */ _Objects_Initialize_information( 8006c60: 34 02 00 01 mvi r2,1 8006c64: 78 01 08 02 mvhi r1,0x802 8006c68: 38 21 5a a0 ori r1,r1,0x5aa0 8006c6c: b8 40 18 00 mv r3,r2 8006c70: b8 40 20 00 mv r4,r2 8006c74: 34 05 01 3c mvi r5,316 8006c78: 34 07 00 08 mvi r7,8 8006c7c: fb ff fc a7 calli 8005f18 <_Objects_Initialize_information> false, /* true if this is a global object class */ NULL /* Proxy extraction support callout */ #endif ); } 8006c80: 2b 9d 00 04 lw ra,(sp+4) 8006c84: 2b 8b 00 10 lw r11,(sp+16) 8006c88: 2b 8c 00 0c lw r12,(sp+12) 8006c8c: 2b 8d 00 08 lw r13,(sp+8) 8006c90: 37 9c 00 10 addi sp,sp,16 8006c94: c3 a0 00 00 ret 08006954 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 8006954: 37 9c ff e0 addi sp,sp,-32 8006958: 5b 8b 00 20 sw (sp+32),r11 800695c: 5b 8c 00 1c sw (sp+28),r12 8006960: 5b 8d 00 18 sw (sp+24),r13 8006964: 5b 8e 00 14 sw (sp+20),r14 8006968: 5b 8f 00 10 sw (sp+16),r15 800696c: 5b 90 00 0c sw (sp+12),r16 8006970: 5b 91 00 08 sw (sp+8),r17 8006974: 5b 9d 00 04 sw (sp+4),ra /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; 8006978: 34 05 00 00 mvi r5,0 800697c: 58 45 01 28 sw (r2+296),r5 8006980: 58 45 01 2c sw (r2+300),r5 8006984: 58 45 01 30 sw (r2+304),r5 extensions_area = NULL; the_thread->libc_reent = NULL; 8006988: 58 45 01 24 sw (r2+292),r5 Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { 800698c: b8 40 58 00 mv r11,r2 8006990: b8 60 60 00 mv r12,r3 8006994: b8 20 80 00 mv r16,r1 8006998: b8 80 68 00 mv r13,r4 800699c: b8 c0 70 00 mv r14,r6 80069a0: b9 00 78 00 mv r15,r8 80069a4: 20 f1 00 ff andi r17,r7,0xff if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { 80069a8: 5c 65 00 0e bne r3,r5,80069e0 <_Thread_Initialize+0x8c> actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 80069ac: b8 40 08 00 mv r1,r2 80069b0: b8 80 10 00 mv r2,r4 80069b4: f8 00 02 ee calli 800756c <_Thread_Stack_Allocate> if ( !actual_stack_size || actual_stack_size < stack_size ) 80069b8: f5 a1 68 00 cmpgu r13,r13,r1 return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); 80069bc: b8 20 28 00 mv r5,r1 if ( !actual_stack_size || actual_stack_size < stack_size ) 80069c0: 64 21 00 00 cmpei r1,r1,0 80069c4: b9 80 48 00 mv r9,r12 80069c8: b9 a1 68 00 or r13,r13,r1 80069cc: 5d ac 00 5f bne r13,r12,8006b48 <_Thread_Initialize+0x1f4> return false; /* stack allocation failed */ stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; 80069d0: 34 01 00 01 mvi r1,1 80069d4: 31 61 00 c0 sb (r11+192),r1 if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; 80069d8: 29 6c 00 cc lw r12,(r11+204) 80069dc: e0 00 00 03 bi 80069e8 <_Thread_Initialize+0x94> the_thread->Start.core_allocated_stack = true; } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; 80069e0: 30 45 00 c0 sb (r2+192),r5 80069e4: b8 80 28 00 mv r5,r4 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 80069e8: 34 04 00 00 mvi r4,0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { 80069ec: 78 02 08 02 mvhi r2,0x802 the_watchdog->routine = routine; the_watchdog->id = id; 80069f0: 59 64 00 68 sw (r11+104),r4 80069f4: 38 42 59 e0 ori r2,r2,0x59e0 80069f8: 28 43 00 00 lw r3,(r2+0) Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; 80069fc: 59 6c 00 c8 sw (r11+200),r12 the_stack->size = size; 8006a00: 59 65 00 c4 sw (r11+196),r5 the_watchdog->user_data = user_data; 8006a04: 59 64 00 6c sw (r11+108),r4 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 8006a08: 59 64 00 50 sw (r11+80),r4 the_watchdog->routine = routine; 8006a0c: 59 64 00 64 sw (r11+100),r4 8006a10: b8 60 60 00 mv r12,r3 8006a14: 44 64 00 07 be r3,r4,8006a30 <_Thread_Initialize+0xdc> extensions_area = _Workspace_Allocate( 8006a18: 34 61 00 01 addi r1,r3,1 8006a1c: 34 02 00 02 mvi r2,2 8006a20: fb ff e8 6b calli 8000bcc <__ashlsi3> 8006a24: f8 00 04 c5 calli 8007d38 <_Workspace_Allocate> 8006a28: b8 20 60 00 mv r12,r1 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) 8006a2c: 44 20 00 35 be r1,r0,8006b00 <_Thread_Initialize+0x1ac> goto failed; } the_thread->extensions = (void **) extensions_area; 8006a30: 59 6c 01 34 sw (r11+308),r12 * 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 ) { 8006a34: 45 80 00 0e be r12,r0,8006a6c <_Thread_Initialize+0x118> for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) 8006a38: 78 02 08 02 mvhi r2,0x802 8006a3c: 38 42 59 e0 ori r2,r2,0x59e0 8006a40: 34 03 00 00 mvi r3,0 8006a44: 28 44 00 00 lw r4,(r2+0) the_thread->extensions[i] = NULL; 8006a48: b8 60 08 00 mv r1,r3 * 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++ ) 8006a4c: b8 60 10 00 mv r2,r3 8006a50: e0 00 00 06 bi 8006a68 <_Thread_Initialize+0x114> the_thread->extensions[i] = NULL; 8006a54: 29 65 01 34 lw r5,(r11+308) * 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++ ) 8006a58: 34 42 00 01 addi r2,r2,1 the_thread->extensions[i] = NULL; 8006a5c: b4 a3 28 00 add r5,r5,r3 8006a60: 58 a1 00 00 sw (r5+0),r1 * 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++ ) 8006a64: 34 63 00 04 addi r3,r3,4 8006a68: 50 82 ff fb bgeu r4,r2,8006a54 <_Thread_Initialize+0x100> * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; 8006a6c: 2b 81 00 24 lw r1,(sp+36) /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; 8006a70: 31 71 00 ac sb (r11+172),r17 the_thread->Start.budget_algorithm = budget_algorithm; 8006a74: 59 6f 00 b0 sw (r11+176),r15 the_thread->Start.budget_callout = budget_callout; 8006a78: 59 61 00 b4 sw (r11+180),r1 switch ( budget_algorithm ) { 8006a7c: 34 01 00 02 mvi r1,2 8006a80: 5d e1 00 05 bne r15,r1,8006a94 <_Thread_Initialize+0x140> 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; 8006a84: 78 02 08 02 mvhi r2,0x802 8006a88: 38 42 58 d4 ori r2,r2,0x58d4 8006a8c: 28 42 00 00 lw r2,(r2+0) 8006a90: 59 62 00 78 sw (r11+120),r2 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 8006a94: 2b 81 00 28 lw r1,(sp+40) the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; 8006a98: 34 0d 00 00 mvi r13,0 #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; 8006a9c: 34 0f 00 01 mvi r15,1 #if defined(RTEMS_ITRON_API) the_thread->suspend_count = 0; #endif the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority ); 8006aa0: b9 c0 10 00 mv r2,r14 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; 8006aa4: 59 61 00 b8 sw (r11+184),r1 the_thread->Wait.queue = NULL; the_thread->resource_count = 0; #if defined(RTEMS_ITRON_API) the_thread->suspend_count = 0; #endif the_thread->real_priority = priority; 8006aa8: 59 6e 00 18 sw (r11+24),r14 the_thread->Start.initial_priority = priority; 8006aac: 59 6e 00 bc sw (r11+188),r14 _Thread_Set_priority( the_thread, priority ); 8006ab0: b9 60 08 00 mv r1,r11 #endif } the_thread->Start.isr_level = isr_level; the_thread->current_state = STATES_DORMANT; 8006ab4: 59 6f 00 10 sw (r11+16),r15 the_thread->Wait.queue = NULL; 8006ab8: 59 6d 00 44 sw (r11+68),r13 the_thread->resource_count = 0; 8006abc: 59 6d 00 1c sw (r11+28),r13 #if defined(RTEMS_ITRON_API) the_thread->suspend_count = 0; #endif the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; _Thread_Set_priority( the_thread, priority ); 8006ac0: f8 00 01 e3 calli 800724c <_Thread_Set_priority> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8006ac4: 29 61 00 08 lw r1,(r11+8) 8006ac8: 2a 0e 00 1c lw r14,(r16+28) 8006acc: 34 02 00 02 mvi r2,2 /* * Initialize the CPU usage statistics */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Set_to_zero( &the_thread->cpu_time_used ); 8006ad0: 59 6d 00 88 sw (r11+136),r13 8006ad4: 59 6d 00 84 sw (r11+132),r13 8006ad8: 20 21 ff ff andi r1,r1,0xffff 8006adc: fb ff e8 3c calli 8000bcc <__ashlsi3> 8006ae0: b5 c1 08 00 add r1,r14,r1 8006ae4: 58 2b 00 00 sw (r1+0),r11 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 8006ae8: 2b 81 00 2c lw r1,(sp+44) 8006aec: 59 61 00 0c sw (r11+12),r1 * 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 ); 8006af0: b9 60 08 00 mv r1,r11 8006af4: f8 00 03 a3 calli 8007980 <_User_extensions_Thread_create> if ( extension_status ) 8006af8: b9 e0 48 00 mv r9,r15 8006afc: 5c 2d 00 13 bne r1,r13,8006b48 <_Thread_Initialize+0x1f4> return true; failed: if ( the_thread->libc_reent ) 8006b00: 29 61 01 24 lw r1,(r11+292) 8006b04: 44 20 00 02 be r1,r0,8006b0c <_Thread_Initialize+0x1b8> _Workspace_Free( the_thread->libc_reent ); 8006b08: f8 00 04 97 calli 8007d64 <_Workspace_Free> for ( i=0 ; i <= THREAD_API_LAST ; i++ ) if ( the_thread->API_Extensions[i] ) 8006b0c: 29 61 01 28 lw r1,(r11+296) 8006b10: 44 20 00 02 be r1,r0,8006b18 <_Thread_Initialize+0x1c4> _Workspace_Free( the_thread->API_Extensions[i] ); 8006b14: f8 00 04 94 calli 8007d64 <_Workspace_Free> 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] ) 8006b18: 29 61 01 2c lw r1,(r11+300) 8006b1c: 44 20 00 02 be r1,r0,8006b24 <_Thread_Initialize+0x1d0> _Workspace_Free( the_thread->API_Extensions[i] ); 8006b20: f8 00 04 91 calli 8007d64 <_Workspace_Free> 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] ) 8006b24: 29 61 01 30 lw r1,(r11+304) 8006b28: 44 20 00 02 be r1,r0,8006b30 <_Thread_Initialize+0x1dc> <== ALWAYS TAKEN _Workspace_Free( the_thread->API_Extensions[i] ); 8006b2c: f8 00 04 8e calli 8007d64 <_Workspace_Free> <== NOT EXECUTED if ( extensions_area ) 8006b30: 45 80 00 03 be r12,r0,8006b3c <_Thread_Initialize+0x1e8> (void) _Workspace_Free( extensions_area ); 8006b34: b9 80 08 00 mv r1,r12 8006b38: f8 00 04 8b calli 8007d64 <_Workspace_Free> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( fp_area ) (void) _Workspace_Free( fp_area ); #endif _Thread_Stack_Free( the_thread ); 8006b3c: b9 60 08 00 mv r1,r11 8006b40: f8 00 02 a8 calli 80075e0 <_Thread_Stack_Free> 8006b44: 34 09 00 00 mvi r9,0 return false; } 8006b48: b9 20 08 00 mv r1,r9 8006b4c: 2b 9d 00 04 lw ra,(sp+4) 8006b50: 2b 8b 00 20 lw r11,(sp+32) 8006b54: 2b 8c 00 1c lw r12,(sp+28) 8006b58: 2b 8d 00 18 lw r13,(sp+24) 8006b5c: 2b 8e 00 14 lw r14,(sp+20) 8006b60: 2b 8f 00 10 lw r15,(sp+16) 8006b64: 2b 90 00 0c lw r16,(sp+12) 8006b68: 2b 91 00 08 lw r17,(sp+8) 8006b6c: 37 9c 00 20 addi sp,sp,32 8006b70: c3 a0 00 00 ret 08005cf4 <_Thread_Restart>: bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { 8005cf4: 37 9c ff f0 addi sp,sp,-16 8005cf8: 5b 8b 00 08 sw (sp+8),r11 8005cfc: 5b 9d 00 04 sw (sp+4),ra if ( !_States_Is_dormant( the_thread->current_state ) ) { 8005d00: 28 25 00 10 lw r5,(r1+16) 8005d04: 34 04 00 00 mvi r4,0 bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { 8005d08: b8 20 58 00 mv r11,r1 if ( !_States_Is_dormant( the_thread->current_state ) ) { 8005d0c: 20 a5 00 01 andi r5,r5,0x1 8005d10: 5c a4 00 16 bne r5,r4,8005d68 <_Thread_Restart+0x74> _Thread_Set_transient( the_thread ); 8005d14: 5b 82 00 10 sw (sp+16),r2 8005d18: 5b 83 00 0c sw (sp+12),r3 8005d1c: f8 00 00 bb calli 8006008 <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); 8005d20: 2b 82 00 10 lw r2,(sp+16) 8005d24: 2b 83 00 0c lw r3,(sp+12) 8005d28: b9 60 08 00 mv r1,r11 8005d2c: f8 00 13 d1 calli 800ac70 <_Thread_Reset> _Thread_Load_environment( the_thread ); 8005d30: b9 60 08 00 mv r1,r11 8005d34: f8 00 12 a6 calli 800a7cc <_Thread_Load_environment> _Thread_Ready( the_thread ); 8005d38: b9 60 08 00 mv r1,r11 8005d3c: f8 00 13 69 calli 800aae0 <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); 8005d40: b9 60 08 00 mv r1,r11 8005d44: f8 00 02 61 calli 80066c8 <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) 8005d48: 78 01 08 02 mvhi r1,0x802 8005d4c: 38 21 29 c0 ori r1,r1,0x29c0 8005d50: 28 21 00 00 lw r1,(r1+0) 8005d54: 34 04 00 01 mvi r4,1 8005d58: 5d 61 00 04 bne r11,r1,8005d68 <_Thread_Restart+0x74> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( _Thread_Executing->fp_context != NULL ) _Context_Restore_fp( &_Thread_Executing->fp_context ); #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); 8005d5c: 35 61 00 d0 addi r1,r11,208 8005d60: f8 00 03 df calli 8006cdc <_CPU_Context_restore> 8005d64: 34 04 00 01 mvi r4,1 <== NOT EXECUTED return true; } return false; } 8005d68: b8 80 08 00 mv r1,r4 8005d6c: 2b 9d 00 04 lw ra,(sp+4) 8005d70: 2b 8b 00 08 lw r11,(sp+8) 8005d74: 37 9c 00 10 addi sp,sp,16 8005d78: c3 a0 00 00 ret 0800a254 <_Thread_Resume>: { ISR_Level level; States_Control current_state; _ISR_Disable( level ); 800a254: 90 00 18 00 rcsr r3,IE 800a258: 34 05 ff fe mvi r5,-2 800a25c: a0 65 28 00 and r5,r3,r5 800a260: d0 05 00 00 wcsr IE,r5 _ISR_Enable( level ); return; } #endif current_state = the_thread->current_state; 800a264: 28 22 00 10 lw r2,(r1+16) if ( current_state & STATES_SUSPENDED ) { 800a268: 20 44 00 02 andi r4,r2,0x2 800a26c: 44 80 00 2b be r4,r0,800a318 <_Thread_Resume+0xc4> <== NEVER TAKEN 800a270: 34 04 ff fd mvi r4,-3 800a274: a0 44 10 00 and r2,r2,r4 current_state = 800a278: 58 22 00 10 sw (r1+16),r2 the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); if ( _States_Is_ready( current_state ) ) { 800a27c: 5c 40 00 27 bne r2,r0,800a318 <_Thread_Resume+0xc4> RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 800a280: 28 26 00 90 lw r6,(r1+144) 800a284: 2c 27 00 96 lhu r7,(r1+150) _Priority_Add_to_bit_map( &the_thread->Priority_map ); _Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node); 800a288: 28 24 00 8c lw r4,(r1+140) 800a28c: 2c c8 00 00 lhu r8,(r6+0) _Priority_Major_bit_map |= the_priority_map->ready_major; 800a290: 78 02 08 02 mvhi r2,0x802 800a294: 38 42 4a 34 ori r2,r2,0x4a34 RTEMS_INLINE_ROUTINE void _Priority_Add_to_bit_map ( Priority_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 800a298: b9 07 38 00 or r7,r8,r7 800a29c: 0c c7 00 00 sh (r6+0),r7 _Priority_Major_bit_map |= the_priority_map->ready_major; 800a2a0: 2c 47 00 00 lhu r7,(r2+0) 800a2a4: 2c 28 00 94 lhu r8,(r1+148) Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 800a2a8: 34 86 00 04 addi r6,r4,4 800a2ac: 58 26 00 00 sw (r1+0),r6 old_last_node = the_chain->last; 800a2b0: 28 86 00 08 lw r6,(r4+8) 800a2b4: b9 07 38 00 or r7,r8,r7 the_chain->last = the_node; 800a2b8: 58 81 00 08 sw (r4+8),r1 800a2bc: 20 e4 ff ff andi r4,r7,0xffff 800a2c0: 0c 44 00 00 sh (r2+0),r4 old_last_node->next = the_node; the_node->previous = old_last_node; 800a2c4: 58 26 00 04 sw (r1+4),r6 Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 800a2c8: 58 c1 00 00 sw (r6+0),r1 _ISR_Flash( level ); 800a2cc: d0 03 00 00 wcsr IE,r3 800a2d0: d0 05 00 00 wcsr IE,r5 if ( the_thread->current_priority < _Thread_Heir->current_priority ) { 800a2d4: 78 02 08 02 mvhi r2,0x802 800a2d8: 38 42 4a 10 ori r2,r2,0x4a10 800a2dc: 28 44 00 00 lw r4,(r2+0) 800a2e0: 28 25 00 14 lw r5,(r1+20) 800a2e4: 28 84 00 14 lw r4,(r4+20) 800a2e8: 50 a4 00 0c bgeu r5,r4,800a318 <_Thread_Resume+0xc4> _Thread_Heir = the_thread; if ( _Thread_Executing->is_preemptible || 800a2ec: 78 04 08 02 mvhi r4,0x802 800a2f0: 38 84 4a 40 ori r4,r4,0x4a40 800a2f4: 28 84 00 00 lw r4,(r4+0) _Chain_Append_unprotected(the_thread->ready, &the_thread->Object.Node); _ISR_Flash( level ); if ( the_thread->current_priority < _Thread_Heir->current_priority ) { _Thread_Heir = the_thread; 800a2f8: 58 41 00 00 sw (r2+0),r1 if ( _Thread_Executing->is_preemptible || 800a2fc: 40 81 00 75 lbu r1,(r4+117) 800a300: 5c 20 00 02 bne r1,r0,800a308 <_Thread_Resume+0xb4> 800a304: 5c a1 00 05 bne r5,r1,800a318 <_Thread_Resume+0xc4> <== ALWAYS TAKEN the_thread->current_priority == 0 ) _Context_Switch_necessary = true; 800a308: 78 01 08 02 mvhi r1,0x802 800a30c: 38 21 4a 50 ori r1,r1,0x4a50 800a310: 34 02 00 01 mvi r2,1 800a314: 30 22 00 00 sb (r1+0),r2 } } } _ISR_Enable( level ); 800a318: d0 03 00 00 wcsr IE,r3 } 800a31c: c3 a0 00 00 ret 0800bffc <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 800bffc: 37 9c ff f8 addi sp,sp,-8 800c000: 5b 8b 00 08 sw (sp+8),r11 800c004: 5b 9d 00 04 sw (sp+4),ra Thread_Control *executing; executing = _Thread_Executing; 800c008: 78 01 08 02 mvhi r1,0x802 800c00c: 38 21 5a a0 ori r1,r1,0x5aa0 800c010: 28 2b 00 00 lw r11,(r1+0) /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 800c014: 41 61 00 75 lbu r1,(r11+117) 800c018: 44 20 00 1b be r1,r0,800c084 <_Thread_Tickle_timeslice+0x88> return; if ( !_States_Is_ready( executing->current_state ) ) 800c01c: 29 61 00 10 lw r1,(r11+16) 800c020: 5c 20 00 19 bne r1,r0,800c084 <_Thread_Tickle_timeslice+0x88> /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 800c024: 29 61 00 7c lw r1,(r11+124) 800c028: 44 20 00 17 be r1,r0,800c084 <_Thread_Tickle_timeslice+0x88> 800c02c: 34 02 00 02 mvi r2,2 800c030: 50 41 00 04 bgeu r2,r1,800c040 <_Thread_Tickle_timeslice+0x44> 800c034: 34 02 00 03 mvi r2,3 800c038: 5c 22 00 13 bne r1,r2,800c084 <_Thread_Tickle_timeslice+0x88><== NEVER TAKEN 800c03c: e0 00 00 0b bi 800c068 <_Thread_Tickle_timeslice+0x6c> 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 ) { 800c040: 29 61 00 78 lw r1,(r11+120) 800c044: 34 21 ff ff addi r1,r1,-1 800c048: 59 61 00 78 sw (r11+120),r1 800c04c: 48 20 00 0e bg r1,r0,800c084 <_Thread_Tickle_timeslice+0x88> _Thread_Reset_timeslice(); 800c050: f8 00 13 4c calli 8010d80 <_Thread_Reset_timeslice> executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 800c054: 78 01 08 02 mvhi r1,0x802 800c058: 38 21 59 74 ori r1,r1,0x5974 800c05c: 28 21 00 00 lw r1,(r1+0) 800c060: 59 61 00 78 sw (r11+120),r1 800c064: e0 00 00 08 bi 800c084 <_Thread_Tickle_timeslice+0x88> } break; #if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: if ( --executing->cpu_time_budget == 0 ) 800c068: 29 61 00 78 lw r1,(r11+120) 800c06c: 34 21 ff ff addi r1,r1,-1 800c070: 59 61 00 78 sw (r11+120),r1 800c074: 5c 20 00 04 bne r1,r0,800c084 <_Thread_Tickle_timeslice+0x88> (*executing->budget_callout)( executing ); 800c078: 29 62 00 80 lw r2,(r11+128) 800c07c: b9 60 08 00 mv r1,r11 800c080: d8 40 00 00 call r2 break; #endif } } 800c084: 2b 9d 00 04 lw ra,(sp+4) 800c088: 2b 8b 00 08 lw r11,(sp+8) 800c08c: 37 9c 00 08 addi sp,sp,8 800c090: c3 a0 00 00 ret 0800cdbc <_Thread_Yield_processor>: { ISR_Level level; Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; 800cdbc: 78 01 08 02 mvhi r1,0x802 800cdc0: 38 21 aa f0 ori r1,r1,0xaaf0 800cdc4: 28 21 00 00 lw r1,(r1+0) ready = executing->ready; 800cdc8: 28 22 00 8c lw r2,(r1+140) _ISR_Disable( level ); 800cdcc: 90 00 20 00 rcsr r4,IE 800cdd0: 34 05 ff fe mvi r5,-2 800cdd4: a0 85 28 00 and r5,r4,r5 800cdd8: d0 05 00 00 wcsr IE,r5 if ( !_Chain_Has_only_one_node( ready ) ) { 800cddc: 28 47 00 00 lw r7,(r2+0) 800cde0: 28 46 00 08 lw r6,(r2+8) 800cde4: 78 03 08 02 mvhi r3,0x802 800cde8: 38 63 aa c0 ori r3,r3,0xaac0 800cdec: 44 e6 00 12 be r7,r6,800ce34 <_Thread_Yield_processor+0x78> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 800cdf0: 28 26 00 00 lw r6,(r1+0) previous = the_node->previous; 800cdf4: 28 27 00 04 lw r7,(r1+4) Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 800cdf8: 34 48 00 04 addi r8,r2,4 Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; previous->next = next; 800cdfc: 58 e6 00 00 sw (r7+0),r6 Chain_Node *the_node ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); 800ce00: 58 28 00 00 sw (r1+0),r8 Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 800ce04: 58 c7 00 04 sw (r6+4),r7 ) { Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; 800ce08: 28 46 00 08 lw r6,(r2+8) the_chain->last = the_node; 800ce0c: 58 41 00 08 sw (r2+8),r1 old_last_node->next = the_node; the_node->previous = old_last_node; 800ce10: 58 26 00 04 sw (r1+4),r6 Chain_Node *old_last_node; the_node->next = _Chain_Tail(the_chain); old_last_node = the_chain->last; the_chain->last = the_node; old_last_node->next = the_node; 800ce14: 58 c1 00 00 sw (r6+0),r1 _Chain_Extract_unprotected( &executing->Object.Node ); _Chain_Append_unprotected( ready, &executing->Object.Node ); _ISR_Flash( level ); 800ce18: d0 04 00 00 wcsr IE,r4 800ce1c: d0 05 00 00 wcsr IE,r5 if ( _Thread_Is_heir( executing ) ) 800ce20: 28 65 00 00 lw r5,(r3+0) 800ce24: 5c 25 00 06 bne r1,r5,800ce3c <_Thread_Yield_processor+0x80><== NEVER TAKEN _Thread_Heir = (Thread_Control *) ready->first; 800ce28: 28 42 00 00 lw r2,(r2+0) 800ce2c: 58 62 00 00 sw (r3+0),r2 800ce30: e0 00 00 03 bi 800ce3c <_Thread_Yield_processor+0x80> _Context_Switch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) 800ce34: 28 62 00 00 lw r2,(r3+0) 800ce38: 44 22 00 05 be r1,r2,800ce4c <_Thread_Yield_processor+0x90><== ALWAYS TAKEN _Context_Switch_necessary = true; 800ce3c: 78 01 08 02 mvhi r1,0x802 800ce40: 38 21 ab 00 ori r1,r1,0xab00 800ce44: 34 02 00 01 mvi r2,1 800ce48: 30 22 00 00 sb (r1+0),r2 _ISR_Enable( level ); 800ce4c: d0 04 00 00 wcsr IE,r4 } 800ce50: c3 a0 00 00 ret 08006f18 <_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 ) { 8006f18: 37 9c ff ec addi sp,sp,-20 8006f1c: 5b 8b 00 14 sw (sp+20),r11 8006f20: 5b 8c 00 10 sw (sp+16),r12 8006f24: 5b 8d 00 0c sw (sp+12),r13 8006f28: 5b 8e 00 08 sw (sp+8),r14 8006f2c: 5b 9d 00 04 sw (sp+4),ra Priority_Control priority; States_Control block_state; _Chain_Initialize_empty( &the_thread->Wait.Block2n ); priority = the_thread->current_priority; 8006f30: 28 4d 00 14 lw r13,(r2+20) Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 8006f34: b8 40 58 00 mv r11,r2 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 8006f38: 34 44 00 3c addi r4,r2,60 8006f3c: 59 64 00 38 sw (r11+56),r4 the_chain->permanent_null = NULL; the_chain->last = _Chain_Head(the_chain); 8006f40: 34 42 00 38 addi r2,r2,56 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 8006f44: 34 04 00 00 mvi r4,0 8006f48: b8 20 60 00 mv r12,r1 8006f4c: 59 64 00 3c sw (r11+60),r4 the_chain->last = _Chain_Head(the_chain); 8006f50: 59 62 00 40 sw (r11+64),r2 _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 ]; 8006f54: b9 a0 08 00 mv r1,r13 8006f58: 34 02 00 06 mvi r2,6 Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 8006f5c: b8 60 70 00 mv r14,r3 _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 ]; 8006f60: fb ff e7 43 calli 8000c6c <__lshrsi3> 8006f64: b4 21 10 00 add r2,r1,r1 8006f68: b4 41 08 00 add r1,r2,r1 8006f6c: 34 02 00 02 mvi r2,2 8006f70: fb ff e7 17 calli 8000bcc <__ashlsi3> block_state = the_thread_queue->state; if ( _Thread_queue_Is_reverse_search( priority ) ) 8006f74: 21 a2 00 20 andi r2,r13,0x20 _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 ]; 8006f78: b5 81 08 00 add r1,r12,r1 block_state = the_thread_queue->state; 8006f7c: 29 87 00 38 lw r7,(r12+56) if ( _Thread_queue_Is_reverse_search( priority ) ) 8006f80: 5c 40 00 23 bne r2,r0,800700c <_Thread_queue_Enqueue_priority+0xf4> */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 8006f84: 34 28 00 04 addi r8,r1,4 goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); 8006f88: 34 03 ff fe mvi r3,-2 8006f8c: 90 00 20 00 rcsr r4,IE 8006f90: a0 83 30 00 and r6,r4,r3 8006f94: d0 06 00 00 wcsr IE,r6 search_thread = (Thread_Control *) header->first; 8006f98: 34 05 ff ff mvi r5,-1 8006f9c: 28 22 00 00 lw r2,(r1+0) while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 8006fa0: e0 00 00 0b bi 8006fcc <_Thread_queue_Enqueue_priority+0xb4> search_priority = search_thread->current_priority; 8006fa4: 28 45 00 14 lw r5,(r2+20) if ( priority <= search_priority ) 8006fa8: 50 ad 00 0a bgeu r5,r13,8006fd0 <_Thread_queue_Enqueue_priority+0xb8> break; search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); 8006fac: d0 04 00 00 wcsr IE,r4 8006fb0: d0 06 00 00 wcsr IE,r6 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 8006fb4: 28 49 00 10 lw r9,(r2+16) 8006fb8: a0 e9 48 00 and r9,r7,r9 8006fbc: 5d 20 00 03 bne r9,r0,8006fc8 <_Thread_queue_Enqueue_priority+0xb0><== ALWAYS TAKEN _ISR_Enable( level ); 8006fc0: d0 04 00 00 wcsr IE,r4 <== NOT EXECUTED goto restart_forward_search; 8006fc4: e3 ff ff f2 bi 8006f8c <_Thread_queue_Enqueue_priority+0x74><== NOT EXECUTED } search_thread = (Thread_Control *)search_thread->Object.Node.next; 8006fc8: 28 42 00 00 lw r2,(r2+0) 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 ) ) { 8006fcc: 5c 48 ff f6 bne r2,r8,8006fa4 <_Thread_queue_Enqueue_priority+0x8c> } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 8006fd0: 29 83 00 30 lw r3,(r12+48) 8006fd4: 34 01 00 01 mvi r1,1 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 ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 8006fd8: b8 80 38 00 mv r7,r4 } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 8006fdc: 5c 61 00 3b bne r3,r1,80070c8 <_Thread_queue_Enqueue_priority+0x1b0> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 8006fe0: 34 01 00 00 mvi r1,0 8006fe4: 59 81 00 30 sw (r12+48),r1 if ( priority == search_priority ) 8006fe8: 45 a5 00 2f be r13,r5,80070a4 <_Thread_queue_Enqueue_priority+0x18c> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; 8006fec: 28 41 00 04 lw r1,(r2+4) the_node = (Chain_Node *) the_thread; the_node->next = search_node; 8006ff0: 59 62 00 00 sw (r11+0),r2 the_node->previous = previous_node; previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 8006ff4: 59 6c 00 44 sw (r11+68),r12 search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; the_node->previous = previous_node; 8006ff8: 59 61 00 04 sw (r11+4),r1 previous_node->next = the_node; 8006ffc: 58 2b 00 00 sw (r1+0),r11 search_node->previous = the_node; 8007000: 58 4b 00 04 sw (r2+4),r11 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 8007004: d0 04 00 00 wcsr IE,r4 8007008: e0 00 00 25 bi 800709c <_Thread_queue_Enqueue_priority+0x184> return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 800700c: 78 04 08 02 mvhi r4,0x802 8007010: 38 84 50 a8 ori r4,r4,0x50a8 _ISR_Disable( level ); 8007014: 34 03 ff fe mvi r3,-2 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 8007018: 40 86 00 00 lbu r6,(r4+0) 800701c: 34 c6 00 01 addi r6,r6,1 _ISR_Disable( level ); 8007020: 90 00 28 00 rcsr r5,IE 8007024: a0 a3 40 00 and r8,r5,r3 8007028: d0 08 00 00 wcsr IE,r8 search_thread = (Thread_Control *) header->last; 800702c: 28 22 00 08 lw r2,(r1+8) while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 8007030: e0 00 00 0b bi 800705c <_Thread_queue_Enqueue_priority+0x144> search_priority = search_thread->current_priority; 8007034: 28 46 00 14 lw r6,(r2+20) if ( priority >= search_priority ) 8007038: 51 a6 00 0a bgeu r13,r6,8007060 <_Thread_queue_Enqueue_priority+0x148> break; search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); 800703c: d0 05 00 00 wcsr IE,r5 8007040: d0 08 00 00 wcsr IE,r8 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 8007044: 28 49 00 10 lw r9,(r2+16) 8007048: a0 e9 48 00 and r9,r7,r9 800704c: 5d 20 00 03 bne r9,r0,8007058 <_Thread_queue_Enqueue_priority+0x140><== ALWAYS TAKEN _ISR_Enable( level ); 8007050: d0 05 00 00 wcsr IE,r5 <== NOT EXECUTED goto restart_reverse_search; 8007054: e3 ff ff f1 bi 8007018 <_Thread_queue_Enqueue_priority+0x100><== NOT EXECUTED } search_thread = (Thread_Control *) 8007058: 28 42 00 04 lw r2,(r2+4) 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 ) ) { 800705c: 5c 41 ff f6 bne r2,r1,8007034 <_Thread_queue_Enqueue_priority+0x11c> } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != 8007060: 29 83 00 30 lw r3,(r12+48) 8007064: 34 01 00 01 mvi r1,1 8007068: b8 a0 38 00 mv r7,r5 800706c: 5c 61 00 17 bne r3,r1,80070c8 <_Thread_queue_Enqueue_priority+0x1b0> THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 8007070: 34 01 00 00 mvi r1,0 8007074: 59 81 00 30 sw (r12+48),r1 if ( priority == search_priority ) 8007078: b8 a0 20 00 mv r4,r5 800707c: 45 a6 00 0a be r13,r6,80070a4 <_Thread_queue_Enqueue_priority+0x18c> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; 8007080: 28 41 00 00 lw r1,(r2+0) the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; 8007084: 59 62 00 04 sw (r11+4),r2 search_node->next = the_node; next_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 8007088: 59 6c 00 44 sw (r11+68),r12 search_node = (Chain_Node *) search_thread; next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; 800708c: 59 61 00 00 sw (r11+0),r1 the_node->previous = search_node; search_node->next = the_node; 8007090: 58 4b 00 00 sw (r2+0),r11 next_node->previous = the_node; 8007094: 58 2b 00 04 sw (r1+4),r11 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 8007098: d0 05 00 00 wcsr IE,r5 800709c: 34 01 00 01 mvi r1,1 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 80070a0: e0 00 00 0c bi 80070d0 <_Thread_queue_Enqueue_priority+0x1b8> 80070a4: 34 42 00 3c addi r2,r2,60 equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; 80070a8: 28 41 00 04 lw r1,(r2+4) the_node = (Chain_Node *) the_thread; the_node->next = search_node; 80070ac: 59 62 00 00 sw (r11+0),r2 the_node->previous = previous_node; previous_node->next = the_node; search_node->previous = the_node; the_thread->Wait.queue = the_thread_queue; 80070b0: 59 6c 00 44 sw (r11+68),r12 search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; the_node->previous = previous_node; 80070b4: 59 61 00 04 sw (r11+4),r1 previous_node->next = the_node; 80070b8: 58 2b 00 00 sw (r1+0),r11 search_node->previous = the_node; 80070bc: 58 4b 00 04 sw (r2+4),r11 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); 80070c0: d0 04 00 00 wcsr IE,r4 80070c4: e3 ff ff f6 bi 800709c <_Thread_queue_Enqueue_priority+0x184> * the mutex by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; 80070c8: 29 81 00 30 lw r1,(r12+48) * For example, the blocking thread could have been given * the mutex by an ISR or timed out. * * WARNING! Returning with interrupts disabled! */ *level_p = level; 80070cc: 59 c7 00 00 sw (r14+0),r7 return the_thread_queue->sync_state; } 80070d0: 2b 9d 00 04 lw ra,(sp+4) 80070d4: 2b 8b 00 14 lw r11,(sp+20) 80070d8: 2b 8c 00 10 lw r12,(sp+16) 80070dc: 2b 8d 00 0c lw r13,(sp+12) 80070e0: 2b 8e 00 08 lw r14,(sp+8) 80070e4: 37 9c 00 14 addi sp,sp,20 80070e8: c3 a0 00 00 ret 0800fe94 <_Thread_queue_Process_timeout>: #include void _Thread_queue_Process_timeout( Thread_Control *the_thread ) { 800fe94: 37 9c ff fc addi sp,sp,-4 800fe98: 5b 9d 00 04 sw (sp+4),ra 800fe9c: b8 20 10 00 mv r2,r1 Thread_queue_Control *the_thread_queue = the_thread->Wait.queue; 800fea0: 28 21 00 44 lw r1,(r1+68) * 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. */ if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED && 800fea4: 28 24 00 30 lw r4,(r1+48) 800fea8: 44 80 00 0c be r4,r0,800fed8 <_Thread_queue_Process_timeout+0x44> 800feac: 78 03 08 02 mvhi r3,0x802 800feb0: 38 63 5a 00 ori r3,r3,0x5a00 800feb4: 28 63 00 00 lw r3,(r3+0) 800feb8: 5c 43 00 08 bne r2,r3,800fed8 <_Thread_queue_Process_timeout+0x44> _Thread_Is_executing( the_thread ) ) { if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { 800febc: 34 03 00 03 mvi r3,3 800fec0: 44 83 00 0a be r4,r3,800fee8 <_Thread_queue_Process_timeout+0x54><== NEVER TAKEN the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 800fec4: 34 03 00 02 mvi r3,2 800fec8: 58 23 00 30 sw (r1+48),r3 */ if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SYNCHRONIZED && _Thread_Is_executing( the_thread ) ) { if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; 800fecc: 28 21 00 3c lw r1,(r1+60) 800fed0: 58 41 00 34 sw (r2+52),r1 800fed4: e0 00 00 05 bi 800fee8 <_Thread_queue_Process_timeout+0x54> the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; 800fed8: 28 21 00 3c lw r1,(r1+60) 800fedc: 58 41 00 34 sw (r2+52),r1 _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); 800fee0: 28 41 00 44 lw r1,(r2+68) 800fee4: f8 00 0a c4 calli 80129f4 <_Thread_queue_Extract> } } 800fee8: 2b 9d 00 04 lw ra,(sp+4) 800feec: 37 9c 00 04 addi sp,sp,4 800fef0: c3 a0 00 00 ret 08007180 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 8007180: 37 9c ff ec addi sp,sp,-20 8007184: 5b 8b 00 10 sw (sp+16),r11 8007188: 5b 8c 00 0c sw (sp+12),r12 800718c: 5b 8d 00 08 sw (sp+8),r13 8007190: 5b 9d 00 04 sw (sp+4),ra 8007194: b8 20 58 00 mv r11,r1 8007198: b8 40 60 00 mv r12,r2 /* * Just in case the thread really wasn't blocked on a thread queue * when we get here. */ if ( !the_thread_queue ) 800719c: 44 20 00 17 be r1,r0,80071f8 <_Thread_queue_Requeue+0x78> <== NEVER TAKEN /* * 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 ) { 80071a0: 28 22 00 34 lw r2,(r1+52) 80071a4: 34 01 00 01 mvi r1,1 80071a8: 5c 41 00 14 bne r2,r1,80071f8 <_Thread_queue_Requeue+0x78> <== NEVER TAKEN Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 80071ac: 90 00 68 00 rcsr r13,IE 80071b0: 34 01 ff fe mvi r1,-2 80071b4: a1 a1 08 00 and r1,r13,r1 80071b8: d0 01 00 00 wcsr IE,r1 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 80071bc: 29 82 00 10 lw r2,(r12+16) 80071c0: 78 01 00 03 mvhi r1,0x3 80071c4: 38 21 be e0 ori r1,r1,0xbee0 80071c8: a0 41 08 00 and r1,r2,r1 80071cc: 44 20 00 0a be r1,r0,80071f4 <_Thread_queue_Requeue+0x74> <== NEVER TAKEN 80071d0: 34 03 00 01 mvi r3,1 80071d4: 59 63 00 30 sw (r11+48),r3 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 80071d8: b9 60 08 00 mv r1,r11 80071dc: b9 80 10 00 mv r2,r12 80071e0: f8 00 22 e2 calli 800fd68 <_Thread_queue_Extract_priority_helper> (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 80071e4: b9 60 08 00 mv r1,r11 80071e8: b9 80 10 00 mv r2,r12 80071ec: 37 83 00 14 addi r3,sp,20 80071f0: fb ff ff 4a calli 8006f18 <_Thread_queue_Enqueue_priority> } _ISR_Enable( level ); 80071f4: d0 0d 00 00 wcsr IE,r13 } } 80071f8: 2b 9d 00 04 lw ra,(sp+4) 80071fc: 2b 8b 00 10 lw r11,(sp+16) 8007200: 2b 8c 00 0c lw r12,(sp+12) 8007204: 2b 8d 00 08 lw r13,(sp+8) 8007208: 37 9c 00 14 addi sp,sp,20 800720c: c3 a0 00 00 ret 08007210 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 8007210: 37 9c ff f8 addi sp,sp,-8 8007214: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 8007218: 37 82 00 08 addi r2,sp,8 800721c: fb ff fd 92 calli 8006864 <_Thread_Get> switch ( location ) { 8007220: 2b 82 00 08 lw r2,(sp+8) 8007224: 5c 40 00 07 bne r2,r0,8007240 <_Thread_queue_Timeout+0x30> <== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); 8007228: f8 00 23 1b calli 800fe94 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 800722c: 78 01 08 02 mvhi r1,0x802 8007230: 38 21 59 44 ori r1,r1,0x5944 8007234: 28 22 00 00 lw r2,(r1+0) 8007238: 34 42 ff ff addi r2,r2,-1 800723c: 58 22 00 00 sw (r1+0),r2 _Thread_Unnest_dispatch(); break; } } 8007240: 2b 9d 00 04 lw ra,(sp+4) 8007244: 37 9c 00 08 addi sp,sp,8 8007248: c3 a0 00 00 ret 08014140 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 8014140: 37 9c ff a4 addi sp,sp,-92 8014144: 5b 8b 00 44 sw (sp+68),r11 8014148: 5b 8c 00 40 sw (sp+64),r12 801414c: 5b 8d 00 3c sw (sp+60),r13 8014150: 5b 8e 00 38 sw (sp+56),r14 8014154: 5b 8f 00 34 sw (sp+52),r15 8014158: 5b 90 00 30 sw (sp+48),r16 801415c: 5b 91 00 2c sw (sp+44),r17 8014160: 5b 92 00 28 sw (sp+40),r18 8014164: 5b 93 00 24 sw (sp+36),r19 8014168: 5b 94 00 20 sw (sp+32),r20 801416c: 5b 95 00 1c sw (sp+28),r21 8014170: 5b 96 00 18 sw (sp+24),r22 8014174: 5b 97 00 14 sw (sp+20),r23 8014178: 5b 98 00 10 sw (sp+16),r24 801417c: 5b 99 00 0c sw (sp+12),r25 8014180: 5b 9b 00 08 sw (sp+8),fp 8014184: 5b 9d 00 04 sw (sp+4),ra static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 8014188: 78 11 08 03 mvhi r17,0x803 * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 801418c: b8 20 58 00 mv r11,r1 8014190: 37 82 00 54 addi r2,sp,84 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); the_chain->permanent_null = NULL; 8014194: 34 01 00 00 mvi r1,0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 8014198: 37 96 00 58 addi r22,sp,88 801419c: 37 8e 00 48 addi r14,sp,72 80141a0: 37 92 00 4c addi r18,sp,76 static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 80141a4: 78 10 08 03 mvhi r16,0x803 80141a8: 78 0d 08 03 mvhi r13,0x803 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 80141ac: 5b 96 00 54 sw (sp+84),r22 the_chain->permanent_null = NULL; 80141b0: 5b 81 00 58 sw (sp+88),r1 the_chain->last = _Chain_Head(the_chain); 80141b4: 5b 82 00 5c sw (sp+92),r2 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { the_chain->first = _Chain_Tail(the_chain); 80141b8: 5b 92 00 48 sw (sp+72),r18 the_chain->permanent_null = NULL; 80141bc: 5b 81 00 4c sw (sp+76),r1 the_chain->last = _Chain_Head(the_chain); 80141c0: 5b 8e 00 50 sw (sp+80),r14 static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 80141c4: 3a 31 fd fc ori r17,r17,0xfdfc static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 80141c8: 3a 10 fd 3c ori r16,r16,0xfd3c */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; 80141cc: b8 20 a8 00 mv r21,r1 80141d0: 39 ad fc ac ori r13,r13,0xfcac */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 80141d4: 35 74 00 30 addi r20,r11,48 /* * 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 ); 80141d8: 35 6f 00 68 addi r15,r11,104 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 80141dc: 35 7b 00 08 addi fp,r11,8 static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 80141e0: 35 79 00 40 addi r25,r11,64 /* * 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 ); 80141e4: 34 18 00 01 mvi r24,1 Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 80141e8: 34 17 00 03 mvi r23,3 * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 80141ec: 34 13 ff fe mvi r19,-2 { /* * 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; 80141f0: 37 81 00 54 addi r1,sp,84 80141f4: 59 61 00 78 sw (r11+120),r1 static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 80141f8: 2a 22 00 00 lw r2,(r17+0) /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 80141fc: 29 63 00 3c lw r3,(r11+60) watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 8014200: ba 80 08 00 mv r1,r20 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 8014204: 59 62 00 3c sw (r11+60),r2 _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 8014208: c8 43 10 00 sub r2,r2,r3 801420c: b9 c0 18 00 mv r3,r14 8014210: f8 00 14 af calli 80194cc <_Watchdog_Adjust_to_chain> Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); Watchdog_Interval last_snapshot = watchdogs->last_snapshot; 8014214: 29 62 00 74 lw r2,(r11+116) static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 8014218: 2a 0c 00 00 lw r12,(r16+0) /* * 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 ) { 801421c: 50 4c 00 06 bgeu r2,r12,8014234 <_Timer_server_Body+0xf4> /* * 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 ); 8014220: c9 82 10 00 sub r2,r12,r2 8014224: b9 e0 08 00 mv r1,r15 8014228: b9 c0 18 00 mv r3,r14 801422c: f8 00 14 a8 calli 80194cc <_Watchdog_Adjust_to_chain> 8014230: e0 00 00 06 bi 8014248 <_Timer_server_Body+0x108> } else if ( snapshot < last_snapshot ) { 8014234: 51 82 00 05 bgeu r12,r2,8014248 <_Timer_server_Body+0x108> /* * 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 ); 8014238: c8 4c 18 00 sub r3,r2,r12 801423c: b9 e0 08 00 mv r1,r15 8014240: 34 02 00 01 mvi r2,1 8014244: f8 00 14 6a calli 80193ec <_Watchdog_Adjust> } watchdogs->last_snapshot = snapshot; 8014248: 59 6c 00 74 sw (r11+116),r12 } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 801424c: 29 61 00 78 lw r1,(r11+120) 8014250: f8 00 03 02 calli 8014e58 <_Chain_Get> if ( timer == NULL ) { 8014254: 44 20 00 0b be r1,r0,8014280 <_Timer_server_Body+0x140> <== ALWAYS TAKEN static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 8014258: 28 23 00 38 lw r3,(r1+56) <== NOT EXECUTED 801425c: 5c 78 00 04 bne r3,r24,801426c <_Timer_server_Body+0x12c> <== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 8014260: 34 22 00 10 addi r2,r1,16 <== NOT EXECUTED 8014264: ba 80 08 00 mv r1,r20 <== NOT EXECUTED 8014268: e0 00 00 04 bi 8014278 <_Timer_server_Body+0x138> <== NOT EXECUTED } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 801426c: 5c 77 ff f8 bne r3,r23,801424c <_Timer_server_Body+0x10c> <== NOT EXECUTED _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 8014270: 34 22 00 10 addi r2,r1,16 <== NOT EXECUTED 8014274: b9 e0 08 00 mv r1,r15 <== NOT EXECUTED 8014278: f8 00 14 c0 calli 8019578 <_Watchdog_Insert> <== NOT EXECUTED 801427c: e3 ff ff f4 bi 801424c <_Timer_server_Body+0x10c> <== NOT EXECUTED * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); 8014280: 90 00 10 00 rcsr r2,IE 8014284: a0 53 08 00 and r1,r2,r19 8014288: d0 01 00 00 wcsr IE,r1 if ( _Chain_Is_empty( insert_chain ) ) { 801428c: 2b 81 00 54 lw r1,(sp+84) 8014290: 5c 36 00 06 bne r1,r22,80142a8 <_Timer_server_Body+0x168> <== NEVER TAKEN ts->insert_chain = NULL; 8014294: 59 75 00 78 sw (r11+120),r21 _ISR_Enable( level ); 8014298: d0 02 00 00 wcsr IE,r2 _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 ) ) { 801429c: 2b 81 00 48 lw r1,(sp+72) 80142a0: 5c 32 00 04 bne r1,r18,80142b0 <_Timer_server_Body+0x170> 80142a4: e0 00 00 17 bi 8014300 <_Timer_server_Body+0x1c0> ts->insert_chain = NULL; _ISR_Enable( level ); break; } else { _ISR_Enable( level ); 80142a8: d0 02 00 00 wcsr IE,r2 <== NOT EXECUTED 80142ac: e3 ff ff d3 bi 80141f8 <_Timer_server_Body+0xb8> <== 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 ); 80142b0: 90 00 10 00 rcsr r2,IE 80142b4: a0 53 08 00 and r1,r2,r19 80142b8: d0 01 00 00 wcsr IE,r1 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 80142bc: 2b 84 00 48 lw r4,(sp+72) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 80142c0: 5c 92 00 03 bne r4,r18,80142cc <_Timer_server_Body+0x18c> 80142c4: 34 04 00 00 mvi r4,0 80142c8: e0 00 00 04 bi 80142d8 <_Timer_server_Body+0x198> { Chain_Node *return_node; Chain_Node *new_first; return_node = the_chain->first; new_first = return_node->next; 80142cc: 28 83 00 00 lw r3,(r4+0) the_chain->first = new_first; 80142d0: 5b 83 00 48 sw (sp+72),r3 new_first->previous = _Chain_Head(the_chain); 80142d4: 58 6e 00 04 sw (r3+4),r14 watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { 80142d8: 44 80 00 08 be r4,r0,80142f8 <_Timer_server_Body+0x1b8> watchdog->state = WATCHDOG_INACTIVE; 80142dc: 58 95 00 08 sw (r4+8),r21 _ISR_Enable( level ); 80142e0: d0 02 00 00 wcsr IE,r2 /* * 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 ); 80142e4: 28 82 00 24 lw r2,(r4+36) 80142e8: 28 83 00 1c lw r3,(r4+28) 80142ec: 28 81 00 20 lw r1,(r4+32) 80142f0: d8 60 00 00 call r3 } 80142f4: e3 ff ff ef bi 80142b0 <_Timer_server_Body+0x170> watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 80142f8: d0 02 00 00 wcsr IE,r2 80142fc: e3 ff ff bd bi 80141f0 <_Timer_server_Body+0xb0> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 8014300: 34 01 00 00 mvi r1,0 8014304: 31 61 00 7c sb (r11+124),r1 8014308: 29 a1 00 00 lw r1,(r13+0) 801430c: 34 21 00 01 addi r1,r1,1 8014310: 59 a1 00 00 sw (r13+0),r1 /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); 8014314: 29 61 00 00 lw r1,(r11+0) 8014318: 34 02 00 08 mvi r2,8 801431c: f8 00 11 2d calli 80187d0 <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); 8014320: b9 60 08 00 mv r1,r11 8014324: fb ff ff 4d calli 8014058 <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); 8014328: b9 60 08 00 mv r1,r11 801432c: fb ff ff 68 calli 80140cc <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); 8014330: f8 00 0d fd calli 8017b24 <_Thread_Enable_dispatch> ts->active = true; 8014334: 34 01 00 01 mvi r1,1 8014338: 31 61 00 7c sb (r11+124),r1 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 801433c: bb 60 08 00 mv r1,fp 8014340: f8 00 14 ed calli 80196f4 <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 8014344: bb 20 08 00 mv r1,r25 8014348: f8 00 14 eb calli 80196f4 <_Watchdog_Remove> 801434c: e3 ff ff a9 bi 80141f0 <_Timer_server_Body+0xb0> 08014350 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 8014350: 37 9c ff f8 addi sp,sp,-8 8014354: 5b 8b 00 08 sw (sp+8),r11 8014358: 5b 9d 00 04 sw (sp+4),ra 801435c: b8 20 58 00 mv r11,r1 if ( ts->insert_chain == NULL ) { 8014360: 28 21 00 78 lw r1,(r1+120) static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 8014364: b8 40 20 00 mv r4,r2 if ( ts->insert_chain == NULL ) { 8014368: 5c 20 00 47 bne r1,r0,8014484 <_Timer_server_Schedule_operation_method+0x134><== NEVER TAKEN 801436c: 78 01 08 03 mvhi r1,0x803 8014370: 38 21 fc ac ori r1,r1,0xfcac 8014374: 28 22 00 00 lw r2,(r1+0) 8014378: 34 42 00 01 addi r2,r2,1 801437c: 58 22 00 00 sw (r1+0),r2 * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 8014380: 28 81 00 38 lw r1,(r4+56) 8014384: 34 02 00 01 mvi r2,1 8014388: 5c 22 00 1d bne r1,r2,80143fc <_Timer_server_Schedule_operation_method+0xac> /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 801438c: 90 00 18 00 rcsr r3,IE 8014390: 34 01 ff fe mvi r1,-2 8014394: a0 61 08 00 and r1,r3,r1 8014398: d0 01 00 00 wcsr IE,r1 snapshot = _Watchdog_Ticks_since_boot; 801439c: 78 02 08 03 mvhi r2,0x803 80143a0: 38 42 fd fc ori r2,r2,0xfdfc */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 80143a4: 29 61 00 30 lw r1,(r11+48) 80143a8: 28 45 00 00 lw r5,(r2+0) last_snapshot = ts->Interval_watchdogs.last_snapshot; 80143ac: 29 62 00 3c lw r2,(r11+60) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 80143b0: 35 66 00 34 addi r6,r11,52 80143b4: 44 26 00 08 be r1,r6,80143d4 <_Timer_server_Schedule_operation_method+0x84> /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 80143b8: 28 27 00 10 lw r7,(r1+16) first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; 80143bc: c8 a2 10 00 sub r2,r5,r2 delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { 80143c0: f4 e2 30 00 cmpgu r6,r7,r2 delta_interval -= delta; 80143c4: c8 e2 10 00 sub r2,r7,r2 * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { 80143c8: c8 06 30 00 sub r6,r0,r6 80143cc: a0 46 10 00 and r2,r2,r6 delta_interval -= delta; } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 80143d0: 58 22 00 10 sw (r1+16),r2 } ts->Interval_watchdogs.last_snapshot = snapshot; 80143d4: 59 65 00 3c sw (r11+60),r5 _ISR_Enable( level ); 80143d8: d0 03 00 00 wcsr IE,r3 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 80143dc: 35 61 00 30 addi r1,r11,48 80143e0: 34 82 00 10 addi r2,r4,16 80143e4: f8 00 14 65 calli 8019578 <_Watchdog_Insert> if ( !ts->active ) { 80143e8: 41 61 00 7c lbu r1,(r11+124) 80143ec: 5c 20 00 24 bne r1,r0,801447c <_Timer_server_Schedule_operation_method+0x12c> _Timer_server_Reset_interval_system_watchdog( ts ); 80143f0: b9 60 08 00 mv r1,r11 80143f4: fb ff ff 19 calli 8014058 <_Timer_server_Reset_interval_system_watchdog> 80143f8: e0 00 00 21 bi 801447c <_Timer_server_Schedule_operation_method+0x12c> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 80143fc: 34 02 00 03 mvi r2,3 8014400: 5c 22 00 1f bne r1,r2,801447c <_Timer_server_Schedule_operation_method+0x12c> /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 8014404: 90 00 38 00 rcsr r7,IE 8014408: 34 01 ff fe mvi r1,-2 801440c: a0 e1 08 00 and r1,r7,r1 8014410: d0 01 00 00 wcsr IE,r1 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 8014414: 29 62 00 68 lw r2,(r11+104) snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 8014418: 78 01 08 03 mvhi r1,0x803 last_snapshot = ts->TOD_watchdogs.last_snapshot; 801441c: 29 66 00 74 lw r6,(r11+116) /* * 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(); 8014420: 38 21 fd 3c ori r1,r1,0xfd3c */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 8014424: 35 63 00 6c addi r3,r11,108 8014428: 28 21 00 00 lw r1,(r1+0) 801442c: 44 43 00 0b be r2,r3,8014458 <_Timer_server_Schedule_operation_method+0x108> 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; 8014430: 28 45 00 10 lw r5,(r2+16) } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 8014434: b4 a6 18 00 add r3,r5,r6 delta_interval += delta; 8014438: c8 61 18 00 sub r3,r3,r1 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 ) { 801443c: 50 c1 00 06 bgeu r6,r1,8014454 <_Timer_server_Schedule_operation_method+0x104> /* * We advanced in time. */ delta = snapshot - last_snapshot; 8014440: c8 26 18 00 sub r3,r1,r6 if (delta_interval > delta) { 8014444: f4 a3 30 00 cmpgu r6,r5,r3 delta_interval -= delta; 8014448: c8 a3 18 00 sub r3,r5,r3 if ( snapshot > last_snapshot ) { /* * We advanced in time. */ delta = snapshot - last_snapshot; if (delta_interval > delta) { 801444c: c8 06 28 00 sub r5,r0,r6 8014450: a0 65 18 00 and r3,r3,r5 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 8014454: 58 43 00 10 sw (r2+16),r3 } ts->TOD_watchdogs.last_snapshot = snapshot; 8014458: 59 61 00 74 sw (r11+116),r1 _ISR_Enable( level ); 801445c: d0 07 00 00 wcsr IE,r7 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 8014460: 35 61 00 68 addi r1,r11,104 8014464: 34 82 00 10 addi r2,r4,16 8014468: f8 00 14 44 calli 8019578 <_Watchdog_Insert> if ( !ts->active ) { 801446c: 41 61 00 7c lbu r1,(r11+124) 8014470: 5c 20 00 03 bne r1,r0,801447c <_Timer_server_Schedule_operation_method+0x12c> _Timer_server_Reset_tod_system_watchdog( ts ); 8014474: b9 60 08 00 mv r1,r11 8014478: fb ff ff 15 calli 80140cc <_Timer_server_Reset_tod_system_watchdog> } } _Thread_Enable_dispatch(); 801447c: f8 00 0d aa calli 8017b24 <_Thread_Enable_dispatch> 8014480: e0 00 00 03 bi 801448c <_Timer_server_Schedule_operation_method+0x13c> * 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 ); 8014484: 29 61 00 78 lw r1,(r11+120) <== NOT EXECUTED 8014488: f8 00 02 68 calli 8014e28 <_Chain_Append> <== NOT EXECUTED } } 801448c: 2b 9d 00 04 lw ra,(sp+4) 8014490: 2b 8b 00 08 lw r11,(sp+8) 8014494: 37 9c 00 08 addi sp,sp,8 8014498: c3 a0 00 00 ret 080079a4 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 80079a4: 37 9c ff e4 addi sp,sp,-28 80079a8: 5b 8b 00 1c sw (sp+28),r11 80079ac: 5b 8c 00 18 sw (sp+24),r12 80079b0: 5b 8d 00 14 sw (sp+20),r13 80079b4: 5b 8e 00 10 sw (sp+16),r14 80079b8: 5b 8f 00 0c sw (sp+12),r15 80079bc: 5b 90 00 08 sw (sp+8),r16 80079c0: 5b 9d 00 04 sw (sp+4),ra 80079c4: b8 20 60 00 mv r12,r1 80079c8: b8 40 20 00 mv r4,r2 80079cc: b8 60 58 00 mv r11,r3 ISR_Level level; _ISR_Disable( level ); 80079d0: 90 00 10 00 rcsr r2,IE 80079d4: 34 01 ff fe mvi r1,-2 80079d8: a0 41 08 00 and r1,r2,r1 80079dc: d0 01 00 00 wcsr IE,r1 */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 80079e0: 29 81 00 00 lw r1,(r12+0) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 80079e4: 35 8e 00 04 addi r14,r12,4 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { 80079e8: 44 2e 00 1d be r1,r14,8007a5c <_Watchdog_Adjust+0xb8> switch ( direction ) { 80079ec: 44 80 00 04 be r4,r0,80079fc <_Watchdog_Adjust+0x58> 80079f0: 34 03 00 01 mvi r3,1 80079f4: 5c 83 00 1a bne r4,r3,8007a5c <_Watchdog_Adjust+0xb8> <== NEVER TAKEN 80079f8: e0 00 00 04 bi 8007a08 <_Watchdog_Adjust+0x64> if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; 80079fc: 34 10 00 01 mvi r16,1 _ISR_Enable( level ); _Watchdog_Tickle( header ); _ISR_Disable( level ); 8007a00: 34 0f ff fe mvi r15,-2 8007a04: e0 00 00 15 bi 8007a58 <_Watchdog_Adjust+0xb4> * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 8007a08: 28 23 00 10 lw r3,(r1+16) 8007a0c: b4 6b 58 00 add r11,r3,r11 8007a10: e0 00 00 05 bi 8007a24 <_Watchdog_Adjust+0x80> RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) header->first ); 8007a14: 29 81 00 00 lw r1,(r12+0) break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { 8007a18: 28 2d 00 10 lw r13,(r1+16) 8007a1c: 51 6d 00 04 bgeu r11,r13,8007a2c <_Watchdog_Adjust+0x88> _Watchdog_First( header )->delta_interval -= units; 8007a20: c9 ab 58 00 sub r11,r13,r11 8007a24: 58 2b 00 10 sw (r1+16),r11 break; 8007a28: e0 00 00 0d bi 8007a5c <_Watchdog_Adjust+0xb8> } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; 8007a2c: 58 30 00 10 sw (r1+16),r16 _ISR_Enable( level ); 8007a30: d0 02 00 00 wcsr IE,r2 _Watchdog_Tickle( header ); 8007a34: b9 80 08 00 mv r1,r12 8007a38: f8 00 00 9e calli 8007cb0 <_Watchdog_Tickle> _ISR_Disable( level ); 8007a3c: 90 00 08 00 rcsr r1,IE 8007a40: a0 2f 10 00 and r2,r1,r15 8007a44: d0 02 00 00 wcsr IE,r2 if ( _Chain_Is_empty( header ) ) 8007a48: 29 83 00 00 lw r3,(r12+0) while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; 8007a4c: c9 6d 58 00 sub r11,r11,r13 8007a50: b8 20 10 00 mv r2,r1 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) 8007a54: 44 6e 00 02 be r3,r14,8007a5c <_Watchdog_Adjust+0xb8> switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 8007a58: 5d 60 ff ef bne r11,r0,8007a14 <_Watchdog_Adjust+0x70> <== ALWAYS TAKEN } break; } } _ISR_Enable( level ); 8007a5c: d0 02 00 00 wcsr IE,r2 } 8007a60: 2b 9d 00 04 lw ra,(sp+4) 8007a64: 2b 8b 00 1c lw r11,(sp+28) 8007a68: 2b 8c 00 18 lw r12,(sp+24) 8007a6c: 2b 8d 00 14 lw r13,(sp+20) 8007a70: 2b 8e 00 10 lw r14,(sp+16) 8007a74: 2b 8f 00 0c lw r15,(sp+12) 8007a78: 2b 90 00 08 lw r16,(sp+8) 8007a7c: 37 9c 00 1c addi sp,sp,28 8007a80: c3 a0 00 00 ret 08007c4c <_Watchdog_Remove>: { ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 8007c4c: 90 00 20 00 rcsr r4,IE 8007c50: 34 02 ff fe mvi r2,-2 8007c54: a0 82 10 00 and r2,r4,r2 8007c58: d0 02 00 00 wcsr IE,r2 previous_state = the_watchdog->state; 8007c5c: 28 22 00 08 lw r2,(r1+8) switch ( previous_state ) { 8007c60: 34 03 00 01 mvi r3,1 8007c64: 44 43 00 05 be r2,r3,8007c78 <_Watchdog_Remove+0x2c> 8007c68: 44 40 00 1e be r2,r0,8007ce0 <_Watchdog_Remove+0x94> 8007c6c: 34 03 00 03 mvi r3,3 8007c70: 54 43 00 1c bgu r2,r3,8007ce0 <_Watchdog_Remove+0x94> <== NEVER TAKEN 8007c74: e0 00 00 04 bi 8007c84 <_Watchdog_Remove+0x38> /* * It is not actually on the chain so just change the state and * the Insert operation we interrupted will be aborted. */ the_watchdog->state = WATCHDOG_INACTIVE; 8007c78: 34 03 00 00 mvi r3,0 8007c7c: 58 23 00 08 sw (r1+8),r3 break; 8007c80: e0 00 00 18 bi 8007ce0 <_Watchdog_Remove+0x94> RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_Next( Watchdog_Control *the_watchdog ) { return ( (Watchdog_Control *) the_watchdog->Node.next ); 8007c84: 28 23 00 00 lw r3,(r1+0) case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 8007c88: 34 05 00 00 mvi r5,0 8007c8c: 58 25 00 08 sw (r1+8),r5 next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 8007c90: 28 65 00 00 lw r5,(r3+0) 8007c94: 44 a0 00 05 be r5,r0,8007ca8 <_Watchdog_Remove+0x5c> next_watchdog->delta_interval += the_watchdog->delta_interval; 8007c98: 28 66 00 10 lw r6,(r3+16) 8007c9c: 28 25 00 10 lw r5,(r1+16) 8007ca0: b4 c5 28 00 add r5,r6,r5 8007ca4: 58 65 00 10 sw (r3+16),r5 if ( _Watchdog_Sync_count ) 8007ca8: 78 03 08 02 mvhi r3,0x802 8007cac: 38 63 5a 90 ori r3,r3,0x5a90 8007cb0: 28 63 00 00 lw r3,(r3+0) 8007cb4: 44 60 00 07 be r3,r0,8007cd0 <_Watchdog_Remove+0x84> _Watchdog_Sync_level = _ISR_Nest_level; 8007cb8: 78 03 08 02 mvhi r3,0x802 8007cbc: 38 63 59 dc ori r3,r3,0x59dc 8007cc0: 28 65 00 00 lw r5,(r3+0) 8007cc4: 78 03 08 02 mvhi r3,0x802 8007cc8: 38 63 59 fc ori r3,r3,0x59fc 8007ccc: 58 65 00 00 sw (r3+0),r5 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 8007cd0: 28 23 00 00 lw r3,(r1+0) previous = the_node->previous; 8007cd4: 28 25 00 04 lw r5,(r1+4) next->previous = previous; previous->next = next; 8007cd8: 58 a3 00 00 sw (r5+0),r3 Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; 8007cdc: 58 65 00 04 sw (r3+4),r5 _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 8007ce0: 78 03 08 02 mvhi r3,0x802 8007ce4: 38 63 5a 94 ori r3,r3,0x5a94 8007ce8: 28 63 00 00 lw r3,(r3+0) 8007cec: 58 23 00 18 sw (r1+24),r3 _ISR_Enable( level ); 8007cf0: d0 04 00 00 wcsr IE,r4 return( previous_state ); } 8007cf4: b8 40 08 00 mv r1,r2 8007cf8: c3 a0 00 00 ret 080076a8 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 80076a8: 37 9c ff ec addi sp,sp,-20 80076ac: 5b 8b 00 14 sw (sp+20),r11 80076b0: 5b 8c 00 10 sw (sp+16),r12 80076b4: 5b 8d 00 0c sw (sp+12),r13 80076b8: 5b 8e 00 08 sw (sp+8),r14 80076bc: 5b 9d 00 04 sw (sp+4),ra 80076c0: b8 20 70 00 mv r14,r1 80076c4: b8 40 60 00 mv r12,r2 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 80076c8: 90 00 68 00 rcsr r13,IE 80076cc: 34 01 ff fe mvi r1,-2 80076d0: a1 a1 08 00 and r1,r13,r1 80076d4: d0 01 00 00 wcsr IE,r1 printk( "Watchdog Chain: %s %p\n", name, header ); 80076d8: 78 01 08 02 mvhi r1,0x802 80076dc: b9 80 18 00 mv r3,r12 80076e0: 38 21 0e 78 ori r1,r1,0xe78 80076e4: b9 c0 10 00 mv r2,r14 80076e8: fb ff ec ed calli 8002a9c */ RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( Chain_Control *the_chain ) { return (the_chain->first == _Chain_Tail(the_chain)); 80076ec: 29 8b 00 00 lw r11,(r12+0) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 80076f0: 35 8c 00 04 addi r12,r12,4 if ( !_Chain_Is_empty( header ) ) { 80076f4: 45 6c 00 0b be r11,r12,8007720 <_Watchdog_Report_chain+0x78> node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 80076f8: b9 60 10 00 mv r2,r11 80076fc: 34 01 00 00 mvi r1,0 8007700: f8 00 00 13 calli 800774c <_Watchdog_Report> _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 ) 8007704: 29 6b 00 00 lw r11,(r11+0) Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = header->first ; 8007708: 5d 6c ff fc bne r11,r12,80076f8 <_Watchdog_Report_chain+0x50><== NEVER TAKEN { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 800770c: 78 01 08 02 mvhi r1,0x802 8007710: 38 21 0e 90 ori r1,r1,0xe90 8007714: b9 c0 10 00 mv r2,r14 8007718: fb ff ec e1 calli 8002a9c 800771c: e0 00 00 04 bi 800772c <_Watchdog_Report_chain+0x84> } else { printk( "Chain is empty\n" ); 8007720: 78 01 08 02 mvhi r1,0x802 8007724: 38 21 0e a0 ori r1,r1,0xea0 8007728: fb ff ec dd calli 8002a9c } _ISR_Enable( level ); 800772c: d0 0d 00 00 wcsr IE,r13 } 8007730: 2b 9d 00 04 lw ra,(sp+4) 8007734: 2b 8b 00 14 lw r11,(sp+20) 8007738: 2b 8c 00 10 lw r12,(sp+16) 800773c: 2b 8d 00 0c lw r13,(sp+12) 8007740: 2b 8e 00 08 lw r14,(sp+8) 8007744: 37 9c 00 14 addi sp,sp,20 8007748: c3 a0 00 00 ret 08007cfc <_Workspace_Allocate_or_fatal_error>: * _Workspace_Allocate_or_fatal_error */ void *_Workspace_Allocate_or_fatal_error( size_t size ) { 8007cfc: 37 9c ff fc addi sp,sp,-4 8007d00: 5b 9d 00 04 sw (sp+4),ra * @brief See _Heap_Allocate_aligned_with_boundary() with alignment and * boundary equals zero. */ RTEMS_INLINE_ROUTINE void *_Heap_Allocate( Heap_Control *heap, uintptr_t size ) { return _Heap_Allocate_aligned_with_boundary( heap, size, 0, 0 ); 8007d04: 34 03 00 00 mvi r3,0 8007d08: b8 20 10 00 mv r2,r1 8007d0c: 78 01 08 02 mvhi r1,0x802 8007d10: 38 21 59 68 ori r1,r1,0x5968 8007d14: b8 60 20 00 mv r4,r3 8007d18: f8 00 1d 70 calli 800f2d8 <_Heap_Allocate_aligned_with_boundary> __builtin_return_address( 1 ), memory ); #endif if ( memory == NULL ) 8007d1c: 5c 20 00 04 bne r1,r0,8007d2c <_Workspace_Allocate_or_fatal_error+0x30><== ALWAYS TAKEN _Internal_error_Occurred( 8007d20: 34 02 00 01 mvi r2,1 <== NOT EXECUTED 8007d24: 34 03 00 04 mvi r3,4 <== NOT EXECUTED 8007d28: fb ff f6 b0 calli 80057e8 <_Internal_error_Occurred> <== NOT EXECUTED true, INTERNAL_ERROR_WORKSPACE_ALLOCATION ); return memory; } 8007d2c: 2b 9d 00 04 lw ra,(sp+4) 8007d30: 37 9c 00 04 addi sp,sp,4 8007d34: c3 a0 00 00 ret 08002718 : int adjtime( struct timeval *delta, struct timeval *olddelta ) { 8002718: 37 9c ff e8 addi sp,sp,-24 800271c: 5b 8b 00 10 sw (sp+16),r11 8002720: 5b 8c 00 0c sw (sp+12),r12 8002724: 5b 8d 00 08 sw (sp+8),r13 8002728: 5b 9d 00 04 sw (sp+4),ra 800272c: b8 40 60 00 mv r12,r2 long adjustment; /* * Simple validations */ if ( !delta ) 8002730: 34 02 00 00 mvi r2,0 int adjtime( struct timeval *delta, struct timeval *olddelta ) { 8002734: b8 20 58 00 mv r11,r1 long adjustment; /* * Simple validations */ if ( !delta ) 8002738: 44 22 00 05 be r1,r2,800274c rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) 800273c: 28 23 00 04 lw r3,(r1+4) 8002740: 78 01 00 0f mvhi r1,0xf 8002744: 38 21 42 3f ori r1,r1,0x423f 8002748: 50 23 00 06 bgeu r1,r3,8002760 rtems_set_errno_and_return_minus_one( EINVAL ); 800274c: f8 00 2b 1e calli 800d3c4 <__errno> 8002750: 34 02 00 16 mvi r2,22 8002754: 58 22 00 00 sw (r1+0),r2 8002758: 34 01 ff ff mvi r1,-1 800275c: e0 00 00 3e bi 8002854 if ( olddelta ) { 8002760: 45 80 00 03 be r12,r0,800276c olddelta->tv_sec = 0; olddelta->tv_usec = 0; 8002764: 59 82 00 04 sw (r12+4),r2 if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { olddelta->tv_sec = 0; 8002768: 59 82 00 00 sw (r12+0),r2 olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); 800276c: 29 61 00 00 lw r1,(r11+0) 8002770: 78 02 00 0f mvhi r2,0xf 8002774: 38 42 42 40 ori r2,r2,0x4240 8002778: f8 00 64 e7 calli 801bb14 <__mulsi3> adjustment += delta->tv_usec; /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 800277c: 78 02 08 01 mvhi r2,0x801 8002780: 38 42 f0 c4 ori r2,r2,0xf0c4 olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); adjustment += delta->tv_usec; 8002784: 29 63 00 04 lw r3,(r11+4) /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 8002788: 28 42 00 0c lw r2,(r2+12) olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); adjustment += delta->tv_usec; 800278c: b4 23 08 00 add r1,r1,r3 /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) 8002790: 54 41 00 30 bgu r2,r1,8002850 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002794: 78 01 08 01 mvhi r1,0x801 8002798: 38 21 f9 9c ori r1,r1,0xf99c 800279c: 28 22 00 00 lw r2,(r1+0) 80027a0: 34 42 00 01 addi r2,r2,1 80027a4: 58 22 00 00 sw (r1+0),r2 * This prevents context switches while we are adjusting the TOD */ _Thread_Disable_dispatch(); _TOD_Get( &ts ); 80027a8: 37 81 00 14 addi r1,sp,20 80027ac: f8 00 03 b3 calli 8003678 <_TOD_Get> ts.tv_sec += delta->tv_sec; 80027b0: 29 63 00 00 lw r3,(r11+0) ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 80027b4: 29 61 00 04 lw r1,(r11+4) _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 80027b8: 2b 8d 00 14 lw r13,(sp+20) ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 80027bc: 34 02 03 e8 mvi r2,1000 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; 80027c0: b5 a3 68 00 add r13,r13,r3 ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 80027c4: f8 00 64 d4 calli 801bb14 <__mulsi3> 80027c8: 2b 84 00 18 lw r4,(sp+24) /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 80027cc: 78 03 3b 9a mvhi r3,0x3b9a 80027d0: 78 02 c4 65 mvhi r2,0xc465 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 80027d4: b4 24 08 00 add r1,r1,r4 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 80027d8: 38 63 c9 ff ori r3,r3,0xc9ff _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; 80027dc: b9 a0 20 00 mv r4,r13 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 80027e0: 38 42 36 00 ori r2,r2,0x3600 80027e4: e0 00 00 02 bi 80027ec 80027e8: b4 22 08 00 add r1,r1,r2 80027ec: b8 80 28 00 mv r5,r4 80027f0: 34 84 00 01 addi r4,r4,1 80027f4: 54 23 ff fd bgu r1,r3,80027e8 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 80027f8: 78 04 c4 65 mvhi r4,0xc465 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 80027fc: 78 03 3b 9a mvhi r3,0x3b9a 8002800: b8 20 10 00 mv r2,r1 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 8002804: 38 84 36 00 ori r4,r4,0x3600 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { 8002808: 38 63 ca 00 ori r3,r3,0xca00 800280c: e0 00 00 02 bi 8002814 8002810: b4 43 10 00 add r2,r2,r3 8002814: b8 a0 30 00 mv r6,r5 8002818: 34 a5 ff ff addi r5,r5,-1 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 800281c: 50 82 ff fd bgeu r4,r2,8002810 ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; } _TOD_Set( &ts ); 8002820: 37 81 00 14 addi r1,sp,20 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { 8002824: 5b 82 00 18 sw (sp+24),r2 8002828: 5b 86 00 14 sw (sp+20),r6 ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; } _TOD_Set( &ts ); 800282c: f8 00 03 c8 calli 800374c <_TOD_Set> _Thread_Enable_dispatch(); 8002830: f8 00 07 f3 calli 80047fc <_Thread_Enable_dispatch> /* set the user's output */ if ( olddelta ) 8002834: 45 80 00 07 be r12,r0,8002850 <== NEVER TAKEN *olddelta = *delta; 8002838: 29 61 00 00 lw r1,(r11+0) 800283c: 59 81 00 00 sw (r12+0),r1 8002840: 29 6b 00 04 lw r11,(r11+4) 8002844: 34 01 00 00 mvi r1,0 8002848: 59 8b 00 04 sw (r12+4),r11 800284c: e0 00 00 02 bi 8002854 8002850: 34 01 00 00 mvi r1,0 return 0; } 8002854: 2b 9d 00 04 lw ra,(sp+4) 8002858: 2b 8b 00 10 lw r11,(sp+16) 800285c: 2b 8c 00 0c lw r12,(sp+12) 8002860: 2b 8d 00 08 lw r13,(sp+8) 8002864: 37 9c 00 18 addi sp,sp,24 8002868: c3 a0 00 00 ret 080025f0 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 80025f0: 37 9c ff fc addi sp,sp,-4 80025f4: 5b 9d 00 04 sw (sp+4),ra if ( !tp ) 80025f8: 44 40 00 13 be r2,r0,8002644 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 80025fc: 34 03 00 01 mvi r3,1 8002600: 5c 23 00 04 bne r1,r3,8002610 _TOD_Get(tp); 8002604: b8 40 08 00 mv r1,r2 8002608: f8 00 06 0f calli 8003e44 <_TOD_Get> 800260c: e0 00 00 07 bi 8002628 return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 8002610: 34 03 00 04 mvi r3,4 8002614: 44 23 00 03 be r1,r3,8002620 <== NEVER TAKEN return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 8002618: 34 03 00 02 mvi r3,2 800261c: 5c 23 00 05 bne r1,r3,8002630 _TOD_Get_uptime_as_timespec( tp ); 8002620: b8 40 08 00 mv r1,r2 8002624: f8 00 06 2e calli 8003edc <_TOD_Get_uptime_as_timespec> 8002628: 34 01 00 00 mvi r1,0 return 0; 800262c: e0 00 00 0a bi 8002654 } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 8002630: 34 02 00 03 mvi r2,3 8002634: 5c 22 00 04 bne r1,r2,8002644 rtems_set_errno_and_return_minus_one( ENOSYS ); 8002638: f8 00 2b c8 calli 800d558 <__errno> 800263c: 34 02 00 58 mvi r2,88 8002640: e0 00 00 03 bi 800264c #endif rtems_set_errno_and_return_minus_one( EINVAL ); 8002644: f8 00 2b c5 calli 800d558 <__errno> 8002648: 34 02 00 16 mvi r2,22 800264c: 58 22 00 00 sw (r1+0),r2 8002650: 34 01 ff ff mvi r1,-1 return 0; } 8002654: 2b 9d 00 04 lw ra,(sp+4) 8002658: 37 9c 00 04 addi sp,sp,4 800265c: c3 a0 00 00 ret 08002660 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 8002660: 37 9c ff fc addi sp,sp,-4 8002664: 5b 9d 00 04 sw (sp+4),ra if ( !tp ) 8002668: 44 40 00 19 be r2,r0,80026cc <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 800266c: 34 03 00 01 mvi r3,1 8002670: 5c 23 00 10 bne r1,r3,80026b0 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 8002674: 28 43 00 00 lw r3,(r2+0) 8002678: 78 01 21 da mvhi r1,0x21da 800267c: 38 21 e4 ff ori r1,r1,0xe4ff 8002680: 54 61 00 02 bgu r3,r1,8002688 8002684: e0 00 00 12 bi 80026cc rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002688: 78 01 08 01 mvhi r1,0x801 800268c: 38 21 f8 b4 ori r1,r1,0xf8b4 8002690: 28 23 00 00 lw r3,(r1+0) 8002694: 34 63 00 01 addi r3,r3,1 8002698: 58 23 00 00 sw (r1+0),r3 rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); 800269c: b8 40 08 00 mv r1,r2 80026a0: f8 00 06 2c calli 8003f50 <_TOD_Set> _Thread_Enable_dispatch(); 80026a4: f8 00 0b 04 calli 80052b4 <_Thread_Enable_dispatch> 80026a8: 34 01 00 00 mvi r1,0 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; 80026ac: e0 00 00 0c bi 80026dc _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 80026b0: 34 02 00 02 mvi r2,2 80026b4: 44 22 00 03 be r1,r2,80026c0 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) 80026b8: 34 02 00 03 mvi r2,3 80026bc: 5c 22 00 04 bne r1,r2,80026cc rtems_set_errno_and_return_minus_one( ENOSYS ); 80026c0: f8 00 2b a6 calli 800d558 <__errno> 80026c4: 34 02 00 58 mvi r2,88 80026c8: e0 00 00 03 bi 80026d4 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 80026cc: f8 00 2b a3 calli 800d558 <__errno> 80026d0: 34 02 00 16 mvi r2,22 80026d4: 58 22 00 00 sw (r1+0),r2 80026d8: 34 01 ff ff mvi r1,-1 return 0; } 80026dc: 2b 9d 00 04 lw ra,(sp+4) 80026e0: 37 9c 00 04 addi sp,sp,4 80026e4: c3 a0 00 00 ret 08011d40 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 8011d40: 37 9c ff dc addi sp,sp,-36 8011d44: 5b 8b 00 18 sw (sp+24),r11 8011d48: 5b 8c 00 14 sw (sp+20),r12 8011d4c: 5b 8d 00 10 sw (sp+16),r13 8011d50: 5b 8e 00 0c sw (sp+12),r14 8011d54: 5b 8f 00 08 sw (sp+8),r15 8011d58: 5b 9d 00 04 sw (sp+4),ra 8011d5c: b8 20 60 00 mv r12,r1 8011d60: b8 40 58 00 mv r11,r2 8011d64: b8 60 68 00 mv r13,r3 POSIX_signals_Siginfo_node *psiginfo; /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) 8011d68: fb ff ed 0f calli 800d1a4 8011d6c: 45 81 00 04 be r12,r1,8011d7c rtems_set_errno_and_return_minus_one( ESRCH ); 8011d70: f8 00 03 ba calli 8012c58 <__errno> 8011d74: 34 02 00 03 mvi r2,3 8011d78: e0 00 00 04 bi 8011d88 /* * Validate the signal passed. */ if ( !sig ) 8011d7c: 5d 60 00 06 bne r11,r0,8011d94 rtems_set_errno_and_return_minus_one( EINVAL ); 8011d80: f8 00 03 b6 calli 8012c58 <__errno> 8011d84: 34 02 00 16 mvi r2,22 8011d88: 58 22 00 00 sw (r1+0),r2 8011d8c: 34 01 ff ff mvi r1,-1 8011d90: e0 00 00 96 bi 8011fe8 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 8011d94: 35 6f ff ff addi r15,r11,-1 if ( !is_valid_signo(sig) ) 8011d98: 34 01 00 1f mvi r1,31 8011d9c: 50 2f 00 02 bgeu r1,r15,8011da4 8011da0: e3 ff ff f8 bi 8011d80 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 ) 8011da4: b5 6b 08 00 add r1,r11,r11 8011da8: 34 02 00 02 mvi r2,2 8011dac: b4 2b 08 00 add r1,r1,r11 8011db0: 78 0c 08 02 mvhi r12,0x802 8011db4: fb ff bb 86 calli 8000bcc <__ashlsi3> 8011db8: 39 8c 5e 44 ori r12,r12,0x5e44 8011dbc: b5 81 08 00 add r1,r12,r1 8011dc0: 28 22 00 08 lw r2,(r1+8) 8011dc4: 34 0e 00 01 mvi r14,1 8011dc8: 34 01 00 00 mvi r1,0 8011dcc: 44 4e 00 87 be r2,r14,8011fe8 /* * 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 ) ) 8011dd0: 65 62 00 04 cmpei r2,r11,4 8011dd4: 65 61 00 08 cmpei r1,r11,8 8011dd8: b8 41 08 00 or r1,r2,r1 8011ddc: 5c 20 00 03 bne r1,r0,8011de8 8011de0: 34 01 00 0b mvi r1,11 8011de4: 5d 61 00 05 bne r11,r1,8011df8 return pthread_kill( pthread_self(), sig ); 8011de8: f8 00 01 f6 calli 80125c0 8011dec: b9 60 10 00 mv r2,r11 8011df0: f8 00 01 a8 calli 8012490 8011df4: e0 00 00 7d bi 8011fe8 static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); 8011df8: b9 e0 10 00 mv r2,r15 8011dfc: b9 c0 08 00 mv r1,r14 8011e00: fb ff bb 73 calli 8000bcc <__ashlsi3> /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; 8011e04: 5b 8e 00 20 sw (sp+32),r14 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 8011e08: 5b 8b 00 1c sw (sp+28),r11 8011e0c: b8 20 60 00 mv r12,r1 siginfo->si_code = SI_USER; if ( !value ) { 8011e10: 45 a0 00 02 be r13,r0,8011e18 siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; 8011e14: 29 ad 00 00 lw r13,(r13+0) rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8011e18: 78 01 08 02 mvhi r1,0x802 8011e1c: 5b 8d 00 24 sw (sp+36),r13 8011e20: 38 21 59 44 ori r1,r1,0x5944 8011e24: 28 22 00 00 lw r2,(r1+0) 8011e28: 34 42 00 01 addi r2,r2,1 8011e2c: 58 22 00 00 sw (r1+0),r2 /* * 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; 8011e30: 78 01 08 02 mvhi r1,0x802 8011e34: 38 21 5a 00 ori r1,r1,0x5a00 8011e38: 28 22 00 00 lw r2,(r1+0) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8011e3c: 28 41 01 2c lw r1,(r2+300) 8011e40: 28 21 00 cc lw r1,(r1+204) 8011e44: a4 20 08 00 not r1,r1 8011e48: a1 81 08 00 and r1,r12,r1 8011e4c: 5c 20 00 3f bne r1,r0,8011f48 /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = the_chain->first ; 8011e50: 78 01 08 02 mvhi r1,0x802 8011e54: 38 21 5f d0 ori r1,r1,0x5fd0 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Tail( Chain_Control *the_chain ) { return (Chain_Node *) &the_chain->permanent_null; 8011e58: 34 24 00 04 addi r4,r1,4 8011e5c: 28 23 00 00 lw r3,(r1+0) 8011e60: e0 00 00 0b bi 8011e8c #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 8011e64: 28 61 00 30 lw r1,(r3+48) for ( the_node = the_chain->first ; !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8011e68: 28 65 01 2c lw r5,(r3+300) for ( the_node = the_chain->first ; !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 8011e6c: b8 60 10 00 mv r2,r3 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 8011e70: a1 81 08 00 and r1,r12,r1 8011e74: 5c 20 00 35 bne r1,r0,8011f48 /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 8011e78: 28 a5 00 cc lw r5,(r5+204) 8011e7c: a4 a0 28 00 not r5,r5 8011e80: a1 85 28 00 and r5,r12,r5 8011e84: 5c a1 00 31 bne r5,r1,8011f48 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 ) { 8011e88: 28 63 00 00 lw r3,(r3+0) 8011e8c: 5c 64 ff f6 bne r3,r4,8011e64 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 8011e90: 78 01 08 02 mvhi r1,0x802 8011e94: 38 21 50 a8 ori r1,r1,0x50a8 8011e98: 40 25 00 00 lbu r5,(r1+0) 8011e9c: 78 02 08 02 mvhi r2,0x802 8011ea0: 38 42 58 e4 ori r2,r2,0x58e4 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 8011ea4: 78 04 10 00 mvhi r4,0x1000 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 8011ea8: 34 a5 00 01 addi r5,r5,1 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 8011eac: 38 84 00 00 ori r4,r4,0x0 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 8011eb0: 34 4d 00 0c addi r13,r2,12 8011eb4: 34 01 00 00 mvi r1,0 for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { /* * This can occur when no one is interested and ITRON is not configured. */ if ( !_Objects_Information_table[ the_api ] ) 8011eb8: 28 43 00 00 lw r3,(r2+0) 8011ebc: 44 60 00 1f be r3,r0,8011f38 continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 8011ec0: 28 63 00 04 lw r3,(r3+4) */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 8011ec4: 34 08 00 01 mvi r8,1 8011ec8: 28 67 00 1c lw r7,(r3+28) 8011ecc: 2c 6e 00 10 lhu r14,(r3+16) object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 8011ed0: e0 00 00 19 bi 8011f34 the_thread = (Thread_Control *) object_table[ index ]; 8011ed4: 28 e3 00 04 lw r3,(r7+4) if ( !the_thread ) 8011ed8: 44 60 00 11 be r3,r0,8011f1c /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 8011edc: 28 66 00 14 lw r6,(r3+20) 8011ee0: 54 c5 00 0f bgu r6,r5,8011f1c DEBUG_STEP("2"); /* * If this thread is not interested, then go on to the next thread. */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8011ee4: 28 69 01 2c lw r9,(r3+300) 8011ee8: 29 29 00 cc lw r9,(r9+204) 8011eec: a5 20 48 00 not r9,r9 8011ef0: a1 89 48 00 and r9,r12,r9 8011ef4: 45 20 00 0a be r9,r0,8011f1c * * 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 ) { 8011ef8: 54 a6 00 0b bgu r5,r6,8011f24 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( !_States_Is_ready( interested->current_state ) ) { 8011efc: 28 29 00 10 lw r9,(r1+16) 8011f00: 45 20 00 07 be r9,r0,8011f1c <== NEVER TAKEN /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 8011f04: 28 6a 00 10 lw r10,(r3+16) 8011f08: 45 40 00 07 be r10,r0,8011f24 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 8011f0c: a1 24 48 00 and r9,r9,r4 8011f10: 5d 20 00 03 bne r9,r0,8011f1c DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 8011f14: a1 44 50 00 and r10,r10,r4 8011f18: 5d 49 00 03 bne r10,r9,8011f24 8011f1c: b8 a0 30 00 mv r6,r5 8011f20: e0 00 00 02 bi 8011f28 8011f24: b8 60 08 00 mv r1,r3 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 8011f28: 35 08 00 01 addi r8,r8,1 8011f2c: 34 e7 00 04 addi r7,r7,4 8011f30: b8 c0 28 00 mv r5,r6 8011f34: 51 c8 ff e8 bgeu r14,r8,8011ed4 8011f38: 34 42 00 04 addi r2,r2,4 * + 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++) { 8011f3c: 5c 4d ff df bne r2,r13,8011eb8 } } } } if ( interested ) { 8011f40: 44 20 00 09 be r1,r0,8011f64 8011f44: b8 20 10 00 mv r2,r1 * 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; 8011f48: 34 01 00 01 mvi r1,1 8011f4c: 30 41 00 74 sb (r2+116),r1 /* * 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 ) ) { 8011f50: 37 83 00 1c addi r3,sp,28 8011f54: b8 40 08 00 mv r1,r2 8011f58: b9 60 10 00 mv r2,r11 8011f5c: f8 00 00 c8 calli 801227c <_POSIX_signals_Unblock_thread> 8011f60: 5c 20 00 20 bne r1,r0,8011fe0 /* * 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 ); 8011f64: b9 80 08 00 mv r1,r12 8011f68: f8 00 00 b2 calli 8012230 <_POSIX_signals_Set_process_signals> if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 8011f6c: b5 6b 08 00 add r1,r11,r11 8011f70: b4 2b 08 00 add r1,r1,r11 8011f74: 34 02 00 02 mvi r2,2 8011f78: 78 0b 08 02 mvhi r11,0x802 8011f7c: fb ff bb 14 calli 8000bcc <__ashlsi3> 8011f80: 39 6b 5e 44 ori r11,r11,0x5e44 8011f84: b5 61 58 00 add r11,r11,r1 8011f88: 29 62 00 00 lw r2,(r11+0) 8011f8c: b8 20 60 00 mv r12,r1 8011f90: 34 01 00 02 mvi r1,2 8011f94: 5c 41 00 13 bne r2,r1,8011fe0 psiginfo = (POSIX_signals_Siginfo_node *) 8011f98: 78 01 08 02 mvhi r1,0x802 8011f9c: 38 21 5f c4 ori r1,r1,0x5fc4 8011fa0: fb ff cb 9d calli 8004e14 <_Chain_Get> 8011fa4: b8 20 58 00 mv r11,r1 _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { 8011fa8: 5c 20 00 05 bne r1,r0,8011fbc _Thread_Enable_dispatch(); 8011fac: fb ff d2 21 calli 8006830 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); 8011fb0: f8 00 03 2a calli 8012c58 <__errno> 8011fb4: 34 02 00 0b mvi r2,11 8011fb8: e3 ff ff 74 bi 8011d88 } psiginfo->Info = *siginfo; 8011fbc: 37 82 00 1c addi r2,sp,28 8011fc0: 34 03 00 0c mvi r3,12 8011fc4: 34 21 00 08 addi r1,r1,8 8011fc8: f8 00 05 ca calli 80136f0 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 8011fcc: 78 03 08 02 mvhi r3,0x802 8011fd0: 38 63 60 3c ori r3,r3,0x603c 8011fd4: b5 83 08 00 add r1,r12,r3 8011fd8: b9 60 10 00 mv r2,r11 8011fdc: fb ff cb 78 calli 8004dbc <_Chain_Append> } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 8011fe0: fb ff d2 14 calli 8006830 <_Thread_Enable_dispatch> 8011fe4: 34 01 00 00 mvi r1,0 return 0; } 8011fe8: 2b 9d 00 04 lw ra,(sp+4) 8011fec: 2b 8b 00 18 lw r11,(sp+24) 8011ff0: 2b 8c 00 14 lw r12,(sp+20) 8011ff4: 2b 8d 00 10 lw r13,(sp+16) 8011ff8: 2b 8e 00 0c lw r14,(sp+12) 8011ffc: 2b 8f 00 08 lw r15,(sp+8) 8012000: 37 9c 00 24 addi sp,sp,36 8012004: c3 a0 00 00 ret 0801ba90 : int nanosleep( const struct timespec *rqtp, struct timespec *rmtp ) { 801ba90: 37 9c ff ec addi sp,sp,-20 801ba94: 5b 8b 00 14 sw (sp+20),r11 801ba98: 5b 8c 00 10 sw (sp+16),r12 801ba9c: 5b 8d 00 0c sw (sp+12),r13 801baa0: 5b 8e 00 08 sw (sp+8),r14 801baa4: 5b 9d 00 04 sw (sp+4),ra Watchdog_Interval ticks; if ( !_Timespec_Is_valid( rqtp ) ) 801baa8: 34 0e 00 00 mvi r14,0 int nanosleep( const struct timespec *rqtp, struct timespec *rmtp ) { 801baac: b8 40 68 00 mv r13,r2 801bab0: b8 20 58 00 mv r11,r1 Watchdog_Interval ticks; if ( !_Timespec_Is_valid( rqtp ) ) 801bab4: f8 00 00 a6 calli 801bd4c <_Timespec_Is_valid> 801bab8: 44 2e 00 05 be r1,r14,801bacc * Return EINVAL if the delay interval is negative. * * NOTE: This behavior is beyond the POSIX specification. * FSU and GNU/Linux pthreads shares this behavior. */ if ( rqtp->tv_sec < 0 || rqtp->tv_nsec < 0 ) 801babc: 29 61 00 00 lw r1,(r11+0) 801bac0: 48 01 00 03 bg r0,r1,801bacc <== NEVER TAKEN 801bac4: 29 61 00 04 lw r1,(r11+4) 801bac8: 4c 20 00 04 bge r1,r0,801bad8 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); 801bacc: fb ff c3 f6 calli 800caa4 <__errno> 801bad0: 34 02 00 16 mvi r2,22 801bad4: e0 00 00 34 bi 801bba4 ticks = _Timespec_To_ticks( rqtp ); 801bad8: b9 60 08 00 mv r1,r11 801badc: fb ff b7 2b calli 8009788 <_Timespec_To_ticks> 801bae0: b8 20 58 00 mv r11,r1 801bae4: 78 01 08 01 mvhi r1,0x801 801bae8: 38 21 e8 dc ori r1,r1,0xe8dc * A nanosleep for zero time is implemented as a yield. * This behavior is also beyond the POSIX specification but is * consistent with the RTEMS API and yields desirable behavior. */ if ( !ticks ) { 801baec: 5d 60 00 0b bne r11,r0,801bb18 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 801baf0: 28 22 00 00 lw r2,(r1+0) 801baf4: 34 42 00 01 addi r2,r2,1 801baf8: 58 22 00 00 sw (r1+0),r2 _Thread_Disable_dispatch(); _Thread_Yield_processor(); 801bafc: f8 00 00 54 calli 801bc4c <_Thread_Yield_processor> _Thread_Enable_dispatch(); 801bb00: fb ff a1 18 calli 8003f60 <_Thread_Enable_dispatch> if ( rmtp ) { 801bb04: 45 ab 00 2b be r13,r11,801bbb0 rmtp->tv_sec = 0; rmtp->tv_nsec = 0; 801bb08: 59 ab 00 04 sw (r13+4),r11 if ( !ticks ) { _Thread_Disable_dispatch(); _Thread_Yield_processor(); _Thread_Enable_dispatch(); if ( rmtp ) { rmtp->tv_sec = 0; 801bb0c: 59 ab 00 00 sw (r13+0),r11 rmtp->tv_nsec = 0; 801bb10: b9 60 08 00 mv r1,r11 801bb14: e0 00 00 28 bi 801bbb4 801bb18: 28 22 00 00 lw r2,(r1+0) 801bb1c: 34 42 00 01 addi r2,r2,1 801bb20: 58 22 00 00 sw (r1+0),r2 /* * Block for the desired amount of time */ _Thread_Disable_dispatch(); _Thread_Set_state( 801bb24: 78 0c 08 01 mvhi r12,0x801 801bb28: 39 8c e9 98 ori r12,r12,0xe998 801bb2c: 29 81 00 00 lw r1,(r12+0) 801bb30: 78 02 10 00 mvhi r2,0x1000 801bb34: 38 42 00 08 ori r2,r2,0x8 801bb38: fb ff b6 79 calli 800951c <_Thread_Set_state> _Thread_Executing, STATES_DELAYING | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Watchdog_Initialize( &_Thread_Executing->Timer, 801bb3c: 29 83 00 00 lw r3,(r12+0) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 801bb40: 78 02 08 01 mvhi r2,0x801 801bb44: 38 42 bc 08 ori r2,r2,0xbc08 _Thread_Disable_dispatch(); _Thread_Set_state( _Thread_Executing, STATES_DELAYING | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Watchdog_Initialize( 801bb48: 28 64 00 08 lw r4,(r3+8) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 801bb4c: 78 01 08 01 mvhi r1,0x801 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 801bb50: 58 62 00 64 sw (r3+100),r2 the_watchdog->id = id; 801bb54: 58 64 00 68 sw (r3+104),r4 the_watchdog->user_data = user_data; 801bb58: 58 6e 00 6c sw (r3+108),r14 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 801bb5c: 38 21 e9 b8 ori r1,r1,0xe9b8 801bb60: 34 62 00 48 addi r2,r3,72 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 801bb64: 58 6e 00 50 sw (r3+80),r14 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 801bb68: 58 6b 00 54 sw (r3+84),r11 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 801bb6c: fb ff b7 38 calli 800984c <_Watchdog_Insert> _Thread_Delay_ended, _Thread_Executing->Object.id, NULL ); _Watchdog_Insert_ticks( &_Thread_Executing->Timer, ticks ); _Thread_Enable_dispatch(); 801bb70: fb ff a0 fc calli 8003f60 <_Thread_Enable_dispatch> /* calculate time remaining */ if ( rmtp ) { 801bb74: 45 a0 00 0f be r13,r0,801bbb0 ticks -= _Thread_Executing->Timer.stop_time - _Thread_Executing->Timer.start_time; 801bb78: 29 81 00 00 lw r1,(r12+0) _Timespec_From_ticks( ticks, rmtp ); 801bb7c: b9 a0 10 00 mv r2,r13 _Thread_Enable_dispatch(); /* calculate time remaining */ if ( rmtp ) { ticks -= 801bb80: 28 23 00 60 lw r3,(r1+96) 801bb84: 28 21 00 5c lw r1,(r1+92) 801bb88: c8 23 08 00 sub r1,r1,r3 801bb8c: b4 2b 58 00 add r11,r1,r11 _Thread_Executing->Timer.stop_time - _Thread_Executing->Timer.start_time; _Timespec_From_ticks( ticks, rmtp ); 801bb90: b9 60 08 00 mv r1,r11 801bb94: f8 00 00 54 calli 801bce4 <_Timespec_From_ticks> */ #if defined(RTEMS_POSIX_API) /* * If there is time remaining, then we were interrupted by a signal. */ if ( ticks ) 801bb98: 45 60 00 06 be r11,r0,801bbb0 rtems_set_errno_and_return_minus_one( EINTR ); 801bb9c: fb ff c3 c2 calli 800caa4 <__errno> 801bba0: 34 02 00 04 mvi r2,4 801bba4: 58 22 00 00 sw (r1+0),r2 801bba8: 34 01 ff ff mvi r1,-1 801bbac: e0 00 00 02 bi 801bbb4 801bbb0: 34 01 00 00 mvi r1,0 #endif } return 0; } 801bbb4: 2b 9d 00 04 lw ra,(sp+4) 801bbb8: 2b 8b 00 14 lw r11,(sp+20) 801bbbc: 2b 8c 00 10 lw r12,(sp+16) 801bbc0: 2b 8d 00 0c lw r13,(sp+12) 801bbc4: 2b 8e 00 08 lw r14,(sp+8) 801bbc8: 37 9c 00 14 addi sp,sp,20 801bbcc: c3 a0 00 00 ret 08006fe8 : int pthread_attr_getstackaddr( const pthread_attr_t *attr, void **stackaddr ) { if ( !attr || !attr->is_initialized || !stackaddr ) 8006fe8: 44 20 00 0a be r1,r0,8007010 <== NEVER TAKEN 8006fec: 28 23 00 00 lw r3,(r1+0) 8006ff0: 64 44 00 00 cmpei r4,r2,0 8006ff4: 64 63 00 00 cmpei r3,r3,0 8006ff8: b8 83 18 00 or r3,r4,r3 8006ffc: 5c 60 00 05 bne r3,r0,8007010 return EINVAL; *stackaddr = attr->stackaddr; 8007000: 28 21 00 04 lw r1,(r1+4) 8007004: 58 41 00 00 sw (r2+0),r1 8007008: b8 60 08 00 mv r1,r3 return 0; 800700c: c3 a0 00 00 ret 8007010: 34 01 00 16 mvi r1,22 } 8007014: c3 a0 00 00 ret 08007124 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) 8007124: 44 20 00 0d be r1,r0,8007158 8007128: 28 23 00 00 lw r3,(r1+0) 800712c: 44 60 00 0b be r3,r0,8007158 return EINVAL; switch ( policy ) { 8007130: 48 02 00 05 bg r0,r2,8007144 8007134: 34 03 00 02 mvi r3,2 8007138: 4c 62 00 05 bge r3,r2,800714c 800713c: 34 03 00 04 mvi r3,4 8007140: 44 43 00 03 be r2,r3,800714c <== ALWAYS TAKEN 8007144: 34 01 00 86 mvi r1,134 8007148: c3 a0 00 00 ret case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 800714c: 58 22 00 14 sw (r1+20),r2 8007150: 34 01 00 00 mvi r1,0 return 0; 8007154: c3 a0 00 00 ret 8007158: 34 01 00 16 mvi r1,22 default: return ENOTSUP; } } 800715c: c3 a0 00 00 ret 08002d38 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 8002d38: 37 9c ff d8 addi sp,sp,-40 8002d3c: 5b 8b 00 18 sw (sp+24),r11 8002d40: 5b 8c 00 14 sw (sp+20),r12 8002d44: 5b 8d 00 10 sw (sp+16),r13 8002d48: 5b 8e 00 0c sw (sp+12),r14 8002d4c: 5b 8f 00 08 sw (sp+8),r15 8002d50: 5b 9d 00 04 sw (sp+4),ra 8002d54: b8 20 68 00 mv r13,r1 8002d58: b8 60 60 00 mv r12,r3 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 8002d5c: 44 20 00 2c be r1,r0,8002e0c return EINVAL; if ( count == 0 ) 8002d60: 44 60 00 2b be r3,r0,8002e0c return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 8002d64: b8 40 20 00 mv r4,r2 8002d68: 5c 40 00 05 bne r2,r0,8002d7c the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 8002d6c: 37 8b 00 1c addi r11,sp,28 8002d70: b9 60 08 00 mv r1,r11 8002d74: fb ff ff bb calli 8002c60 8002d78: b9 60 20 00 mv r4,r11 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 8002d7c: 28 81 00 00 lw r1,(r4+0) 8002d80: 44 20 00 23 be r1,r0,8002e0c return EINVAL; switch ( the_attr->process_shared ) { 8002d84: 28 8b 00 04 lw r11,(r4+4) 8002d88: 5d 60 00 21 bne r11,r0,8002e0c <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002d8c: 78 02 08 01 mvhi r2,0x801 8002d90: 38 42 f8 7c ori r2,r2,0xf87c 8002d94: 28 41 00 00 lw r1,(r2+0) /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; the_attributes.maximum_count = count; 8002d98: 5b 8c 00 28 sw (sp+40),r12 } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 8002d9c: 5b 8b 00 24 sw (sp+36),r11 8002da0: 34 21 00 01 addi r1,r1,1 8002da4: 58 41 00 00 sw (r2+0),r1 * This function allocates a barrier control block from * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) 8002da8: 78 01 08 01 mvhi r1,0x801 8002dac: 38 21 fb fc ori r1,r1,0xfbfc 8002db0: f8 00 06 c7 calli 80048cc <_Objects_Allocate> 8002db4: b8 20 60 00 mv r12,r1 */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 8002db8: 5c 2b 00 04 bne r1,r11,8002dc8 _Thread_Enable_dispatch(); 8002dbc: f8 00 0a 0f calli 80055f8 <_Thread_Enable_dispatch> 8002dc0: 34 01 00 0b mvi r1,11 return EAGAIN; 8002dc4: e0 00 00 13 bi 8002e10 } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 8002dc8: 34 21 00 10 addi r1,r1,16 8002dcc: 37 82 00 24 addi r2,sp,36 8002dd0: f8 00 04 0f calli 8003e0c <_CORE_barrier_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8002dd4: 78 02 08 01 mvhi r2,0x801 8002dd8: 29 8e 00 08 lw r14,(r12+8) 8002ddc: 38 42 fb fc ori r2,r2,0xfbfc 8002de0: 28 4f 00 1c lw r15,(r2+28) 8002de4: 21 c1 ff ff andi r1,r14,0xffff 8002de8: 34 02 00 02 mvi r2,2 8002dec: fb ff f8 59 calli 8000f50 <__ashlsi3> 8002df0: b5 e1 08 00 add r1,r15,r1 8002df4: 58 2c 00 00 sw (r1+0),r12 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 8002df8: 59 8b 00 0c sw (r12+12),r11 ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 8002dfc: 59 ae 00 00 sw (r13+0),r14 _Thread_Enable_dispatch(); 8002e00: f8 00 09 fe calli 80055f8 <_Thread_Enable_dispatch> 8002e04: b9 60 08 00 mv r1,r11 return 0; 8002e08: e0 00 00 02 bi 8002e10 8002e0c: 34 01 00 16 mvi r1,22 } 8002e10: 2b 9d 00 04 lw ra,(sp+4) 8002e14: 2b 8b 00 18 lw r11,(sp+24) 8002e18: 2b 8c 00 14 lw r12,(sp+20) 8002e1c: 2b 8d 00 10 lw r13,(sp+16) 8002e20: 2b 8e 00 0c lw r14,(sp+12) 8002e24: 2b 8f 00 08 lw r15,(sp+8) 8002e28: 37 9c 00 28 addi sp,sp,40 8002e2c: c3 a0 00 00 ret 08002424 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 8002424: 37 9c ff f4 addi sp,sp,-12 8002428: 5b 8b 00 0c sw (sp+12),r11 800242c: 5b 8c 00 08 sw (sp+8),r12 8002430: 5b 9d 00 04 sw (sp+4),ra 8002434: b8 20 58 00 mv r11,r1 8002438: b8 40 60 00 mv r12,r2 /* * 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 ) 800243c: 44 20 00 14 be r1,r0,800248c rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002440: 78 03 08 01 mvhi r3,0x801 8002444: 38 63 f8 64 ori r3,r3,0xf864 8002448: 28 61 00 00 lw r1,(r3+0) 800244c: 34 21 00 01 addi r1,r1,1 8002450: 58 61 00 00 sw (r3+0),r1 return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 8002454: 34 01 00 10 mvi r1,16 8002458: f8 00 0f 7e calli 8006250 <_Workspace_Allocate> 800245c: b8 20 18 00 mv r3,r1 if ( handler ) { 8002460: 44 20 00 0a be r1,r0,8002488 <== NEVER TAKEN thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; 8002464: 78 04 08 01 mvhi r4,0x801 8002468: 38 84 f9 20 ori r4,r4,0xf920 800246c: 28 81 00 00 lw r1,(r4+0) handler->routine = routine; 8002470: 58 6b 00 08 sw (r3+8),r11 handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); 8002474: b8 60 10 00 mv r2,r3 handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); if ( handler ) { thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; 8002478: 28 21 01 2c lw r1,(r1+300) handler->routine = routine; handler->arg = arg; 800247c: 58 6c 00 0c sw (r3+12),r12 _Chain_Append( handler_stack, &handler->Node ); 8002480: 34 21 00 e0 addi r1,r1,224 8002484: f8 00 04 48 calli 80035a4 <_Chain_Append> } _Thread_Enable_dispatch(); 8002488: f8 00 09 f3 calli 8004c54 <_Thread_Enable_dispatch> } 800248c: 2b 9d 00 04 lw ra,(sp+4) 8002490: 2b 8b 00 0c lw r11,(sp+12) 8002494: 2b 8c 00 08 lw r12,(sp+8) 8002498: 37 9c 00 0c addi sp,sp,12 800249c: c3 a0 00 00 ret 0800379c : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 800379c: 37 9c ff e8 addi sp,sp,-24 80037a0: 5b 8b 00 18 sw (sp+24),r11 80037a4: 5b 8c 00 14 sw (sp+20),r12 80037a8: 5b 8d 00 10 sw (sp+16),r13 80037ac: 5b 8e 00 0c sw (sp+12),r14 80037b0: 5b 8f 00 08 sw (sp+8),r15 80037b4: 5b 9d 00 04 sw (sp+4),ra 80037b8: b8 20 70 00 mv r14,r1 POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; 80037bc: b8 40 60 00 mv r12,r2 80037c0: 5c 40 00 03 bne r2,r0,80037cc 80037c4: 78 0c 08 01 mvhi r12,0x801 80037c8: 39 8c e7 70 ori r12,r12,0xe770 /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 80037cc: 29 82 00 04 lw r2,(r12+4) 80037d0: 34 01 00 01 mvi r1,1 80037d4: 44 41 00 27 be r2,r1,8003870 <== NEVER TAKEN return EINVAL; if ( !the_attr->is_initialized ) 80037d8: 29 81 00 00 lw r1,(r12+0) 80037dc: 34 0d 00 00 mvi r13,0 80037e0: 44 2d 00 24 be r1,r13,8003870 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 80037e4: 78 02 08 02 mvhi r2,0x802 80037e8: 38 42 08 74 ori r2,r2,0x874 80037ec: 28 41 00 00 lw r1,(r2+0) 80037f0: 34 21 00 01 addi r1,r1,1 80037f4: 58 41 00 00 sw (r2+0),r1 */ RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) 80037f8: 78 01 08 02 mvhi r1,0x802 80037fc: 38 21 0c 8c ori r1,r1,0xc8c 8003800: f8 00 08 93 calli 8005a4c <_Objects_Allocate> 8003804: b8 20 58 00 mv r11,r1 _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 8003808: 5c 2d 00 04 bne r1,r13,8003818 _Thread_Enable_dispatch(); 800380c: f8 00 0c 6f calli 80069c8 <_Thread_Enable_dispatch> 8003810: 34 01 00 0c mvi r1,12 return ENOMEM; 8003814: e0 00 00 18 bi 8003874 } the_cond->process_shared = the_attr->process_shared; 8003818: 29 8c 00 04 lw r12,(r12+4) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; /* XXX some more initialization might need to go here */ _Thread_queue_Initialize( 800381c: 34 03 08 00 mvi r3,2048 8003820: 34 04 00 74 mvi r4,116 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 8003824: 58 2c 00 10 sw (r1+16),r12 the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; 8003828: 58 2d 00 14 sw (r1+20),r13 /* XXX some more initialization might need to go here */ _Thread_queue_Initialize( 800382c: b9 a0 10 00 mv r2,r13 8003830: 34 21 00 18 addi r1,r1,24 8003834: f8 00 0e 9f calli 80072b0 <_Thread_queue_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8003838: 78 02 08 02 mvhi r2,0x802 800383c: 29 6c 00 08 lw r12,(r11+8) 8003840: 38 42 0c 8c ori r2,r2,0xc8c 8003844: 28 4f 00 1c lw r15,(r2+28) 8003848: 21 81 ff ff andi r1,r12,0xffff 800384c: 34 02 00 02 mvi r2,2 8003850: fb ff f8 1a calli 80018b8 <__ashlsi3> 8003854: b5 e1 10 00 add r2,r15,r1 8003858: 58 4b 00 00 sw (r2+0),r11 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 800385c: 59 6d 00 0c sw (r11+12),r13 &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 8003860: 59 cc 00 00 sw (r14+0),r12 _Thread_Enable_dispatch(); 8003864: f8 00 0c 59 calli 80069c8 <_Thread_Enable_dispatch> 8003868: b9 a0 08 00 mv r1,r13 return 0; 800386c: e0 00 00 02 bi 8003874 8003870: 34 01 00 16 mvi r1,22 } 8003874: 2b 9d 00 04 lw ra,(sp+4) 8003878: 2b 8b 00 18 lw r11,(sp+24) 800387c: 2b 8c 00 14 lw r12,(sp+20) 8003880: 2b 8d 00 10 lw r13,(sp+16) 8003884: 2b 8e 00 0c lw r14,(sp+12) 8003888: 2b 8f 00 08 lw r15,(sp+8) 800388c: 37 9c 00 18 addi sp,sp,24 8003890: c3 a0 00 00 ret 080035f0 : int pthread_condattr_destroy( pthread_condattr_t *attr ) { if ( !attr || attr->is_initialized == false ) 80035f0: 34 02 00 00 mvi r2,0 80035f4: 44 22 00 06 be r1,r2,800360c 80035f8: 28 23 00 00 lw r3,(r1+0) 80035fc: 44 62 00 04 be r3,r2,800360c <== NEVER TAKEN return EINVAL; attr->is_initialized = false; 8003600: 58 22 00 00 sw (r1+0),r2 8003604: b8 40 08 00 mv r1,r2 return 0; 8003608: c3 a0 00 00 ret 800360c: 34 01 00 16 mvi r1,22 } 8003610: c3 a0 00 00 ret 08002938 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 8002938: 37 9c ff a4 addi sp,sp,-92 800293c: 5b 8b 00 38 sw (sp+56),r11 8002940: 5b 8c 00 34 sw (sp+52),r12 8002944: 5b 8d 00 30 sw (sp+48),r13 8002948: 5b 8e 00 2c sw (sp+44),r14 800294c: 5b 8f 00 28 sw (sp+40),r15 8002950: 5b 90 00 24 sw (sp+36),r16 8002954: 5b 91 00 20 sw (sp+32),r17 8002958: 5b 92 00 1c sw (sp+28),r18 800295c: 5b 93 00 18 sw (sp+24),r19 8002960: 5b 94 00 14 sw (sp+20),r20 8002964: 5b 9d 00 10 sw (sp+16),ra int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 8002968: 34 0c 00 0e mvi r12,14 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 800296c: b8 60 80 00 mv r16,r3 8002970: b8 20 88 00 mv r17,r1 8002974: b8 80 90 00 mv r18,r4 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 8002978: 44 60 00 83 be r3,r0,8002b84 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 800297c: b8 40 58 00 mv r11,r2 8002980: 5c 40 00 03 bne r2,r0,800298c 8002984: 78 0b 08 01 mvhi r11,0x801 8002988: 39 6b cb 94 ori r11,r11,0xcb94 if ( !the_attr->is_initialized ) 800298c: 29 61 00 00 lw r1,(r11+0) 8002990: 44 20 00 7c be r1,r0,8002b80 * 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) ) 8002994: 29 61 00 04 lw r1,(r11+4) 8002998: 44 20 00 06 be r1,r0,80029b0 800299c: 78 02 08 01 mvhi r2,0x801 80029a0: 38 42 e0 e0 ori r2,r2,0xe0e0 80029a4: 28 41 00 00 lw r1,(r2+0) 80029a8: 29 62 00 08 lw r2,(r11+8) 80029ac: 54 22 00 75 bgu r1,r2,8002b80 * 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 ) { 80029b0: 29 62 00 10 lw r2,(r11+16) 80029b4: 34 01 00 01 mvi r1,1 80029b8: 44 41 00 04 be r2,r1,80029c8 80029bc: 34 01 00 02 mvi r1,2 80029c0: 5c 41 00 70 bne r2,r1,8002b80 80029c4: e0 00 00 0a bi 80029ec case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 80029c8: 78 02 08 01 mvhi r2,0x801 80029cc: 38 42 e9 20 ori r2,r2,0xe920 80029d0: 28 42 00 00 lw r2,(r2+0) schedpolicy = api->schedpolicy; schedparam = api->schedparam; 80029d4: 37 81 00 3c addi r1,sp,60 80029d8: 34 03 00 1c mvi r3,28 * 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 ]; 80029dc: 28 45 01 2c lw r5,(r2+300) schedpolicy = api->schedpolicy; schedparam = api->schedparam; 80029e0: 34 a2 00 84 addi r2,r5,132 * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; schedpolicy = api->schedpolicy; 80029e4: 28 af 00 80 lw r15,(r5+128) 80029e8: e0 00 00 05 bi 80029fc schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 80029ec: 29 6f 00 14 lw r15,(r11+20) schedparam = the_attr->schedparam; 80029f0: 37 81 00 3c addi r1,sp,60 80029f4: 35 62 00 18 addi r2,r11,24 80029f8: 34 03 00 1c mvi r3,28 80029fc: f8 00 2c e6 calli 800dd94 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 8002a00: 29 6d 00 0c lw r13,(r11+12) 8002a04: 34 0c 00 86 mvi r12,134 8002a08: 5d a0 00 5f bne r13,r0,8002b84 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 8002a0c: 2b 81 00 3c lw r1,(sp+60) 8002a10: f8 00 19 a6 calli 80090a8 <_POSIX_Priority_Is_valid> 8002a14: 44 2d 00 5b be r1,r13,8002b80 <== NEVER TAKEN RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 8002a18: 78 05 08 01 mvhi r5,0x801 8002a1c: 38 a5 e0 e4 ori r5,r5,0xe0e4 core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 8002a20: b9 e0 08 00 mv r1,r15 8002a24: 37 82 00 3c addi r2,sp,60 8002a28: 37 83 00 5c addi r3,sp,92 8002a2c: 37 84 00 58 addi r4,sp,88 8002a30: 40 b4 00 00 lbu r20,(r5+0) * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 8002a34: 2b 93 00 3c lw r19,(sp+60) /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 8002a38: f8 00 19 a4 calli 80090c8 <_POSIX_Thread_Translate_sched_param> 8002a3c: b8 20 60 00 mv r12,r1 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 8002a40: 5c 20 00 51 bne r1,r0,8002b84 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 8002a44: 78 0e 08 01 mvhi r14,0x801 8002a48: 39 ce e9 18 ori r14,r14,0xe918 8002a4c: 29 c1 00 00 lw r1,(r14+0) 8002a50: f8 00 04 4d calli 8003b84 <_API_Mutex_Lock> * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 8002a54: 78 01 08 01 mvhi r1,0x801 8002a58: 38 21 ea 64 ori r1,r1,0xea64 8002a5c: f8 00 06 fd calli 8004650 <_Objects_Allocate> 8002a60: b8 20 68 00 mv r13,r1 * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 8002a64: 5c 2c 00 03 bne r1,r12,8002a70 _RTEMS_Unlock_allocator(); 8002a68: 29 c1 00 00 lw r1,(r14+0) 8002a6c: e0 00 00 1f bi 8002ae8 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 8002a70: 78 02 08 01 mvhi r2,0x801 8002a74: 38 42 e0 e0 ori r2,r2,0xe0e0 8002a78: 28 42 00 00 lw r2,(r2+0) 8002a7c: 29 65 00 08 lw r5,(r11+8) 8002a80: 29 63 00 04 lw r3,(r11+4) 8002a84: b4 42 10 00 add r2,r2,r2 8002a88: 50 45 00 02 bgeu r2,r5,8002a90 8002a8c: b8 a0 10 00 mv r2,r5 8002a90: 34 09 00 00 mvi r9,0 8002a94: 5b 89 00 08 sw (sp+8),r9 8002a98: 2b 88 00 5c lw r8,(sp+92) 8002a9c: 2b 89 00 58 lw r9,(sp+88) 8002aa0: 78 01 08 01 mvhi r1,0x801 8002aa4: b8 40 20 00 mv r4,r2 8002aa8: ca 93 30 00 sub r6,r20,r19 8002aac: 38 21 ea 64 ori r1,r1,0xea64 8002ab0: b9 a0 10 00 mv r2,r13 8002ab4: b9 80 28 00 mv r5,r12 8002ab8: 34 07 00 01 mvi r7,1 8002abc: 5b 89 00 04 sw (sp+4),r9 8002ac0: 5b 8c 00 0c sw (sp+12),r12 8002ac4: f8 00 0a 69 calli 8005468 <_Thread_Initialize> budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 8002ac8: 5c 20 00 0a bne r1,r0,8002af0 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 8002acc: 78 01 08 01 mvhi r1,0x801 8002ad0: 38 21 ea 64 ori r1,r1,0xea64 8002ad4: b9 a0 10 00 mv r2,r13 8002ad8: f8 00 07 db calli 8004a44 <_Objects_Free> _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 8002adc: 78 01 08 01 mvhi r1,0x801 8002ae0: 38 21 e9 18 ori r1,r1,0xe918 8002ae4: 28 21 00 00 lw r1,(r1+0) 8002ae8: 34 0c 00 0b mvi r12,11 8002aec: e0 00 00 23 bi 8002b78 } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8002af0: 29 ae 01 2c lw r14,(r13+300) api->Attributes = *the_attr; 8002af4: b9 60 10 00 mv r2,r11 8002af8: 34 03 00 3c mvi r3,60 8002afc: b9 c0 08 00 mv r1,r14 8002b00: f8 00 2c a5 calli 800dd94 api->detachstate = the_attr->detachstate; 8002b04: 29 6b 00 38 lw r11,(r11+56) api->schedpolicy = schedpolicy; api->schedparam = schedparam; 8002b08: 37 82 00 3c addi r2,sp,60 8002b0c: 34 03 00 1c mvi r3,28 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; 8002b10: 59 cb 00 3c sw (r14+60),r11 api->schedpolicy = schedpolicy; 8002b14: 59 cf 00 80 sw (r14+128),r15 api->schedparam = schedparam; 8002b18: 35 c1 00 84 addi r1,r14,132 8002b1c: f8 00 2c 9e calli 800dd94 * 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; 8002b20: 34 01 00 01 mvi r1,1 8002b24: 31 a1 00 74 sb (r13+116),r1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 8002b28: ba 00 18 00 mv r3,r16 8002b2c: ba 40 20 00 mv r4,r18 8002b30: b9 a0 08 00 mv r1,r13 8002b34: 34 02 00 01 mvi r2,1 8002b38: b9 80 28 00 mv r5,r12 8002b3c: f8 00 0d 92 calli 8006184 <_Thread_Start> _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 8002b40: 34 01 00 04 mvi r1,4 8002b44: 5d e1 00 08 bne r15,r1,8002b64 _Watchdog_Insert_ticks( 8002b48: 35 c1 00 8c addi r1,r14,140 8002b4c: f8 00 0e 30 calli 800640c <_Timespec_To_ticks> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8002b50: 59 c1 00 b0 sw (r14+176),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8002b54: 78 01 08 01 mvhi r1,0x801 8002b58: 38 21 e9 40 ori r1,r1,0xe940 8002b5c: 35 c2 00 a4 addi r2,r14,164 8002b60: f8 00 0f 52 calli 80068a8 <_Watchdog_Insert> /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; _RTEMS_Unlock_allocator(); 8002b64: 78 02 08 01 mvhi r2,0x801 8002b68: 38 42 e9 18 ori r2,r2,0xe918 } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 8002b6c: 29 ad 00 08 lw r13,(r13+8) _RTEMS_Unlock_allocator(); 8002b70: 28 41 00 00 lw r1,(r2+0) } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 8002b74: 5a 2d 00 00 sw (r17+0),r13 _RTEMS_Unlock_allocator(); 8002b78: f8 00 04 1f calli 8003bf4 <_API_Mutex_Unlock> return 0; 8002b7c: e0 00 00 02 bi 8002b84 8002b80: 34 0c 00 16 mvi r12,22 } 8002b84: b9 80 08 00 mv r1,r12 8002b88: 2b 9d 00 10 lw ra,(sp+16) 8002b8c: 2b 8b 00 38 lw r11,(sp+56) 8002b90: 2b 8c 00 34 lw r12,(sp+52) 8002b94: 2b 8d 00 30 lw r13,(sp+48) 8002b98: 2b 8e 00 2c lw r14,(sp+44) 8002b9c: 2b 8f 00 28 lw r15,(sp+40) 8002ba0: 2b 90 00 24 lw r16,(sp+36) 8002ba4: 2b 91 00 20 lw r17,(sp+32) 8002ba8: 2b 92 00 1c lw r18,(sp+28) 8002bac: 2b 93 00 18 lw r19,(sp+24) 8002bb0: 2b 94 00 14 lw r20,(sp+20) 8002bb4: 37 9c 00 5c addi sp,sp,92 8002bb8: c3 a0 00 00 ret 08012468 : void pthread_exit( void *value_ptr ) { 8012468: 37 9c ff fc addi sp,sp,-4 801246c: 5b 9d 00 04 sw (sp+4),ra _POSIX_Thread_Exit( _Thread_Executing, value_ptr ); 8012470: 78 03 08 02 mvhi r3,0x802 8012474: 38 63 5a 00 ori r3,r3,0x5a00 } void pthread_exit( void *value_ptr ) { 8012478: b8 20 10 00 mv r2,r1 _POSIX_Thread_Exit( _Thread_Executing, value_ptr ); 801247c: 28 61 00 00 lw r1,(r3+0) 8012480: fb ff ff d4 calli 80123d0 <_POSIX_Thread_Exit> } 8012484: 2b 9d 00 04 lw ra,(sp+4) <== NOT EXECUTED 8012488: 37 9c 00 04 addi sp,sp,4 <== NOT EXECUTED 801248c: c3 a0 00 00 ret <== NOT EXECUTED 08004fd0 : int pthread_mutex_init( pthread_mutex_t *mutex, const pthread_mutexattr_t *attr ) { 8004fd0: 37 9c ff ec addi sp,sp,-20 8004fd4: 5b 8b 00 14 sw (sp+20),r11 8004fd8: 5b 8c 00 10 sw (sp+16),r12 8004fdc: 5b 8d 00 0c sw (sp+12),r13 8004fe0: 5b 8e 00 08 sw (sp+8),r14 8004fe4: 5b 9d 00 04 sw (sp+4),ra 8004fe8: b8 20 70 00 mv r14,r1 POSIX_Mutex_Control *the_mutex; CORE_mutex_Attributes *the_mutex_attr; const pthread_mutexattr_t *the_attr; CORE_mutex_Disciplines the_discipline; if ( attr ) the_attr = attr; 8004fec: b8 40 58 00 mv r11,r2 8004ff0: 5c 40 00 03 bne r2,r0,8004ffc 8004ff4: 78 0b 08 02 mvhi r11,0x802 8004ff8: 39 6b 3c 84 ori r11,r11,0x3c84 else the_attr = &_POSIX_Mutex_Default_attributes; /* Check for NULL mutex */ if ( !mutex ) 8004ffc: 45 c0 00 4a be r14,r0,8005124 <== NEVER TAKEN } } } #endif if ( !the_attr->is_initialized ) 8005000: 29 61 00 00 lw r1,(r11+0) 8005004: 44 20 00 48 be r1,r0,8005124 return EINVAL; /* * We only support process private mutexes. */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 8005008: 29 62 00 04 lw r2,(r11+4) 800500c: 34 03 00 01 mvi r3,1 8005010: 34 01 00 58 mvi r1,88 8005014: 44 43 00 45 be r2,r3,8005128 return ENOSYS; if ( the_attr->process_shared != PTHREAD_PROCESS_PRIVATE ) 8005018: 5c 40 00 43 bne r2,r0,8005124 return EINVAL; /* * Determine the discipline of the mutex */ switch ( the_attr->protocol ) { 800501c: 29 62 00 0c lw r2,(r11+12) 8005020: 44 43 00 05 be r2,r3,8005034 8005024: 34 01 00 02 mvi r1,2 8005028: 44 41 00 07 be r2,r1,8005044 800502c: 5c 40 00 3e bne r2,r0,8005124 8005030: e0 00 00 03 bi 800503c 8005034: 34 0d 00 02 mvi r13,2 8005038: e0 00 00 04 bi 8005048 800503c: b8 40 68 00 mv r13,r2 8005040: e0 00 00 02 bi 8005048 8005044: 34 0d 00 03 mvi r13,3 } /* * Validate the priority ceiling field -- should always be valid. */ if ( !_POSIX_Priority_Is_valid( the_attr->prio_ceiling ) ) 8005048: 29 61 00 08 lw r1,(r11+8) 800504c: f8 00 00 f2 calli 8005414 <_POSIX_Priority_Is_valid> 8005050: 44 20 00 35 be r1,r0,8005124 #if defined(_UNIX98_THREAD_MUTEX_ATTRIBUTES) /* * Validate the mutex type and set appropriate SuperCore mutex * attributes. */ switch ( the_attr->type ) { 8005054: 29 62 00 10 lw r2,(r11+16) 8005058: 34 01 00 03 mvi r1,3 800505c: 54 41 00 32 bgu r2,r1,8005124 8005060: 78 02 08 02 mvhi r2,0x802 8005064: 38 42 38 c4 ori r2,r2,0x38c4 8005068: 28 41 00 00 lw r1,(r2+0) 800506c: 34 21 00 01 addi r1,r1,1 8005070: 58 41 00 00 sw (r2+0),r1 * _POSIX_Mutex_Allocate */ RTEMS_INLINE_ROUTINE POSIX_Mutex_Control *_POSIX_Mutex_Allocate( void ) { return (POSIX_Mutex_Control *) _Objects_Allocate( &_POSIX_Mutex_Information ); 8005074: 78 01 08 02 mvhi r1,0x802 8005078: 38 21 3c 04 ori r1,r1,0x3c04 800507c: f8 00 08 41 calli 8007180 <_Objects_Allocate> 8005080: b8 20 60 00 mv r12,r1 */ _Thread_Disable_dispatch(); the_mutex = _POSIX_Mutex_Allocate(); if ( !the_mutex ) { 8005084: 5c 20 00 04 bne r1,r0,8005094 _Thread_Enable_dispatch(); 8005088: f8 00 0c 1d calli 80080fc <_Thread_Enable_dispatch> 800508c: 34 01 00 0b mvi r1,11 return EAGAIN; 8005090: e0 00 00 26 bi 8005128 } the_mutex->process_shared = the_attr->process_shared; 8005094: 29 61 00 04 lw r1,(r11+4) 8005098: 59 81 00 10 sw (r12+16),r1 the_mutex_attr = &the_mutex->Mutex.Attributes; if ( the_attr->recursive ) 800509c: 29 61 00 14 lw r1,(r11+20) 80050a0: 44 20 00 03 be r1,r0,80050ac the_mutex_attr->lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; 80050a4: 34 01 00 00 mvi r1,0 80050a8: e0 00 00 02 bi 80050b0 else the_mutex_attr->lock_nesting_behavior = CORE_MUTEX_NESTING_IS_ERROR; 80050ac: 34 01 00 01 mvi r1,1 80050b0: 59 81 00 54 sw (r12+84),r1 the_mutex_attr->only_owner_release = true; the_mutex_attr->priority_ceiling = 80050b4: 78 02 08 02 mvhi r2,0x802 if ( the_attr->recursive ) the_mutex_attr->lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; else the_mutex_attr->lock_nesting_behavior = CORE_MUTEX_NESTING_IS_ERROR; the_mutex_attr->only_owner_release = true; 80050b8: 34 01 00 01 mvi r1,1 80050bc: 31 81 00 58 sb (r12+88),r1 the_mutex_attr->priority_ceiling = 80050c0: 38 42 30 e4 ori r2,r2,0x30e4 80050c4: 40 42 00 00 lbu r2,(r2+0) 80050c8: 29 61 00 08 lw r1,(r11+8) the_mutex_attr->discipline = the_discipline; /* * Must be initialized to unlocked. */ _CORE_mutex_Initialize( 80050cc: 34 03 00 01 mvi r3,1 else the_mutex_attr->lock_nesting_behavior = CORE_MUTEX_NESTING_IS_ERROR; the_mutex_attr->only_owner_release = true; the_mutex_attr->priority_ceiling = _POSIX_Priority_To_core( the_attr->prio_ceiling ); the_mutex_attr->discipline = the_discipline; 80050d0: 59 8d 00 5c sw (r12+92),r13 if ( the_attr->recursive ) the_mutex_attr->lock_nesting_behavior = CORE_MUTEX_NESTING_ACQUIRES; else the_mutex_attr->lock_nesting_behavior = CORE_MUTEX_NESTING_IS_ERROR; the_mutex_attr->only_owner_release = true; the_mutex_attr->priority_ceiling = 80050d4: c8 41 08 00 sub r1,r2,r1 80050d8: 59 81 00 60 sw (r12+96),r1 the_mutex_attr->discipline = the_discipline; /* * Must be initialized to unlocked. */ _CORE_mutex_Initialize( 80050dc: 35 82 00 54 addi r2,r12,84 80050e0: 35 81 00 14 addi r1,r12,20 80050e4: f8 00 05 5e calli 800665c <_CORE_mutex_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 80050e8: 78 02 08 02 mvhi r2,0x802 80050ec: 29 8d 00 08 lw r13,(r12+8) 80050f0: 38 42 3c 04 ori r2,r2,0x3c04 80050f4: 28 4b 00 1c lw r11,(r2+28) 80050f8: 21 a1 ff ff andi r1,r13,0xffff 80050fc: 34 02 00 02 mvi r2,2 8005100: fb ff f7 34 calli 8002dd0 <__ashlsi3> 8005104: b5 61 08 00 add r1,r11,r1 8005108: 58 2c 00 00 sw (r1+0),r12 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 800510c: 34 0b 00 00 mvi r11,0 8005110: 59 8b 00 0c sw (r12+12),r11 CORE_MUTEX_UNLOCKED ); _Objects_Open_u32( &_POSIX_Mutex_Information, &the_mutex->Object, 0 ); *mutex = the_mutex->Object.id; 8005114: 59 cd 00 00 sw (r14+0),r13 _Thread_Enable_dispatch(); 8005118: f8 00 0b f9 calli 80080fc <_Thread_Enable_dispatch> 800511c: b9 60 08 00 mv r1,r11 return 0; 8005120: e0 00 00 02 bi 8005128 8005124: 34 01 00 16 mvi r1,22 } 8005128: 2b 9d 00 04 lw ra,(sp+4) 800512c: 2b 8b 00 14 lw r11,(sp+20) 8005130: 2b 8c 00 10 lw r12,(sp+16) 8005134: 2b 8d 00 0c lw r13,(sp+12) 8005138: 2b 8e 00 08 lw r14,(sp+8) 800513c: 37 9c 00 14 addi sp,sp,20 8005140: c3 a0 00 00 ret 080020d0 : int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { if ( !attr ) 80020d0: 44 20 00 08 be r1,r0,80020f0 return EINVAL; if ( !attr->is_initialized ) 80020d4: 28 23 00 00 lw r3,(r1+0) 80020d8: 44 60 00 06 be r3,r0,80020f0 return EINVAL; if ( !type ) 80020dc: 44 40 00 05 be r2,r0,80020f0 <== NEVER TAKEN return EINVAL; *type = attr->type; 80020e0: 28 21 00 10 lw r1,(r1+16) 80020e4: 58 41 00 00 sw (r2+0),r1 80020e8: 34 01 00 00 mvi r1,0 return 0; 80020ec: c3 a0 00 00 ret 80020f0: 34 01 00 16 mvi r1,22 } 80020f4: c3 a0 00 00 ret 08004db4 : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { if ( !attr || !attr->is_initialized ) 8004db4: 44 20 00 08 be r1,r0,8004dd4 8004db8: 28 23 00 00 lw r3,(r1+0) 8004dbc: 44 60 00 06 be r3,r0,8004dd4 return EINVAL; switch ( pshared ) { 8004dc0: 34 03 00 01 mvi r3,1 8004dc4: 54 43 00 04 bgu r2,r3,8004dd4 <== NEVER TAKEN case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 8004dc8: 58 22 00 04 sw (r1+4),r2 8004dcc: 34 01 00 00 mvi r1,0 return 0; 8004dd0: c3 a0 00 00 ret 8004dd4: 34 01 00 16 mvi r1,22 default: return EINVAL; } } 8004dd8: c3 a0 00 00 ret 0800212c : int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { if ( !attr || !attr->is_initialized ) 800212c: 44 20 00 08 be r1,r0,800214c 8002130: 28 23 00 00 lw r3,(r1+0) 8002134: 44 60 00 06 be r3,r0,800214c <== NEVER TAKEN return EINVAL; switch ( type ) { 8002138: 34 03 00 03 mvi r3,3 800213c: 54 43 00 04 bgu r2,r3,800214c case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 8002140: 58 22 00 10 sw (r1+16),r2 8002144: 34 01 00 00 mvi r1,0 return 0; 8002148: c3 a0 00 00 ret 800214c: 34 01 00 16 mvi r1,22 default: return EINVAL; } } 8002150: c3 a0 00 00 ret 080030a0 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 80030a0: 37 9c ff ec addi sp,sp,-20 80030a4: 5b 8b 00 10 sw (sp+16),r11 80030a8: 5b 8c 00 0c sw (sp+12),r12 80030ac: 5b 8d 00 08 sw (sp+8),r13 80030b0: 5b 9d 00 04 sw (sp+4),ra if ( !once_control || !init_routine ) 80030b4: 64 43 00 00 cmpei r3,r2,0 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 80030b8: b8 40 60 00 mv r12,r2 if ( !once_control || !init_routine ) 80030bc: 64 22 00 00 cmpei r2,r1,0 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 80030c0: b8 20 58 00 mv r11,r1 if ( !once_control || !init_routine ) 80030c4: b8 62 18 00 or r3,r3,r2 80030c8: 34 01 00 16 mvi r1,22 80030cc: 5c 60 00 13 bne r3,r0,8003118 return EINVAL; if ( !once_control->init_executed ) { 80030d0: 29 6d 00 04 lw r13,(r11+4) 80030d4: b8 60 08 00 mv r1,r3 80030d8: 5d a3 00 10 bne r13,r3,8003118 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 80030dc: 34 01 01 00 mvi r1,256 80030e0: b8 20 10 00 mv r2,r1 80030e4: 37 83 00 14 addi r3,sp,20 80030e8: f8 00 01 0a calli 8003510 if ( !once_control->init_executed ) { 80030ec: 29 61 00 04 lw r1,(r11+4) 80030f0: 5c 2d 00 05 bne r1,r13,8003104 <== NEVER TAKEN once_control->is_initialized = true; 80030f4: 34 01 00 01 mvi r1,1 once_control->init_executed = true; 80030f8: 59 61 00 04 sw (r11+4),r1 if ( !once_control->init_executed ) { rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); if ( !once_control->init_executed ) { once_control->is_initialized = true; 80030fc: 59 61 00 00 sw (r11+0),r1 once_control->init_executed = true; (*init_routine)(); 8003100: d9 80 00 00 call r12 } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 8003104: 2b 81 00 14 lw r1,(sp+20) 8003108: 34 02 01 00 mvi r2,256 800310c: 37 83 00 14 addi r3,sp,20 8003110: f8 00 01 00 calli 8003510 8003114: 34 01 00 00 mvi r1,0 } return 0; } 8003118: 2b 9d 00 04 lw ra,(sp+4) 800311c: 2b 8b 00 10 lw r11,(sp+16) 8003120: 2b 8c 00 0c lw r12,(sp+12) 8003124: 2b 8d 00 08 lw r13,(sp+8) 8003128: 37 9c 00 14 addi sp,sp,20 800312c: c3 a0 00 00 ret 08003a98 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 8003a98: 37 9c ff dc addi sp,sp,-36 8003a9c: 5b 8b 00 18 sw (sp+24),r11 8003aa0: 5b 8c 00 14 sw (sp+20),r12 8003aa4: 5b 8d 00 10 sw (sp+16),r13 8003aa8: 5b 8e 00 0c sw (sp+12),r14 8003aac: 5b 8f 00 08 sw (sp+8),r15 8003ab0: 5b 9d 00 04 sw (sp+4),ra 8003ab4: b8 20 68 00 mv r13,r1 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 8003ab8: 44 20 00 29 be r1,r0,8003b5c return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 8003abc: b8 40 18 00 mv r3,r2 8003ac0: 5c 40 00 05 bne r2,r0,8003ad4 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 8003ac4: 37 8b 00 1c addi r11,sp,28 8003ac8: b9 60 08 00 mv r1,r11 8003acc: f8 00 02 b6 calli 80045a4 8003ad0: b9 60 18 00 mv r3,r11 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 8003ad4: 28 61 00 00 lw r1,(r3+0) 8003ad8: 44 20 00 21 be r1,r0,8003b5c <== NEVER TAKEN return EINVAL; switch ( the_attr->process_shared ) { 8003adc: 28 6c 00 04 lw r12,(r3+4) 8003ae0: 5d 80 00 1f bne r12,r0,8003b5c <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8003ae4: 78 02 08 02 mvhi r2,0x802 8003ae8: 38 42 18 7c ori r2,r2,0x187c 8003aec: 28 41 00 00 lw r1,(r2+0) 8003af0: 34 21 00 01 addi r1,r1,1 8003af4: 58 41 00 00 sw (r2+0),r1 * This function allocates a RWLock control block from * the inactive chain of free RWLock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void ) { return (POSIX_RWLock_Control *) 8003af8: 78 01 08 02 mvhi r1,0x802 8003afc: 38 21 1a 3c ori r1,r1,0x1a3c 8003b00: f8 00 08 90 calli 8005d40 <_Objects_Allocate> 8003b04: b8 20 58 00 mv r11,r1 */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 8003b08: 5c 2c 00 04 bne r1,r12,8003b18 _Thread_Enable_dispatch(); 8003b0c: f8 00 0b d8 calli 8006a6c <_Thread_Enable_dispatch> 8003b10: 34 01 00 0b mvi r1,11 return EAGAIN; 8003b14: e0 00 00 13 bi 8003b60 } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 8003b18: 34 21 00 10 addi r1,r1,16 8003b1c: 37 82 00 24 addi r2,sp,36 8003b20: f8 00 05 f5 calli 80052f4 <_CORE_RWLock_Initialize> #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8003b24: 78 02 08 02 mvhi r2,0x802 8003b28: 29 6e 00 08 lw r14,(r11+8) 8003b2c: 38 42 1a 3c ori r2,r2,0x1a3c 8003b30: 28 4f 00 1c lw r15,(r2+28) 8003b34: 21 c1 ff ff andi r1,r14,0xffff 8003b38: 34 02 00 02 mvi r2,2 8003b3c: fb ff f8 62 calli 8001cc4 <__ashlsi3> 8003b40: b5 e1 08 00 add r1,r15,r1 8003b44: 58 2b 00 00 sw (r1+0),r11 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 8003b48: 59 6c 00 0c sw (r11+12),r12 &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 8003b4c: 59 ae 00 00 sw (r13+0),r14 _Thread_Enable_dispatch(); 8003b50: f8 00 0b c7 calli 8006a6c <_Thread_Enable_dispatch> 8003b54: b9 80 08 00 mv r1,r12 return 0; 8003b58: e0 00 00 02 bi 8003b60 8003b5c: 34 01 00 16 mvi r1,22 } 8003b60: 2b 9d 00 04 lw ra,(sp+4) 8003b64: 2b 8b 00 18 lw r11,(sp+24) 8003b68: 2b 8c 00 14 lw r12,(sp+20) 8003b6c: 2b 8d 00 10 lw r13,(sp+16) 8003b70: 2b 8e 00 0c lw r14,(sp+12) 8003b74: 2b 8f 00 08 lw r15,(sp+8) 8003b78: 37 9c 00 24 addi sp,sp,36 8003b7c: c3 a0 00 00 ret 08003bf4 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 8003bf4: 37 9c ff e8 addi sp,sp,-24 8003bf8: 5b 8b 00 10 sw (sp+16),r11 8003bfc: 5b 8c 00 0c sw (sp+12),r12 8003c00: 5b 8d 00 08 sw (sp+8),r13 8003c04: 5b 9d 00 04 sw (sp+4),ra 8003c08: b8 20 60 00 mv r12,r1 8003c0c: b8 40 08 00 mv r1,r2 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 8003c10: 45 80 00 24 be r12,r0,8003ca0 * * 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 ); 8003c14: 37 82 00 14 addi r2,sp,20 8003c18: f8 00 1a 63 calli 800a5a4 <_POSIX_Absolute_timeout_to_ticks> 8003c1c: 29 82 00 00 lw r2,(r12+0) 8003c20: b8 20 58 00 mv r11,r1 8003c24: 78 01 08 02 mvhi r1,0x802 8003c28: 38 21 1a 3c ori r1,r1,0x1a3c 8003c2c: 37 83 00 18 addi r3,sp,24 8003c30: f8 00 09 84 calli 8006240 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 8003c34: 2b 8d 00 18 lw r13,(sp+24) 8003c38: 5d a0 00 1a bne r13,r0,8003ca0 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 8003c3c: 29 82 00 00 lw r2,(r12+0) 8003c40: 2b 84 00 14 lw r4,(sp+20) 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, 8003c44: 65 6c 00 03 cmpei r12,r11,3 8003c48: 34 21 00 10 addi r1,r1,16 8003c4c: b9 80 18 00 mv r3,r12 8003c50: b9 a0 28 00 mv r5,r13 8003c54: f8 00 05 b6 calli 800532c <_CORE_RWLock_Obtain_for_reading> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 8003c58: f8 00 0b 85 calli 8006a6c <_Thread_Enable_dispatch> if ( !do_wait ) { 8003c5c: 5d 8d 00 0b bne r12,r13,8003c88 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 8003c60: 78 01 08 02 mvhi r1,0x802 8003c64: 38 21 19 38 ori r1,r1,0x1938 8003c68: 28 21 00 00 lw r1,(r1+0) 8003c6c: 34 02 00 02 mvi r2,2 8003c70: 28 21 00 34 lw r1,(r1+52) 8003c74: 5c 22 00 05 bne r1,r2,8003c88 switch (status) { 8003c78: 45 6c 00 0a be r11,r12,8003ca0 <== NEVER TAKEN 8003c7c: 55 61 00 03 bgu r11,r1,8003c88 <== NEVER TAKEN 8003c80: 34 01 00 74 mvi r1,116 8003c84: e0 00 00 08 bi 8003ca4 break; } } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 8003c88: 78 01 08 02 mvhi r1,0x802 8003c8c: 38 21 19 38 ori r1,r1,0x1938 8003c90: 28 21 00 00 lw r1,(r1+0) 8003c94: 28 21 00 34 lw r1,(r1+52) 8003c98: f8 00 00 3b calli 8003d84 <_POSIX_RWLock_Translate_core_RWLock_return_code> 8003c9c: e0 00 00 02 bi 8003ca4 8003ca0: 34 01 00 16 mvi r1,22 case OBJECTS_ERROR: break; } return EINVAL; } 8003ca4: 2b 9d 00 04 lw ra,(sp+4) 8003ca8: 2b 8b 00 10 lw r11,(sp+16) 8003cac: 2b 8c 00 0c lw r12,(sp+12) 8003cb0: 2b 8d 00 08 lw r13,(sp+8) 8003cb4: 37 9c 00 18 addi sp,sp,24 8003cb8: c3 a0 00 00 ret 08003cbc : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 8003cbc: 37 9c ff e8 addi sp,sp,-24 8003cc0: 5b 8b 00 10 sw (sp+16),r11 8003cc4: 5b 8c 00 0c sw (sp+12),r12 8003cc8: 5b 8d 00 08 sw (sp+8),r13 8003ccc: 5b 9d 00 04 sw (sp+4),ra 8003cd0: b8 20 60 00 mv r12,r1 8003cd4: b8 40 08 00 mv r1,r2 Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) 8003cd8: 45 80 00 24 be r12,r0,8003d68 * * 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 ); 8003cdc: 37 82 00 14 addi r2,sp,20 8003ce0: f8 00 1a 31 calli 800a5a4 <_POSIX_Absolute_timeout_to_ticks> 8003ce4: 29 82 00 00 lw r2,(r12+0) 8003ce8: b8 20 58 00 mv r11,r1 8003cec: 78 01 08 02 mvhi r1,0x802 8003cf0: 38 21 1a 3c ori r1,r1,0x1a3c 8003cf4: 37 83 00 18 addi r3,sp,24 8003cf8: f8 00 09 52 calli 8006240 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 8003cfc: 2b 8d 00 18 lw r13,(sp+24) 8003d00: 5d a0 00 1a bne r13,r0,8003d68 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 8003d04: 29 82 00 00 lw r2,(r12+0) 8003d08: 2b 84 00 14 lw r4,(sp+20) (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, 8003d0c: 65 6c 00 03 cmpei r12,r11,3 8003d10: 34 21 00 10 addi r1,r1,16 8003d14: b9 80 18 00 mv r3,r12 8003d18: b9 a0 28 00 mv r5,r13 8003d1c: f8 00 05 c7 calli 8005438 <_CORE_RWLock_Obtain_for_writing> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 8003d20: f8 00 0b 53 calli 8006a6c <_Thread_Enable_dispatch> if ( !do_wait && 8003d24: 5d 8d 00 0b bne r12,r13,8003d50 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 8003d28: 78 01 08 02 mvhi r1,0x802 8003d2c: 38 21 19 38 ori r1,r1,0x1938 8003d30: 28 21 00 00 lw r1,(r1+0) 8003d34: 34 02 00 02 mvi r2,2 8003d38: 28 21 00 34 lw r1,(r1+52) 8003d3c: 5c 22 00 05 bne r1,r2,8003d50 switch (status) { 8003d40: 45 6c 00 0a be r11,r12,8003d68 <== NEVER TAKEN 8003d44: 55 61 00 03 bgu r11,r1,8003d50 <== NEVER TAKEN 8003d48: 34 01 00 74 mvi r1,116 8003d4c: e0 00 00 08 bi 8003d6c case POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE: break; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 8003d50: 78 01 08 02 mvhi r1,0x802 8003d54: 38 21 19 38 ori r1,r1,0x1938 8003d58: 28 21 00 00 lw r1,(r1+0) 8003d5c: 28 21 00 34 lw r1,(r1+52) 8003d60: f8 00 00 09 calli 8003d84 <_POSIX_RWLock_Translate_core_RWLock_return_code> 8003d64: e0 00 00 02 bi 8003d6c 8003d68: 34 01 00 16 mvi r1,22 case OBJECTS_ERROR: break; } return EINVAL; } 8003d6c: 2b 9d 00 04 lw ra,(sp+4) 8003d70: 2b 8b 00 10 lw r11,(sp+16) 8003d74: 2b 8c 00 0c lw r12,(sp+12) 8003d78: 2b 8d 00 08 lw r13,(sp+8) 8003d7c: 37 9c 00 18 addi sp,sp,24 8003d80: c3 a0 00 00 ret 080045c8 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { if ( !attr ) 80045c8: 44 20 00 08 be r1,r0,80045e8 return EINVAL; if ( !attr->is_initialized ) 80045cc: 28 23 00 00 lw r3,(r1+0) 80045d0: 44 60 00 06 be r3,r0,80045e8 return EINVAL; switch ( pshared ) { 80045d4: 34 03 00 01 mvi r3,1 80045d8: 54 43 00 04 bgu r2,r3,80045e8 <== NEVER TAKEN case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 80045dc: 58 22 00 04 sw (r1+4),r2 80045e0: 34 01 00 00 mvi r1,0 return 0; 80045e4: c3 a0 00 00 ret 80045e8: 34 01 00 16 mvi r1,22 default: return EINVAL; } } 80045ec: c3 a0 00 00 ret 08005c64 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 8005c64: 37 9c ff dc addi sp,sp,-36 8005c68: 5b 8b 00 18 sw (sp+24),r11 8005c6c: 5b 8c 00 14 sw (sp+20),r12 8005c70: 5b 8d 00 10 sw (sp+16),r13 8005c74: 5b 8e 00 0c sw (sp+12),r14 8005c78: 5b 8f 00 08 sw (sp+8),r15 8005c7c: 5b 9d 00 04 sw (sp+4),ra int rc; /* * Check all the parameters */ if ( !param ) 8005c80: 34 0d 00 16 mvi r13,22 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 8005c84: b8 60 70 00 mv r14,r3 8005c88: b8 20 58 00 mv r11,r1 8005c8c: b8 40 78 00 mv r15,r2 int rc; /* * Check all the parameters */ if ( !param ) 8005c90: 44 60 00 3e be r3,r0,8005d88 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 8005c94: b8 40 08 00 mv r1,r2 8005c98: 37 84 00 20 addi r4,sp,32 8005c9c: b8 60 10 00 mv r2,r3 8005ca0: 37 83 00 24 addi r3,sp,36 8005ca4: f8 00 18 27 calli 800bd40 <_POSIX_Thread_Translate_sched_param> 8005ca8: b8 20 68 00 mv r13,r1 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 8005cac: 5c 20 00 37 bne r1,r0,8005d88 8005cb0: 78 01 08 02 mvhi r1,0x802 8005cb4: 38 21 3a c4 ori r1,r1,0x3ac4 8005cb8: b9 60 10 00 mv r2,r11 8005cbc: 37 83 00 1c addi r3,sp,28 8005cc0: f8 00 06 ce calli 80077f8 <_Objects_Get> 8005cc4: b8 20 60 00 mv r12,r1 /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 8005cc8: 2b 81 00 1c lw r1,(sp+28) 8005ccc: 44 2d 00 03 be r1,r13,8005cd8 8005cd0: 34 0d 00 03 mvi r13,3 8005cd4: e0 00 00 2d bi 8005d88 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8005cd8: 29 8b 01 2c lw r11,(r12+300) if ( api->schedpolicy == SCHED_SPORADIC ) 8005cdc: 34 01 00 04 mvi r1,4 8005ce0: 29 62 00 80 lw r2,(r11+128) 8005ce4: 5c 41 00 03 bne r2,r1,8005cf0 (void) _Watchdog_Remove( &api->Sporadic_timer ); 8005ce8: 35 61 00 a4 addi r1,r11,164 8005cec: f8 00 0e a0 calli 800976c <_Watchdog_Remove> api->schedpolicy = policy; api->schedparam = *param; 8005cf0: b9 c0 10 00 mv r2,r14 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; 8005cf4: 59 6f 00 80 sw (r11+128),r15 api->schedparam = *param; 8005cf8: 35 61 00 84 addi r1,r11,132 8005cfc: 34 03 00 1c mvi r3,28 8005d00: f8 00 2b 0d calli 8010934 the_thread->budget_algorithm = budget_algorithm; 8005d04: 2b 82 00 24 lw r2,(sp+36) the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { 8005d08: 29 61 00 80 lw r1,(r11+128) if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; 8005d0c: 59 82 00 7c sw (r12+124),r2 the_thread->budget_callout = budget_callout; 8005d10: 2b 82 00 20 lw r2,(sp+32) 8005d14: 59 82 00 80 sw (r12+128),r2 switch ( api->schedpolicy ) { 8005d18: 48 01 00 1b bg r0,r1,8005d84 <== NEVER TAKEN 8005d1c: 34 02 00 02 mvi r2,2 8005d20: 4c 41 00 04 bge r2,r1,8005d30 8005d24: 34 02 00 04 mvi r2,4 8005d28: 5c 22 00 17 bne r1,r2,8005d84 <== NEVER TAKEN 8005d2c: e0 00 00 0f bi 8005d68 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 8005d30: 78 01 08 02 mvhi r1,0x802 8005d34: 38 21 38 54 ori r1,r1,0x3854 8005d38: 28 21 00 00 lw r1,(r1+0) 8005d3c: 29 62 00 84 lw r2,(r11+132) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 8005d40: 34 03 00 01 mvi r3,1 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 8005d44: 59 81 00 78 sw (r12+120),r1 8005d48: 78 01 08 02 mvhi r1,0x802 8005d4c: 38 21 30 e4 ori r1,r1,0x30e4 8005d50: 40 24 00 00 lbu r4,(r1+0) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 8005d54: b9 80 08 00 mv r1,r12 8005d58: c8 82 10 00 sub r2,r4,r2 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; the_thread->real_priority = 8005d5c: 59 82 00 18 sw (r12+24),r2 _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 8005d60: f8 00 07 76 calli 8007b38 <_Thread_Change_priority> the_thread, the_thread->real_priority, true ); break; 8005d64: e0 00 00 08 bi 8005d84 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 8005d68: 29 61 00 84 lw r1,(r11+132) 8005d6c: 59 61 00 a0 sw (r11+160),r1 _Watchdog_Remove( &api->Sporadic_timer ); 8005d70: 35 61 00 a4 addi r1,r11,164 8005d74: f8 00 0e 7e calli 800976c <_Watchdog_Remove> _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 8005d78: b9 80 10 00 mv r2,r12 8005d7c: 34 01 00 00 mvi r1,0 8005d80: fb ff ff 92 calli 8005bc8 <_POSIX_Threads_Sporadic_budget_TSR> break; } _Thread_Enable_dispatch(); 8005d84: f8 00 08 de calli 80080fc <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return ESRCH; } 8005d88: b9 a0 08 00 mv r1,r13 8005d8c: 2b 9d 00 04 lw ra,(sp+4) 8005d90: 2b 8b 00 18 lw r11,(sp+24) 8005d94: 2b 8c 00 14 lw r12,(sp+20) 8005d98: 2b 8d 00 10 lw r13,(sp+16) 8005d9c: 2b 8e 00 0c lw r14,(sp+12) 8005da0: 2b 8f 00 08 lw r15,(sp+8) 8005da4: 37 9c 00 24 addi sp,sp,36 8005da8: c3 a0 00 00 ret 08002d08 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 8002d08: 37 9c ff f8 addi sp,sp,-8 8002d0c: 5b 8b 00 08 sw (sp+8),r11 8002d10: 5b 9d 00 04 sw (sp+4),ra * 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() ) 8002d14: 78 01 08 01 mvhi r1,0x801 8002d18: 38 21 f8 fc ori r1,r1,0xf8fc 8002d1c: 28 22 00 00 lw r2,(r1+0) 8002d20: 5c 40 00 16 bne r2,r0,8002d78 <== NEVER TAKEN 8002d24: 78 01 08 01 mvhi r1,0x801 8002d28: 38 21 f8 64 ori r1,r1,0xf864 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 8002d2c: 78 03 08 01 mvhi r3,0x801 8002d30: 28 24 00 00 lw r4,(r1+0) 8002d34: 38 63 f9 20 ori r3,r3,0xf920 8002d38: 28 63 00 00 lw r3,(r3+0) 8002d3c: 34 84 00 01 addi r4,r4,1 8002d40: 58 24 00 00 sw (r1+0),r4 8002d44: 28 61 01 2c lw r1,(r3+300) _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 8002d48: 28 23 00 d4 lw r3,(r1+212) 8002d4c: b8 40 58 00 mv r11,r2 8002d50: 5c 62 00 03 bne r3,r2,8002d5c <== NEVER TAKEN /* 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)); 8002d54: 28 2b 00 dc lw r11,(r1+220) 8002d58: 7d 6b 00 00 cmpnei r11,r11,0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 8002d5c: f8 00 07 be calli 8004c54 <_Thread_Enable_dispatch> if ( cancel ) 8002d60: 45 60 00 06 be r11,r0,8002d78 _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 8002d64: 78 01 08 01 mvhi r1,0x801 8002d68: 38 21 f9 20 ori r1,r1,0xf920 8002d6c: 28 21 00 00 lw r1,(r1+0) 8002d70: 34 02 ff ff mvi r2,-1 8002d74: f8 00 16 f1 calli 8008938 <_POSIX_Thread_Exit> } 8002d78: 2b 9d 00 04 lw ra,(sp+4) 8002d7c: 2b 8b 00 08 lw r11,(sp+8) 8002d80: 37 9c 00 08 addi sp,sp,8 8002d84: c3 a0 00 00 ret 0800355c : #include rtems_status_code rtems_clock_get_tod( rtems_time_of_day *time_buffer ) { 800355c: 37 9c ff c0 addi sp,sp,-64 8003560: 5b 8b 00 0c sw (sp+12),r11 8003564: 5b 8c 00 08 sw (sp+8),r12 8003568: 5b 9d 00 04 sw (sp+4),ra 800356c: b8 20 58 00 mv r11,r1 rtems_time_of_day *tmbuf = time_buffer; struct tm time; struct timeval now; if ( !time_buffer ) 8003570: 34 01 00 09 mvi r1,9 8003574: 45 60 00 2b be r11,r0,8003620 <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( !_TOD_Is_set ) 8003578: 78 01 08 02 mvhi r1,0x802 800357c: 38 21 c6 c0 ori r1,r1,0xc6c0 8003580: 40 22 00 00 lbu r2,(r1+0) 8003584: 34 01 00 0b mvi r1,11 8003588: 44 40 00 26 be r2,r0,8003620 <== NEVER TAKEN { ISR_Level level; struct timespec now; suseconds_t useconds; _ISR_Disable(level); 800358c: 90 00 60 00 rcsr r12,IE 8003590: 34 01 ff fe mvi r1,-2 8003594: a1 81 08 00 and r1,r12,r1 8003598: d0 01 00 00 wcsr IE,r1 _TOD_Get( &now ); 800359c: 37 81 00 34 addi r1,sp,52 80035a0: f8 00 05 50 calli 8004ae0 <_TOD_Get> _ISR_Enable(level); 80035a4: d0 0c 00 00 wcsr IE,r12 useconds = (suseconds_t)now.tv_nsec; useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND; time->tv_sec = now.tv_sec; 80035a8: 2b 81 00 34 lw r1,(sp+52) time->tv_usec = useconds; 80035ac: 34 02 03 e8 mvi r2,1000 _ISR_Enable(level); useconds = (suseconds_t)now.tv_nsec; useconds /= (suseconds_t)TOD_NANOSECONDS_PER_MICROSECOND; time->tv_sec = now.tv_sec; 80035b0: 5b 81 00 3c sw (sp+60),r1 time->tv_usec = useconds; 80035b4: 2b 81 00 38 lw r1,(sp+56) 80035b8: f8 00 70 66 calli 801f750 <__divsi3> 80035bc: 5b 81 00 40 sw (sp+64),r1 /* Obtain the current time */ _TOD_Get_timeval( &now ); /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); 80035c0: 37 82 00 10 addi r2,sp,16 80035c4: 37 81 00 3c addi r1,sp,60 80035c8: f8 00 2f 16 calli 800f220 /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; tmbuf->month = time.tm_mon + 1; tmbuf->day = time.tm_mday; 80035cc: 2b 81 00 1c lw r1,(sp+28) /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; 80035d0: 2b 83 00 24 lw r3,(sp+36) tmbuf->month = time.tm_mon + 1; 80035d4: 2b 82 00 20 lw r2,(sp+32) tmbuf->day = time.tm_mday; 80035d8: 59 61 00 08 sw (r11+8),r1 tmbuf->hour = time.tm_hour; 80035dc: 2b 81 00 18 lw r1,(sp+24) /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; 80035e0: 34 63 07 6c addi r3,r3,1900 tmbuf->month = time.tm_mon + 1; 80035e4: 34 42 00 01 addi r2,r2,1 tmbuf->day = time.tm_mday; tmbuf->hour = time.tm_hour; 80035e8: 59 61 00 0c sw (r11+12),r1 tmbuf->minute = time.tm_min; 80035ec: 2b 81 00 14 lw r1,(sp+20) /* Split it into a closer format */ gmtime_r( &now.tv_sec, &time ); /* Now adjust it to the RTEMS format */ tmbuf->year = time.tm_year + 1900; 80035f0: 59 63 00 00 sw (r11+0),r3 tmbuf->month = time.tm_mon + 1; 80035f4: 59 62 00 04 sw (r11+4),r2 tmbuf->day = time.tm_mday; tmbuf->hour = time.tm_hour; tmbuf->minute = time.tm_min; 80035f8: 59 61 00 10 sw (r11+16),r1 tmbuf->second = time.tm_sec; 80035fc: 2b 81 00 10 lw r1,(sp+16) 8003600: 59 61 00 14 sw (r11+20),r1 tmbuf->ticks = now.tv_usec / 8003604: 78 01 08 02 mvhi r1,0x802 8003608: 38 21 40 c4 ori r1,r1,0x40c4 800360c: 28 22 00 0c lw r2,(r1+12) 8003610: 2b 81 00 40 lw r1,(sp+64) 8003614: f8 00 70 ae calli 801f8cc <__udivsi3> 8003618: 59 61 00 18 sw (r11+24),r1 800361c: 34 01 00 00 mvi r1,0 rtems_configuration_get_microseconds_per_tick(); return RTEMS_SUCCESSFUL; } 8003620: 2b 9d 00 04 lw ra,(sp+4) 8003624: 2b 8b 00 0c lw r11,(sp+12) 8003628: 2b 8c 00 08 lw r12,(sp+8) 800362c: 37 9c 00 40 addi sp,sp,64 8003630: c3 a0 00 00 ret 0801013c : * error code - if unsuccessful */ rtems_status_code rtems_clock_set_nanoseconds_extension( rtems_nanoseconds_extension_routine routine ) { 801013c: b8 20 18 00 mv r3,r1 if ( !routine ) 8010140: 34 01 00 09 mvi r1,9 8010144: 44 60 00 05 be r3,r0,8010158 <== ALWAYS TAKEN return RTEMS_INVALID_ADDRESS; _Watchdog_Nanoseconds_since_tick_handler = routine; 8010148: 78 02 08 03 mvhi r2,0x803 <== NOT EXECUTED 801014c: 38 42 fe 4c ori r2,r2,0xfe4c <== NOT EXECUTED 8010150: 58 43 00 00 sw (r2+0),r3 <== NOT EXECUTED 8010154: 34 01 00 00 mvi r1,0 <== NOT EXECUTED return RTEMS_SUCCESSFUL; } 8010158: c3 a0 00 00 ret 080052dc : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 80052dc: 37 9c ff e4 addi sp,sp,-28 80052e0: 5b 8b 00 1c sw (sp+28),r11 80052e4: 5b 8c 00 18 sw (sp+24),r12 80052e8: 5b 8d 00 14 sw (sp+20),r13 80052ec: 5b 8e 00 10 sw (sp+16),r14 80052f0: 5b 8f 00 0c sw (sp+12),r15 80052f4: 5b 90 00 08 sw (sp+8),r16 80052f8: 5b 9d 00 04 sw (sp+4),ra 80052fc: b8 20 78 00 mv r15,r1 uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 8005300: 44 20 00 17 be r1,r0,800535c <== NEVER TAKEN 8005304: 78 0b 08 02 mvhi r11,0x802 8005308: 39 6b c6 48 ori r11,r11,0xc648 #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 800530c: 35 70 00 10 addi r16,r11,16 if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { if ( !_Objects_Information_table[ api_index ] ) 8005310: 29 61 00 00 lw r1,(r11+0) 8005314: 44 20 00 10 be r1,r0,8005354 continue; information = _Objects_Information_table[ api_index ][ 1 ]; 8005318: 28 2c 00 04 lw r12,(r1+4) if ( !information ) 800531c: 34 0e 00 04 mvi r14,4 8005320: 34 0d 00 01 mvi r13,1 8005324: 5d 80 00 0a bne r12,r0,800534c 8005328: e0 00 00 0b bi 8005354 continue; for ( i=1 ; i <= information->maximum ; i++ ) { the_thread = (Thread_Control *)information->local_table[ i ]; 800532c: 29 81 00 1c lw r1,(r12+28) information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 8005330: 35 ad 00 01 addi r13,r13,1 the_thread = (Thread_Control *)information->local_table[ i ]; 8005334: b4 2e 08 00 add r1,r1,r14 8005338: 28 22 00 00 lw r2,(r1+0) information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 800533c: 35 ce 00 04 addi r14,r14,4 the_thread = (Thread_Control *)information->local_table[ i ]; if ( !the_thread ) continue; (*routine)(the_thread); 8005340: b8 40 08 00 mv r1,r2 continue; for ( i=1 ; i <= information->maximum ; i++ ) { the_thread = (Thread_Control *)information->local_table[ i ]; if ( !the_thread ) 8005344: 44 40 00 02 be r2,r0,800534c <== NEVER TAKEN continue; (*routine)(the_thread); 8005348: d9 e0 00 00 call r15 information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 800534c: 2d 81 00 10 lhu r1,(r12+16) 8005350: 50 2d ff f7 bgeu r1,r13,800532c 8005354: 35 6b 00 04 addi r11,r11,4 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { 8005358: 5d 70 ff ee bne r11,r16,8005310 (*routine)(the_thread); } } } 800535c: 2b 9d 00 04 lw ra,(sp+4) 8005360: 2b 8b 00 1c lw r11,(sp+28) 8005364: 2b 8c 00 18 lw r12,(sp+24) 8005368: 2b 8d 00 14 lw r13,(sp+20) 800536c: 2b 8e 00 10 lw r14,(sp+16) 8005370: 2b 8f 00 0c lw r15,(sp+12) 8005374: 2b 90 00 08 lw r16,(sp+8) 8005378: 37 9c 00 1c addi sp,sp,28 800537c: c3 a0 00 00 ret 08011088 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 8011088: 37 9c ff dc addi sp,sp,-36 801108c: 5b 8b 00 24 sw (sp+36),r11 8011090: 5b 8c 00 20 sw (sp+32),r12 8011094: 5b 8d 00 1c sw (sp+28),r13 8011098: 5b 8e 00 18 sw (sp+24),r14 801109c: 5b 8f 00 14 sw (sp+20),r15 80110a0: 5b 90 00 10 sw (sp+16),r16 80110a4: 5b 91 00 0c sw (sp+12),r17 80110a8: 5b 92 00 08 sw (sp+8),r18 80110ac: 5b 9d 00 04 sw (sp+4),ra register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 80110b0: 34 07 00 03 mvi r7,3 uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 80110b4: b8 20 88 00 mv r17,r1 80110b8: b8 40 70 00 mv r14,r2 80110bc: b8 60 78 00 mv r15,r3 80110c0: b8 80 60 00 mv r12,r4 80110c4: b8 a0 90 00 mv r18,r5 80110c8: b8 c0 80 00 mv r16,r6 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 80110cc: 44 20 00 38 be r1,r0,80111ac return RTEMS_INVALID_NAME; if ( !starting_address ) 80110d0: 44 40 00 34 be r2,r0,80111a0 return RTEMS_INVALID_ADDRESS; if ( !id ) 80110d4: 44 c0 00 33 be r6,r0,80111a0 <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 80110d8: 64 82 00 00 cmpei r2,r4,0 80110dc: 64 61 00 00 cmpei r1,r3,0 80110e0: b8 41 08 00 or r1,r2,r1 80110e4: 5c 20 00 31 bne r1,r0,80111a8 80110e8: 54 83 00 30 bgu r4,r3,80111a8 80110ec: 20 81 00 07 andi r1,r4,0x7 80110f0: 5c 20 00 2e bne r1,r0,80111a8 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 80110f4: 21 cd 00 07 andi r13,r14,0x7 80110f8: 5d a1 00 2a bne r13,r1,80111a0 80110fc: 78 02 08 03 mvhi r2,0x803 8011100: 38 42 fc ac ori r2,r2,0xfcac 8011104: 28 41 00 00 lw r1,(r2+0) 8011108: 34 21 00 01 addi r1,r1,1 801110c: 58 41 00 00 sw (r2+0),r1 * 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 ); 8011110: 78 01 08 03 mvhi r1,0x803 8011114: 38 21 fa f4 ori r1,r1,0xfaf4 8011118: f8 00 15 d6 calli 8016870 <_Objects_Allocate> 801111c: b8 20 58 00 mv r11,r1 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 8011120: 5c 2d 00 04 bne r1,r13,8011130 _Thread_Enable_dispatch(); 8011124: f8 00 1a 80 calli 8017b24 <_Thread_Enable_dispatch> 8011128: 34 07 00 05 mvi r7,5 return RTEMS_TOO_MANY; 801112c: e0 00 00 20 bi 80111ac _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 8011130: 58 2e 00 10 sw (r1+16),r14 the_partition->length = length; 8011134: 58 2f 00 14 sw (r1+20),r15 the_partition->buffer_size = buffer_size; 8011138: 58 2c 00 18 sw (r1+24),r12 the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; _Chain_Initialize( &the_partition->Memory, starting_address, 801113c: b9 80 10 00 mv r2,r12 #endif the_partition->starting_address = starting_address; the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; 8011140: 58 32 00 1c sw (r1+28),r18 the_partition->number_of_used_blocks = 0; 8011144: 58 2d 00 20 sw (r1+32),r13 _Chain_Initialize( &the_partition->Memory, starting_address, 8011148: b9 e0 08 00 mv r1,r15 801114c: f8 00 7d 65 calli 80306e0 <__udivsi3> 8011150: 35 6f 00 24 addi r15,r11,36 8011154: b8 20 18 00 mv r3,r1 8011158: b9 80 20 00 mv r4,r12 801115c: b9 c0 10 00 mv r2,r14 8011160: b9 e0 08 00 mv r1,r15 8011164: f8 00 0f 4c calli 8014e94 <_Chain_Initialize> 8011168: 78 02 08 03 mvhi r2,0x803 801116c: 29 6c 00 08 lw r12,(r11+8) 8011170: 38 42 fa f4 ori r2,r2,0xfaf4 8011174: 28 4e 00 1c lw r14,(r2+28) 8011178: 21 81 ff ff andi r1,r12,0xffff 801117c: 34 02 00 02 mvi r2,2 8011180: fb ff f3 46 calli 800de98 <__ashlsi3> 8011184: b5 c1 08 00 add r1,r14,r1 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 8011188: 59 71 00 0c sw (r11+12),r17 &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 801118c: 5a 0c 00 00 sw (r16+0),r12 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8011190: 58 2b 00 00 sw (r1+0),r11 name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 8011194: f8 00 1a 64 calli 8017b24 <_Thread_Enable_dispatch> 8011198: b9 a0 38 00 mv r7,r13 return RTEMS_SUCCESSFUL; 801119c: e0 00 00 04 bi 80111ac 80111a0: 34 07 00 09 mvi r7,9 80111a4: e0 00 00 02 bi 80111ac 80111a8: 34 07 00 08 mvi r7,8 } 80111ac: b8 e0 08 00 mv r1,r7 80111b0: 2b 9d 00 04 lw ra,(sp+4) 80111b4: 2b 8b 00 24 lw r11,(sp+36) 80111b8: 2b 8c 00 20 lw r12,(sp+32) 80111bc: 2b 8d 00 1c lw r13,(sp+28) 80111c0: 2b 8e 00 18 lw r14,(sp+24) 80111c4: 2b 8f 00 14 lw r15,(sp+20) 80111c8: 2b 90 00 10 lw r16,(sp+16) 80111cc: 2b 91 00 0c lw r17,(sp+12) 80111d0: 2b 92 00 08 lw r18,(sp+8) 80111d4: 37 9c 00 24 addi sp,sp,36 80111d8: c3 a0 00 00 ret 080036ec : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 80036ec: 37 9c ff e8 addi sp,sp,-24 80036f0: 5b 8b 00 14 sw (sp+20),r11 80036f4: 5b 8c 00 10 sw (sp+16),r12 80036f8: 5b 8d 00 0c sw (sp+12),r13 80036fc: 5b 8e 00 08 sw (sp+8),r14 8003700: 5b 9d 00 04 sw (sp+4),ra 8003704: b8 20 70 00 mv r14,r1 RTEMS_INLINE_ROUTINE Rate_monotonic_Control *_Rate_monotonic_Get ( Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) 8003708: 78 01 08 02 mvhi r1,0x802 800370c: b8 40 60 00 mv r12,r2 8003710: 38 21 38 94 ori r1,r1,0x3894 8003714: b9 c0 10 00 mv r2,r14 8003718: 37 83 00 18 addi r3,sp,24 800371c: f8 00 09 21 calli 8005ba0 <_Objects_Get> 8003720: b8 20 58 00 mv r11,r1 rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 8003724: 2b 81 00 18 lw r1,(sp+24) 8003728: 5c 20 00 61 bne r1,r0,80038ac case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 800372c: 78 03 08 02 mvhi r3,0x802 8003730: 38 63 3a 88 ori r3,r3,0x3a88 8003734: 28 61 00 00 lw r1,(r3+0) 8003738: 29 62 00 40 lw r2,(r11+64) 800373c: 44 41 00 04 be r2,r1,800374c _Thread_Enable_dispatch(); 8003740: f8 00 0b 78 calli 8006520 <_Thread_Enable_dispatch> 8003744: 34 0b 00 17 mvi r11,23 return RTEMS_NOT_OWNER_OF_RESOURCE; 8003748: e0 00 00 5a bi 80038b0 } if ( length == RTEMS_PERIOD_STATUS ) { 800374c: 5d 80 00 0d bne r12,r0,8003780 switch ( the_period->state ) { 8003750: 29 61 00 38 lw r1,(r11+56) 8003754: 34 02 00 04 mvi r2,4 8003758: 50 41 00 03 bgeu r2,r1,8003764 <== ALWAYS TAKEN 800375c: b9 80 58 00 mv r11,r12 <== NOT EXECUTED 8003760: e0 00 00 51 bi 80038a4 <== NOT EXECUTED 8003764: 78 0b 08 02 mvhi r11,0x802 8003768: 34 02 00 02 mvi r2,2 800376c: 39 6b 0c 68 ori r11,r11,0xc68 8003770: fb ff f6 b7 calli 800124c <__ashlsi3> 8003774: b5 61 08 00 add r1,r11,r1 8003778: 28 2b 00 00 lw r11,(r1+0) 800377c: e0 00 00 4a bi 80038a4 } _Thread_Enable_dispatch(); return( return_value ); } _ISR_Disable( level ); 8003780: 90 00 68 00 rcsr r13,IE 8003784: 34 01 ff fe mvi r1,-2 8003788: a1 a1 08 00 and r1,r13,r1 800378c: d0 01 00 00 wcsr IE,r1 switch ( the_period->state ) { 8003790: 29 63 00 38 lw r3,(r11+56) 8003794: 34 01 00 02 mvi r1,2 8003798: 44 61 00 18 be r3,r1,80037f8 800379c: 34 01 00 04 mvi r1,4 80037a0: 44 61 00 35 be r3,r1,8003874 80037a4: 5c 60 00 42 bne r3,r0,80038ac <== NEVER TAKEN case RATE_MONOTONIC_INACTIVE: { _ISR_Enable( level ); 80037a8: d0 0d 00 00 wcsr IE,r13 /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 80037ac: b9 60 08 00 mv r1,r11 80037b0: fb ff ff 31 calli 8003474 <_Rate_monotonic_Initiate_statistics> Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 80037b4: 78 03 08 00 mvhi r3,0x800 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 80037b8: 34 0d 00 00 mvi r13,0 the_watchdog->routine = routine; 80037bc: 38 63 3c 38 ori r3,r3,0x3c38 the_period->state = RATE_MONOTONIC_ACTIVE; 80037c0: 34 02 00 02 mvi r2,2 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 80037c4: 78 01 08 02 mvhi r1,0x802 80037c8: 59 62 00 38 sw (r11+56),r2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 80037cc: 59 63 00 2c sw (r11+44),r3 the_watchdog->id = id; 80037d0: 59 6e 00 30 sw (r11+48),r14 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 80037d4: 59 6c 00 1c sw (r11+28),r12 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 80037d8: 35 62 00 10 addi r2,r11,16 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 80037dc: 59 6d 00 18 sw (r11+24),r13 the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 80037e0: 59 6d 00 34 sw (r11+52),r13 _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 80037e4: 59 6c 00 3c sw (r11+60),r12 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 80037e8: 38 21 3a a8 ori r1,r1,0x3aa8 80037ec: f8 00 11 0c calli 8007c1c <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 80037f0: b9 a0 58 00 mv r11,r13 80037f4: e0 00 00 2c bi 80038a4 case RATE_MONOTONIC_ACTIVE: /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 80037f8: b9 60 08 00 mv r1,r11 80037fc: fb ff ff 7c calli 80035ec <_Rate_monotonic_Update_statistics> /* * 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; 8003800: 34 01 00 01 mvi r1,1 the_period->next_length = length; 8003804: 59 6c 00 3c sw (r11+60),r12 /* * 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; 8003808: 59 61 00 38 sw (r11+56),r1 the_period->next_length = length; _ISR_Enable( level ); 800380c: d0 0d 00 00 wcsr IE,r13 _Thread_Executing->Wait.id = the_period->Object.id; 8003810: 78 01 08 02 mvhi r1,0x802 8003814: 38 21 3a 88 ori r1,r1,0x3a88 8003818: 28 21 00 00 lw r1,(r1+0) 800381c: 29 63 00 08 lw r3,(r11+8) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 8003820: 34 02 40 00 mvi r2,16384 the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; the_period->next_length = length; _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; 8003824: 58 23 00 20 sw (r1+32),r3 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 8003828: f8 00 0d f4 calli 8006ff8 <_Thread_Set_state> /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 800382c: 90 00 08 00 rcsr r1,IE 8003830: 34 02 ff fe mvi r2,-2 8003834: a0 22 10 00 and r2,r1,r2 8003838: d0 02 00 00 wcsr IE,r2 local_state = the_period->state; the_period->state = RATE_MONOTONIC_ACTIVE; 800383c: 34 03 00 02 mvi r3,2 /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; 8003840: 29 62 00 38 lw r2,(r11+56) the_period->state = RATE_MONOTONIC_ACTIVE; 8003844: 59 63 00 38 sw (r11+56),r3 _ISR_Enable( level ); 8003848: d0 01 00 00 wcsr IE,r1 /* * 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 ) 800384c: 34 01 00 03 mvi r1,3 8003850: 5c 41 00 06 bne r2,r1,8003868 <== ALWAYS TAKEN _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 8003854: 78 01 08 02 mvhi r1,0x802 <== NOT EXECUTED 8003858: 38 21 3a 88 ori r1,r1,0x3a88 <== NOT EXECUTED 800385c: 28 21 00 00 lw r1,(r1+0) <== NOT EXECUTED 8003860: 34 02 40 00 mvi r2,16384 <== NOT EXECUTED 8003864: f8 00 0a 36 calli 800613c <_Thread_Clear_state> <== NOT EXECUTED _Thread_Enable_dispatch(); 8003868: f8 00 0b 2e calli 8006520 <_Thread_Enable_dispatch> 800386c: 34 0b 00 00 mvi r11,0 return RTEMS_SUCCESSFUL; 8003870: e0 00 00 10 bi 80038b0 case RATE_MONOTONIC_EXPIRED: /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 8003874: b9 60 08 00 mv r1,r11 8003878: fb ff ff 5d calli 80035ec <_Rate_monotonic_Update_statistics> _ISR_Enable( level ); 800387c: d0 0d 00 00 wcsr IE,r13 the_period->state = RATE_MONOTONIC_ACTIVE; 8003880: 34 02 00 02 mvi r2,2 8003884: 78 01 08 02 mvhi r1,0x802 8003888: 59 62 00 38 sw (r11+56),r2 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 800388c: 59 6c 00 1c sw (r11+28),r12 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8003890: 35 62 00 10 addi r2,r11,16 the_period->next_length = length; 8003894: 59 6c 00 3c sw (r11+60),r12 8003898: 38 21 3a a8 ori r1,r1,0x3aa8 800389c: f8 00 10 e0 calli 8007c1c <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 80038a0: 34 0b 00 06 mvi r11,6 80038a4: f8 00 0b 1f calli 8006520 <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; 80038a8: e0 00 00 02 bi 80038b0 80038ac: 34 0b 00 04 mvi r11,4 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 80038b0: b9 60 08 00 mv r1,r11 80038b4: 2b 9d 00 04 lw ra,(sp+4) 80038b8: 2b 8b 00 14 lw r11,(sp+20) 80038bc: 2b 8c 00 10 lw r12,(sp+16) 80038c0: 2b 8d 00 0c lw r13,(sp+12) 80038c4: 2b 8e 00 08 lw r14,(sp+8) 80038c8: 37 9c 00 18 addi sp,sp,24 80038cc: c3 a0 00 00 ret 080038d0 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 80038d0: 37 9c ff 5c addi sp,sp,-164 80038d4: 5b 8b 00 44 sw (sp+68),r11 80038d8: 5b 8c 00 40 sw (sp+64),r12 80038dc: 5b 8d 00 3c sw (sp+60),r13 80038e0: 5b 8e 00 38 sw (sp+56),r14 80038e4: 5b 8f 00 34 sw (sp+52),r15 80038e8: 5b 90 00 30 sw (sp+48),r16 80038ec: 5b 91 00 2c sw (sp+44),r17 80038f0: 5b 92 00 28 sw (sp+40),r18 80038f4: 5b 93 00 24 sw (sp+36),r19 80038f8: 5b 94 00 20 sw (sp+32),r20 80038fc: 5b 95 00 1c sw (sp+28),r21 8003900: 5b 96 00 18 sw (sp+24),r22 8003904: 5b 97 00 14 sw (sp+20),r23 8003908: 5b 98 00 10 sw (sp+16),r24 800390c: 5b 99 00 0c sw (sp+12),r25 8003910: 5b 9b 00 08 sw (sp+8),fp 8003914: 5b 9d 00 04 sw (sp+4),ra 8003918: b8 40 58 00 mv r11,r2 800391c: b8 20 60 00 mv r12,r1 rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) 8003920: 44 40 00 73 be r2,r0,8003aec <== NEVER TAKEN return; (*print)( context, "Period information by period\n" ); 8003924: 78 02 08 02 mvhi r2,0x802 8003928: 38 42 0c 7c ori r2,r2,0xc7c 800392c: d9 60 00 00 call r11 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 8003930: 78 02 08 02 mvhi r2,0x802 8003934: 38 42 0c 9c ori r2,r2,0xc9c 8003938: b9 80 08 00 mv r1,r12 800393c: d9 60 00 00 call r11 (*print)( context, "--- Wall times are in seconds ---\n" ); 8003940: 78 02 08 02 mvhi r2,0x802 8003944: 38 42 0c c0 ori r2,r2,0xcc0 8003948: b9 80 08 00 mv r1,r12 800394c: d9 60 00 00 call r11 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 8003950: 78 02 08 02 mvhi r2,0x802 8003954: 38 42 0c e4 ori r2,r2,0xce4 8003958: b9 80 08 00 mv r1,r12 800395c: d9 60 00 00 call r11 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 8003960: 78 02 08 02 mvhi r2,0x802 8003964: b9 80 08 00 mv r1,r12 8003968: 38 42 0d 30 ori r2,r2,0xd30 800396c: d9 60 00 00 call r11 /* * 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 ; 8003970: 78 01 08 02 mvhi r1,0x802 8003974: 38 21 38 94 ori r1,r1,0x3894 8003978: b8 20 80 00 mv r16,r1 800397c: 28 2d 00 08 lw r13,(r1+8) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 8003980: 37 99 00 48 addi r25,sp,72 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 ); 8003984: 37 98 00 80 addi r24,sp,128 #if defined(RTEMS_DEBUG) if ( status != RTEMS_SUCCESSFUL ) continue; #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 8003988: 37 8f 00 a0 addi r15,sp,160 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 800398c: 78 17 08 02 mvhi r23,0x802 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 ); 8003990: 37 96 00 60 addi r22,sp,96 8003994: 37 8e 00 98 addi r14,sp,152 (*print)( context, 8003998: 78 15 08 02 mvhi r21,0x802 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); 800399c: 37 94 00 78 addi r20,sp,120 (*print)( context, 80039a0: 78 13 08 02 mvhi r19,0x802 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 80039a4: 78 12 08 02 mvhi r18,0x802 /* * 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 ; 80039a8: e0 00 00 4d bi 8003adc id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 80039ac: f8 00 1b ba calli 800a894 80039b0: b8 20 88 00 mv r17,r1 if ( status != RTEMS_SUCCESSFUL ) 80039b4: 5c 20 00 49 bne r1,r0,8003ad8 continue; /* If the above passed, so should this but check it anyway */ status = rtems_rate_monotonic_get_status( id, &the_status ); 80039b8: bb 00 10 00 mv r2,r24 80039bc: b9 a0 08 00 mv r1,r13 80039c0: f8 00 1b e8 calli 800a960 #if defined(RTEMS_DEBUG) if ( status != RTEMS_SUCCESSFUL ) continue; #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 80039c4: 2b 81 00 80 lw r1,(sp+128) 80039c8: b9 e0 18 00 mv r3,r15 80039cc: 34 02 00 05 mvi r2,5 80039d0: f8 00 00 c9 calli 8003cf4 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 80039d4: 2b 85 00 48 lw r5,(sp+72) 80039d8: 2b 86 00 4c lw r6,(sp+76) 80039dc: ba e0 10 00 mv r2,r23 80039e0: b9 a0 18 00 mv r3,r13 80039e4: 38 42 0d 7c ori r2,r2,0xd7c 80039e8: b9 80 08 00 mv r1,r12 80039ec: b9 e0 20 00 mv r4,r15 80039f0: d9 60 00 00 call r11 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 80039f4: 2b 85 00 48 lw r5,(sp+72) (*print)( context, "\n" ); 80039f8: ba 40 10 00 mv r2,r18 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 ); 80039fc: b9 c0 18 00 mv r3,r14 8003a00: ba c0 08 00 mv r1,r22 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 8003a04: 38 42 02 70 ori r2,r2,0x270 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 8003a08: 5c b1 00 04 bne r5,r17,8003a18 (*print)( context, "\n" ); 8003a0c: b9 80 08 00 mv r1,r12 8003a10: d9 60 00 00 call r11 continue; 8003a14: e0 00 00 31 bi 8003ad8 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 ); 8003a18: b8 a0 10 00 mv r2,r5 8003a1c: f8 00 0f 46 calli 8007734 <_Timespec_Divide_by_integer> (*print)( context, 8003a20: 2b 81 00 54 lw r1,(sp+84) 8003a24: 34 02 03 e8 mvi r2,1000 8003a28: f8 00 6e 33 calli 801f2f4 <__divsi3> 8003a2c: b8 20 d8 00 mv fp,r1 8003a30: 2b 81 00 5c lw r1,(sp+92) 8003a34: 34 02 03 e8 mvi r2,1000 8003a38: f8 00 6e 2f calli 801f2f4 <__divsi3> 8003a3c: b8 20 88 00 mv r17,r1 8003a40: 2b 81 00 9c lw r1,(sp+156) 8003a44: 34 02 03 e8 mvi r2,1000 8003a48: f8 00 6e 2b calli 801f2f4 <__divsi3> 8003a4c: 2b 85 00 58 lw r5,(sp+88) 8003a50: 2b 87 00 98 lw r7,(sp+152) 8003a54: 2b 83 00 50 lw r3,(sp+80) 8003a58: ba a0 10 00 mv r2,r21 8003a5c: b8 20 40 00 mv r8,r1 8003a60: bb 60 20 00 mv r4,fp 8003a64: ba 20 30 00 mv r6,r17 8003a68: 38 42 0d 94 ori r2,r2,0xd94 8003a6c: b9 80 08 00 mv r1,r12 8003a70: d9 60 00 00 call r11 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); 8003a74: 2b 82 00 48 lw r2,(sp+72) 8003a78: b9 c0 18 00 mv r3,r14 8003a7c: ba 80 08 00 mv r1,r20 8003a80: f8 00 0f 2d calli 8007734 <_Timespec_Divide_by_integer> (*print)( context, 8003a84: 2b 81 00 6c lw r1,(sp+108) 8003a88: 34 02 03 e8 mvi r2,1000 8003a8c: f8 00 6e 1a calli 801f2f4 <__divsi3> 8003a90: b8 20 d8 00 mv fp,r1 8003a94: 2b 81 00 74 lw r1,(sp+116) 8003a98: 34 02 03 e8 mvi r2,1000 8003a9c: f8 00 6e 16 calli 801f2f4 <__divsi3> 8003aa0: b8 20 88 00 mv r17,r1 8003aa4: 2b 81 00 9c lw r1,(sp+156) 8003aa8: 34 02 03 e8 mvi r2,1000 8003aac: f8 00 6e 12 calli 801f2f4 <__divsi3> 8003ab0: 2b 83 00 68 lw r3,(sp+104) 8003ab4: 2b 85 00 70 lw r5,(sp+112) 8003ab8: 2b 87 00 98 lw r7,(sp+152) 8003abc: ba 60 10 00 mv r2,r19 8003ac0: b8 20 40 00 mv r8,r1 8003ac4: bb 60 20 00 mv r4,fp 8003ac8: b9 80 08 00 mv r1,r12 8003acc: ba 20 30 00 mv r6,r17 8003ad0: 38 42 0d b4 ori r2,r2,0xdb4 8003ad4: d9 60 00 00 call r11 * 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++ ) { 8003ad8: 35 ad 00 01 addi r13,r13,1 /* * 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 ; 8003adc: 2a 03 00 0c lw r3,(r16+12) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 8003ae0: b9 a0 08 00 mv r1,r13 8003ae4: bb 20 10 00 mv r2,r25 /* * 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 ; 8003ae8: 50 6d ff b1 bgeu r3,r13,80039ac the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } 8003aec: 2b 9d 00 04 lw ra,(sp+4) 8003af0: 2b 8b 00 44 lw r11,(sp+68) 8003af4: 2b 8c 00 40 lw r12,(sp+64) 8003af8: 2b 8d 00 3c lw r13,(sp+60) 8003afc: 2b 8e 00 38 lw r14,(sp+56) 8003b00: 2b 8f 00 34 lw r15,(sp+52) 8003b04: 2b 90 00 30 lw r16,(sp+48) 8003b08: 2b 91 00 2c lw r17,(sp+44) 8003b0c: 2b 92 00 28 lw r18,(sp+40) 8003b10: 2b 93 00 24 lw r19,(sp+36) 8003b14: 2b 94 00 20 lw r20,(sp+32) 8003b18: 2b 95 00 1c lw r21,(sp+28) 8003b1c: 2b 96 00 18 lw r22,(sp+24) 8003b20: 2b 97 00 14 lw r23,(sp+20) 8003b24: 2b 98 00 10 lw r24,(sp+16) 8003b28: 2b 99 00 0c lw r25,(sp+12) 8003b2c: 2b 9b 00 08 lw fp,(sp+8) 8003b30: 37 9c 00 a4 addi sp,sp,164 8003b34: c3 a0 00 00 ret 08012b50 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 8012b50: 37 9c ff f4 addi sp,sp,-12 8012b54: 5b 8b 00 08 sw (sp+8),r11 8012b58: 5b 9d 00 04 sw (sp+4),ra register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 8012b5c: 34 03 00 0a mvi r3,10 rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 8012b60: b8 40 58 00 mv r11,r2 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) 8012b64: 44 40 00 2e be r2,r0,8012c1c return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 8012b68: 37 82 00 0c addi r2,sp,12 8012b6c: f8 00 14 0e calli 8017ba4 <_Thread_Get> switch ( location ) { 8012b70: 2b 82 00 0c lw r2,(sp+12) 8012b74: 34 03 00 04 mvi r3,4 8012b78: 5c 40 00 29 bne r2,r0,8012c1c case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 8012b7c: 28 23 01 28 lw r3,(r1+296) asr = &api->Signal; 8012b80: 28 64 00 0c lw r4,(r3+12) 8012b84: 44 82 00 24 be r4,r2,8012c14 if ( ! _ASR_Is_null_handler( asr->handler ) ) { if ( asr->is_enabled ) { 8012b88: 40 62 00 08 lbu r2,(r3+8) 8012b8c: 44 40 00 17 be r2,r0,8012be8 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 8012b90: 90 00 10 00 rcsr r2,IE 8012b94: 34 04 ff fe mvi r4,-2 8012b98: a0 44 20 00 and r4,r2,r4 8012b9c: d0 04 00 00 wcsr IE,r4 *signal_set |= signals; 8012ba0: 28 64 00 14 lw r4,(r3+20) 8012ba4: b8 8b 58 00 or r11,r4,r11 8012ba8: 58 6b 00 14 sw (r3+20),r11 _ISR_Enable( _level ); 8012bac: d0 02 00 00 wcsr IE,r2 _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 ) ) 8012bb0: 78 02 08 03 mvhi r2,0x803 8012bb4: 38 42 fd 44 ori r2,r2,0xfd44 8012bb8: 28 42 00 00 lw r2,(r2+0) 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; 8012bbc: 34 03 00 01 mvi r3,1 8012bc0: 30 23 00 74 sb (r1+116),r3 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 8012bc4: 44 40 00 11 be r2,r0,8012c08 8012bc8: 78 02 08 03 mvhi r2,0x803 8012bcc: 38 42 fd 68 ori r2,r2,0xfd68 8012bd0: 28 42 00 00 lw r2,(r2+0) 8012bd4: 5c 22 00 0d bne r1,r2,8012c08 <== NEVER TAKEN _ISR_Signals_to_thread_executing = true; 8012bd8: 78 01 08 03 mvhi r1,0x803 8012bdc: 38 21 fe 00 ori r1,r1,0xfe00 8012be0: 30 23 00 00 sb (r1+0),r3 8012be4: e0 00 00 09 bi 8012c08 rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 8012be8: 90 00 08 00 rcsr r1,IE 8012bec: 34 02 ff fe mvi r2,-2 8012bf0: a0 22 10 00 and r2,r1,r2 8012bf4: d0 02 00 00 wcsr IE,r2 *signal_set |= signals; 8012bf8: 28 62 00 18 lw r2,(r3+24) 8012bfc: b8 4b 58 00 or r11,r2,r11 8012c00: 58 6b 00 18 sw (r3+24),r11 _ISR_Enable( _level ); 8012c04: d0 01 00 00 wcsr IE,r1 } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 8012c08: f8 00 13 c7 calli 8017b24 <_Thread_Enable_dispatch> 8012c0c: 34 03 00 00 mvi r3,0 return RTEMS_SUCCESSFUL; 8012c10: e0 00 00 03 bi 8012c1c } _Thread_Enable_dispatch(); 8012c14: f8 00 13 c4 calli 8017b24 <_Thread_Enable_dispatch> 8012c18: 34 03 00 0b mvi r3,11 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 8012c1c: b8 60 08 00 mv r1,r3 8012c20: 2b 9d 00 04 lw ra,(sp+4) 8012c24: 2b 8b 00 08 lw r11,(sp+8) 8012c28: 37 9c 00 0c addi sp,sp,12 8012c2c: c3 a0 00 00 ret 0800e990 : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 800e990: 37 9c ff e0 addi sp,sp,-32 800e994: 5b 8b 00 20 sw (sp+32),r11 800e998: 5b 8c 00 1c sw (sp+28),r12 800e99c: 5b 8d 00 18 sw (sp+24),r13 800e9a0: 5b 8e 00 14 sw (sp+20),r14 800e9a4: 5b 8f 00 10 sw (sp+16),r15 800e9a8: 5b 90 00 0c sw (sp+12),r16 800e9ac: 5b 91 00 08 sw (sp+8),r17 800e9b0: 5b 9d 00 04 sw (sp+4),ra ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) 800e9b4: 34 04 00 09 mvi r4,9 rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 800e9b8: b8 60 80 00 mv r16,r3 800e9bc: b8 20 68 00 mv r13,r1 800e9c0: b8 40 70 00 mv r14,r2 ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) 800e9c4: 44 60 00 51 be r3,r0,800eb08 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 800e9c8: 78 01 08 02 mvhi r1,0x802 800e9cc: 38 21 5a 00 ori r1,r1,0x5a00 800e9d0: 28 2b 00 00 lw r11,(r1+0) api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 800e9d4: 34 0f 00 00 mvi r15,0 800e9d8: 41 61 00 75 lbu r1,(r11+117) if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 800e9dc: 29 6c 01 28 lw r12,(r11+296) asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 800e9e0: 5c 2f 00 02 bne r1,r15,800e9e8 800e9e4: 34 0f 01 00 mvi r15,256 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 800e9e8: 29 61 00 7c lw r1,(r11+124) 800e9ec: 44 20 00 02 be r1,r0,800e9f4 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 800e9f0: 39 ef 02 00 ori r15,r15,0x200 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 800e9f4: 41 81 00 08 lbu r1,(r12+8) 800e9f8: 34 11 00 00 mvi r17,0 800e9fc: 5c 31 00 02 bne r1,r17,800ea04 800ea00: 34 11 04 00 mvi r17,1024 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; old_mode |= _ISR_Get_level(); 800ea04: fb ff e5 63 calli 8007f90 <_CPU_ISR_Get_level> 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; 800ea08: ba 21 88 00 or r17,r17,r1 old_mode |= _ISR_Get_level(); *previous_mode_set = old_mode; 800ea0c: ba 2f 88 00 or r17,r17,r15 800ea10: 5a 11 00 00 sw (r16+0),r17 /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 800ea14: 21 c1 01 00 andi r1,r14,0x100 800ea18: 44 20 00 07 be r1,r0,800ea34 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 800ea1c: b9 a0 08 00 mv r1,r13 800ea20: 34 02 00 08 mvi r2,8 800ea24: fb ff c8 92 calli 8000c6c <__lshrsi3> 800ea28: 18 21 00 01 xori r1,r1,0x1 800ea2c: 20 21 00 01 andi r1,r1,0x1 800ea30: 31 61 00 75 sb (r11+117),r1 if ( mask & RTEMS_TIMESLICE_MASK ) { 800ea34: 21 c1 02 00 andi r1,r14,0x200 800ea38: 44 20 00 0b be r1,r0,800ea64 if ( _Modes_Is_timeslice(mode_set) ) { 800ea3c: 21 a1 02 00 andi r1,r13,0x200 800ea40: 44 20 00 08 be r1,r0,800ea60 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 800ea44: 78 01 08 02 mvhi r1,0x802 800ea48: 38 21 58 d4 ori r1,r1,0x58d4 800ea4c: 28 21 00 00 lw r1,(r1+0) if ( mask & RTEMS_PREEMPT_MASK ) executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 800ea50: 34 02 00 01 mvi r2,1 800ea54: 59 62 00 7c sw (r11+124),r2 executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 800ea58: 59 61 00 78 sw (r11+120),r1 800ea5c: e0 00 00 02 bi 800ea64 } else executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 800ea60: 59 61 00 7c sw (r11+124),r1 /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 800ea64: 21 c1 00 01 andi r1,r14,0x1 800ea68: 44 20 00 04 be r1,r0,800ea78 */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); 800ea6c: 19 a1 00 01 xori r1,r13,0x1 800ea70: 20 21 00 01 andi r1,r1,0x1 800ea74: d0 01 00 00 wcsr IE,r1 */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 800ea78: 21 ce 04 00 andi r14,r14,0x400 800ea7c: 45 c0 00 18 be r14,r0,800eadc * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 800ea80: 34 02 00 0a mvi r2,10 800ea84: b9 a0 08 00 mv r1,r13 800ea88: fb ff c8 79 calli 8000c6c <__lshrsi3> if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 800ea8c: 41 82 00 08 lbu r2,(r12+8) * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 800ea90: 18 21 00 01 xori r1,r1,0x1 800ea94: 20 21 00 01 andi r1,r1,0x1 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 800ea98: 44 41 00 11 be r2,r1,800eadc 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 ) { asr->is_enabled = is_asr_enabled; 800ea9c: 31 81 00 08 sb (r12+8),r1 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 800eaa0: 90 00 08 00 rcsr r1,IE 800eaa4: 34 02 ff fe mvi r2,-2 800eaa8: a0 22 10 00 and r2,r1,r2 800eaac: d0 02 00 00 wcsr IE,r2 _signals = information->signals_pending; 800eab0: 29 82 00 18 lw r2,(r12+24) information->signals_pending = information->signals_posted; 800eab4: 29 83 00 14 lw r3,(r12+20) information->signals_posted = _signals; 800eab8: 59 82 00 14 sw (r12+20),r2 rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; 800eabc: 59 83 00 18 sw (r12+24),r3 information->signals_posted = _signals; _ISR_Enable( _level ); 800eac0: d0 01 00 00 wcsr IE,r1 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; 800eac4: 29 81 00 14 lw r1,(r12+20) 800eac8: 44 20 00 05 be r1,r0,800eadc 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; executing->do_post_task_switch_extension = true; 800eacc: 34 01 00 01 mvi r1,1 800ead0: 31 61 00 74 sb (r11+116),r1 800ead4: b8 20 58 00 mv r11,r1 800ead8: e0 00 00 02 bi 800eae0 800eadc: 34 0b 00 00 mvi r11,0 } } } if ( _System_state_Is_up( _System_state_Get() ) ) 800eae0: 78 01 08 02 mvhi r1,0x802 800eae4: 38 21 5a e0 ori r1,r1,0x5ae0 800eae8: 28 22 00 00 lw r2,(r1+0) 800eaec: 34 01 00 03 mvi r1,3 800eaf0: 5c 41 00 05 bne r2,r1,800eb04 <== NEVER TAKEN if ( _Thread_Evaluate_mode() || needs_asr_dispatching ) 800eaf4: f8 00 04 36 calli 800fbcc <_Thread_Evaluate_mode> 800eaf8: 5c 20 00 02 bne r1,r0,800eb00 800eafc: 45 61 00 02 be r11,r1,800eb04 _Thread_Dispatch(); 800eb00: fb ff de d8 calli 8006660 <_Thread_Dispatch> 800eb04: 34 04 00 00 mvi r4,0 return RTEMS_SUCCESSFUL; } 800eb08: b8 80 08 00 mv r1,r4 800eb0c: 2b 9d 00 04 lw ra,(sp+4) 800eb10: 2b 8b 00 20 lw r11,(sp+32) 800eb14: 2b 8c 00 1c lw r12,(sp+28) 800eb18: 2b 8d 00 18 lw r13,(sp+24) 800eb1c: 2b 8e 00 14 lw r14,(sp+20) 800eb20: 2b 8f 00 10 lw r15,(sp+16) 800eb24: 2b 90 00 0c lw r16,(sp+12) 800eb28: 2b 91 00 08 lw r17,(sp+8) 800eb2c: 37 9c 00 20 addi sp,sp,32 800eb30: c3 a0 00 00 ret 080087a8 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 80087a8: 37 9c ff f0 addi sp,sp,-16 80087ac: 5b 8b 00 0c sw (sp+12),r11 80087b0: 5b 8c 00 08 sw (sp+8),r12 80087b4: 5b 9d 00 04 sw (sp+4),ra 80087b8: b8 40 58 00 mv r11,r2 80087bc: b8 60 60 00 mv r12,r3 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 80087c0: 44 40 00 07 be r2,r0,80087dc 80087c4: 78 02 08 02 mvhi r2,0x802 80087c8: 38 42 50 c0 ori r2,r2,0x50c0 80087cc: 40 42 00 00 lbu r2,(r2+0) 80087d0: 50 4b 00 03 bgeu r2,r11,80087dc 80087d4: 34 02 00 13 mvi r2,19 80087d8: e0 00 00 15 bi 800882c !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 80087dc: 34 02 00 09 mvi r2,9 80087e0: 45 80 00 13 be r12,r0,800882c return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 80087e4: 37 82 00 10 addi r2,sp,16 80087e8: f8 00 09 b0 calli 800aea8 <_Thread_Get> switch ( location ) { 80087ec: 2b 84 00 10 lw r4,(sp+16) 80087f0: 34 02 00 04 mvi r2,4 80087f4: 5c 80 00 0e bne r4,r0,800882c case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 80087f8: 28 22 00 14 lw r2,(r1+20) 80087fc: 59 82 00 00 sw (r12+0),r2 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 8008800: 45 64 00 09 be r11,r4,8008824 the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 8008804: 28 22 00 1c lw r2,(r1+28) case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; if ( new_priority != RTEMS_CURRENT_PRIORITY ) { the_thread->real_priority = new_priority; 8008808: 58 2b 00 18 sw (r1+24),r11 if ( the_thread->resource_count == 0 || 800880c: 44 40 00 03 be r2,r0,8008818 the_thread->current_priority > new_priority ) 8008810: 28 22 00 14 lw r2,(r1+20) 8008814: 51 62 00 04 bgeu r11,r2,8008824 <== ALWAYS TAKEN _Thread_Change_priority( the_thread, new_priority, false ); 8008818: b9 60 10 00 mv r2,r11 800881c: 34 03 00 00 mvi r3,0 8008820: f8 00 07 de calli 800a798 <_Thread_Change_priority> } _Thread_Enable_dispatch(); 8008824: f8 00 09 81 calli 800ae28 <_Thread_Enable_dispatch> 8008828: 34 02 00 00 mvi r2,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 800882c: b8 40 08 00 mv r1,r2 8008830: 2b 9d 00 04 lw ra,(sp+4) 8008834: 2b 8b 00 0c lw r11,(sp+12) 8008838: 2b 8c 00 08 lw r12,(sp+8) 800883c: 37 9c 00 10 addi sp,sp,16 8008840: c3 a0 00 00 ret 08013728 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 8013728: 37 9c ff f8 addi sp,sp,-8 801372c: 5b 9d 00 04 sw (sp+4),ra 8013730: b8 20 10 00 mv r2,r1 RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Get ( Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) 8013734: 78 01 08 04 mvhi r1,0x804 8013738: 37 83 00 08 addi r3,sp,8 801373c: 38 21 05 a4 ori r1,r1,0x5a4 8013740: f8 00 0e 06 calli 8016f58 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 8013744: 2b 83 00 08 lw r3,(sp+8) 8013748: 34 02 00 04 mvi r2,4 801374c: 5c 60 00 07 bne r3,r0,8013768 case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 8013750: 28 23 00 38 lw r3,(r1+56) 8013754: 44 62 00 03 be r3,r2,8013760 <== NEVER TAKEN (void) _Watchdog_Remove( &the_timer->Ticker ); 8013758: 34 21 00 10 addi r1,r1,16 801375c: f8 00 17 e6 calli 80196f4 <_Watchdog_Remove> _Thread_Enable_dispatch(); 8013760: f8 00 10 f1 calli 8017b24 <_Thread_Enable_dispatch> 8013764: 34 02 00 00 mvi r2,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 8013768: b8 40 08 00 mv r1,r2 801376c: 2b 9d 00 04 lw ra,(sp+4) 8013770: 37 9c 00 08 addi sp,sp,8 8013774: c3 a0 00 00 ret 08013d68 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 8013d68: 37 9c ff d8 addi sp,sp,-40 8013d6c: 5b 8b 00 24 sw (sp+36),r11 8013d70: 5b 8c 00 20 sw (sp+32),r12 8013d74: 5b 8d 00 1c sw (sp+28),r13 8013d78: 5b 8e 00 18 sw (sp+24),r14 8013d7c: 5b 8f 00 14 sw (sp+20),r15 8013d80: 5b 90 00 10 sw (sp+16),r16 8013d84: 5b 91 00 0c sw (sp+12),r17 8013d88: 5b 92 00 08 sw (sp+8),r18 8013d8c: 5b 9d 00 04 sw (sp+4),ra Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; 8013d90: 78 05 08 04 mvhi r5,0x804 8013d94: 38 a5 05 e4 ori r5,r5,0x5e4 8013d98: 28 ae 00 00 lw r14,(r5+0) rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 8013d9c: b8 20 88 00 mv r17,r1 8013da0: b8 40 58 00 mv r11,r2 8013da4: b8 60 78 00 mv r15,r3 8013da8: b8 80 90 00 mv r18,r4 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) 8013dac: 34 05 00 0e mvi r5,14 8013db0: 45 c0 00 2e be r14,r0,8013e68 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 8013db4: 78 05 08 03 mvhi r5,0x803 8013db8: 38 a5 fc c0 ori r5,r5,0xfcc0 8013dbc: 40 a1 00 00 lbu r1,(r5+0) 8013dc0: 34 05 00 0b mvi r5,11 8013dc4: 44 20 00 29 be r1,r0,8013e68 <== NEVER TAKEN return RTEMS_NOT_DEFINED; if ( !routine ) 8013dc8: 34 05 00 09 mvi r5,9 8013dcc: 44 60 00 27 be r3,r0,8013e68 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 8013dd0: b8 40 08 00 mv r1,r2 8013dd4: fb ff f1 58 calli 8010334 <_TOD_Validate> 8013dd8: 44 20 00 23 be r1,r0,8013e64 return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); if ( seconds <= _TOD_Seconds_since_epoch() ) 8013ddc: 78 0c 08 03 mvhi r12,0x803 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 8013de0: b9 60 08 00 mv r1,r11 8013de4: fb ff f1 14 calli 8010234 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) 8013de8: 39 8c fd 3c ori r12,r12,0xfd3c return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 8013dec: b8 20 80 00 mv r16,r1 if ( seconds <= _TOD_Seconds_since_epoch() ) 8013df0: 29 81 00 00 lw r1,(r12+0) 8013df4: 50 30 00 1c bgeu r1,r16,8013e64 8013df8: 78 01 08 04 mvhi r1,0x804 8013dfc: 38 21 05 a4 ori r1,r1,0x5a4 8013e00: ba 20 10 00 mv r2,r17 8013e04: 37 83 00 28 addi r3,sp,40 8013e08: f8 00 0c 54 calli 8016f58 <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 8013e0c: 2b 8d 00 28 lw r13,(sp+40) 8013e10: b8 20 58 00 mv r11,r1 8013e14: 34 05 00 04 mvi r5,4 8013e18: 5d a0 00 14 bne r13,r0,8013e68 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 8013e1c: 34 21 00 10 addi r1,r1,16 8013e20: f8 00 16 35 calli 80196f4 <_Watchdog_Remove> void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; 8013e24: 59 71 00 30 sw (r11+48),r17 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(); 8013e28: 29 81 00 00 lw r1,(r12+0) (*timer_server->schedule_operation)( timer_server, the_timer ); 8013e2c: 29 c3 00 04 lw r3,(r14+4) 8013e30: b9 60 10 00 mv r2,r11 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(); 8013e34: ca 01 80 00 sub r16,r16,r1 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 8013e38: 34 01 00 03 mvi r1,3 8013e3c: 59 61 00 38 sw (r11+56),r1 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 8013e40: 59 6f 00 2c sw (r11+44),r15 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); (*timer_server->schedule_operation)( timer_server, the_timer ); 8013e44: b9 c0 08 00 mv r1,r14 the_watchdog->id = id; the_watchdog->user_data = user_data; 8013e48: 59 72 00 34 sw (r11+52),r18 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(); 8013e4c: 59 70 00 1c sw (r11+28),r16 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 8013e50: 59 6d 00 18 sw (r11+24),r13 (*timer_server->schedule_operation)( timer_server, the_timer ); 8013e54: d8 60 00 00 call r3 _Thread_Enable_dispatch(); 8013e58: f8 00 0f 33 calli 8017b24 <_Thread_Enable_dispatch> 8013e5c: b9 a0 28 00 mv r5,r13 return RTEMS_SUCCESSFUL; 8013e60: e0 00 00 02 bi 8013e68 8013e64: 34 05 00 14 mvi r5,20 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 8013e68: b8 a0 08 00 mv r1,r5 8013e6c: 2b 9d 00 04 lw ra,(sp+4) 8013e70: 2b 8b 00 24 lw r11,(sp+36) 8013e74: 2b 8c 00 20 lw r12,(sp+32) 8013e78: 2b 8d 00 1c lw r13,(sp+28) 8013e7c: 2b 8e 00 18 lw r14,(sp+24) 8013e80: 2b 8f 00 14 lw r15,(sp+20) 8013e84: 2b 90 00 10 lw r16,(sp+16) 8013e88: 2b 91 00 0c lw r17,(sp+12) 8013e8c: 2b 92 00 08 lw r18,(sp+8) 8013e90: 37 9c 00 28 addi sp,sp,40 8013e94: c3 a0 00 00 ret 08003144 : #include int sched_get_priority_max( int policy ) { 8003144: 37 9c ff fc addi sp,sp,-4 8003148: 5b 9d 00 04 sw (sp+4),ra switch ( policy ) { 800314c: 48 01 00 05 bg r0,r1,8003160 8003150: 34 02 00 02 mvi r2,2 8003154: 4c 41 00 08 bge r2,r1,8003174 8003158: 34 02 00 04 mvi r2,4 800315c: 44 22 00 06 be r1,r2,8003174 <== ALWAYS TAKEN case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 8003160: f8 00 28 67 calli 800d2fc <__errno> 8003164: 34 02 00 16 mvi r2,22 8003168: 58 22 00 00 sw (r1+0),r2 800316c: 34 01 ff ff mvi r1,-1 8003170: e0 00 00 05 bi 8003184 } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 8003174: 78 01 08 01 mvhi r1,0x801 8003178: 38 21 e0 e4 ori r1,r1,0xe0e4 800317c: 40 21 00 00 lbu r1,(r1+0) 8003180: 34 21 ff ff addi r1,r1,-1 } 8003184: 2b 9d 00 04 lw ra,(sp+4) 8003188: 37 9c 00 04 addi sp,sp,4 800318c: c3 a0 00 00 ret 08003190 : #include int sched_get_priority_min( int policy ) { 8003190: 37 9c ff fc addi sp,sp,-4 8003194: 5b 9d 00 04 sw (sp+4),ra switch ( policy ) { 8003198: 48 01 00 07 bg r0,r1,80031b4 800319c: 34 02 00 02 mvi r2,2 80031a0: 4c 41 00 03 bge r2,r1,80031ac <== ALWAYS TAKEN 80031a4: 34 02 00 04 mvi r2,4 <== NOT EXECUTED 80031a8: 5c 22 00 03 bne r1,r2,80031b4 <== NOT EXECUTED 80031ac: 34 01 00 01 mvi r1,1 80031b0: e0 00 00 05 bi 80031c4 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 80031b4: f8 00 28 52 calli 800d2fc <__errno> 80031b8: 34 02 00 16 mvi r2,22 80031bc: 58 22 00 00 sw (r1+0),r2 80031c0: 34 01 ff ff mvi r1,-1 } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } 80031c4: 2b 9d 00 04 lw ra,(sp+4) 80031c8: 37 9c 00 04 addi sp,sp,4 80031cc: c3 a0 00 00 ret 080031d0 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 80031d0: 37 9c ff f4 addi sp,sp,-12 80031d4: 5b 8b 00 08 sw (sp+8),r11 80031d8: 5b 9d 00 04 sw (sp+4),ra 80031dc: b8 20 58 00 mv r11,r1 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 80031e0: 44 20 00 08 be r1,r0,8003200 <== NEVER TAKEN 80031e4: 5b 82 00 0c sw (sp+12),r2 80031e8: fb ff f9 c2 calli 80018f0 80031ec: 2b 82 00 0c lw r2,(sp+12) 80031f0: 45 61 00 04 be r11,r1,8003200 rtems_set_errno_and_return_minus_one( ESRCH ); 80031f4: f8 00 28 42 calli 800d2fc <__errno> 80031f8: 34 02 00 03 mvi r2,3 80031fc: e0 00 00 04 bi 800320c if ( !interval ) 8003200: 5c 40 00 06 bne r2,r0,8003218 rtems_set_errno_and_return_minus_one( EINVAL ); 8003204: f8 00 28 3e calli 800d2fc <__errno> 8003208: 34 02 00 16 mvi r2,22 800320c: 58 22 00 00 sw (r1+0),r2 8003210: 34 01 ff ff mvi r1,-1 8003214: e0 00 00 06 bi 800322c _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 8003218: 78 01 08 01 mvhi r1,0x801 800321c: 38 21 e7 f4 ori r1,r1,0xe7f4 8003220: 28 21 00 00 lw r1,(r1+0) 8003224: f8 00 0c 52 calli 800636c <_Timespec_From_ticks> 8003228: 34 01 00 00 mvi r1,0 return 0; } 800322c: 2b 9d 00 04 lw ra,(sp+4) 8003230: 2b 8b 00 08 lw r11,(sp+8) 8003234: 37 9c 00 0c addi sp,sp,12 8003238: c3 a0 00 00 ret 080057b0 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 80057b0: 37 9c ff c0 addi sp,sp,-64 80057b4: 5b 8b 00 18 sw (sp+24),r11 80057b8: 5b 8c 00 14 sw (sp+20),r12 80057bc: 5b 8d 00 10 sw (sp+16),r13 80057c0: 5b 8e 00 0c sw (sp+12),r14 80057c4: 5b 8f 00 08 sw (sp+8),r15 80057c8: 5b 9d 00 04 sw (sp+4),ra rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 80057cc: 78 09 08 02 mvhi r9,0x802 80057d0: 39 29 3a 64 ori r9,r9,0x3a64 80057d4: 29 2a 00 00 lw r10,(r9+0) 80057d8: 5b 83 00 2c sw (sp+44),r3 80057dc: 5b 84 00 30 sw (sp+48),r4 80057e0: 35 43 00 01 addi r3,r10,1 80057e4: 59 23 00 00 sw (r9+0),r3 80057e8: 5b 85 00 34 sw (sp+52),r5 80057ec: 5b 86 00 38 sw (sp+56),r6 80057f0: 5b 87 00 3c sw (sp+60),r7 80057f4: 5b 88 00 40 sw (sp+64),r8 80057f8: b8 20 68 00 mv r13,r1 80057fc: 5b 82 00 28 sw (sp+40),r2 8005800: b8 40 78 00 mv r15,r2 POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 8005804: 20 4c 02 00 andi r12,r2,0x200 8005808: b9 80 70 00 mv r14,r12 800580c: 45 80 00 02 be r12,r0,8005814 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 8005810: 2b 8e 00 30 lw r14,(sp+48) va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 8005814: b9 a0 08 00 mv r1,r13 8005818: 37 82 00 24 addi r2,sp,36 800581c: f8 00 16 32 calli 800b0e4 <_POSIX_Semaphore_Name_to_id> 8005820: b8 20 58 00 mv r11,r1 * 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 ) { 8005824: 44 20 00 08 be r1,r0,8005844 /* * 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) ) ) { 8005828: 34 01 00 02 mvi r1,2 800582c: 5d 61 00 02 bne r11,r1,8005834 <== NEVER TAKEN 8005830: 5d 80 00 1a bne r12,r0,8005898 _Thread_Enable_dispatch(); 8005834: f8 00 07 8b calli 8007660 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 8005838: f8 00 2b d9 calli 801079c <__errno> 800583c: 58 2b 00 00 sw (r1+0),r11 8005840: e0 00 00 08 bi 8005860 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 8005844: 21 ef 0a 00 andi r15,r15,0xa00 8005848: 34 01 0a 00 mvi r1,2560 800584c: 5d e1 00 07 bne r15,r1,8005868 _Thread_Enable_dispatch(); 8005850: f8 00 07 84 calli 8007660 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 8005854: f8 00 2b d2 calli 801079c <__errno> 8005858: 34 02 00 11 mvi r2,17 800585c: 58 22 00 00 sw (r1+0),r2 8005860: 34 01 ff ff mvi r1,-1 8005864: e0 00 00 19 bi 80058c8 8005868: 2b 82 00 24 lw r2,(sp+36) 800586c: 78 01 08 02 mvhi r1,0x802 8005870: 37 83 00 1c addi r3,sp,28 8005874: 38 21 3c e4 ori r1,r1,0x3ce4 8005878: f8 00 05 ac calli 8006f28 <_Objects_Get> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 800587c: 28 22 00 18 lw r2,(r1+24) 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 ); 8005880: 5b 81 00 20 sw (sp+32),r1 the_semaphore->open_count += 1; 8005884: 34 42 00 01 addi r2,r2,1 8005888: 58 22 00 18 sw (r1+24),r2 _Thread_Enable_dispatch(); 800588c: f8 00 07 75 calli 8007660 <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); 8005890: f8 00 07 74 calli 8007660 <_Thread_Enable_dispatch> goto return_id; 8005894: e0 00 00 0b bi 80058c0 /* * 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( 8005898: 34 02 00 00 mvi r2,0 800589c: b9 c0 18 00 mv r3,r14 80058a0: 37 84 00 20 addi r4,sp,32 80058a4: b9 a0 08 00 mv r1,r13 80058a8: f8 00 15 a7 calli 800af44 <_POSIX_Semaphore_Create_support> 80058ac: b8 20 58 00 mv r11,r1 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 80058b0: f8 00 07 6c calli 8007660 <_Thread_Enable_dispatch> if ( status == -1 ) 80058b4: 34 02 ff ff mvi r2,-1 80058b8: b9 60 08 00 mv r1,r11 80058bc: 45 62 00 03 be r11,r2,80058c8 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; 80058c0: 2b 81 00 20 lw r1,(sp+32) 80058c4: 34 21 00 08 addi r1,r1,8 #endif return id; } 80058c8: 2b 9d 00 04 lw ra,(sp+4) 80058cc: 2b 8b 00 18 lw r11,(sp+24) 80058d0: 2b 8c 00 14 lw r12,(sp+20) 80058d4: 2b 8d 00 10 lw r13,(sp+16) 80058d8: 2b 8e 00 0c lw r14,(sp+12) 80058dc: 2b 8f 00 08 lw r15,(sp+8) 80058e0: 37 9c 00 40 addi sp,sp,64 80058e4: c3 a0 00 00 ret 0800300c : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 800300c: 37 9c ff e8 addi sp,sp,-24 8003010: 5b 8b 00 18 sw (sp+24),r11 8003014: 5b 8c 00 14 sw (sp+20),r12 8003018: 5b 8d 00 10 sw (sp+16),r13 800301c: 5b 8e 00 0c sw (sp+12),r14 8003020: 5b 8f 00 08 sw (sp+8),r15 8003024: 5b 9d 00 04 sw (sp+4),ra 8003028: b8 60 70 00 mv r14,r3 800302c: b8 20 58 00 mv r11,r1 8003030: b8 40 60 00 mv r12,r2 ISR_Level level; if ( oact ) 8003034: 44 60 00 0b be r3,r0,8003060 *oact = _POSIX_signals_Vectors[ sig ]; 8003038: b4 21 08 00 add r1,r1,r1 800303c: 34 02 00 02 mvi r2,2 8003040: b4 2b 08 00 add r1,r1,r11 8003044: 78 0d 08 01 mvhi r13,0x801 8003048: fb ff f6 38 calli 8000928 <__ashlsi3> 800304c: 39 ad fd c0 ori r13,r13,0xfdc0 8003050: b5 a1 10 00 add r2,r13,r1 8003054: 34 03 00 0c mvi r3,12 8003058: b9 c0 08 00 mv r1,r14 800305c: f8 00 2b ec calli 800e00c if ( !sig ) 8003060: 45 60 00 07 be r11,r0,800307c rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 8003064: 35 61 ff ff addi r1,r11,-1 8003068: 34 02 00 1f mvi r2,31 800306c: 50 41 00 02 bgeu r2,r1,8003074 8003070: e0 00 00 03 bi 800307c * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 8003074: 34 01 00 09 mvi r1,9 8003078: 5d 61 00 06 bne r11,r1,8003090 rtems_set_errno_and_return_minus_one( EINVAL ); 800307c: f8 00 29 37 calli 800d558 <__errno> 8003080: 34 02 00 16 mvi r2,22 8003084: 58 22 00 00 sw (r1+0),r2 8003088: 34 01 ff ff mvi r1,-1 800308c: e0 00 00 1f bi 8003108 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 8003090: b9 80 08 00 mv r1,r12 8003094: 45 80 00 1d be r12,r0,8003108 <== NEVER TAKEN /* * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); 8003098: 90 00 70 00 rcsr r14,IE 800309c: 34 01 ff fe mvi r1,-2 80030a0: a1 c1 08 00 and r1,r14,r1 80030a4: d0 01 00 00 wcsr IE,r1 if ( act->sa_handler == SIG_DFL ) { 80030a8: 29 81 00 08 lw r1,(r12+8) 80030ac: 78 0d 08 01 mvhi r13,0x801 80030b0: 39 ad fd c0 ori r13,r13,0xfdc0 80030b4: b5 6b 78 00 add r15,r11,r11 80030b8: 5c 20 00 09 bne r1,r0,80030dc _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 80030bc: 34 02 00 02 mvi r2,2 80030c0: b5 eb 08 00 add r1,r15,r11 80030c4: fb ff f6 19 calli 8000928 <__ashlsi3> 80030c8: 78 02 08 01 mvhi r2,0x801 80030cc: 38 42 de 0c ori r2,r2,0xde0c 80030d0: b4 41 10 00 add r2,r2,r1 80030d4: b5 a1 08 00 add r1,r13,r1 80030d8: e0 00 00 08 bi 80030f8 } else { _POSIX_signals_Clear_process_signals( sig ); 80030dc: b9 60 08 00 mv r1,r11 80030e0: f8 00 17 4f calli 8008e1c <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; 80030e4: 34 02 00 02 mvi r2,2 80030e8: b5 eb 08 00 add r1,r15,r11 80030ec: fb ff f6 0f calli 8000928 <__ashlsi3> 80030f0: b5 a1 08 00 add r1,r13,r1 80030f4: b9 80 10 00 mv r2,r12 80030f8: 34 03 00 0c mvi r3,12 80030fc: f8 00 2b c4 calli 800e00c } _ISR_Enable( level ); 8003100: d0 0e 00 00 wcsr IE,r14 8003104: 34 01 00 00 mvi r1,0 * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; } 8003108: 2b 9d 00 04 lw ra,(sp+4) 800310c: 2b 8b 00 18 lw r11,(sp+24) 8003110: 2b 8c 00 14 lw r12,(sp+20) 8003114: 2b 8d 00 10 lw r13,(sp+16) 8003118: 2b 8e 00 0c lw r14,(sp+12) 800311c: 2b 8f 00 08 lw r15,(sp+8) 8003120: 37 9c 00 18 addi sp,sp,24 8003124: c3 a0 00 00 ret 0800588c : #include int sigsuspend( const sigset_t *sigmask ) { 800588c: 37 9c ff f0 addi sp,sp,-16 8005890: 5b 8b 00 08 sw (sp+8),r11 8005894: 5b 9d 00 04 sw (sp+4),ra int status; POSIX_API_Control *api; api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; status = sigprocmask( SIG_BLOCK, sigmask, &saved_signals_blocked ); 8005898: b8 20 10 00 mv r2,r1 800589c: 37 83 00 10 addi r3,sp,16 80058a0: 34 01 00 01 mvi r1,1 80058a4: fb ff ff ec calli 8005854 (void) sigfillset( &all_signals ); 80058a8: 37 8b 00 0c addi r11,sp,12 80058ac: b9 60 08 00 mv r1,r11 80058b0: fb ff ff ac calli 8005760 status = sigtimedwait( &all_signals, NULL, NULL ); 80058b4: 34 02 00 00 mvi r2,0 80058b8: b8 40 18 00 mv r3,r2 80058bc: b9 60 08 00 mv r1,r11 80058c0: f8 00 00 2f calli 800597c 80058c4: b8 20 58 00 mv r11,r1 (void) sigprocmask( SIG_SETMASK, &saved_signals_blocked, NULL ); 80058c8: 34 01 00 00 mvi r1,0 80058cc: 37 82 00 10 addi r2,sp,16 80058d0: b8 20 18 00 mv r3,r1 80058d4: fb ff ff e0 calli 8005854 /* * sigtimedwait() returns the signal number while sigsuspend() * is supposed to return -1 and EINTR when a signal is caught. */ if ( status != -1 ) 80058d8: 34 02 ff ff mvi r2,-1 80058dc: 45 62 00 04 be r11,r2,80058ec <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINTR ); 80058e0: f8 00 28 20 calli 800f960 <__errno> 80058e4: 34 02 00 04 mvi r2,4 80058e8: 58 22 00 00 sw (r1+0),r2 return status; } 80058ec: 34 01 ff ff mvi r1,-1 80058f0: 2b 9d 00 04 lw ra,(sp+4) 80058f4: 2b 8b 00 08 lw r11,(sp+8) 80058f8: 37 9c 00 10 addi sp,sp,16 80058fc: c3 a0 00 00 ret 080035f8 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 80035f8: 37 9c ff dc addi sp,sp,-36 80035fc: 5b 8b 00 18 sw (sp+24),r11 8003600: 5b 8c 00 14 sw (sp+20),r12 8003604: 5b 8d 00 10 sw (sp+16),r13 8003608: 5b 8e 00 0c sw (sp+12),r14 800360c: 5b 8f 00 08 sw (sp+8),r15 8003610: 5b 9d 00 04 sw (sp+4),ra 8003614: b8 20 60 00 mv r12,r1 8003618: b8 40 68 00 mv r13,r2 800361c: b8 60 58 00 mv r11,r3 ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 8003620: 44 20 00 09 be r1,r0,8003644 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 8003624: 44 60 00 0d be r3,r0,8003658 if ( !_Timespec_Is_valid( timeout ) ) 8003628: b8 60 08 00 mv r1,r3 800362c: f8 00 0c 8a calli 8006854 <_Timespec_Is_valid> 8003630: 44 20 00 05 be r1,r0,8003644 rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 8003634: b9 60 08 00 mv r1,r11 8003638: f8 00 0c a0 calli 80068b8 <_Timespec_To_ticks> 800363c: b8 20 10 00 mv r2,r1 if ( !interval ) 8003640: 5c 20 00 07 bne r1,r0,800365c <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); 8003644: f8 00 28 a1 calli 800d8c8 <__errno> 8003648: 34 02 00 16 mvi r2,22 800364c: 58 22 00 00 sw (r1+0),r2 8003650: 34 0c ff ff mvi r12,-1 8003654: e0 00 00 58 bi 80037b4 8003658: b8 60 10 00 mv r2,r3 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 800365c: 37 8b 00 1c addi r11,sp,28 8003660: 45 a0 00 02 be r13,r0,8003668 8003664: b9 a0 58 00 mv r11,r13 the_thread = _Thread_Executing; 8003668: 78 01 08 01 mvhi r1,0x801 800366c: 38 21 f9 70 ori r1,r1,0xf970 8003670: 28 24 00 00 lw r4,(r1+0) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8003674: 28 8d 01 2c lw r13,(r4+300) * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 8003678: 90 00 70 00 rcsr r14,IE 800367c: 34 01 ff fe mvi r1,-2 8003680: a1 c1 08 00 and r1,r14,r1 8003684: d0 01 00 00 wcsr IE,r1 if ( *set & api->signals_pending ) { 8003688: 29 83 00 00 lw r3,(r12+0) 800368c: 29 a1 00 d0 lw r1,(r13+208) 8003690: a0 61 78 00 and r15,r3,r1 8003694: 45 e0 00 0f be r15,r0,80036d0 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_highest( api->signals_pending ); 8003698: fb ff ff b9 calli 800357c <_POSIX_signals_Get_highest> _POSIX_signals_Clear_signals( 800369c: 34 04 00 00 mvi r4,0 /* 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 ); 80036a0: b8 20 10 00 mv r2,r1 80036a4: 59 61 00 00 sw (r11+0),r1 _POSIX_signals_Clear_signals( 80036a8: b9 60 18 00 mv r3,r11 80036ac: b9 a0 08 00 mv r1,r13 80036b0: b8 80 28 00 mv r5,r4 80036b4: f8 00 18 2b calli 8009760 <_POSIX_signals_Clear_signals> the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 80036b8: d0 0e 00 00 wcsr IE,r14 the_info->si_code = SI_USER; 80036bc: 34 01 00 01 mvi r1,1 80036c0: 59 61 00 04 sw (r11+4),r1 the_info->si_value.sival_int = 0; 80036c4: 34 01 00 00 mvi r1,0 80036c8: 59 61 00 08 sw (r11+8),r1 80036cc: e0 00 00 39 bi 80037b0 return the_info->si_signo; } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 80036d0: 78 01 08 01 mvhi r1,0x801 80036d4: 38 21 ff b4 ori r1,r1,0xffb4 80036d8: 28 21 00 00 lw r1,(r1+0) 80036dc: a0 61 18 00 and r3,r3,r1 80036e0: 44 6f 00 10 be r3,r15,8003720 signo = _POSIX_signals_Get_highest( _POSIX_signals_Pending ); 80036e4: fb ff ff a6 calli 800357c <_POSIX_signals_Get_highest> 80036e8: b8 20 60 00 mv r12,r1 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 80036ec: b9 80 10 00 mv r2,r12 80036f0: b9 a0 08 00 mv r1,r13 80036f4: b9 60 18 00 mv r3,r11 80036f8: b9 e0 28 00 mv r5,r15 80036fc: 34 04 00 01 mvi r4,1 8003700: f8 00 18 18 calli 8009760 <_POSIX_signals_Clear_signals> _ISR_Enable( level ); 8003704: d0 0e 00 00 wcsr IE,r14 the_info->si_signo = signo; the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; 8003708: 34 01 00 00 mvi r1,0 800370c: 59 61 00 08 sw (r11+8),r1 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; the_info->si_code = SI_USER; 8003710: 34 01 00 01 mvi r1,1 8003714: 59 61 00 04 sw (r11+4),r1 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; 8003718: 59 6c 00 00 sw (r11+0),r12 the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; return signo; 800371c: e0 00 00 26 bi 80037b4 8003720: 78 03 08 01 mvhi r3,0x801 8003724: 38 63 f8 b4 ori r3,r3,0xf8b4 8003728: 28 61 00 00 lw r1,(r3+0) } the_info->si_signo = -1; 800372c: 34 05 ff ff mvi r5,-1 8003730: 59 65 00 00 sw (r11+0),r5 8003734: 34 21 00 01 addi r1,r1,1 8003738: 58 61 00 00 sw (r3+0),r1 _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 800373c: 34 01 00 04 mvi r1,4 8003740: 58 81 00 34 sw (r4+52),r1 the_thread->Wait.option = *set; 8003744: 29 8c 00 00 lw r12,(r12+0) } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 8003748: 78 03 08 01 mvhi r3,0x801 800374c: 38 63 ff 4c ori r3,r3,0xff4c 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; 8003750: 34 01 00 01 mvi r1,1 the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; 8003754: 58 8c 00 30 sw (r4+48),r12 8003758: 58 61 00 30 sw (r3+48),r1 the_thread->Wait.return_argument = the_info; 800375c: 58 8b 00 28 sw (r4+40),r11 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 8003760: 58 83 00 44 sw (r4+68),r3 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 ); 8003764: d0 0e 00 00 wcsr IE,r14 _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 8003768: 78 01 08 01 mvhi r1,0x801 800376c: 78 03 08 00 mvhi r3,0x800 8003770: 38 63 62 9c ori r3,r3,0x629c 8003774: 38 21 ff 4c ori r1,r1,0xff4c 8003778: f8 00 09 da calli 8005ee0 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); 800377c: f8 00 08 8e calli 80059b4 <_Thread_Enable_dispatch> /* * 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 ); 8003780: 29 62 00 00 lw r2,(r11+0) 8003784: 34 04 00 00 mvi r4,0 8003788: b9 60 18 00 mv r3,r11 800378c: b8 80 28 00 mv r5,r4 8003790: b9 a0 08 00 mv r1,r13 8003794: f8 00 17 f3 calli 8009760 <_POSIX_signals_Clear_signals> errno = _Thread_Executing->Wait.return_code; 8003798: f8 00 28 4c calli 800d8c8 <__errno> 800379c: 78 02 08 01 mvhi r2,0x801 80037a0: 38 42 f9 70 ori r2,r2,0xf970 80037a4: 28 42 00 00 lw r2,(r2+0) 80037a8: 28 42 00 34 lw r2,(r2+52) 80037ac: 58 22 00 00 sw (r1+0),r2 return the_info->si_signo; 80037b0: 29 6c 00 00 lw r12,(r11+0) } 80037b4: b9 80 08 00 mv r1,r12 80037b8: 2b 9d 00 04 lw ra,(sp+4) 80037bc: 2b 8b 00 18 lw r11,(sp+24) 80037c0: 2b 8c 00 14 lw r12,(sp+20) 80037c4: 2b 8d 00 10 lw r13,(sp+16) 80037c8: 2b 8e 00 0c lw r14,(sp+12) 80037cc: 2b 8f 00 08 lw r15,(sp+8) 80037d0: 37 9c 00 24 addi sp,sp,36 80037d4: c3 a0 00 00 ret 08005b78 : int sigwait( const sigset_t *set, int *sig ) { 8005b78: 37 9c ff f8 addi sp,sp,-8 8005b7c: 5b 8b 00 08 sw (sp+8),r11 8005b80: 5b 9d 00 04 sw (sp+4),ra 8005b84: b8 40 58 00 mv r11,r2 int status; status = sigtimedwait( set, NULL, NULL ); 8005b88: 34 02 00 00 mvi r2,0 8005b8c: b8 40 18 00 mv r3,r2 8005b90: fb ff ff 7b calli 800597c 8005b94: b8 20 10 00 mv r2,r1 if ( status != -1 ) { 8005b98: 34 01 ff ff mvi r1,-1 8005b9c: 44 41 00 06 be r2,r1,8005bb4 if ( sig ) 8005ba0: b9 60 08 00 mv r1,r11 8005ba4: 45 60 00 06 be r11,r0,8005bbc <== NEVER TAKEN *sig = status; 8005ba8: 59 62 00 00 sw (r11+0),r2 8005bac: 34 01 00 00 mvi r1,0 8005bb0: e0 00 00 03 bi 8005bbc return 0; } return errno; 8005bb4: f8 00 27 6b calli 800f960 <__errno> 8005bb8: 28 21 00 00 lw r1,(r1+0) } 8005bbc: 2b 9d 00 04 lw ra,(sp+4) 8005bc0: 2b 8b 00 08 lw r11,(sp+8) 8005bc4: 37 9c 00 08 addi sp,sp,8 8005bc8: c3 a0 00 00 ret 080025e4 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 80025e4: 37 9c ff e8 addi sp,sp,-24 80025e8: 5b 8b 00 18 sw (sp+24),r11 80025ec: 5b 8c 00 14 sw (sp+20),r12 80025f0: 5b 8d 00 10 sw (sp+16),r13 80025f4: 5b 8e 00 0c sw (sp+12),r14 80025f8: 5b 8f 00 08 sw (sp+8),r15 80025fc: 5b 9d 00 04 sw (sp+4),ra 8002600: b8 40 60 00 mv r12,r2 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 8002604: 34 02 00 01 mvi r2,1 int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 8002608: b8 60 68 00 mv r13,r3 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 800260c: 5c 22 00 0c bne r1,r2,800263c rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 8002610: 44 60 00 0b be r3,r0,800263c /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 8002614: 45 80 00 0d be r12,r0,8002648 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 8002618: 29 82 00 00 lw r2,(r12+0) 800261c: 34 42 ff ff addi r2,r2,-1 8002620: 50 22 00 02 bgeu r1,r2,8002628 <== ALWAYS TAKEN 8002624: e0 00 00 06 bi 800263c <== NOT EXECUTED ( 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 ) 8002628: 29 81 00 04 lw r1,(r12+4) 800262c: 44 20 00 04 be r1,r0,800263c <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 8002630: 34 21 ff ff addi r1,r1,-1 8002634: 34 02 00 1f mvi r2,31 8002638: 50 41 00 04 bgeu r2,r1,8002648 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); 800263c: f8 00 2a e2 calli 800d1c4 <__errno> 8002640: 34 02 00 16 mvi r2,22 8002644: e0 00 00 0e bi 800267c rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002648: 78 01 08 02 mvhi r1,0x802 800264c: 38 21 18 bc ori r1,r1,0x18bc 8002650: 28 22 00 00 lw r2,(r1+0) 8002654: 34 42 00 01 addi r2,r2,1 8002658: 58 22 00 00 sw (r1+0),r2 * 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 ); 800265c: 78 01 08 02 mvhi r1,0x802 8002660: 38 21 1b 7c ori r1,r1,0x1b7c 8002664: f8 00 05 8a calli 8003c8c <_Objects_Allocate> 8002668: b8 20 58 00 mv r11,r1 /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 800266c: 5c 20 00 07 bne r1,r0,8002688 _Thread_Enable_dispatch(); 8002670: f8 00 08 25 calli 8004704 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); 8002674: f8 00 2a d4 calli 800d1c4 <__errno> 8002678: 34 02 00 0b mvi r2,11 800267c: 58 22 00 00 sw (r1+0),r2 8002680: 34 01 ff ff mvi r1,-1 8002684: e0 00 00 26 bi 800271c } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 8002688: 34 02 00 02 mvi r2,2 ptimer->thread_id = _Thread_Executing->Object.id; 800268c: 78 01 08 02 mvhi r1,0x802 rtems_set_errno_and_return_minus_one( EAGAIN ); } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 8002690: 31 62 00 3c sb (r11+60),r2 ptimer->thread_id = _Thread_Executing->Object.id; 8002694: 38 21 19 78 ori r1,r1,0x1978 8002698: 28 21 00 00 lw r1,(r1+0) 800269c: 28 21 00 08 lw r1,(r1+8) 80026a0: 59 61 00 38 sw (r11+56),r1 if ( evp != NULL ) { 80026a4: 45 80 00 07 be r12,r0,80026c0 ptimer->inf.sigev_notify = evp->sigev_notify; ptimer->inf.sigev_signo = evp->sigev_signo; ptimer->inf.sigev_value = evp->sigev_value; 80026a8: 29 81 00 08 lw r1,(r12+8) 80026ac: 59 61 00 48 sw (r11+72),r1 ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; if ( evp != NULL ) { ptimer->inf.sigev_notify = evp->sigev_notify; 80026b0: 29 81 00 00 lw r1,(r12+0) ptimer->inf.sigev_signo = evp->sigev_signo; 80026b4: 29 8c 00 04 lw r12,(r12+4) ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; if ( evp != NULL ) { ptimer->inf.sigev_notify = evp->sigev_notify; 80026b8: 59 61 00 40 sw (r11+64),r1 ptimer->inf.sigev_signo = evp->sigev_signo; 80026bc: 59 6c 00 44 sw (r11+68),r12 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 80026c0: 29 6e 00 08 lw r14,(r11+8) 80026c4: 78 01 08 02 mvhi r1,0x802 80026c8: 38 21 1b 7c ori r1,r1,0x1b7c ptimer->inf.sigev_value = evp->sigev_value; } ptimer->overrun = 0; 80026cc: 34 0c 00 00 mvi r12,0 80026d0: 28 2f 00 1c lw r15,(r1+28) 80026d4: 34 02 00 02 mvi r2,2 80026d8: 59 6c 00 68 sw (r11+104),r12 ptimer->timer_data.it_value.tv_sec = 0; 80026dc: 59 6c 00 5c sw (r11+92),r12 ptimer->timer_data.it_value.tv_nsec = 0; 80026e0: 59 6c 00 60 sw (r11+96),r12 ptimer->timer_data.it_interval.tv_sec = 0; 80026e4: 59 6c 00 54 sw (r11+84),r12 ptimer->timer_data.it_interval.tv_nsec = 0; 80026e8: 59 6c 00 58 sw (r11+88),r12 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 80026ec: 59 6c 00 18 sw (r11+24),r12 the_watchdog->routine = routine; 80026f0: 59 6c 00 2c sw (r11+44),r12 the_watchdog->id = id; 80026f4: 59 6c 00 30 sw (r11+48),r12 the_watchdog->user_data = user_data; 80026f8: 59 6c 00 34 sw (r11+52),r12 80026fc: 21 c1 ff ff andi r1,r14,0xffff 8002700: fb ff f7 af calli 80005bc <__ashlsi3> 8002704: b5 e1 08 00 add r1,r15,r1 8002708: 58 2b 00 00 sw (r1+0),r11 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 800270c: 59 6c 00 0c sw (r11+12),r12 _Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL ); _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; 8002710: 59 ae 00 00 sw (r13+0),r14 _Thread_Enable_dispatch(); 8002714: f8 00 07 fc calli 8004704 <_Thread_Enable_dispatch> 8002718: b9 80 08 00 mv r1,r12 return 0; } 800271c: 2b 9d 00 04 lw ra,(sp+4) 8002720: 2b 8b 00 18 lw r11,(sp+24) 8002724: 2b 8c 00 14 lw r12,(sp+20) 8002728: 2b 8d 00 10 lw r13,(sp+16) 800272c: 2b 8e 00 0c lw r14,(sp+12) 8002730: 2b 8f 00 08 lw r15,(sp+8) 8002734: 37 9c 00 18 addi sp,sp,24 8002738: c3 a0 00 00 ret 0800273c : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 800273c: 37 9c ff cc addi sp,sp,-52 8002740: 5b 8b 00 18 sw (sp+24),r11 8002744: 5b 8c 00 14 sw (sp+20),r12 8002748: 5b 8d 00 10 sw (sp+16),r13 800274c: 5b 8e 00 0c sw (sp+12),r14 8002750: 5b 8f 00 08 sw (sp+8),r15 8002754: 5b 9d 00 04 sw (sp+4),ra 8002758: b8 60 60 00 mv r12,r3 800275c: b8 20 78 00 mv r15,r1 8002760: b8 40 58 00 mv r11,r2 8002764: b8 80 68 00 mv r13,r4 Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 8002768: 44 60 00 59 be r3,r0,80028cc <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); /* First, it verifies if the structure "value" is correct */ if ( ( value->it_value.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) || 800276c: 28 61 00 0c lw r1,(r3+12) 8002770: 78 03 3b 9a mvhi r3,0x3b9a 8002774: 38 63 c9 ff ori r3,r3,0xc9ff 8002778: 54 23 00 55 bgu r1,r3,80028cc <== NEVER TAKEN ( value->it_value.tv_nsec < 0 ) || ( value->it_interval.tv_nsec >= TOD_NANOSECONDS_PER_SECOND) || 800277c: 29 81 00 04 lw r1,(r12+4) 8002780: 50 61 00 02 bgeu r3,r1,8002788 <== ALWAYS TAKEN 8002784: e0 00 00 52 bi 80028cc <== NOT EXECUTED ( value->it_interval.tv_nsec < 0 )) { /* The number of nanoseconds is not correct */ rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 8002788: 7c 42 00 00 cmpnei r2,r2,0 800278c: 7d 61 00 04 cmpnei r1,r11,4 8002790: a0 41 08 00 and r1,r2,r1 8002794: 5c 20 00 4e bne r1,r0,80028cc <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 8002798: 37 81 00 1c addi r1,sp,28 800279c: b9 80 10 00 mv r2,r12 80027a0: 34 03 00 10 mvi r3,16 80027a4: f8 00 2d 4f calli 800dce0 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 80027a8: 34 01 00 04 mvi r1,4 80027ac: 5d 61 00 0d bne r11,r1,80027e0 struct timespec now; _TOD_Get( &now ); 80027b0: 37 8b 00 2c addi r11,sp,44 80027b4: b9 60 08 00 mv r1,r11 80027b8: f8 00 03 83 calli 80035c4 <_TOD_Get> /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 80027bc: 37 8e 00 24 addi r14,sp,36 80027c0: b9 60 08 00 mv r1,r11 80027c4: b9 c0 10 00 mv r2,r14 80027c8: f8 00 09 c1 calli 8004ecc <_Timespec_Greater_than> 80027cc: 5c 20 00 40 bne r1,r0,80028cc <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 80027d0: b9 c0 10 00 mv r2,r14 80027d4: b9 60 08 00 mv r1,r11 80027d8: b9 c0 18 00 mv r3,r14 80027dc: f8 00 09 c8 calli 8004efc <_Timespec_Subtract> RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get ( timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) 80027e0: 78 01 08 02 mvhi r1,0x802 80027e4: b9 e0 10 00 mv r2,r15 80027e8: 38 21 1b 7c ori r1,r1,0x1b7c 80027ec: 37 83 00 34 addi r3,sp,52 80027f0: f8 00 06 4f calli 800412c <_Objects_Get> * something with the structure of times of the timer: to stop, start * or start it again */ ptimer = _POSIX_Timer_Get( timerid, &location ); switch ( location ) { 80027f4: 2b 82 00 34 lw r2,(sp+52) 80027f8: b8 20 58 00 mv r11,r1 80027fc: 5c 40 00 34 bne r2,r0,80028cc <== NEVER TAKEN 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 ) { 8002800: 2b 81 00 24 lw r1,(sp+36) 8002804: 5c 22 00 11 bne r1,r2,8002848 8002808: 2b 8e 00 28 lw r14,(sp+40) 800280c: 5d c1 00 0f bne r14,r1,8002848 /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 8002810: 35 61 00 10 addi r1,r11,16 8002814: f8 00 0b 1f calli 8005490 <_Watchdog_Remove> /* The old data of the timer are returned */ if ( ovalue ) 8002818: 45 ae 00 05 be r13,r14,800282c *ovalue = ptimer->timer_data; 800281c: b9 a0 08 00 mv r1,r13 8002820: 35 62 00 54 addi r2,r11,84 8002824: 34 03 00 10 mvi r3,16 8002828: f8 00 2d 2e calli 800dce0 /* The new data are set */ ptimer->timer_data = normalize; 800282c: 37 82 00 1c addi r2,sp,28 8002830: 34 03 00 10 mvi r3,16 8002834: 35 61 00 54 addi r1,r11,84 8002838: f8 00 2d 2a calli 800dce0 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 800283c: 34 01 00 04 mvi r1,4 8002840: 31 61 00 3c sb (r11+60),r1 8002844: e0 00 00 1f bi 80028c0 _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); 8002848: b9 80 08 00 mv r1,r12 800284c: f8 00 09 ba calli 8004f34 <_Timespec_To_ticks> 8002850: 59 61 00 64 sw (r11+100),r1 initial_period = _Timespec_To_ticks( &normalize.it_value ); 8002854: 37 81 00 24 addi r1,sp,36 8002858: f8 00 09 b7 calli 8004f34 <_Timespec_To_ticks> activated = _POSIX_Timer_Insert_helper( 800285c: 29 63 00 08 lw r3,(r11+8) 8002860: 78 04 08 00 mvhi r4,0x800 8002864: b8 20 10 00 mv r2,r1 8002868: 38 84 28 fc ori r4,r4,0x28fc 800286c: 35 61 00 10 addi r1,r11,16 8002870: b9 60 28 00 mv r5,r11 8002874: f8 00 15 bd calli 8007f68 <_POSIX_Timer_Insert_helper> 8002878: b8 20 60 00 mv r12,r1 initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 800287c: 5c 20 00 04 bne r1,r0,800288c _Thread_Enable_dispatch(); 8002880: f8 00 07 a1 calli 8004704 <_Thread_Enable_dispatch> 8002884: b9 80 08 00 mv r1,r12 return 0; 8002888: e0 00 00 15 bi 80028dc /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 800288c: 45 a0 00 05 be r13,r0,80028a0 *ovalue = ptimer->timer_data; 8002890: b9 a0 08 00 mv r1,r13 8002894: 35 62 00 54 addi r2,r11,84 8002898: 34 03 00 10 mvi r3,16 800289c: f8 00 2d 11 calli 800dce0 ptimer->timer_data = normalize; 80028a0: 37 82 00 1c addi r2,sp,28 80028a4: 34 03 00 10 mvi r3,16 80028a8: 35 61 00 54 addi r1,r11,84 80028ac: f8 00 2d 0d calli 800dce0 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 80028b0: 34 01 00 03 mvi r1,3 80028b4: 31 61 00 3c sb (r11+60),r1 _TOD_Get( &ptimer->time ); 80028b8: 35 61 00 6c addi r1,r11,108 80028bc: f8 00 03 42 calli 80035c4 <_TOD_Get> _Thread_Enable_dispatch(); 80028c0: f8 00 07 91 calli 8004704 <_Thread_Enable_dispatch> 80028c4: 34 01 00 00 mvi r1,0 return 0; 80028c8: e0 00 00 05 bi 80028dc #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 80028cc: f8 00 2a 3e calli 800d1c4 <__errno> 80028d0: 34 02 00 16 mvi r2,22 80028d4: 58 22 00 00 sw (r1+0),r2 80028d8: 34 01 ff ff mvi r1,-1 } 80028dc: 2b 9d 00 04 lw ra,(sp+4) 80028e0: 2b 8b 00 18 lw r11,(sp+24) 80028e4: 2b 8c 00 14 lw r12,(sp+20) 80028e8: 2b 8d 00 10 lw r13,(sp+16) 80028ec: 2b 8e 00 0c lw r14,(sp+12) 80028f0: 2b 8f 00 08 lw r15,(sp+8) 80028f4: 37 9c 00 34 addi sp,sp,52 80028f8: c3 a0 00 00 ret 08002498 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 8002498: 37 9c ff ec addi sp,sp,-20 800249c: 5b 8b 00 0c sw (sp+12),r11 80024a0: 5b 8c 00 08 sw (sp+8),r12 80024a4: 5b 9d 00 04 sw (sp+4),ra /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 80024a8: 78 0b 08 02 mvhi r11,0x802 80024ac: 39 6b 01 48 ori r11,r11,0x148 80024b0: 29 62 00 1c lw r2,(r11+28) useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 80024b4: b8 20 60 00 mv r12,r1 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 80024b8: 5c 40 00 09 bne r2,r0,80024dc Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 80024bc: 78 01 08 00 mvhi r1,0x800 80024c0: 38 21 25 b0 ori r1,r1,0x25b0 80024c4: 59 61 00 1c sw (r11+28),r1 the_watchdog->id = id; the_watchdog->user_data = user_data; 80024c8: 59 62 00 24 sw (r11+36),r2 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 80024cc: 59 62 00 08 sw (r11+8),r2 the_watchdog->routine = routine; the_watchdog->id = id; 80024d0: 59 62 00 20 sw (r11+32),r2 the_watchdog->user_data = user_data; 80024d4: b8 40 58 00 mv r11,r2 80024d8: e0 00 00 18 bi 8002538 _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 80024dc: b9 60 08 00 mv r1,r11 80024e0: f8 00 0a 15 calli 8004d34 <_Watchdog_Remove> if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 80024e4: 34 21 ff fe addi r1,r1,-2 80024e8: 34 02 00 01 mvi r2,1 80024ec: 50 41 00 03 bgeu r2,r1,80024f8 <== ALWAYS TAKEN 80024f0: 34 0b 00 00 mvi r11,0 <== NOT EXECUTED 80024f4: e0 00 00 11 bi 8002538 <== NOT EXECUTED * 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); 80024f8: 29 64 00 14 lw r4,(r11+20) 80024fc: 29 61 00 0c lw r1,(r11+12) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 8002500: 29 63 00 18 lw r3,(r11+24) 8002504: 37 82 00 10 addi r2,sp,16 * 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); 8002508: b4 81 08 00 add r1,r4,r1 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 800250c: c8 23 08 00 sub r1,r1,r3 8002510: f8 00 08 52 calli 8004658 <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 8002514: 2b 81 00 10 lw r1,(sp+16) 8002518: 78 02 00 0f mvhi r2,0xf 800251c: 38 42 42 40 ori r2,r2,0x4240 8002520: f8 00 65 c8 calli 801bc40 <__mulsi3> 8002524: b8 20 58 00 mv r11,r1 remaining += tp.tv_nsec / 1000; 8002528: 2b 81 00 14 lw r1,(sp+20) 800252c: 34 02 03 e8 mvi r2,1000 8002530: f8 00 65 e4 calli 801bcc0 <__divsi3> 8002534: b4 2b 58 00 add r11,r1,r11 /* * 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 ) { 8002538: 45 80 00 18 be r12,r0,8002598 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 800253c: 78 02 00 0f mvhi r2,0xf 8002540: 38 42 42 40 ori r2,r2,0x4240 8002544: b9 80 08 00 mv r1,r12 8002548: f8 00 66 3d calli 801be3c <__udivsi3> tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 800254c: 78 02 00 0f mvhi r2,0xf * 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; 8002550: 5b 81 00 10 sw (sp+16),r1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 8002554: 38 42 42 40 ori r2,r2,0x4240 8002558: b9 80 08 00 mv r1,r12 800255c: f8 00 66 48 calli 801be7c <__umodsi3> 8002560: 34 02 03 e8 mvi r2,1000 8002564: f8 00 65 b7 calli 801bc40 <__mulsi3> ticks = _Timespec_To_ticks( &tp ); 8002568: 37 8c 00 10 addi r12,sp,16 */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 800256c: 5b 81 00 14 sw (sp+20),r1 ticks = _Timespec_To_ticks( &tp ); 8002570: b9 80 08 00 mv r1,r12 8002574: f8 00 08 61 calli 80046f8 <_Timespec_To_ticks> if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 8002578: b9 80 08 00 mv r1,r12 800257c: f8 00 08 5f calli 80046f8 <_Timespec_To_ticks> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8002580: 78 02 08 02 mvhi r2,0x802 8002584: 38 42 01 48 ori r2,r2,0x148 8002588: 58 41 00 0c sw (r2+12),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 800258c: 78 01 08 01 mvhi r1,0x801 8002590: 38 21 f9 a0 ori r1,r1,0xf9a0 8002594: f8 00 09 89 calli 8004bb8 <_Watchdog_Insert> } return remaining; } 8002598: b9 60 08 00 mv r1,r11 800259c: 2b 9d 00 04 lw ra,(sp+4) 80025a0: 2b 8b 00 0c lw r11,(sp+12) 80025a4: 2b 8c 00 08 lw r12,(sp+8) 80025a8: 37 9c 00 14 addi sp,sp,20 80025ac: c3 a0 00 00 ret