=============================================================================== 08006034 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { 8006034: 37 9c ff f4 addi sp,sp,-12 8006038: 5b 8b 00 0c sw (sp+12),r11 800603c: 5b 8c 00 08 sw (sp+8),r12 8006040: 5b 9d 00 04 sw (sp+4),ra 8006044: b8 20 58 00 mv r11,r1 ISR_Level level; Thread_Control *executing = _Thread_Executing; 8006048: 78 01 08 01 mvhi r1,0x801 800604c: 38 21 8d 74 ori r1,r1,0x8d74 8006050: 28 22 00 0c lw r2,(r1+12) * 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 ); 8006054: 90 00 08 00 rcsr r1,IE 8006058: 34 03 ff fe mvi r3,-2 800605c: a0 23 18 00 and r3,r1,r3 8006060: d0 03 00 00 wcsr IE,r3 if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ 8006064: 29 63 00 44 lw r3,(r11+68) 8006068: 5c 60 00 05 bne r3,r0,800607c <_CORE_RWLock_Release+0x48> _ISR_Enable( level ); 800606c: d0 01 00 00 wcsr IE,r1 executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; 8006070: 34 01 00 02 mvi r1,2 8006074: 58 41 00 34 sw (r2+52),r1 return CORE_RWLOCK_SUCCESSFUL; 8006078: e0 00 00 26 bi 8006110 <_CORE_RWLock_Release+0xdc> } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { 800607c: 34 04 00 01 mvi r4,1 8006080: 5c 64 00 07 bne r3,r4,800609c <_CORE_RWLock_Release+0x68> the_rwlock->number_of_readers -= 1; 8006084: 29 63 00 48 lw r3,(r11+72) 8006088: 34 63 ff ff addi r3,r3,-1 800608c: 59 63 00 48 sw (r11+72),r3 if ( the_rwlock->number_of_readers != 0 ) { 8006090: 44 60 00 03 be r3,r0,800609c <_CORE_RWLock_Release+0x68> /* must be unlocked again */ _ISR_Enable( level ); 8006094: d0 01 00 00 wcsr IE,r1 return CORE_RWLOCK_SUCCESSFUL; 8006098: e0 00 00 1e bi 8006110 <_CORE_RWLock_Release+0xdc> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; 800609c: 58 40 00 34 sw (r2+52),r0 /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; 80060a0: 59 60 00 44 sw (r11+68),r0 _ISR_Enable( level ); 80060a4: d0 01 00 00 wcsr IE,r1 next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); 80060a8: b9 60 08 00 mv r1,r11 80060ac: f8 00 07 a7 calli 8007f48 <_Thread_queue_Dequeue> if ( next ) { 80060b0: 44 20 00 18 be r1,r0,8006110 <_CORE_RWLock_Release+0xdc> if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { 80060b4: 28 22 00 30 lw r2,(r1+48) 80060b8: 34 01 00 01 mvi r1,1 80060bc: 5c 41 00 04 bne r2,r1,80060cc <_CORE_RWLock_Release+0x98> the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; 80060c0: 34 01 00 02 mvi r1,2 80060c4: 59 61 00 44 sw (r11+68),r1 return CORE_RWLOCK_SUCCESSFUL; 80060c8: e0 00 00 12 bi 8006110 <_CORE_RWLock_Release+0xdc> } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 80060cc: 29 62 00 48 lw r2,(r11+72) the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; 80060d0: 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 || 80060d4: 34 0c 00 01 mvi r12,1 } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; 80060d8: 34 42 00 01 addi r2,r2,1 80060dc: 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 ); 80060e0: b9 60 08 00 mv r1,r11 80060e4: f8 00 09 20 calli 8008564 <_Thread_queue_First> 80060e8: b8 20 10 00 mv r2,r1 if ( !next || 80060ec: 44 20 00 09 be r1,r0,8006110 <_CORE_RWLock_Release+0xdc> 80060f0: 28 21 00 30 lw r1,(r1+48) 80060f4: 44 2c 00 07 be r1,r12,8006110 <_CORE_RWLock_Release+0xdc> <== NEVER TAKEN next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; 80060f8: 29 61 00 48 lw r1,(r11+72) 80060fc: 34 21 00 01 addi r1,r1,1 8006100: 59 61 00 48 sw (r11+72),r1 _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); 8006104: b9 60 08 00 mv r1,r11 8006108: f8 00 08 cd calli 800843c <_Thread_queue_Extract> } 800610c: e3 ff ff f5 bi 80060e0 <_CORE_RWLock_Release+0xac> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } 8006110: 34 01 00 00 mvi r1,0 8006114: 2b 9d 00 04 lw ra,(sp+4) 8006118: 2b 8b 00 0c lw r11,(sp+12) 800611c: 2b 8c 00 08 lw r12,(sp+8) 8006120: 37 9c 00 0c addi sp,sp,12 8006124: c3 a0 00 00 ret =============================================================================== 08006128 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { 8006128: 37 9c ff f8 addi sp,sp,-8 800612c: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 8006130: 37 82 00 08 addi r2,sp,8 8006134: f8 00 06 98 calli 8007b94 <_Thread_Get> switch ( location ) { 8006138: 2b 82 00 08 lw r2,(sp+8) 800613c: 5c 40 00 07 bne r2,r0,8006158 <_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 ); 8006140: f8 00 09 63 calli 80086cc <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 8006144: 78 01 08 01 mvhi r1,0x801 8006148: 38 21 88 a8 ori r1,r1,0x88a8 800614c: 28 22 00 00 lw r2,(r1+0) 8006150: 34 42 ff ff addi r2,r2,-1 8006154: 58 22 00 00 sw (r1+0),r2 _Thread_Unnest_dispatch(); break; } } 8006158: 2b 9d 00 04 lw ra,(sp+4) 800615c: 37 9c 00 08 addi sp,sp,8 8006160: c3 a0 00 00 ret =============================================================================== 08015644 <_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 ) { 8015644: 37 9c ff e4 addi sp,sp,-28 8015648: 5b 8b 00 1c sw (sp+28),r11 801564c: 5b 8c 00 18 sw (sp+24),r12 8015650: 5b 8d 00 14 sw (sp+20),r13 8015654: 5b 8e 00 10 sw (sp+16),r14 8015658: 5b 8f 00 0c sw (sp+12),r15 801565c: 5b 90 00 08 sw (sp+8),r16 8015660: 5b 9d 00 04 sw (sp+4),ra 8015664: b8 40 80 00 mv r16,r2 Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 8015668: 28 22 00 4c lw r2,(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 ) { 801566c: b8 20 58 00 mv r11,r1 8015670: b8 60 68 00 mv r13,r3 8015674: 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 ) { return CORE_MESSAGE_QUEUE_STATUS_INVALID_SIZE; 8015678: 34 01 00 01 mvi r1,1 { Thread_Control *the_thread; uint32_t number_broadcasted; Thread_Wait_information *waitp; if ( size > the_message_queue->maximum_message_size ) { 801567c: 54 62 00 13 bgu r3,r2,80156c8 <_CORE_message_queue_Broadcast+0x84><== NEVER TAKEN * 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 ) { 8015680: 29 61 00 48 lw r1,(r11+72) 8015684: 34 0c 00 00 mvi r12,0 8015688: 44 20 00 0a be r1,r0,80156b0 <_CORE_message_queue_Broadcast+0x6c> *count = 0; 801568c: 58 c0 00 00 sw (r6+0),r0 8015690: e0 00 00 0d bi 80156c4 <_CORE_message_queue_Broadcast+0x80> const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 8015694: 29 c1 00 2c lw r1,(r14+44) 8015698: ba 00 10 00 mv r2,r16 801569c: b9 a0 18 00 mv r3,r13 80156a0: f8 00 2a 6d calli 8020054 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 80156a4: 29 c1 00 28 lw r1,(r14+40) */ number_broadcasted = 0; while ((the_thread = _Thread_queue_Dequeue(&the_message_queue->Wait_queue))) { waitp = &the_thread->Wait; number_broadcasted += 1; 80156a8: 35 8c 00 01 addi r12,r12,1 buffer, waitp->return_argument_second.mutable_object, size ); *(size_t *) the_thread->Wait.return_argument = size; 80156ac: 58 2d 00 00 sw (r1+0),r13 /* * There must be no pending messages if there is a thread waiting to * receive a message. */ number_broadcasted = 0; while ((the_thread = 80156b0: b9 60 08 00 mv r1,r11 80156b4: f8 00 0d 47 calli 8018bd0 <_Thread_queue_Dequeue> 80156b8: b8 20 70 00 mv r14,r1 80156bc: 5c 20 ff f6 bne r1,r0,8015694 <_CORE_message_queue_Broadcast+0x50> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_message_queue_mp_support) ( the_thread, id ); #endif } *count = number_broadcasted; 80156c0: 59 ec 00 00 sw (r15+0),r12 return CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; 80156c4: 34 01 00 00 mvi r1,0 } 80156c8: 2b 9d 00 04 lw ra,(sp+4) 80156cc: 2b 8b 00 1c lw r11,(sp+28) 80156d0: 2b 8c 00 18 lw r12,(sp+24) 80156d4: 2b 8d 00 14 lw r13,(sp+20) 80156d8: 2b 8e 00 10 lw r14,(sp+16) 80156dc: 2b 8f 00 0c lw r15,(sp+12) 80156e0: 2b 90 00 08 lw r16,(sp+8) 80156e4: 37 9c 00 1c addi sp,sp,28 80156e8: c3 a0 00 00 ret =============================================================================== 0800dabc <_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 ) { 800dabc: 37 9c ff e4 addi sp,sp,-28 800dac0: 5b 8b 00 1c sw (sp+28),r11 800dac4: 5b 8c 00 18 sw (sp+24),r12 800dac8: 5b 8d 00 14 sw (sp+20),r13 800dacc: 5b 8e 00 10 sw (sp+16),r14 800dad0: 5b 8f 00 0c sw (sp+12),r15 800dad4: 5b 90 00 08 sw (sp+8),r16 800dad8: 5b 9d 00 04 sw (sp+4),ra 800dadc: 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; 800dae0: 58 20 00 48 sw (r1+72),r0 the_message_queue->maximum_message_size = maximum_message_size; 800dae4: 58 24 00 4c sw (r1+76),r4 CORE_message_queue_Control *the_message_queue, CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; 800dae8: 58 20 00 60 sw (r1+96),r0 the_message_queue->notify_argument = the_argument; 800daec: 58 20 00 64 sw (r1+100),r0 ) { size_t message_buffering_required; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; 800daf0: 59 63 00 44 sw (r11+68),r3 /* * 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)) { 800daf4: 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 ) { 800daf8: b8 40 80 00 mv r16,r2 800dafc: b8 60 70 00 mv r14,r3 /* * 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)) { 800db00: b8 80 60 00 mv r12,r4 800db04: 44 20 00 06 be r1,r0,800db1c <_CORE_message_queue_Initialize+0x60> allocated_message_size += sizeof(uint32_t); 800db08: 34 8c 00 04 addi r12,r4,4 allocated_message_size &= ~(sizeof(uint32_t) - 1); 800db0c: 34 01 ff fc mvi r1,-4 800db10: a1 81 60 00 and r12,r12,r1 } if (allocated_message_size < maximum_message_size) return false; 800db14: 34 0d 00 00 mvi r13,0 if (allocated_message_size & (sizeof(uint32_t) - 1)) { allocated_message_size += sizeof(uint32_t); allocated_message_size &= ~(sizeof(uint32_t) - 1); } if (allocated_message_size < maximum_message_size) 800db18: 54 8c 00 1c bgu r4,r12,800db88 <_CORE_message_queue_Initialize+0xcc><== 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)); 800db1c: 35 8f 00 14 addi r15,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 * 800db20: b9 e0 08 00 mv r1,r15 800db24: b9 c0 10 00 mv r2,r14 800db28: f8 00 5e 7d calli 802551c <__mulsi3> (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) return false; 800db2c: 34 0d 00 00 mvi r13,0 * check for overflow on the multiplication. */ message_buffering_required = (size_t) maximum_pending_messages * (allocated_message_size + sizeof(CORE_message_queue_Buffer_control)); if (message_buffering_required < allocated_message_size) 800db30: 55 81 00 16 bgu r12,r1,800db88 <_CORE_message_queue_Initialize+0xcc><== NEVER TAKEN /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); 800db34: f8 00 0e 9c calli 80115a4 <_Workspace_Allocate> return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) 800db38: 59 61 00 5c sw (r11+92),r1 _Workspace_Allocate( message_buffering_required ); 800db3c: b8 20 28 00 mv r5,r1 if (the_message_queue->message_buffers == 0) 800db40: 44 20 00 12 be r1,r0,800db88 <_CORE_message_queue_Initialize+0xcc> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( 800db44: b8 a0 10 00 mv r2,r5 800db48: 35 61 00 68 addi r1,r11,104 800db4c: b9 c0 18 00 mv r3,r14 800db50: b9 e0 20 00 mv r4,r15 800db54: f8 00 19 e5 calli 80142e8 <_Chain_Initialize> RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 800db58: 35 61 00 54 addi r1,r11,84 head->next = tail; 800db5c: 59 61 00 50 sw (r11+80),r1 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 800db60: 35 61 00 50 addi r1,r11,80 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; tail->previous = head; 800db64: 59 61 00 58 sw (r11+88),r1 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 800db68: 59 60 00 54 sw (r11+84),r0 allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( 800db6c: 2a 02 00 00 lw r2,(r16+0) 800db70: b9 60 08 00 mv r1,r11 800db74: 34 03 00 80 mvi r3,128 800db78: 64 42 00 01 cmpei r2,r2,1 800db7c: 34 04 00 06 mvi r4,6 800db80: f8 00 0b 59 calli 80108e4 <_Thread_queue_Initialize> THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; 800db84: 34 0d 00 01 mvi r13,1 } 800db88: b9 a0 08 00 mv r1,r13 800db8c: 2b 9d 00 04 lw ra,(sp+4) 800db90: 2b 8b 00 1c lw r11,(sp+28) 800db94: 2b 8c 00 18 lw r12,(sp+24) 800db98: 2b 8d 00 14 lw r13,(sp+20) 800db9c: 2b 8e 00 10 lw r14,(sp+16) 800dba0: 2b 8f 00 0c lw r15,(sp+12) 800dba4: 2b 90 00 08 lw r16,(sp+8) 800dba8: 37 9c 00 1c addi sp,sp,28 800dbac: c3 a0 00 00 ret =============================================================================== 0800dbb0 <_CORE_message_queue_Seize>: void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 800dbb0: 37 9c ff f0 addi sp,sp,-16 800dbb4: 5b 8b 00 10 sw (sp+16),r11 800dbb8: 5b 8c 00 0c sw (sp+12),r12 800dbbc: 5b 8d 00 08 sw (sp+8),r13 800dbc0: 5b 9d 00 04 sw (sp+4),ra ISR_Level level; CORE_message_queue_Buffer_control *the_message; Thread_Control *executing; executing = _Thread_Executing; 800dbc4: 78 07 08 02 mvhi r7,0x802 800dbc8: 38 e7 8f 4c ori r7,r7,0x8f4c 800dbcc: 28 e7 00 0c lw r7,(r7+12) void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 800dbd0: b8 20 58 00 mv r11,r1 800dbd4: 20 a5 00 ff andi r5,r5,0xff 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; 800dbd8: 58 e0 00 34 sw (r7+52),r0 void *buffer, size_t *size_p, bool wait, Watchdog_Interval timeout ) { 800dbdc: 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 ); 800dbe0: 90 00 40 00 rcsr r8,IE 800dbe4: 34 03 ff fe mvi r3,-2 800dbe8: a1 03 18 00 and r3,r8,r3 800dbec: d0 03 00 00 wcsr IE,r3 executing->Wait.return_argument = size_p; /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); } 800dbf0: 29 6c 00 50 lw r12,(r11+80) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 800dbf4: 35 63 00 54 addi r3,r11,84 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 800dbf8: 45 83 00 07 be r12,r3,800dc14 <_CORE_message_queue_Seize+0x64> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; 800dbfc: 29 83 00 00 lw r3,(r12+0) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_first_unprotected( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 800dc00: 35 69 00 50 addi r9,r11,80 Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; 800dc04: 59 63 00 50 sw (r11+80),r3 new_first->previous = head; 800dc08: 58 69 00 04 sw (r3+4),r9 executing = _Thread_Executing; executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_SUCCESSFUL; _ISR_Disable( level ); the_message = _CORE_message_queue_Get_pending_message( the_message_queue ); if ( the_message != NULL ) { 800dc0c: 5d 80 00 04 bne r12,r0,800dc1c <_CORE_message_queue_Seize+0x6c><== ALWAYS TAKEN 800dc10: e0 00 00 25 bi 800dca4 <_CORE_message_queue_Seize+0xf4> <== NOT EXECUTED ) { if ( !_Chain_Is_empty(the_chain)) return _Chain_Get_first_unprotected(the_chain); else return NULL; 800dc14: 34 0c 00 00 mvi r12,0 800dc18: e0 00 00 23 bi 800dca4 <_CORE_message_queue_Seize+0xf4> the_message_queue->number_of_pending_messages -= 1; 800dc1c: 29 62 00 48 lw r2,(r11+72) 800dc20: 34 42 ff ff addi r2,r2,-1 800dc24: 59 62 00 48 sw (r11+72),r2 _ISR_Enable( level ); 800dc28: d0 08 00 00 wcsr IE,r8 *size_p = the_message->Contents.size; 800dc2c: 29 83 00 0c lw r3,(r12+12) _Thread_Executing->Wait.count = 800dc30: 78 02 08 02 mvhi r2,0x802 800dc34: 38 42 8f 4c ori r2,r2,0x8f4c 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; 800dc38: 58 83 00 00 sw (r4+0),r3 _Thread_Executing->Wait.count = 800dc3c: 29 84 00 08 lw r4,(r12+8) 800dc40: 28 42 00 0c lw r2,(r2+12) _CORE_message_queue_Get_message_priority( the_message ); _CORE_message_queue_Copy_buffer( the_message->Contents.buffer, 800dc44: 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 = 800dc48: 58 44 00 24 sw (r2+36),r4 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 800dc4c: b9 a0 10 00 mv r2,r13 800dc50: f8 00 27 9b calli 8017abc * 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 ); 800dc54: b9 60 08 00 mv r1,r11 800dc58: f8 00 09 c5 calli 801036c <_Thread_queue_Dequeue> 800dc5c: b8 20 20 00 mv r4,r1 if ( !the_thread ) { 800dc60: 5c 20 00 05 bne r1,r0,800dc74 <_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 ); 800dc64: 35 61 00 68 addi r1,r11,104 800dc68: b9 80 10 00 mv r2,r12 800dc6c: fb ff ff 64 calli 800d9fc <_Chain_Append> _CORE_message_queue_Free_message_buffer( the_message_queue, the_message ); return; 800dc70: e0 00 00 1e bi 800dce8 <_CORE_message_queue_Seize+0x138> CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 800dc74: 28 21 00 24 lw r1,(r1+36) */ _CORE_message_queue_Set_message_priority( the_message, the_thread->Wait.count ); the_message->Contents.size = (size_t) the_thread->Wait.option; 800dc78: 28 83 00 30 lw r3,(r4+48) const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 800dc7c: 28 82 00 2c lw r2,(r4+44) CORE_message_queue_Buffer_control *the_message, int priority ) { #if defined(RTEMS_SCORE_COREMSG_ENABLE_MESSAGE_PRIORITY) the_message->priority = priority; 800dc80: 59 81 00 08 sw (r12+8),r1 800dc84: 59 83 00 0c sw (r12+12),r3 const void *source, void *destination, size_t size ) { memcpy(destination, source, size); 800dc88: b9 a0 08 00 mv r1,r13 800dc8c: f8 00 27 8c calli 8017abc the_thread->Wait.return_argument_second.immutable_object, the_message->Contents.buffer, the_message->Contents.size ); _CORE_message_queue_Insert_message( 800dc90: 29 83 00 08 lw r3,(r12+8) 800dc94: b9 60 08 00 mv r1,r11 800dc98: b9 80 10 00 mv r2,r12 800dc9c: f8 00 19 a0 calli 801431c <_CORE_message_queue_Insert_message> the_message_queue, the_message, _CORE_message_queue_Get_message_priority( the_message ) ); return; 800dca0: e0 00 00 12 bi 800dce8 <_CORE_message_queue_Seize+0x138> } #endif } if ( !wait ) { 800dca4: 5c ac 00 05 bne r5,r12,800dcb8 <_CORE_message_queue_Seize+0x108> _ISR_Enable( level ); 800dca8: d0 08 00 00 wcsr IE,r8 executing->Wait.return_code = CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_NOWAIT; 800dcac: 34 01 00 04 mvi r1,4 800dcb0: 58 e1 00 34 sw (r7+52),r1 return; 800dcb4: e0 00 00 0d bi 800dce8 <_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; 800dcb8: 34 03 00 01 mvi r3,1 800dcbc: 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; 800dcc0: 58 eb 00 44 sw (r7+68),r11 executing->Wait.id = id; 800dcc4: 58 e2 00 20 sw (r7+32),r2 executing->Wait.return_argument_second.mutable_object = buffer; 800dcc8: 58 e1 00 2c sw (r7+44),r1 executing->Wait.return_argument = size_p; 800dccc: 58 e4 00 28 sw (r7+40),r4 /* Wait.count will be filled in with the message priority */ _ISR_Enable( level ); 800dcd0: d0 08 00 00 wcsr IE,r8 _Thread_queue_Enqueue( &the_message_queue->Wait_queue, timeout ); 800dcd4: 78 03 08 01 mvhi r3,0x801 800dcd8: b9 60 08 00 mv r1,r11 800dcdc: b8 c0 10 00 mv r2,r6 800dce0: 38 63 0a 24 ori r3,r3,0xa24 800dce4: f8 00 0a 15 calli 8010538 <_Thread_queue_Enqueue_with_handler> } 800dce8: 2b 9d 00 04 lw ra,(sp+4) 800dcec: 2b 8b 00 10 lw r11,(sp+16) 800dcf0: 2b 8c 00 0c lw r12,(sp+12) 800dcf4: 2b 8d 00 08 lw r13,(sp+8) 800dcf8: 37 9c 00 10 addi sp,sp,16 800dcfc: c3 a0 00 00 ret =============================================================================== 08004d18 <_CORE_mutex_Seize>: Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 8004d18: 37 9c ff e8 addi sp,sp,-24 8004d1c: 5b 8b 00 14 sw (sp+20),r11 8004d20: 5b 8c 00 10 sw (sp+16),r12 8004d24: 5b 8d 00 0c sw (sp+12),r13 8004d28: 5b 8e 00 08 sw (sp+8),r14 8004d2c: 5b 9d 00 04 sw (sp+4),ra 8004d30: b8 20 58 00 mv r11,r1 _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 8004d34: 78 01 08 01 mvhi r1,0x801 8004d38: 38 21 99 60 ori r1,r1,0x9960 8004d3c: 28 21 00 00 lw r1,(r1+0) Objects_Id _id, bool _wait, Watchdog_Interval _timeout, ISR_Level _level ) { 8004d40: 5b 85 00 18 sw (sp+24),r5 8004d44: b8 40 70 00 mv r14,r2 8004d48: b8 80 68 00 mv r13,r4 8004d4c: 20 6c 00 ff andi r12,r3,0xff _CORE_mutex_Seize_body( _the_mutex, _id, _wait, _timeout, _level ); 8004d50: 44 20 00 0b be r1,r0,8004d7c <_CORE_mutex_Seize+0x64> 8004d54: 45 80 00 0a be r12,r0,8004d7c <_CORE_mutex_Seize+0x64> <== NEVER TAKEN 8004d58: 78 01 08 01 mvhi r1,0x801 8004d5c: 38 21 9a d8 ori r1,r1,0x9ad8 8004d60: 28 21 00 00 lw r1,(r1+0) 8004d64: 34 02 00 01 mvi r2,1 8004d68: 50 41 00 05 bgeu r2,r1,8004d7c <_CORE_mutex_Seize+0x64> 8004d6c: 34 01 00 00 mvi r1,0 8004d70: 34 02 00 00 mvi r2,0 8004d74: 34 03 00 12 mvi r3,18 8004d78: f8 00 02 0a calli 80055a0 <_Internal_error_Occurred> 8004d7c: b9 60 08 00 mv r1,r11 8004d80: 37 82 00 18 addi r2,sp,24 8004d84: f8 00 25 f5 calli 800e558 <_CORE_mutex_Seize_interrupt_trylock> 8004d88: 44 20 00 19 be r1,r0,8004dec <_CORE_mutex_Seize+0xd4> 8004d8c: 78 01 08 01 mvhi r1,0x801 8004d90: 38 21 9e 2c ori r1,r1,0x9e2c 8004d94: 5d 80 00 07 bne r12,r0,8004db0 <_CORE_mutex_Seize+0x98> 8004d98: 2b 82 00 18 lw r2,(sp+24) 8004d9c: d0 02 00 00 wcsr IE,r2 8004da0: 28 21 00 0c lw r1,(r1+12) 8004da4: 34 02 00 01 mvi r2,1 8004da8: 58 22 00 34 sw (r1+52),r2 8004dac: e0 00 00 10 bi 8004dec <_CORE_mutex_Seize+0xd4> 8004db0: 28 21 00 0c lw r1,(r1+12) 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; 8004db4: 34 02 00 01 mvi r2,1 8004db8: 59 62 00 30 sw (r11+48),r2 8004dbc: 58 2b 00 44 sw (r1+68),r11 8004dc0: 58 2e 00 20 sw (r1+32),r14 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8004dc4: 78 01 08 01 mvhi r1,0x801 8004dc8: 38 21 99 60 ori r1,r1,0x9960 8004dcc: 28 22 00 00 lw r2,(r1+0) 8004dd0: 34 42 00 01 addi r2,r2,1 8004dd4: 58 22 00 00 sw (r1+0),r2 8004dd8: 2b 81 00 18 lw r1,(sp+24) 8004ddc: d0 01 00 00 wcsr IE,r1 8004de0: b9 60 08 00 mv r1,r11 8004de4: b9 a0 10 00 mv r2,r13 8004de8: fb ff ff ab calli 8004c94 <_CORE_mutex_Seize_interrupt_blocking> } 8004dec: 2b 9d 00 04 lw ra,(sp+4) 8004df0: 2b 8b 00 14 lw r11,(sp+20) 8004df4: 2b 8c 00 10 lw r12,(sp+16) 8004df8: 2b 8d 00 0c lw r13,(sp+12) 8004dfc: 2b 8e 00 08 lw r14,(sp+8) 8004e00: 37 9c 00 18 addi sp,sp,24 8004e04: c3 a0 00 00 ret =============================================================================== 08004f80 <_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 ) { 8004f80: 37 9c ff f8 addi sp,sp,-8 8004f84: 5b 8b 00 08 sw (sp+8),r11 8004f88: 5b 9d 00 04 sw (sp+4),ra 8004f8c: 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)) ) { 8004f90: f8 00 07 64 calli 8006d20 <_Thread_queue_Dequeue> { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 8004f94: 34 02 00 00 mvi r2,0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { 8004f98: 5c 20 00 0d bne r1,r0,8004fcc <_CORE_semaphore_Surrender+0x4c> if ( !_Objects_Is_local_id( the_thread->Object.id ) ) (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); 8004f9c: 90 00 08 00 rcsr r1,IE 8004fa0: 34 02 ff fe mvi r2,-2 8004fa4: a0 22 10 00 and r2,r1,r2 8004fa8: d0 02 00 00 wcsr IE,r2 if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 8004fac: 29 63 00 48 lw r3,(r11+72) 8004fb0: 29 64 00 40 lw r4,(r11+64) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; 8004fb4: 34 02 00 04 mvi r2,4 (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) 8004fb8: 50 64 00 04 bgeu r3,r4,8004fc8 <_CORE_semaphore_Surrender+0x48><== NEVER TAKEN the_semaphore->count += 1; 8004fbc: 34 63 00 01 addi r3,r3,1 8004fc0: 59 63 00 48 sw (r11+72),r3 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; 8004fc4: 34 02 00 00 mvi r2,0 _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); 8004fc8: d0 01 00 00 wcsr IE,r1 } return status; } 8004fcc: b8 40 08 00 mv r1,r2 8004fd0: 2b 9d 00 04 lw ra,(sp+4) 8004fd4: 2b 8b 00 08 lw r11,(sp+8) 8004fd8: 37 9c 00 08 addi sp,sp,8 8004fdc: c3 a0 00 00 ret =============================================================================== 0800d954 <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { 800d954: 37 9c ff f8 addi sp,sp,-8 800d958: 5b 8b 00 08 sw (sp+8),r11 800d95c: 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 ]; 800d960: 28 24 01 1c lw r4,(r1+284) option_set = (rtems_option) the_thread->Wait.option; 800d964: 28 28 00 30 lw r8,(r1+48) */ void _Event_Surrender( Thread_Control *the_thread ) { 800d968: 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 ); 800d96c: 90 00 08 00 rcsr r1,IE 800d970: 34 07 ff fe mvi r7,-2 800d974: a0 27 38 00 and r7,r1,r7 800d978: d0 07 00 00 wcsr IE,r7 pending_events = api->pending_events; 800d97c: 28 85 00 00 lw r5,(r4+0) event_condition = (rtems_event_set) the_thread->Wait.count; 800d980: 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 ); 800d984: 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 ) ) { 800d988: 5c 40 00 03 bne r2,r0,800d994 <_Event_Surrender+0x40> _ISR_Enable( level ); 800d98c: d0 01 00 00 wcsr IE,r1 return; 800d990: e0 00 00 3d bi 800da84 <_Event_Surrender+0x130> /* * 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() && 800d994: 78 03 08 01 mvhi r3,0x801 800d998: 38 63 9e 2c ori r3,r3,0x9e2c 800d99c: 28 69 00 08 lw r9,(r3+8) 800d9a0: 45 20 00 1a be r9,r0,800da08 <_Event_Surrender+0xb4> 800d9a4: 28 63 00 0c lw r3,(r3+12) 800d9a8: 5d 63 00 18 bne r11,r3,800da08 <_Event_Surrender+0xb4> _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 800d9ac: 78 03 08 01 mvhi r3,0x801 800d9b0: 38 63 a3 20 ori r3,r3,0xa320 800d9b4: 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() && _Thread_Is_executing( the_thread ) && 800d9b8: 34 09 00 02 mvi r9,2 800d9bc: 45 49 00 04 be r10,r9,800d9cc <_Event_Surrender+0x78> <== NEVER TAKEN ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { 800d9c0: 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() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || 800d9c4: 34 03 00 01 mvi r3,1 800d9c8: 5d 23 00 10 bne r9,r3,800da08 <_Event_Surrender+0xb4> <== NEVER TAKEN (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { 800d9cc: 44 46 00 03 be r2,r6,800d9d8 <_Event_Surrender+0x84> <== ALWAYS TAKEN */ RTEMS_INLINE_ROUTINE bool _Options_Is_any ( rtems_option option_set ) { return (option_set & RTEMS_EVENT_ANY) ? true : false; 800d9d0: 21 08 00 02 andi r8,r8,0x2 <== NOT EXECUTED 800d9d4: 45 00 00 0b be r8,r0,800da00 <_Event_Surrender+0xac> <== NOT EXECUTED RTEMS_INLINE_ROUTINE rtems_event_set _Event_sets_Clear( rtems_event_set the_event_set, rtems_event_set the_mask ) { return ( the_event_set & ~(the_mask) ); 800d9d8: a4 40 18 00 not r3,r2 800d9dc: a0 65 28 00 and r5,r3,r5 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; 800d9e0: 29 63 00 28 lw r3,(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 ); 800d9e4: 58 85 00 00 sw (r4+0),r5 the_thread->Wait.count = 0; 800d9e8: 59 60 00 24 sw (r11+36),r0 *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 800d9ec: 58 62 00 00 sw (r3+0),r2 _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; 800d9f0: 78 02 08 01 mvhi r2,0x801 800d9f4: 38 42 a3 20 ori r2,r2,0xa320 800d9f8: 34 03 00 03 mvi r3,3 800d9fc: 58 43 00 00 sw (r2+0),r3 } _ISR_Enable( level ); 800da00: d0 01 00 00 wcsr IE,r1 return; 800da04: e0 00 00 20 bi 800da84 <_Event_Surrender+0x130> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); 800da08: 29 63 00 10 lw r3,(r11+16) 800da0c: 20 63 01 00 andi r3,r3,0x100 } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { 800da10: 44 60 00 1c be r3,r0,800da80 <_Event_Surrender+0x12c> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { 800da14: 44 46 00 03 be r2,r6,800da20 <_Event_Surrender+0xcc> 800da18: 21 08 00 02 andi r8,r8,0x2 800da1c: 45 00 00 19 be r8,r0,800da80 <_Event_Surrender+0x12c> <== NEVER TAKEN 800da20: a4 40 18 00 not r3,r2 800da24: a0 65 28 00 and r5,r3,r5 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; 800da28: 29 63 00 28 lw r3,(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 ); 800da2c: 58 85 00 00 sw (r4+0),r5 the_thread->Wait.count = 0; 800da30: 59 60 00 24 sw (r11+36),r0 *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; 800da34: 58 62 00 00 sw (r3+0),r2 _ISR_Flash( level ); 800da38: d0 01 00 00 wcsr IE,r1 800da3c: d0 07 00 00 wcsr IE,r7 if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { 800da40: 29 63 00 50 lw r3,(r11+80) 800da44: 34 02 00 02 mvi r2,2 800da48: 44 62 00 03 be r3,r2,800da54 <_Event_Surrender+0x100> _ISR_Enable( level ); 800da4c: d0 01 00 00 wcsr IE,r1 800da50: e0 00 00 06 bi 800da68 <_Event_Surrender+0x114> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 800da54: 34 02 00 03 mvi r2,3 800da58: 59 62 00 50 sw (r11+80),r2 _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 800da5c: d0 01 00 00 wcsr IE,r1 (void) _Watchdog_Remove( &the_thread->Timer ); 800da60: 35 61 00 48 addi r1,r11,72 800da64: fb ff e8 6e calli 8007c1c <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 800da68: 78 03 08 01 mvhi r3,0x801 800da6c: 38 63 81 bc ori r3,r3,0x81bc 800da70: 28 62 00 00 lw r2,(r3+0) 800da74: b9 60 08 00 mv r1,r11 800da78: f8 00 05 6d calli 800f02c <_Thread_Clear_state> 800da7c: e0 00 00 02 bi 800da84 <_Event_Surrender+0x130> _Thread_Unblock( the_thread ); } return; } } _ISR_Enable( level ); 800da80: d0 01 00 00 wcsr IE,r1 } 800da84: 2b 9d 00 04 lw ra,(sp+4) 800da88: 2b 8b 00 08 lw r11,(sp+8) 800da8c: 37 9c 00 08 addi sp,sp,8 800da90: c3 a0 00 00 ret =============================================================================== 0800da94 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { 800da94: 37 9c ff f8 addi sp,sp,-8 800da98: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); 800da9c: 37 82 00 08 addi r2,sp,8 800daa0: fb ff e3 b3 calli 800696c <_Thread_Get> switch ( location ) { 800daa4: 2b 82 00 08 lw r2,(sp+8) 800daa8: 5c 40 00 1d bne r2,r0,800db1c <_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 ); 800daac: 90 00 18 00 rcsr r3,IE 800dab0: 34 02 ff fe mvi r2,-2 800dab4: a0 62 10 00 and r2,r3,r2 800dab8: d0 02 00 00 wcsr IE,r2 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 800dabc: 78 02 08 01 mvhi r2,0x801 800dac0: 38 42 9e 2c ori r2,r2,0x9e2c return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { 800dac4: 28 42 00 0c lw r2,(r2+12) _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; 800dac8: 58 20 00 24 sw (r1+36),r0 if ( _Thread_Is_executing( the_thread ) ) { 800dacc: 5c 22 00 08 bne r1,r2,800daec <_Event_Timeout+0x58> if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 800dad0: 78 02 08 01 mvhi r2,0x801 800dad4: 38 42 a3 20 ori r2,r2,0xa320 800dad8: 28 45 00 00 lw r5,(r2+0) 800dadc: 34 04 00 01 mvi r4,1 800dae0: 5c a4 00 03 bne r5,r4,800daec <_Event_Timeout+0x58> _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 800dae4: 34 04 00 02 mvi r4,2 800dae8: 58 44 00 00 sw (r2+0),r4 } the_thread->Wait.return_code = RTEMS_TIMEOUT; 800daec: 34 02 00 06 mvi r2,6 800daf0: 58 22 00 34 sw (r1+52),r2 _ISR_Enable( level ); 800daf4: d0 03 00 00 wcsr IE,r3 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 800daf8: 78 03 08 01 mvhi r3,0x801 800dafc: 38 63 81 bc ori r3,r3,0x81bc 800db00: 28 62 00 00 lw r2,(r3+0) 800db04: f8 00 05 4a calli 800f02c <_Thread_Clear_state> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 800db08: 78 01 08 01 mvhi r1,0x801 800db0c: 38 21 99 60 ori r1,r1,0x9960 800db10: 28 22 00 00 lw r2,(r1+0) 800db14: 34 42 ff ff addi r2,r2,-1 800db18: 58 22 00 00 sw (r1+0),r2 case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } 800db1c: 2b 9d 00 04 lw ra,(sp+4) 800db20: 37 9c 00 08 addi sp,sp,8 800db24: c3 a0 00 00 ret =============================================================================== 08009e28 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 8009e28: 37 9c ff b8 addi sp,sp,-72 8009e2c: 5b 8b 00 40 sw (sp+64),r11 8009e30: 5b 8c 00 3c sw (sp+60),r12 8009e34: 5b 8d 00 38 sw (sp+56),r13 8009e38: 5b 8e 00 34 sw (sp+52),r14 8009e3c: 5b 8f 00 30 sw (sp+48),r15 8009e40: 5b 90 00 2c sw (sp+44),r16 8009e44: 5b 91 00 28 sw (sp+40),r17 8009e48: 5b 92 00 24 sw (sp+36),r18 8009e4c: 5b 93 00 20 sw (sp+32),r19 8009e50: 5b 94 00 1c sw (sp+28),r20 8009e54: 5b 95 00 18 sw (sp+24),r21 8009e58: 5b 96 00 14 sw (sp+20),r22 8009e5c: 5b 97 00 10 sw (sp+16),r23 8009e60: 5b 98 00 0c sw (sp+12),r24 8009e64: 5b 99 00 08 sw (sp+8),r25 8009e68: 5b 9d 00 04 sw (sp+4),ra 8009e6c: b8 40 70 00 mv r14,r2 Heap_Block *start_block = first_block; Heap_Block *merge_below_block = NULL; Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; 8009e70: 5b 80 00 48 sw (sp+72),r0 Heap_Block *extend_last_block = NULL; 8009e74: 5b 80 00 44 sw (sp+68),r0 uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; 8009e78: b5 c3 68 00 add r13,r14,r3 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { 8009e7c: b8 80 a0 00 mv r20,r4 8009e80: b8 20 58 00 mv r11,r1 8009e84: b8 60 10 00 mv r2,r3 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; 8009e88: 28 35 00 20 lw r21,(r1+32) Heap_Block *merge_above_block = NULL; Heap_Block *link_below_block = NULL; Heap_Block *link_above_block = NULL; Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; 8009e8c: 28 36 00 10 lw r22,(r1+16) uintptr_t const min_block_size = heap->min_block_size; 8009e90: 28 24 00 14 lw r4,(r1+20) uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; uintptr_t const free_size = stats->free_size; 8009e94: 28 37 00 30 lw r23,(r1+48) uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { return false; 8009e98: 34 0c 00 00 mvi r12,0 uintptr_t const free_size = stats->free_size; uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { 8009e9c: 55 cd 00 8e bgu r14,r13,800a0d4 <_Heap_Extend+0x2ac> return false; } extend_area_ok = _Heap_Get_first_and_last_block( 8009ea0: b9 c0 08 00 mv r1,r14 8009ea4: ba c0 18 00 mv r3,r22 8009ea8: 37 85 00 48 addi r5,sp,72 8009eac: 37 86 00 44 addi r6,sp,68 8009eb0: fb ff e8 34 calli 8003f80 <_Heap_Get_first_and_last_block> page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { 8009eb4: 44 20 00 88 be r1,r0,800a0d4 <_Heap_Extend+0x2ac> 8009eb8: ba a0 78 00 mv r15,r21 8009ebc: 34 11 00 00 mvi r17,0 8009ec0: 34 13 00 00 mvi r19,0 8009ec4: 34 10 00 00 mvi r16,0 return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; 8009ec8: 29 61 00 18 lw r1,(r11+24) - 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; 8009ecc: 34 18 ff fe mvi r24,-2 8009ed0: e0 00 00 02 bi 8009ed8 <_Heap_Extend+0xb0> 8009ed4: b9 e0 08 00 mv r1,r15 uintptr_t const sub_area_end = start_block->prev_size; 8009ed8: 29 f2 00 00 lw r18,(r15+0) Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( sub_area_end > extend_area_begin && extend_area_end > sub_area_begin 8009edc: f5 a1 18 00 cmpgu r3,r13,r1 8009ee0: f6 4e 10 00 cmpgu r2,r18,r14 (uintptr_t) start_block : heap->area_begin; uintptr_t const sub_area_end = start_block->prev_size; Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( 8009ee4: a0 62 10 00 and r2,r3,r2 8009ee8: 5c 40 00 7a bne r2,r0,800a0d0 <_Heap_Extend+0x2a8> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { 8009eec: 45 a1 00 03 be r13,r1,8009ef8 <_Heap_Extend+0xd0> merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 8009ef0: 56 4d 00 04 bgu r18,r13,8009f00 <_Heap_Extend+0xd8> 8009ef4: e0 00 00 04 bi 8009f04 <_Heap_Extend+0xdc> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { 8009ef8: b9 e0 80 00 mv r16,r15 8009efc: e0 00 00 02 bi 8009f04 <_Heap_Extend+0xdc> merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { 8009f00: b9 e0 98 00 mv r19,r15 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 8009f04: ba 40 08 00 mv r1,r18 8009f08: ba c0 10 00 mv r2,r22 8009f0c: 36 59 ff f8 addi r25,r18,-8 8009f10: f8 00 21 2f calli 80123cc <__umodsi3> uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 8009f14: cb 21 08 00 sub r1,r25,r1 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { 8009f18: 5d d2 00 04 bne r14,r18,8009f28 <_Heap_Extend+0x100> start_block->prev_size = extend_area_end; 8009f1c: 59 ed 00 00 sw (r15+0),r13 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 ) 8009f20: b8 20 60 00 mv r12,r1 8009f24: e0 00 00 04 bi 8009f34 <_Heap_Extend+0x10c> merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { 8009f28: 55 d2 00 02 bgu r14,r18,8009f30 <_Heap_Extend+0x108> 8009f2c: e0 00 00 02 bi 8009f34 <_Heap_Extend+0x10c> 8009f30: b8 20 88 00 mv r17,r1 - 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; 8009f34: 28 2f 00 04 lw r15,(r1+4) 8009f38: a3 0f 78 00 and r15,r24,r15 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 8009f3c: b4 2f 78 00 add r15,r1,r15 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); 8009f40: 5d f5 ff e5 bne r15,r21,8009ed4 <_Heap_Extend+0xac> if ( extend_area_begin < heap->area_begin ) { 8009f44: 29 61 00 18 lw r1,(r11+24) 8009f48: 51 c1 00 03 bgeu r14,r1,8009f54 <_Heap_Extend+0x12c> heap->area_begin = extend_area_begin; 8009f4c: 59 6e 00 18 sw (r11+24),r14 8009f50: e0 00 00 04 bi 8009f60 <_Heap_Extend+0x138> } else if ( heap->area_end < extend_area_end ) { 8009f54: 29 61 00 1c lw r1,(r11+28) 8009f58: 50 2d 00 02 bgeu r1,r13,8009f60 <_Heap_Extend+0x138> heap->area_end = extend_area_end; 8009f5c: 59 6d 00 1c sw (r11+28),r13 } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; 8009f60: 2b 81 00 44 lw r1,(sp+68) 8009f64: 2b 82 00 48 lw r2,(sp+72) heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = 8009f68: c8 22 18 00 sub r3,r1,r2 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; 8009f6c: 58 4d 00 00 sw (r2+0),r13 extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; 8009f70: 38 64 00 01 ori r4,r3,0x1 _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; 8009f74: 58 23 00 00 sw (r1+0),r3 extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 8009f78: 29 63 00 20 lw r3,(r11+32) extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = 8009f7c: 58 44 00 04 sw (r2+4),r4 extend_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; 8009f80: 58 20 00 04 sw (r1+4),r0 _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { 8009f84: 50 43 00 03 bgeu r2,r3,8009f90 <_Heap_Extend+0x168> heap->first_block = extend_first_block; 8009f88: 59 62 00 20 sw (r11+32),r2 8009f8c: e0 00 00 04 bi 8009f9c <_Heap_Extend+0x174> } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { 8009f90: 29 62 00 24 lw r2,(r11+36) 8009f94: 50 41 00 02 bgeu r2,r1,8009f9c <_Heap_Extend+0x174> heap->last_block = extend_last_block; 8009f98: 59 61 00 24 sw (r11+36),r1 } if ( merge_below_block != NULL ) { 8009f9c: 46 00 00 12 be r16,r0,8009fe4 <_Heap_Extend+0x1bc> Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; 8009fa0: 29 6f 00 10 lw r15,(r11+16) uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); 8009fa4: 35 ce 00 08 addi r14,r14,8 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; 8009fa8: b9 c0 08 00 mv r1,r14 8009fac: b9 e0 10 00 mv r2,r15 8009fb0: f8 00 21 07 calli 80123cc <__umodsi3> if ( remainder != 0 ) { 8009fb4: 44 20 00 03 be r1,r0,8009fc0 <_Heap_Extend+0x198> <== ALWAYS TAKEN return value - remainder + alignment; 8009fb8: b5 cf 70 00 add r14,r14,r15 <== NOT EXECUTED 8009fbc: c9 c1 70 00 sub r14,r14,r1 <== NOT EXECUTED uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; 8009fc0: 2a 01 00 00 lw r1,(r16+0) ) { uintptr_t const page_size = heap->page_size; uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = 8009fc4: 35 c2 ff f8 addi r2,r14,-8 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; 8009fc8: 59 c1 ff f8 sw (r14+-8),r1 uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); uintptr_t const new_first_block_begin = new_first_block_alloc_begin - HEAP_BLOCK_HEADER_SIZE; uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = 8009fcc: ca 02 08 00 sub r1,r16,r2 first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; 8009fd0: 38 21 00 01 ori r1,r1,0x1 8009fd4: 58 41 00 04 sw (r2+4),r1 _Heap_Free_block( heap, new_first_block ); 8009fd8: b9 60 08 00 mv r1,r11 8009fdc: fb ff ff 86 calli 8009df4 <_Heap_Free_block> 8009fe0: e0 00 00 06 bi 8009ff8 <_Heap_Extend+0x1d0> heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { _Heap_Merge_below( heap, extend_area_begin, merge_below_block ); } else if ( link_below_block != NULL ) { 8009fe4: 46 70 00 05 be r19,r16,8009ff8 <_Heap_Extend+0x1d0> _Heap_Link_below( 8009fe8: 2b 81 00 44 lw r1,(sp+68) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = (link_begin - last_block_begin) | HEAP_PREV_BLOCK_USED; 8009fec: ca 61 98 00 sub r19,r19,r1 8009ff0: 3a 73 00 01 ori r19,r19,0x1 ) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = 8009ff4: 58 33 00 04 sw (r1+4),r19 link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { 8009ff8: 45 80 00 14 be r12,r0,800a048 <_Heap_Extend+0x220> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 8009ffc: 29 62 00 10 lw r2,(r11+16) ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( extend_area_end - last_block_begin - HEAP_BLOCK_HEADER_SIZE, 800a000: 35 ad ff f8 addi r13,r13,-8 uintptr_t extend_area_end ) { uintptr_t const page_size = heap->page_size; uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const last_block_new_size = _Heap_Align_down( 800a004: c9 ac 68 00 sub r13,r13,r12 800a008: b9 a0 08 00 mv r1,r13 800a00c: f8 00 20 f0 calli 80123cc <__umodsi3> ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = (last_block->size_and_flag - last_block_new_size) 800a010: 29 83 00 04 lw r3,(r12+4) 800a014: c9 a1 08 00 sub r1,r13,r1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 800a018: b4 2c 10 00 add r2,r1,r12 (last_block->size_and_flag - last_block_new_size) 800a01c: c8 61 18 00 sub r3,r3,r1 | HEAP_PREV_BLOCK_USED; 800a020: 38 63 00 01 ori r3,r3,0x1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = 800a024: 58 43 00 04 sw (r2+4),r3 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 800a028: 29 82 00 04 lw r2,(r12+4) 800a02c: 20 42 00 01 andi r2,r2,0x1 block->size_and_flag = size | flag; 800a030: b8 22 08 00 or r1,r1,r2 800a034: 59 81 00 04 sw (r12+4),r1 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); 800a038: b9 80 10 00 mv r2,r12 800a03c: b9 60 08 00 mv r1,r11 800a040: fb ff ff 6d calli 8009df4 <_Heap_Free_block> 800a044: e0 00 00 0c bi 800a074 <_Heap_Extend+0x24c> ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { 800a048: 46 2c 00 0b be r17,r12,800a074 <_Heap_Extend+0x24c> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 800a04c: 2a 21 00 04 lw r1,(r17+4) ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); 800a050: 2b 83 00 48 lw r3,(sp+72) } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { _Heap_Link_above( 800a054: 2b 82 00 44 lw r2,(sp+68) 800a058: 20 21 00 01 andi r1,r1,0x1 ) { uintptr_t const link_begin = (uintptr_t) link; uintptr_t const first_block_begin = (uintptr_t) first_block; _Heap_Block_set_size( link, first_block_begin - link_begin ); 800a05c: c8 71 18 00 sub r3,r3,r17 block->size_and_flag = size | flag; 800a060: b8 61 08 00 or r1,r3,r1 800a064: 5a 21 00 04 sw (r17+4),r1 last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 800a068: 28 41 00 04 lw r1,(r2+4) 800a06c: 38 21 00 01 ori r1,r1,0x1 800a070: 58 41 00 04 sw (r2+4),r1 extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { 800a074: 65 8c 00 00 cmpei r12,r12,0 800a078: 66 10 00 00 cmpei r16,r16,0 800a07c: a1 90 60 00 and r12,r12,r16 800a080: 45 80 00 04 be r12,r0,800a090 <_Heap_Extend+0x268> _Heap_Free_block( heap, extend_first_block ); 800a084: 2b 82 00 48 lw r2,(sp+72) 800a088: b9 60 08 00 mv r1,r11 800a08c: fb ff ff 5a calli 8009df4 <_Heap_Free_block> */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( heap->last_block, (uintptr_t) heap->first_block - (uintptr_t) heap->last_block 800a090: 29 61 00 24 lw r1,(r11+36) * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 800a094: 29 63 00 20 lw r3,(r11+32) stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; 800a098: 34 0c 00 01 mvi r12,1 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 800a09c: 28 22 00 04 lw r2,(r1+4) * This feature will be used to terminate the scattered heap area list. See * also _Heap_Extend(). */ RTEMS_INLINE_ROUTINE void _Heap_Set_last_block_size( Heap_Control *heap ) { _Heap_Block_set_size( 800a0a0: c8 61 18 00 sub r3,r3,r1 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 800a0a4: 20 42 00 01 andi r2,r2,0x1 block->size_and_flag = size | flag; 800a0a8: b8 62 10 00 or r2,r3,r2 800a0ac: 58 22 00 04 sw (r1+4),r2 _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 800a0b0: 29 61 00 30 lw r1,(r11+48) /* Statistics */ stats->size += extended_size; 800a0b4: 29 62 00 2c lw r2,(r11+44) _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; 800a0b8: c8 37 08 00 sub r1,r1,r23 /* Statistics */ stats->size += extended_size; 800a0bc: b4 41 10 00 add r2,r2,r1 800a0c0: 59 62 00 2c sw (r11+44),r2 if ( extended_size_ptr != NULL ) 800a0c4: 46 80 00 04 be r20,r0,800a0d4 <_Heap_Extend+0x2ac> <== NEVER TAKEN *extended_size_ptr = extended_size; 800a0c8: 5a 81 00 00 sw (r20+0),r1 800a0cc: e0 00 00 02 bi 800a0d4 <_Heap_Extend+0x2ac> _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; 800a0d0: 34 0c 00 00 mvi r12,0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } 800a0d4: b9 80 08 00 mv r1,r12 800a0d8: 2b 9d 00 04 lw ra,(sp+4) 800a0dc: 2b 8b 00 40 lw r11,(sp+64) 800a0e0: 2b 8c 00 3c lw r12,(sp+60) 800a0e4: 2b 8d 00 38 lw r13,(sp+56) 800a0e8: 2b 8e 00 34 lw r14,(sp+52) 800a0ec: 2b 8f 00 30 lw r15,(sp+48) 800a0f0: 2b 90 00 2c lw r16,(sp+44) 800a0f4: 2b 91 00 28 lw r17,(sp+40) 800a0f8: 2b 92 00 24 lw r18,(sp+36) 800a0fc: 2b 93 00 20 lw r19,(sp+32) 800a100: 2b 94 00 1c lw r20,(sp+28) 800a104: 2b 95 00 18 lw r21,(sp+24) 800a108: 2b 96 00 14 lw r22,(sp+20) 800a10c: 2b 97 00 10 lw r23,(sp+16) 800a110: 2b 98 00 0c lw r24,(sp+12) 800a114: 2b 99 00 08 lw r25,(sp+8) 800a118: 37 9c 00 48 addi sp,sp,72 800a11c: c3 a0 00 00 ret =============================================================================== 0800e930 <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { 800e930: 37 9c ff f4 addi sp,sp,-12 800e934: 5b 8b 00 0c sw (sp+12),r11 800e938: 5b 8c 00 08 sw (sp+8),r12 800e93c: 5b 9d 00 04 sw (sp+4),ra 800e940: b8 20 58 00 mv r11,r1 800e944: 34 4c ff f8 addi r12,r2,-8 800e948: b8 40 08 00 mv r1,r2 800e94c: 29 62 00 10 lw r2,(r11+16) 800e950: f8 00 22 65 calli 80172e4 <__umodsi3> 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 800e954: 29 67 00 20 lw r7,(r11+32) uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 800e958: c9 81 18 00 sub r3,r12,r1 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; 800e95c: 34 01 00 00 mvi r1,0 800e960: 54 e3 00 03 bgu r7,r3,800e96c <_Heap_Free+0x3c> 800e964: 29 61 00 24 lw r1,(r11+36) 800e968: f0 23 08 00 cmpgeu r1,r1,r3 uintptr_t next_block_size = 0; bool next_is_free = false; _Heap_Protection_block_check( heap, block ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { 800e96c: b8 20 10 00 mv r2,r1 return false; 800e970: 34 01 00 00 mvi r1,0 uintptr_t next_block_size = 0; bool next_is_free = false; _Heap_Protection_block_check( heap, block ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { 800e974: 44 40 00 66 be r2,r0,800eb0c <_Heap_Free+0x1dc> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 800e978: 28 66 00 04 lw r6,(r3+4) - 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; 800e97c: 34 04 ff fe mvi r4,-2 800e980: a0 c4 20 00 and r4,r6,r4 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800e984: b4 64 10 00 add r2,r3,r4 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; 800e988: 54 e2 00 03 bgu r7,r2,800e994 <_Heap_Free+0x64> <== NEVER TAKEN 800e98c: 29 61 00 24 lw r1,(r11+36) 800e990: f0 22 08 00 cmpgeu r1,r1,r2 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 800e994: b8 20 28 00 mv r5,r1 _HAssert( false ); return false; 800e998: 34 01 00 00 mvi r1,0 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 800e99c: 44 a0 00 5c be r5,r0,800eb0c <_Heap_Free+0x1dc> <== NEVER TAKEN --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 800e9a0: 28 45 00 04 lw r5,(r2+4) 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; 800e9a4: 20 a8 00 01 andi r8,r5,0x1 if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { _HAssert( false ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 800e9a8: 45 00 00 59 be r8,r0,800eb0c <_Heap_Free+0x1dc> <== NEVER TAKEN if ( !_Heap_Protection_determine_block_free( heap, block ) ) { return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 800e9ac: 29 69 00 24 lw r9,(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; 800e9b0: 34 01 ff fe mvi r1,-2 800e9b4: a0 a1 28 00 and r5,r5,r1 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); 800e9b8: 34 08 00 00 mvi r8,0 800e9bc: 45 22 00 05 be r9,r2,800e9d0 <_Heap_Free+0xa0> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } 800e9c0: b4 45 08 00 add r1,r2,r5 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; 800e9c4: 28 28 00 04 lw r8,(r1+4) 800e9c8: 21 08 00 01 andi r8,r8,0x1 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) 800e9cc: 65 08 00 00 cmpei r8,r8,0 800e9d0: 20 c6 00 01 andi r6,r6,0x1 if ( !_Heap_Protection_determine_block_free( heap, block ) ) { return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block 800e9d4: 21 08 00 ff andi r8,r8,0xff && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { 800e9d8: 5c c0 00 24 bne r6,r0,800ea68 <_Heap_Free+0x138> uintptr_t const prev_size = block->prev_size; 800e9dc: 28 66 00 00 lw r6,(r3+0) 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; 800e9e0: 34 01 00 00 mvi r1,0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800e9e4: c8 66 18 00 sub r3,r3,r6 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; 800e9e8: 54 e3 00 02 bgu r7,r3,800e9f0 <_Heap_Free+0xc0> <== NEVER TAKEN 800e9ec: f1 23 08 00 cmpgeu r1,r9,r3 Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { 800e9f0: b8 20 38 00 mv r7,r1 _HAssert( false ); return( false ); 800e9f4: 34 01 00 00 mvi r1,0 if ( !_Heap_Is_prev_used( block ) ) { uintptr_t const prev_size = block->prev_size; Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { 800e9f8: 44 e0 00 45 be r7,r0,800eb0c <_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; 800e9fc: 28 67 00 04 lw r7,(r3+4) 800ea00: 20 e7 00 01 andi r7,r7,0x1 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) ) { 800ea04: 44 e0 00 42 be r7,r0,800eb0c <_Heap_Free+0x1dc> <== NEVER TAKEN _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ 800ea08: 45 00 00 0f be r8,r0,800ea44 <_Heap_Free+0x114> return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 800ea0c: 28 41 00 08 lw r1,(r2+8) Heap_Block *prev = block->prev; 800ea10: 28 42 00 0c lw r2,(r2+12) uintptr_t const size = block_size + prev_size + next_block_size; 800ea14: b4 85 28 00 add r5,r4,r5 800ea18: b4 a6 30 00 add r6,r5,r6 prev->next = next; 800ea1c: 58 41 00 08 sw (r2+8),r1 next->prev = prev; 800ea20: 58 22 00 0c sw (r1+12),r2 _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; 800ea24: 29 61 00 38 lw r1,(r11+56) 800ea28: 34 21 ff ff addi r1,r1,-1 800ea2c: 59 61 00 38 sw (r11+56),r1 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 800ea30: 38 c1 00 01 ori r1,r6,0x1 800ea34: 58 61 00 04 sw (r3+4),r1 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; 800ea38: b4 66 18 00 add r3,r3,r6 800ea3c: 58 66 00 00 sw (r3+0),r6 800ea40: e0 00 00 29 bi 800eae4 <_Heap_Free+0x1b4> } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; 800ea44: b4 86 30 00 add r6,r4,r6 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 800ea48: 38 c1 00 01 ori r1,r6,0x1 800ea4c: 58 61 00 04 sw (r3+4),r1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 800ea50: 28 43 00 04 lw r3,(r2+4) 800ea54: 34 01 ff fe mvi r1,-2 next_block->prev_size = size; 800ea58: 58 46 00 00 sw (r2+0),r6 _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; 800ea5c: a0 61 08 00 and r1,r3,r1 800ea60: 58 41 00 04 sw (r2+4),r1 800ea64: e0 00 00 20 bi 800eae4 <_Heap_Free+0x1b4> next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ 800ea68: 45 00 00 0d be r8,r0,800ea9c <_Heap_Free+0x16c> uintptr_t const size = block_size + next_block_size; 800ea6c: b4 a4 08 00 add r1,r5,r4 RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace( Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; 800ea70: 28 45 00 08 lw r5,(r2+8) Heap_Block *prev = old_block->prev; 800ea74: 28 42 00 0c lw r2,(r2+12) new_block->next = next; 800ea78: 58 65 00 08 sw (r3+8),r5 new_block->prev = prev; 800ea7c: 58 62 00 0c sw (r3+12),r2 next->prev = new_block; prev->next = new_block; 800ea80: 58 43 00 08 sw (r2+8),r3 _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; 800ea84: 38 22 00 01 ori r2,r1,0x1 Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; 800ea88: 58 a3 00 0c sw (r5+12),r3 800ea8c: 58 62 00 04 sw (r3+4),r2 next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; 800ea90: b4 61 18 00 add r3,r3,r1 800ea94: 58 61 00 00 sw (r3+0),r1 800ea98: e0 00 00 13 bi 800eae4 <_Heap_Free+0x1b4> RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; 800ea9c: 29 61 00 08 lw r1,(r11+8) new_block->next = next; new_block->prev = block_before; 800eaa0: 58 6b 00 0c sw (r3+12),r11 /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; 800eaa4: 58 44 00 00 sw (r2+0),r4 Heap_Block *new_block ) { Heap_Block *next = block_before->next; new_block->next = next; 800eaa8: 58 61 00 08 sw (r3+8),r1 new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; 800eaac: 58 23 00 0c sw (r1+12),r3 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; 800eab0: 38 81 00 01 ori r1,r4,0x1 800eab4: 58 61 00 04 sw (r3+4),r1 { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; 800eab8: 59 63 00 08 sw (r11+8),r3 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; 800eabc: 28 43 00 04 lw r3,(r2+4) 800eac0: 34 01 ff fe mvi r1,-2 800eac4: a0 61 08 00 and r1,r3,r1 800eac8: 58 41 00 04 sw (r2+4),r1 next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; 800eacc: 29 61 00 38 lw r1,(r11+56) if ( stats->max_free_blocks < stats->free_blocks ) { 800ead0: 29 62 00 3c lw r2,(r11+60) 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; 800ead4: 34 21 00 01 addi r1,r1,1 800ead8: 59 61 00 38 sw (r11+56),r1 if ( stats->max_free_blocks < stats->free_blocks ) { 800eadc: 50 41 00 02 bgeu r2,r1,800eae4 <_Heap_Free+0x1b4> stats->max_free_blocks = stats->free_blocks; 800eae0: 59 61 00 3c sw (r11+60),r1 } } /* Statistics */ --stats->used_blocks; 800eae4: 29 61 00 40 lw r1,(r11+64) 800eae8: 34 21 ff ff addi r1,r1,-1 800eaec: 59 61 00 40 sw (r11+64),r1 ++stats->frees; 800eaf0: 29 61 00 50 lw r1,(r11+80) 800eaf4: 34 21 00 01 addi r1,r1,1 800eaf8: 59 61 00 50 sw (r11+80),r1 stats->free_size += block_size; 800eafc: 29 61 00 30 lw r1,(r11+48) 800eb00: b4 24 20 00 add r4,r1,r4 800eb04: 59 64 00 30 sw (r11+48),r4 return( true ); 800eb08: 34 01 00 01 mvi r1,1 } 800eb0c: 2b 9d 00 04 lw ra,(sp+4) 800eb10: 2b 8b 00 0c lw r11,(sp+12) 800eb14: 2b 8c 00 08 lw r12,(sp+8) 800eb18: 37 9c 00 0c addi sp,sp,12 800eb1c: c3 a0 00 00 ret =============================================================================== 0800eb20 <_Heap_Resize_block>: void *alloc_begin_ptr, uintptr_t new_alloc_size, uintptr_t *old_size, uintptr_t *new_size ) { 800eb20: 37 9c ff e4 addi sp,sp,-28 800eb24: 5b 8b 00 1c sw (sp+28),r11 800eb28: 5b 8c 00 18 sw (sp+24),r12 800eb2c: 5b 8d 00 14 sw (sp+20),r13 800eb30: 5b 8e 00 10 sw (sp+16),r14 800eb34: 5b 8f 00 0c sw (sp+12),r15 800eb38: 5b 90 00 08 sw (sp+8),r16 800eb3c: 5b 9d 00 04 sw (sp+4),ra 800eb40: b8 20 58 00 mv r11,r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 800eb44: 34 50 ff f8 addi r16,r2,-8 800eb48: b8 40 08 00 mv r1,r2 800eb4c: b8 40 60 00 mv r12,r2 800eb50: 29 62 00 10 lw r2,(r11+16) 800eb54: b8 80 78 00 mv r15,r4 800eb58: b8 a0 68 00 mv r13,r5 800eb5c: b8 60 70 00 mv r14,r3 800eb60: f8 00 21 e1 calli 80172e4 <__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; 800eb64: 29 62 00 20 lw r2,(r11+32) uintptr_t const alloc_begin = (uintptr_t) alloc_begin_ptr; Heap_Block *const block = _Heap_Block_of_alloc_area( alloc_begin, page_size ); *old_size = 0; 800eb68: 59 e0 00 00 sw (r15+0),r0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 800eb6c: ca 01 30 00 sub r6,r16,r1 *new_size = 0; 800eb70: 59 a0 00 00 sw (r13+0),r0 new_alloc_size, old_size, new_size ); } else { return HEAP_RESIZE_FATAL_ERROR; 800eb74: 34 01 00 02 mvi r1,2 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; 800eb78: 54 46 00 38 bgu r2,r6,800ec58 <_Heap_Resize_block+0x138> 800eb7c: 29 62 00 24 lw r2,(r11+36) 800eb80: 54 c2 00 36 bgu r6,r2,800ec58 <_Heap_Resize_block+0x138> <== NEVER TAKEN - 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; 800eb84: 28 c2 00 04 lw r2,(r6+4) 800eb88: 34 01 ff fe mvi r1,-2 800eb8c: a0 22 10 00 and r2,r1,r2 { Heap_Statistics *const stats = &heap->stats; uintptr_t const block_begin = (uintptr_t) block; uintptr_t block_size = _Heap_Block_size( block ); uintptr_t block_end = block_begin + block_size; 800eb90: b4 c2 38 00 add r7,r6,r2 800eb94: 28 e8 00 04 lw r8,(r7+4) uintptr_t alloc_size = block_end - alloc_begin + HEAP_ALLOC_BONUS; 800eb98: c8 ec 48 00 sub r9,r7,r12 800eb9c: 35 29 00 04 addi r9,r9,4 800eba0: a0 28 40 00 and r8,r1,r8 new_size ); } else { return HEAP_RESIZE_FATAL_ERROR; } } 800eba4: b4 e8 08 00 add r1,r7,r8 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; 800eba8: 28 23 00 04 lw r3,(r1+4) bool next_block_is_free = _Heap_Is_free( next_block );; _HAssert( _Heap_Is_block_in_heap( heap, next_block ) ); _HAssert( _Heap_Is_prev_used( next_block ) ); *old_size = alloc_size; 800ebac: 59 e9 00 00 sw (r15+0),r9 800ebb0: 20 63 00 01 andi r3,r3,0x1 RTEMS_INLINE_ROUTINE bool _Heap_Is_free( const Heap_Block *block ) { return !_Heap_Is_used( block ); 800ebb4: 18 63 00 01 xori r3,r3,0x1 if ( next_block_is_free ) { 800ebb8: 44 60 00 03 be r3,r0,800ebc4 <_Heap_Resize_block+0xa4> block_size += next_block_size; 800ebbc: b4 48 10 00 add r2,r2,r8 alloc_size += next_block_size; 800ebc0: b5 28 48 00 add r9,r9,r8 } if ( new_alloc_size > alloc_size ) { return HEAP_RESIZE_UNSATISFIED; 800ebc4: 34 01 00 01 mvi r1,1 if ( next_block_is_free ) { block_size += next_block_size; alloc_size += next_block_size; } if ( new_alloc_size > alloc_size ) { 800ebc8: 55 c9 00 24 bgu r14,r9,800ec58 <_Heap_Resize_block+0x138> return HEAP_RESIZE_UNSATISFIED; } if ( next_block_is_free ) { 800ebcc: 44 60 00 13 be r3,r0,800ec18 <_Heap_Resize_block+0xf8> RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 800ebd0: 28 c1 00 04 lw r1,(r6+4) } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; 800ebd4: 28 e3 00 0c lw r3,(r7+12) RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; 800ebd8: 20 21 00 01 andi r1,r1,0x1 block->size_and_flag = size | flag; 800ebdc: b8 41 08 00 or r1,r2,r1 800ebe0: 58 c1 00 04 sw (r6+4),r1 return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; 800ebe4: 28 e1 00 08 lw r1,(r7+8) RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800ebe8: b4 46 10 00 add r2,r2,r6 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; 800ebec: 58 61 00 08 sw (r3+8),r1 next->prev = prev; 800ebf0: 58 23 00 0c sw (r1+12),r3 _Heap_Block_set_size( block, block_size ); _Heap_Free_list_remove( next_block ); next_block = _Heap_Block_at( block, block_size ); next_block->size_and_flag |= HEAP_PREV_BLOCK_USED; 800ebf4: 28 41 00 04 lw r1,(r2+4) 800ebf8: 38 21 00 01 ori r1,r1,0x1 800ebfc: 58 41 00 04 sw (r2+4),r1 /* Statistics */ --stats->free_blocks; 800ec00: 29 61 00 38 lw r1,(r11+56) 800ec04: 34 21 ff ff addi r1,r1,-1 800ec08: 59 61 00 38 sw (r11+56),r1 stats->free_size -= next_block_size; 800ec0c: 29 61 00 30 lw r1,(r11+48) 800ec10: c8 28 40 00 sub r8,r1,r8 800ec14: 59 68 00 30 sw (r11+48),r8 } block = _Heap_Block_allocate( heap, block, alloc_begin, new_alloc_size ); 800ec18: b9 80 18 00 mv r3,r12 800ec1c: b8 c0 10 00 mv r2,r6 800ec20: b9 60 08 00 mv r1,r11 800ec24: b9 c0 20 00 mv r4,r14 800ec28: fb ff da 02 calli 8005430 <_Heap_Block_allocate> - 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; 800ec2c: 28 23 00 04 lw r3,(r1+4) 800ec30: 34 02 ff fe mvi r2,-2 800ec34: a0 43 10 00 and r2,r2,r3 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800ec38: 34 42 00 04 addi r2,r2,4 block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); *new_size = (uintptr_t) next_block - alloc_begin + HEAP_ALLOC_BONUS; 800ec3c: c8 4c 60 00 sub r12,r2,r12 800ec40: b4 2c 08 00 add r1,r1,r12 800ec44: 59 a1 00 00 sw (r13+0),r1 /* Statistics */ ++stats->resizes; 800ec48: 29 61 00 54 lw r1,(r11+84) 800ec4c: 34 21 00 01 addi r1,r1,1 800ec50: 59 61 00 54 sw (r11+84),r1 return HEAP_RESIZE_SUCCESSFUL; 800ec54: 34 01 00 00 mvi r1,0 new_size ); } else { return HEAP_RESIZE_FATAL_ERROR; } } 800ec58: 2b 9d 00 04 lw ra,(sp+4) 800ec5c: 2b 8b 00 1c lw r11,(sp+28) 800ec60: 2b 8c 00 18 lw r12,(sp+24) 800ec64: 2b 8d 00 14 lw r13,(sp+20) 800ec68: 2b 8e 00 10 lw r14,(sp+16) 800ec6c: 2b 8f 00 0c lw r15,(sp+12) 800ec70: 2b 90 00 08 lw r16,(sp+8) 800ec74: 37 9c 00 1c addi sp,sp,28 800ec78: c3 a0 00 00 ret =============================================================================== 0800ec7c <_Heap_Size_of_alloc_area>: bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { 800ec7c: 37 9c ff ec addi sp,sp,-20 800ec80: 5b 8b 00 14 sw (sp+20),r11 800ec84: 5b 8c 00 10 sw (sp+16),r12 800ec88: 5b 8d 00 0c sw (sp+12),r13 800ec8c: 5b 8e 00 08 sw (sp+8),r14 800ec90: 5b 9d 00 04 sw (sp+4),ra 800ec94: b8 20 58 00 mv r11,r1 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); 800ec98: 34 4e ff f8 addi r14,r2,-8 800ec9c: b8 40 08 00 mv r1,r2 800eca0: b8 40 60 00 mv r12,r2 800eca4: 29 62 00 10 lw r2,(r11+16) 800eca8: b8 60 68 00 mv r13,r3 800ecac: f8 00 21 8e calli 80172e4 <__umodsi3> 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 800ecb0: 29 62 00 20 lw r2,(r11+32) uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); 800ecb4: c9 c1 20 00 sub r4,r14,r1 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; 800ecb8: 34 01 00 00 mvi r1,0 800ecbc: 54 44 00 03 bgu r2,r4,800ecc8 <_Heap_Size_of_alloc_area+0x4c> 800ecc0: 29 61 00 24 lw r1,(r11+36) 800ecc4: 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 ) ) { 800ecc8: b8 20 18 00 mv r3,r1 return false; 800eccc: 34 01 00 00 mvi r1,0 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 ) ) { 800ecd0: 44 60 00 13 be r3,r0,800ed1c <_Heap_Size_of_alloc_area+0xa0> - 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; 800ecd4: 28 83 00 04 lw r3,(r4+4) 800ecd8: 34 01 ff fe mvi r1,-2 800ecdc: a0 23 08 00 and r1,r1,r3 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 800ece0: b4 81 20 00 add r4,r4,r1 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; 800ece4: 34 01 00 00 mvi r1,0 800ece8: 54 44 00 03 bgu r2,r4,800ecf4 <_Heap_Size_of_alloc_area+0x78><== NEVER TAKEN 800ecec: 29 61 00 24 lw r1,(r11+36) 800ecf0: f0 24 08 00 cmpgeu r1,r1,r4 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 800ecf4: b8 20 10 00 mv r2,r1 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) ) { return false; 800ecf8: 34 01 00 00 mvi r1,0 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( 800ecfc: 44 40 00 08 be r2,r0,800ed1c <_Heap_Size_of_alloc_area+0xa0><== 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; 800ed00: 28 82 00 04 lw r2,(r4+4) 800ed04: 20 42 00 01 andi r2,r2,0x1 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) 800ed08: 44 40 00 05 be r2,r0,800ed1c <_Heap_Size_of_alloc_area+0xa0><== NEVER TAKEN ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; 800ed0c: c8 8c 20 00 sub r4,r4,r12 800ed10: 34 84 00 04 addi r4,r4,4 800ed14: 59 a4 00 00 sw (r13+0),r4 return true; 800ed18: 34 01 00 01 mvi r1,1 } 800ed1c: 2b 9d 00 04 lw ra,(sp+4) 800ed20: 2b 8b 00 14 lw r11,(sp+20) 800ed24: 2b 8c 00 10 lw r12,(sp+16) 800ed28: 2b 8d 00 0c lw r13,(sp+12) 800ed2c: 2b 8e 00 08 lw r14,(sp+8) 800ed30: 37 9c 00 14 addi sp,sp,20 800ed34: c3 a0 00 00 ret =============================================================================== 08004bfc <_Heap_Walk>: bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 8004bfc: 37 9c ff a0 addi sp,sp,-96 8004c00: 5b 8b 00 50 sw (sp+80),r11 8004c04: 5b 8c 00 4c sw (sp+76),r12 8004c08: 5b 8d 00 48 sw (sp+72),r13 8004c0c: 5b 8e 00 44 sw (sp+68),r14 8004c10: 5b 8f 00 40 sw (sp+64),r15 8004c14: 5b 90 00 3c sw (sp+60),r16 8004c18: 5b 91 00 38 sw (sp+56),r17 8004c1c: 5b 92 00 34 sw (sp+52),r18 8004c20: 5b 93 00 30 sw (sp+48),r19 8004c24: 5b 94 00 2c sw (sp+44),r20 8004c28: 5b 95 00 28 sw (sp+40),r21 8004c2c: 5b 96 00 24 sw (sp+36),r22 8004c30: 5b 97 00 20 sw (sp+32),r23 8004c34: 5b 98 00 1c sw (sp+28),r24 8004c38: 5b 99 00 18 sw (sp+24),r25 8004c3c: 5b 9b 00 14 sw (sp+20),fp 8004c40: 5b 9d 00 10 sw (sp+16),ra uintptr_t const min_block_size = heap->min_block_size; Heap_Block *const first_block = heap->first_block; Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 8004c44: 78 0d 08 00 mvhi r13,0x800 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { 8004c48: 20 63 00 ff andi r3,r3,0xff 8004c4c: b8 20 60 00 mv r12,r1 8004c50: b8 40 70 00 mv r14,r2 uintptr_t const page_size = heap->page_size; 8004c54: 28 33 00 10 lw r19,(r1+16) uintptr_t const min_block_size = heap->min_block_size; 8004c58: 28 35 00 14 lw r21,(r1+20) Heap_Block *const first_block = heap->first_block; 8004c5c: 28 34 00 20 lw r20,(r1+32) Heap_Block *const last_block = heap->last_block; 8004c60: 28 36 00 24 lw r22,(r1+36) Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; 8004c64: 39 ad 4b 64 ori r13,r13,0x4b64 8004c68: 44 60 00 03 be r3,r0,8004c74 <_Heap_Walk+0x78> 8004c6c: 78 0d 08 00 mvhi r13,0x800 8004c70: 39 ad 4b 88 ori r13,r13,0x4b88 if ( !_System_state_Is_up( _System_state_Get() ) ) { 8004c74: 78 03 08 01 mvhi r3,0x801 8004c78: 38 63 6a a8 ori r3,r3,0x6aa8 8004c7c: 28 67 00 00 lw r7,(r3+0) 8004c80: 34 02 00 03 mvi r2,3 return true; 8004c84: 34 03 00 01 mvi r3,1 Heap_Block *const last_block = heap->last_block; Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; if ( !_System_state_Is_up( _System_state_Get() ) ) { 8004c88: 5c e2 01 08 bne r7,r2,80050a8 <_Heap_Walk+0x4ac> <== 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)( 8004c8c: 29 81 00 08 lw r1,(r12+8) 8004c90: 29 86 00 18 lw r6,(r12+24) 8004c94: 29 87 00 1c lw r7,(r12+28) 8004c98: 5b 81 00 08 sw (sp+8),r1 8004c9c: 29 81 00 0c lw r1,(r12+12) 8004ca0: 78 03 08 01 mvhi r3,0x801 8004ca4: 5b 96 00 04 sw (sp+4),r22 8004ca8: 5b 81 00 0c sw (sp+12),r1 8004cac: 34 02 00 00 mvi r2,0 8004cb0: b9 c0 08 00 mv r1,r14 8004cb4: 38 63 41 d0 ori r3,r3,0x41d0 8004cb8: ba 60 20 00 mv r4,r19 8004cbc: ba a0 28 00 mv r5,r21 8004cc0: ba 80 40 00 mv r8,r20 8004cc4: d9 a0 00 00 call r13 heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { 8004cc8: 5e 60 00 06 bne r19,r0,8004ce0 <_Heap_Walk+0xe4> (*printer)( source, true, "page size is zero\n" ); 8004ccc: 78 03 08 01 mvhi r3,0x801 8004cd0: b9 c0 08 00 mv r1,r14 8004cd4: 34 02 00 01 mvi r2,1 8004cd8: 38 63 42 64 ori r3,r3,0x4264 8004cdc: e0 00 00 25 bi 8004d70 <_Heap_Walk+0x174> ) { #if (CPU_ALIGNMENT == 0) return true; #else return (((uintptr_t)address % CPU_ALIGNMENT) == 0); 8004ce0: 22 6f 00 07 andi r15,r19,0x7 return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { 8004ce4: 45 e0 00 07 be r15,r0,8004d00 <_Heap_Walk+0x104> (*printer)( 8004ce8: 78 03 08 01 mvhi r3,0x801 8004cec: b9 c0 08 00 mv r1,r14 8004cf0: 34 02 00 01 mvi r2,1 8004cf4: 38 63 42 78 ori r3,r3,0x4278 8004cf8: ba 60 20 00 mv r4,r19 8004cfc: e0 00 01 04 bi 800510c <_Heap_Walk+0x510> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 8004d00: ba a0 08 00 mv r1,r21 8004d04: ba 60 10 00 mv r2,r19 8004d08: fb ff ef 9c calli 8000b78 <__umodsi3> 8004d0c: b8 20 58 00 mv r11,r1 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { 8004d10: 44 2f 00 07 be r1,r15,8004d2c <_Heap_Walk+0x130> (*printer)( 8004d14: 78 03 08 01 mvhi r3,0x801 8004d18: b9 c0 08 00 mv r1,r14 8004d1c: 34 02 00 01 mvi r2,1 8004d20: 38 63 42 98 ori r3,r3,0x4298 8004d24: ba a0 20 00 mv r4,r21 8004d28: e0 00 00 f9 bi 800510c <_Heap_Walk+0x510> 8004d2c: 36 81 00 08 addi r1,r20,8 8004d30: ba 60 10 00 mv r2,r19 8004d34: fb ff ef 91 calli 8000b78 <__umodsi3> ); return false; } if ( 8004d38: 44 2b 00 07 be r1,r11,8004d54 <_Heap_Walk+0x158> !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( 8004d3c: 78 03 08 01 mvhi r3,0x801 8004d40: b9 c0 08 00 mv r1,r14 8004d44: 34 02 00 01 mvi r2,1 8004d48: 38 63 42 bc ori r3,r3,0x42bc 8004d4c: ba 80 20 00 mv r4,r20 8004d50: e0 00 00 ef bi 800510c <_Heap_Walk+0x510> 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; 8004d54: 2a 82 00 04 lw r2,(r20+4) 8004d58: 20 42 00 01 andi r2,r2,0x1 ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { 8004d5c: 5c 41 00 07 bne r2,r1,8004d78 <_Heap_Walk+0x17c> (*printer)( 8004d60: 78 03 08 01 mvhi r3,0x801 8004d64: b9 c0 08 00 mv r1,r14 8004d68: 34 02 00 01 mvi r2,1 8004d6c: 38 63 42 f0 ori r3,r3,0x42f0 8004d70: d9 a0 00 00 call r13 8004d74: e0 00 00 40 bi 8004e74 <_Heap_Walk+0x278> - 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; 8004d78: 2a cf 00 04 lw r15,(r22+4) 8004d7c: 34 02 ff fe mvi r2,-2 8004d80: a0 4f 78 00 and r15,r2,r15 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 8004d84: b6 cf 78 00 add r15,r22,r15 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; 8004d88: 29 e2 00 04 lw r2,(r15+4) 8004d8c: 20 42 00 01 andi r2,r2,0x1 ); return false; } if ( _Heap_Is_free( last_block ) ) { 8004d90: 5c 41 00 06 bne r2,r1,8004da8 <_Heap_Walk+0x1ac> (*printer)( 8004d94: 78 03 08 01 mvhi r3,0x801 8004d98: b9 c0 08 00 mv r1,r14 8004d9c: 34 02 00 01 mvi r2,1 8004da0: 38 63 43 20 ori r3,r3,0x4320 8004da4: e3 ff ff f3 bi 8004d70 <_Heap_Walk+0x174> ); return false; } if ( 8004da8: 45 f4 00 06 be r15,r20,8004dc0 <_Heap_Walk+0x1c4> <== ALWAYS TAKEN _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( 8004dac: 78 03 08 01 mvhi r3,0x801 <== NOT EXECUTED 8004db0: b9 c0 08 00 mv r1,r14 <== NOT EXECUTED 8004db4: 34 02 00 01 mvi r2,1 <== NOT EXECUTED 8004db8: 38 63 43 38 ori r3,r3,0x4338 <== NOT EXECUTED 8004dbc: e3 ff ff ed bi 8004d70 <_Heap_Walk+0x174> <== NOT EXECUTED int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; 8004dc0: 29 92 00 10 lw r18,(r12+16) block = next_block; } while ( block != first_block ); return true; } 8004dc4: 29 8b 00 08 lw r11,(r12+8) Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); 8004dc8: b9 80 80 00 mv r16,r12 - 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; 8004dcc: 34 11 ff fe mvi r17,-2 8004dd0: e0 00 00 2d bi 8004e84 <_Heap_Walk+0x288> 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; 8004dd4: 29 83 00 20 lw r3,(r12+32) 8004dd8: 34 01 00 00 mvi r1,0 8004ddc: 54 6b 00 03 bgu r3,r11,8004de8 <_Heap_Walk+0x1ec> 8004de0: 29 81 00 24 lw r1,(r12+36) 8004de4: f0 2b 08 00 cmpgeu r1,r1,r11 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 ) ) { 8004de8: 5c 20 00 06 bne r1,r0,8004e00 <_Heap_Walk+0x204> (*printer)( 8004dec: 78 03 08 01 mvhi r3,0x801 8004df0: b9 c0 08 00 mv r1,r14 8004df4: 34 02 00 01 mvi r2,1 8004df8: 38 63 43 68 ori r3,r3,0x4368 8004dfc: e0 00 00 14 bi 8004e4c <_Heap_Walk+0x250> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 8004e00: 35 61 00 08 addi r1,r11,8 8004e04: ba 40 10 00 mv r2,r18 8004e08: fb ff ef 5c calli 8000b78 <__umodsi3> ); return false; } if ( 8004e0c: 44 20 00 06 be r1,r0,8004e24 <_Heap_Walk+0x228> !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( 8004e10: 78 03 08 01 mvhi r3,0x801 8004e14: b9 c0 08 00 mv r1,r14 8004e18: 34 02 00 01 mvi r2,1 8004e1c: 38 63 43 88 ori r3,r3,0x4388 8004e20: e0 00 00 0b bi 8004e4c <_Heap_Walk+0x250> - 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; 8004e24: 29 63 00 04 lw r3,(r11+4) 8004e28: a2 23 18 00 and r3,r17,r3 block = next_block; } while ( block != first_block ); return true; } 8004e2c: b5 63 18 00 add r3,r11,r3 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; 8004e30: 28 63 00 04 lw r3,(r3+4) 8004e34: 20 63 00 01 andi r3,r3,0x1 ); return false; } if ( _Heap_Is_used( free_block ) ) { 8004e38: 44 61 00 07 be r3,r1,8004e54 <_Heap_Walk+0x258> (*printer)( 8004e3c: 78 03 08 01 mvhi r3,0x801 8004e40: b9 c0 08 00 mv r1,r14 8004e44: 34 02 00 01 mvi r2,1 8004e48: 38 63 43 b8 ori r3,r3,0x43b8 8004e4c: b9 60 20 00 mv r4,r11 8004e50: e0 00 00 af bi 800510c <_Heap_Walk+0x510> ); return false; } if ( free_block->prev != prev_block ) { 8004e54: 29 65 00 0c lw r5,(r11+12) 8004e58: 44 b0 00 09 be r5,r16,8004e7c <_Heap_Walk+0x280> (*printer)( 8004e5c: 78 03 08 01 mvhi r3,0x801 8004e60: b9 c0 08 00 mv r1,r14 8004e64: 34 02 00 01 mvi r2,1 8004e68: 38 63 43 d4 ori r3,r3,0x43d4 8004e6c: b9 60 20 00 mv r4,r11 8004e70: d9 a0 00 00 call r13 if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; 8004e74: 34 03 00 00 mvi r3,0 8004e78: e0 00 00 8c bi 80050a8 <_Heap_Walk+0x4ac> return false; } prev_block = free_block; free_block = free_block->next; 8004e7c: b9 60 80 00 mv r16,r11 8004e80: 29 6b 00 08 lw r11,(r11+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 ) { 8004e84: 5d 6c ff d4 bne r11,r12,8004dd4 <_Heap_Walk+0x1d8> 8004e88: e0 00 00 03 bi 8004e94 <_Heap_Walk+0x298> block->prev_size ); } block = next_block; } while ( block != first_block ); 8004e8c: ba 20 78 00 mv r15,r17 8004e90: e0 00 00 15 bi 8004ee4 <_Heap_Walk+0x2e8> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 8004e94: 78 01 08 01 mvhi r1,0x801 8004e98: 38 21 45 84 ori r1,r1,0x4584 8004e9c: 5b 81 00 54 sw (sp+84),r1 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( 8004ea0: 78 01 08 01 mvhi r1,0x801 8004ea4: 38 21 45 6c ori r1,r1,0x456c 8004ea8: 5b 81 00 58 sw (sp+88),r1 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)( 8004eac: 78 01 08 01 mvhi r1,0x801 8004eb0: 38 21 41 98 ori r1,r1,0x4198 8004eb4: 5b 81 00 5c sw (sp+92),r1 8004eb8: 78 01 08 01 mvhi r1,0x801 8004ebc: 38 21 41 b4 ori r1,r1,0x41b4 8004ec0: 78 1b 08 01 mvhi fp,0x801 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 8004ec4: 78 17 08 01 mvhi r23,0x801 8004ec8: 78 19 08 01 mvhi r25,0x801 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 8004ecc: 78 18 08 01 mvhi r24,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)( 8004ed0: 5b 81 00 60 sw (sp+96),r1 8004ed4: 3b 7b 44 c8 ori fp,fp,0x44c8 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 8004ed8: 3a f7 45 38 ori r23,r23,0x4538 8004edc: 3b 39 41 c4 ori r25,r25,0x41c4 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 8004ee0: 3b 18 41 a8 ori r24,r24,0x41a8 block = next_block; } while ( block != first_block ); return true; } 8004ee4: 29 f2 00 04 lw r18,(r15+4) - 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; 8004ee8: 34 01 ff fe mvi r1,-2 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; 8004eec: 29 84 00 20 lw r4,(r12+32) - 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; 8004ef0: a2 41 80 00 and r16,r18,r1 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); 8004ef4: b5 f0 88 00 add r17,r15,r16 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; 8004ef8: 34 06 00 00 mvi r6,0 8004efc: 54 91 00 03 bgu r4,r17,8004f08 <_Heap_Walk+0x30c> <== NEVER TAKEN 8004f00: 29 86 00 24 lw r6,(r12+36) 8004f04: f0 d1 30 00 cmpgeu r6,r6,r17 bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { 8004f08: 5c c0 00 06 bne r6,r0,8004f20 <_Heap_Walk+0x324> (*printer)( 8004f0c: 78 03 08 01 mvhi r3,0x801 8004f10: b9 c0 08 00 mv r1,r14 8004f14: 34 02 00 01 mvi r2,1 8004f18: 38 63 44 08 ori r3,r3,0x4408 8004f1c: e0 00 00 1f bi 8004f98 <_Heap_Walk+0x39c> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; 8004f20: ba 00 08 00 mv r1,r16 8004f24: ba 60 10 00 mv r2,r19 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); bool const prev_used = _Heap_Is_prev_used( block ); Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; 8004f28: fd f6 58 00 cmpne r11,r15,r22 8004f2c: fb ff ef 13 calli 8000b78 <__umodsi3> ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { 8004f30: 44 20 00 09 be r1,r0,8004f54 <_Heap_Walk+0x358> 8004f34: 45 60 00 08 be r11,r0,8004f54 <_Heap_Walk+0x358> (*printer)( 8004f38: 78 03 08 01 mvhi r3,0x801 8004f3c: b9 c0 08 00 mv r1,r14 8004f40: 34 02 00 01 mvi r2,1 8004f44: 38 63 44 38 ori r3,r3,0x4438 8004f48: b9 e0 20 00 mv r4,r15 8004f4c: ba 00 28 00 mv r5,r16 8004f50: e3 ff ff c8 bi 8004e70 <_Heap_Walk+0x274> ); return false; } if ( block_size < min_block_size && is_not_last_block ) { 8004f54: 52 15 00 0b bgeu r16,r21,8004f80 <_Heap_Walk+0x384> 8004f58: 45 60 00 0a be r11,r0,8004f80 <_Heap_Walk+0x384> <== NEVER TAKEN (*printer)( 8004f5c: 78 03 08 01 mvhi r3,0x801 8004f60: b9 c0 08 00 mv r1,r14 8004f64: 34 02 00 01 mvi r2,1 8004f68: 38 63 44 68 ori r3,r3,0x4468 8004f6c: b9 e0 20 00 mv r4,r15 8004f70: ba 00 28 00 mv r5,r16 8004f74: ba a0 30 00 mv r6,r21 8004f78: d9 a0 00 00 call r13 8004f7c: e3 ff ff be bi 8004e74 <_Heap_Walk+0x278> ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { 8004f80: 56 2f 00 09 bgu r17,r15,8004fa4 <_Heap_Walk+0x3a8> 8004f84: 45 60 00 08 be r11,r0,8004fa4 <_Heap_Walk+0x3a8> (*printer)( 8004f88: 78 03 08 01 mvhi r3,0x801 8004f8c: b9 c0 08 00 mv r1,r14 8004f90: 34 02 00 01 mvi r2,1 8004f94: 38 63 44 94 ori r3,r3,0x4494 8004f98: b9 e0 20 00 mv r4,r15 8004f9c: ba 20 28 00 mv r5,r17 8004fa0: e3 ff ff b4 bi 8004e70 <_Heap_Walk+0x274> 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; 8004fa4: 2a 24 00 04 lw r4,(r17+4) 8004fa8: 22 52 00 01 andi r18,r18,0x1 8004fac: 20 84 00 01 andi r4,r4,0x1 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { 8004fb0: 5c 80 00 2d bne r4,r0,8005064 <_Heap_Walk+0x468> false, "block 0x%08x: size %u, prev 0x%08x%s, next 0x%08x%s\n", block, block_size, block->prev, block->prev == first_free_block ? 8004fb4: 29 e6 00 0c lw r6,(r15+12) 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)( 8004fb8: 29 85 00 08 lw r5,(r12+8) block = next_block; } while ( block != first_block ); return true; } 8004fbc: 29 84 00 0c lw r4,(r12+12) 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)( 8004fc0: 2b 87 00 5c lw r7,(sp+92) 8004fc4: 44 c5 00 04 be r6,r5,8004fd4 <_Heap_Walk+0x3d8> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), 8004fc8: ba e0 38 00 mv r7,r23 8004fcc: 5c cc 00 02 bne r6,r12,8004fd4 <_Heap_Walk+0x3d8> 8004fd0: bb 00 38 00 mv r7,r24 block->next, block->next == last_free_block ? 8004fd4: 29 e8 00 08 lw r8,(r15+8) 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)( 8004fd8: 2b 89 00 60 lw r9,(sp+96) 8004fdc: 45 04 00 04 be r8,r4,8004fec <_Heap_Walk+0x3f0> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") 8004fe0: ba e0 48 00 mv r9,r23 8004fe4: 5d 0c 00 02 bne r8,r12,8004fec <_Heap_Walk+0x3f0> 8004fe8: bb 20 48 00 mv r9,r25 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)( 8004fec: 5b 89 00 04 sw (sp+4),r9 8004ff0: b9 c0 08 00 mv r1,r14 8004ff4: 34 02 00 00 mvi r2,0 8004ff8: bb 60 18 00 mv r3,fp 8004ffc: b9 e0 20 00 mv r4,r15 8005000: ba 00 28 00 mv r5,r16 8005004: d9 a0 00 00 call r13 block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { 8005008: 2a 26 00 00 lw r6,(r17+0) 800500c: 46 06 00 0a be r16,r6,8005034 <_Heap_Walk+0x438> (*printer)( 8005010: 78 03 08 01 mvhi r3,0x801 8005014: b9 c0 08 00 mv r1,r14 8005018: 34 02 00 01 mvi r2,1 800501c: 38 63 45 00 ori r3,r3,0x4500 8005020: b9 e0 20 00 mv r4,r15 8005024: ba 00 28 00 mv r5,r16 8005028: ba 20 38 00 mv r7,r17 800502c: d9 a0 00 00 call r13 8005030: e3 ff ff 91 bi 8004e74 <_Heap_Walk+0x278> ); return false; } if ( !prev_used ) { 8005034: 5e 40 00 06 bne r18,r0,800504c <_Heap_Walk+0x450> (*printer)( 8005038: 78 03 08 01 mvhi r3,0x801 800503c: b9 c0 08 00 mv r1,r14 8005040: 34 02 00 01 mvi r2,1 8005044: 38 63 45 3c ori r3,r3,0x453c 8005048: e0 00 00 30 bi 8005108 <_Heap_Walk+0x50c> block = next_block; } while ( block != first_block ); return true; } 800504c: 29 85 00 08 lw r5,(r12+8) 8005050: e0 00 00 03 bi 800505c <_Heap_Walk+0x460> { 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 ) { 8005054: 44 af 00 13 be r5,r15,80050a0 <_Heap_Walk+0x4a4> return true; } free_block = free_block->next; 8005058: 28 a5 00 08 lw r5,(r5+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 ) { 800505c: 5c ac ff fe bne r5,r12,8005054 <_Heap_Walk+0x458> 8005060: e0 00 00 26 bi 80050f8 <_Heap_Walk+0x4fc> if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { 8005064: 46 40 00 08 be r18,r0,8005084 <_Heap_Walk+0x488> (*printer)( 8005068: 2b 83 00 58 lw r3,(sp+88) 800506c: b9 c0 08 00 mv r1,r14 8005070: 34 02 00 00 mvi r2,0 8005074: b9 e0 20 00 mv r4,r15 8005078: ba 00 28 00 mv r5,r16 800507c: d9 a0 00 00 call r13 8005080: e0 00 00 08 bi 80050a0 <_Heap_Walk+0x4a4> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( 8005084: 2b 83 00 54 lw r3,(sp+84) 8005088: 29 e6 00 00 lw r6,(r15+0) 800508c: b9 c0 08 00 mv r1,r14 8005090: 34 02 00 00 mvi r2,0 8005094: b9 e0 20 00 mv r4,r15 8005098: ba 00 28 00 mv r5,r16 800509c: d9 a0 00 00 call r13 block->prev_size ); } block = next_block; } while ( block != first_block ); 80050a0: 5e 91 ff 7b bne r20,r17,8004e8c <_Heap_Walk+0x290> return true; 80050a4: 34 03 00 01 mvi r3,1 } 80050a8: b8 60 08 00 mv r1,r3 80050ac: 2b 9d 00 10 lw ra,(sp+16) 80050b0: 2b 8b 00 50 lw r11,(sp+80) 80050b4: 2b 8c 00 4c lw r12,(sp+76) 80050b8: 2b 8d 00 48 lw r13,(sp+72) 80050bc: 2b 8e 00 44 lw r14,(sp+68) 80050c0: 2b 8f 00 40 lw r15,(sp+64) 80050c4: 2b 90 00 3c lw r16,(sp+60) 80050c8: 2b 91 00 38 lw r17,(sp+56) 80050cc: 2b 92 00 34 lw r18,(sp+52) 80050d0: 2b 93 00 30 lw r19,(sp+48) 80050d4: 2b 94 00 2c lw r20,(sp+44) 80050d8: 2b 95 00 28 lw r21,(sp+40) 80050dc: 2b 96 00 24 lw r22,(sp+36) 80050e0: 2b 97 00 20 lw r23,(sp+32) 80050e4: 2b 98 00 1c lw r24,(sp+28) 80050e8: 2b 99 00 18 lw r25,(sp+24) 80050ec: 2b 9b 00 14 lw fp,(sp+20) 80050f0: 37 9c 00 60 addi sp,sp,96 80050f4: c3 a0 00 00 ret return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( 80050f8: 78 03 08 01 mvhi r3,0x801 80050fc: b9 c0 08 00 mv r1,r14 8005100: 34 02 00 01 mvi r2,1 8005104: 38 63 45 ac ori r3,r3,0x45ac 8005108: b9 e0 20 00 mv r4,r15 800510c: d9 a0 00 00 call r13 8005110: e3 ff ff 59 bi 8004e74 <_Heap_Walk+0x278> =============================================================================== 08004508 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { 8004508: 37 9c ff e8 addi sp,sp,-24 800450c: 5b 8b 00 18 sw (sp+24),r11 8004510: 5b 8c 00 14 sw (sp+20),r12 8004514: 5b 8d 00 10 sw (sp+16),r13 8004518: 5b 8e 00 0c sw (sp+12),r14 800451c: 5b 8f 00 08 sw (sp+8),r15 8004520: 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; 8004524: 78 01 08 01 mvhi r1,0x801 8004528: 38 21 90 ac ori r1,r1,0x90ac drivers_in_table = Configuration.number_of_device_drivers; 800452c: 28 2d 00 34 lw r13,(r1+52) number_of_drivers = Configuration.maximum_drivers; 8004530: 28 2b 00 30 lw r11,(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; 8004534: 28 2e 00 38 lw r14,(r1+56) /* * 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 ) 8004538: 51 ab 00 03 bgeu r13,r11,8004544 <_IO_Manager_initialization+0x3c> /* * 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 ) { 800453c: 5d 6d 00 0a bne r11,r13,8004564 <_IO_Manager_initialization+0x5c><== ALWAYS TAKEN 8004540: e0 00 00 02 bi 8004548 <_IO_Manager_initialization+0x40> <== NOT EXECUTED /* * 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 ) 8004544: b9 a0 58 00 mv r11,r13 * 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; 8004548: 78 01 08 01 mvhi r1,0x801 800454c: 38 21 a2 9c ori r1,r1,0xa29c 8004550: 58 2e 00 00 sw (r1+0),r14 _IO_Number_of_drivers = number_of_drivers; 8004554: 78 01 08 01 mvhi r1,0x801 8004558: 38 21 a2 98 ori r1,r1,0xa298 800455c: 58 2b 00 00 sw (r1+0),r11 return; 8004560: e0 00 00 27 bi 80045fc <_IO_Manager_initialization+0xf4> * 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 ) 8004564: 34 02 00 01 mvi r2,1 8004568: b9 60 08 00 mv r1,r11 800456c: f8 00 4a 74 calli 8016f3c <__ashlsi3> 8004570: 34 02 00 03 mvi r2,3 8004574: b4 2b 08 00 add r1,r1,r11 8004578: f8 00 4a 71 calli 8016f3c <__ashlsi3> 800457c: b8 20 78 00 mv r15,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 *) _Workspace_Allocate_or_fatal_error( 8004580: f8 00 0e 01 calli 8007d84 <_Workspace_Allocate_or_fatal_error> sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 8004584: 78 02 08 01 mvhi r2,0x801 8004588: 38 42 a2 98 ori r2,r2,0xa298 /* * 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 *) 800458c: 78 0c 08 01 mvhi r12,0x801 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; 8004590: 58 4b 00 00 sw (r2+0),r11 memset( 8004594: b9 e0 18 00 mv r3,r15 /* * 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 *) 8004598: 39 8c a2 9c ori r12,r12,0xa29c _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 800459c: 34 02 00 00 mvi r2,0 /* * 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 *) 80045a0: 59 81 00 00 sw (r12+0),r1 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( 80045a4: f8 00 36 b5 calli 8012078 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 80045a8: 34 03 00 00 mvi r3,0 80045ac: 34 04 00 00 mvi r4,0 80045b0: e0 00 00 12 bi 80045f8 <_IO_Manager_initialization+0xf0> _IO_Driver_address_table[index] = driver_table[index]; 80045b4: 29 82 00 00 lw r2,(r12+0) * registration. The driver table is now allocated in the * workspace. * */ void _IO_Manager_initialization(void) 80045b8: b5 c3 08 00 add r1,r14,r3 _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]; 80045bc: 28 29 00 00 lw r9,(r1+0) 80045c0: 28 28 00 04 lw r8,(r1+4) 80045c4: 28 27 00 08 lw r7,(r1+8) 80045c8: 28 26 00 0c lw r6,(r1+12) 80045cc: 28 25 00 10 lw r5,(r1+16) 80045d0: 28 21 00 14 lw r1,(r1+20) 80045d4: b4 43 10 00 add r2,r2,r3 80045d8: 58 49 00 00 sw (r2+0),r9 80045dc: 58 48 00 04 sw (r2+4),r8 80045e0: 58 47 00 08 sw (r2+8),r7 80045e4: 58 46 00 0c sw (r2+12),r6 80045e8: 58 45 00 10 sw (r2+16),r5 80045ec: 58 41 00 14 sw (r2+20),r1 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) 80045f0: 34 84 00 01 addi r4,r4,1 80045f4: 34 63 00 18 addi r3,r3,24 80045f8: 55 a4 ff ef bgu r13,r4,80045b4 <_IO_Manager_initialization+0xac> _IO_Driver_address_table[index] = driver_table[index]; } 80045fc: 2b 9d 00 04 lw ra,(sp+4) 8004600: 2b 8b 00 18 lw r11,(sp+24) 8004604: 2b 8c 00 14 lw r12,(sp+20) 8004608: 2b 8d 00 10 lw r13,(sp+16) 800460c: 2b 8e 00 0c lw r14,(sp+12) 8004610: 2b 8f 00 08 lw r15,(sp+8) 8004614: 37 9c 00 18 addi sp,sp,24 8004618: c3 a0 00 00 ret =============================================================================== 08005664 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { 8005664: 37 9c ff ec addi sp,sp,-20 8005668: 5b 8b 00 14 sw (sp+20),r11 800566c: 5b 8c 00 10 sw (sp+16),r12 8005670: 5b 8d 00 0c sw (sp+12),r13 8005674: 5b 8e 00 08 sw (sp+8),r14 8005678: 5b 9d 00 04 sw (sp+4),ra 800567c: 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 ) 8005680: 28 21 00 18 lw r1,(r1+24) return NULL; 8005684: 34 0c 00 00 mvi r12,0 * 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 ) 8005688: 44 20 00 1e be r1,r0,8005700 <_Objects_Allocate+0x9c> <== 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 ); 800568c: 35 6d 00 20 addi r13,r11,32 8005690: b9 a0 08 00 mv r1,r13 8005694: fb ff fd 3d calli 8004b88 <_Chain_Get> 8005698: b8 20 60 00 mv r12,r1 800569c: b8 20 70 00 mv r14,r1 if ( information->auto_extend ) { 80056a0: 41 61 00 12 lbu r1,(r11+18) 80056a4: 44 20 00 17 be r1,r0,8005700 <_Objects_Allocate+0x9c> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { 80056a8: 5d 80 00 07 bne r12,r0,80056c4 <_Objects_Allocate+0x60> _Objects_Extend_information( information ); 80056ac: b9 60 08 00 mv r1,r11 80056b0: f8 00 00 32 calli 8005778 <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); 80056b4: b9 a0 08 00 mv r1,r13 80056b8: fb ff fd 34 calli 8004b88 <_Chain_Get> 80056bc: b8 20 60 00 mv r12,r1 } if ( the_object ) { 80056c0: 44 2e 00 10 be r1,r14,8005700 <_Objects_Allocate+0x9c> uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - 80056c4: 2d 82 00 0a lhu r2,(r12+10) 80056c8: 2d 61 00 0a lhu r1,(r11+10) _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; 80056cc: c8 41 08 00 sub r1,r2,r1 80056d0: 2d 62 00 14 lhu r2,(r11+20) 80056d4: f8 00 46 f4 calli 80172a4 <__udivsi3> information->inactive_per_block[ block ]--; 80056d8: 34 02 00 02 mvi r2,2 80056dc: f8 00 46 18 calli 8016f3c <__ashlsi3> 80056e0: 29 62 00 30 lw r2,(r11+48) 80056e4: b4 41 08 00 add r1,r2,r1 80056e8: 28 22 00 00 lw r2,(r1+0) 80056ec: 34 42 ff ff addi r2,r2,-1 80056f0: 58 22 00 00 sw (r1+0),r2 information->inactive--; 80056f4: 2d 61 00 2c lhu r1,(r11+44) 80056f8: 34 21 ff ff addi r1,r1,-1 80056fc: 0d 61 00 2c sh (r11+44),r1 ); } #endif return the_object; } 8005700: b9 80 08 00 mv r1,r12 8005704: 2b 9d 00 04 lw ra,(sp+4) 8005708: 2b 8b 00 14 lw r11,(sp+20) 800570c: 2b 8c 00 10 lw r12,(sp+16) 8005710: 2b 8d 00 0c lw r13,(sp+12) 8005714: 2b 8e 00 08 lw r14,(sp+8) 8005718: 37 9c 00 14 addi sp,sp,20 800571c: c3 a0 00 00 ret =============================================================================== 0800ed84 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { 800ed84: 37 9c ff ec addi sp,sp,-20 800ed88: 5b 8b 00 14 sw (sp+20),r11 800ed8c: 5b 8c 00 10 sw (sp+16),r12 800ed90: 5b 8d 00 0c sw (sp+12),r13 800ed94: 5b 8e 00 08 sw (sp+8),r14 800ed98: 5b 9d 00 04 sw (sp+4),ra 800ed9c: 20 4c ff ff andi r12,r2,0xffff 800eda0: b8 20 70 00 mv r14,r1 Objects_Information *info; int the_class_api_maximum; if ( !the_class ) return NULL; 800eda4: 34 0b 00 00 mvi r11,0 ) { Objects_Information *info; int the_class_api_maximum; if ( !the_class ) 800eda8: 45 80 00 16 be r12,r0,800ee00 <_Objects_Get_information+0x7c> /* * 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 ); 800edac: f8 00 09 09 calli 80111d0 <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) 800edb0: 44 20 00 14 be r1,r0,800ee00 <_Objects_Get_information+0x7c> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) 800edb4: 55 81 00 13 bgu r12,r1,800ee00 <_Objects_Get_information+0x7c> return NULL; if ( !_Objects_Information_table[ the_api ] ) 800edb8: 78 0d 08 01 mvhi r13,0x801 800edbc: b9 c0 08 00 mv r1,r14 800edc0: 34 02 00 02 mvi r2,2 800edc4: 39 ad 98 fc ori r13,r13,0x98fc 800edc8: f8 00 20 5d calli 8016f3c <__ashlsi3> 800edcc: b5 a1 08 00 add r1,r13,r1 800edd0: 28 2d 00 00 lw r13,(r1+0) 800edd4: 45 a0 00 0b be r13,r0,800ee00 <_Objects_Get_information+0x7c><== NEVER TAKEN return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; 800edd8: b9 80 08 00 mv r1,r12 800eddc: 34 02 00 02 mvi r2,2 800ede0: f8 00 20 57 calli 8016f3c <__ashlsi3> 800ede4: b5 a1 08 00 add r1,r13,r1 800ede8: 28 2b 00 00 lw r11,(r1+0) if ( !info ) 800edec: 45 60 00 05 be r11,r0,800ee00 <_Objects_Get_information+0x7c><== 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 ) 800edf0: 2d 61 00 10 lhu r1,(r11+16) return NULL; 800edf4: 7c 21 00 00 cmpnei r1,r1,0 800edf8: c8 01 08 00 sub r1,r0,r1 800edfc: a1 61 58 00 and r11,r11,r1 #endif return info; } 800ee00: b9 60 08 00 mv r1,r11 800ee04: 2b 9d 00 04 lw ra,(sp+4) 800ee08: 2b 8b 00 14 lw r11,(sp+20) 800ee0c: 2b 8c 00 10 lw r12,(sp+16) 800ee10: 2b 8d 00 0c lw r13,(sp+12) 800ee14: 2b 8e 00 08 lw r14,(sp+8) 800ee18: 37 9c 00 14 addi sp,sp,20 800ee1c: c3 a0 00 00 ret =============================================================================== 08017898 <_Objects_Get_no_protection>: Objects_Control *_Objects_Get_no_protection( Objects_Information *information, Objects_Id id, Objects_Locations *location ) { 8017898: 37 9c ff f4 addi sp,sp,-12 801789c: 5b 8b 00 0c sw (sp+12),r11 80178a0: 5b 8c 00 08 sw (sp+8),r12 80178a4: 5b 9d 00 04 sw (sp+4),ra 80178a8: 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; 80178ac: 28 21 00 08 lw r1,(r1+8) Objects_Control *_Objects_Get_no_protection( Objects_Information *information, Objects_Id id, Objects_Locations *location ) { 80178b0: 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; 80178b4: c8 41 08 00 sub r1,r2,r1 if ( information->maximum >= index ) { 80178b8: 2c 82 00 10 lhu r2,(r4+16) /* * 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; 80178bc: 34 21 00 01 addi r1,r1,1 if ( information->maximum >= index ) { 80178c0: 54 22 00 09 bgu r1,r2,80178e4 <_Objects_Get_no_protection+0x4c> if ( (the_object = information->local_table[ index ]) != NULL ) { 80178c4: 28 8c 00 1c lw r12,(r4+28) 80178c8: 34 02 00 02 mvi r2,2 80178cc: fb ff d9 62 calli 800de54 <__ashlsi3> 80178d0: b5 81 08 00 add r1,r12,r1 80178d4: 28 21 00 00 lw r1,(r1+0) 80178d8: 44 20 00 03 be r1,r0,80178e4 <_Objects_Get_no_protection+0x4c><== NEVER TAKEN *location = OBJECTS_LOCAL; 80178dc: 59 60 00 00 sw (r11+0),r0 return the_object; 80178e0: e0 00 00 04 bi 80178f0 <_Objects_Get_no_protection+0x58> /* * This isn't supported or required yet for Global objects so * if it isn't local, we don't find it. */ *location = OBJECTS_ERROR; 80178e4: 34 01 00 01 mvi r1,1 80178e8: 59 61 00 00 sw (r11+0),r1 return NULL; 80178ec: 34 01 00 00 mvi r1,0 } 80178f0: 2b 9d 00 04 lw ra,(sp+4) 80178f4: 2b 8b 00 0c lw r11,(sp+12) 80178f8: 2b 8c 00 08 lw r12,(sp+8) 80178fc: 37 9c 00 0c addi sp,sp,12 8017900: c3 a0 00 00 ret =============================================================================== 08006260 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { 8006260: 37 9c ff e8 addi sp,sp,-24 8006264: 5b 8b 00 14 sw (sp+20),r11 8006268: 5b 8c 00 10 sw (sp+16),r12 800626c: 5b 8d 00 0c sw (sp+12),r13 8006270: 5b 8e 00 08 sw (sp+8),r14 8006274: 5b 9d 00 04 sw (sp+4),ra 8006278: b8 40 70 00 mv r14,r2 /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; 800627c: b8 20 58 00 mv r11,r1 8006280: 5c 20 00 05 bne r1,r0,8006294 <_Objects_Id_to_name+0x34> 8006284: 78 01 08 02 mvhi r1,0x802 8006288: 38 21 0d fc ori r1,r1,0xdfc 800628c: 28 21 00 0c lw r1,(r1+12) 8006290: 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); 8006294: 34 02 00 18 mvi r2,24 8006298: b9 60 08 00 mv r1,r11 800629c: f8 00 58 9f calli 801c518 <__lshrsi3> 80062a0: 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 ) 80062a4: 34 23 ff ff addi r3,r1,-1 80062a8: 34 02 00 02 mvi r2,2 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; 80062ac: 34 0d 00 03 mvi r13,3 80062b0: 54 62 00 14 bgu r3,r2,8006300 <_Objects_Id_to_name+0xa0> 80062b4: e0 00 00 1b bi 8006320 <_Objects_Id_to_name+0xc0> */ RTEMS_INLINE_ROUTINE uint32_t _Objects_Get_class( Objects_Id id ) { return (uint32_t) 80062b8: 34 02 00 1b mvi r2,27 80062bc: b9 60 08 00 mv r1,r11 80062c0: f8 00 58 96 calli 801c518 <__lshrsi3> if ( !_Objects_Information_table[ the_api ] ) return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; 80062c4: 34 02 00 02 mvi r2,2 80062c8: fb ff ec dd calli 800163c <__ashlsi3> 80062cc: b5 81 08 00 add r1,r12,r1 80062d0: 28 21 00 00 lw r1,(r1+0) if ( !information ) 80062d4: 44 20 00 0b be r1,r0,8006300 <_Objects_Id_to_name+0xa0> <== NEVER TAKEN return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) 80062d8: 40 2c 00 38 lbu r12,(r1+56) 80062dc: 5d 80 00 09 bne r12,r0,8006300 <_Objects_Id_to_name+0xa0> <== NEVER TAKEN return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); 80062e0: b9 60 10 00 mv r2,r11 80062e4: 37 83 00 18 addi r3,sp,24 80062e8: fb ff ff b8 calli 80061c8 <_Objects_Get> if ( !the_object ) 80062ec: 44 2c 00 05 be r1,r12,8006300 <_Objects_Id_to_name+0xa0> return OBJECTS_INVALID_ID; *name = the_object->name; 80062f0: 28 21 00 0c lw r1,(r1+12) _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; 80062f4: 34 0d 00 00 mvi r13,0 the_object = _Objects_Get( information, tmpId, &ignored_location ); if ( !the_object ) return OBJECTS_INVALID_ID; *name = the_object->name; 80062f8: 59 c1 00 00 sw (r14+0),r1 _Thread_Enable_dispatch(); 80062fc: f8 00 03 65 calli 8007090 <_Thread_Enable_dispatch> return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } 8006300: b9 a0 08 00 mv r1,r13 8006304: 2b 9d 00 04 lw ra,(sp+4) 8006308: 2b 8b 00 14 lw r11,(sp+20) 800630c: 2b 8c 00 10 lw r12,(sp+16) 8006310: 2b 8d 00 0c lw r13,(sp+12) 8006314: 2b 8e 00 08 lw r14,(sp+8) 8006318: 37 9c 00 18 addi sp,sp,24 800631c: 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 ] ) 8006320: 78 0c 08 02 mvhi r12,0x802 8006324: 34 02 00 02 mvi r2,2 8006328: 39 8c 08 cc ori r12,r12,0x8cc 800632c: fb ff ec c4 calli 800163c <__ashlsi3> 8006330: b5 81 08 00 add r1,r12,r1 8006334: 28 2c 00 00 lw r12,(r1+0) 8006338: 5d 80 ff e0 bne r12,r0,80062b8 <_Objects_Id_to_name+0x58> 800633c: e3 ff ff f1 bi 8006300 <_Objects_Id_to_name+0xa0> =============================================================================== 08005c90 <_Objects_Initialize_information>: , bool supports_global, Objects_Thread_queue_Extract_callout extract #endif ) { 8005c90: 37 9c ff e4 addi sp,sp,-28 8005c94: 5b 8b 00 1c sw (sp+28),r11 8005c98: 5b 8c 00 18 sw (sp+24),r12 8005c9c: 5b 8d 00 14 sw (sp+20),r13 8005ca0: 5b 8e 00 10 sw (sp+16),r14 8005ca4: 5b 8f 00 0c sw (sp+12),r15 8005ca8: 5b 90 00 08 sw (sp+8),r16 8005cac: 5b 9d 00 04 sw (sp+4),ra 8005cb0: 20 6d ff ff andi r13,r3,0xffff 8005cb4: b8 20 58 00 mv r11,r1 8005cb8: 20 a5 ff ff andi r5,r5,0xffff uint32_t index; #endif information->the_api = the_api; information->the_class = the_class; information->size = size; 8005cbc: 58 25 00 18 sw (r1+24),r5 information->local_table = 0; information->inactive_per_block = 0; information->object_blocks = 0; information->inactive = 0; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) information->is_string = is_string; 8005cc0: 30 26 00 38 sb (r1+56),r6 uint32_t maximum_per_allocation; #if defined(RTEMS_MULTIPROCESSING) uint32_t index; #endif information->the_api = the_api; 8005cc4: 59 62 00 00 sw (r11+0),r2 information->the_class = the_class; 8005cc8: 0c 2d 00 04 sh (r1+4),r13 information->size = size; information->local_table = 0; 8005ccc: 58 20 00 1c sw (r1+28),r0 information->inactive_per_block = 0; 8005cd0: 58 20 00 30 sw (r1+48),r0 information->object_blocks = 0; 8005cd4: 58 20 00 34 sw (r1+52),r0 information->inactive = 0; 8005cd8: 0c 20 00 2c sh (r1+44),r0 /* * Set the maximum value to 0. It will be updated when objects are * added to the inactive set from _Objects_Extend_information() */ information->maximum = 0; 8005cdc: 0c 20 00 10 sh (r1+16),r0 , bool supports_global, Objects_Thread_queue_Extract_callout extract #endif ) { 8005ce0: b8 40 70 00 mv r14,r2 information->maximum = 0; /* * Register this Object Class in the Object Information Table. */ _Objects_Information_table[ the_api ][ the_class ] = information; 8005ce4: b8 40 08 00 mv r1,r2 8005ce8: 78 0f 08 01 mvhi r15,0x801 8005cec: 34 02 00 02 mvi r2,2 , bool supports_global, Objects_Thread_queue_Extract_callout extract #endif ) { 8005cf0: b8 80 60 00 mv r12,r4 8005cf4: b8 e0 80 00 mv r16,r7 information->maximum = 0; /* * Register this Object Class in the Object Information Table. */ _Objects_Information_table[ the_api ][ the_class ] = information; 8005cf8: 39 ef 98 fc ori r15,r15,0x98fc 8005cfc: f8 00 44 90 calli 8016f3c <__ashlsi3> 8005d00: b5 e1 08 00 add r1,r15,r1 8005d04: 28 2f 00 00 lw r15,(r1+0) 8005d08: 34 02 00 02 mvi r2,2 8005d0c: b9 a0 08 00 mv r1,r13 8005d10: f8 00 44 8b calli 8016f3c <__ashlsi3> 8005d14: b5 e1 08 00 add r1,r15,r1 8005d18: 58 2b 00 00 sw (r1+0),r11 /* * Are we operating in limited or unlimited (e.g. auto-extend) mode. */ information->auto_extend = (maximum & OBJECTS_UNLIMITED_OBJECTS) ? true : false; 8005d1c: 34 02 00 1f mvi r2,31 8005d20: b9 80 08 00 mv r1,r12 8005d24: f8 00 44 d4 calli 8017074 <__lshrsi3> maximum_per_allocation = maximum & ~OBJECTS_UNLIMITED_OBJECTS; 8005d28: 78 03 08 01 mvhi r3,0x801 8005d2c: 38 63 81 b0 ori r3,r3,0x81b0 /* * Are we operating in limited or unlimited (e.g. auto-extend) mode. */ information->auto_extend = (maximum & OBJECTS_UNLIMITED_OBJECTS) ? true : false; 8005d30: 20 22 00 ff andi r2,r1,0xff maximum_per_allocation = maximum & ~OBJECTS_UNLIMITED_OBJECTS; 8005d34: 28 61 00 00 lw r1,(r3+0) _Objects_Information_table[ the_api ][ the_class ] = information; /* * Are we operating in limited or unlimited (e.g. auto-extend) mode. */ information->auto_extend = 8005d38: 31 62 00 12 sb (r11+18),r2 (maximum & OBJECTS_UNLIMITED_OBJECTS) ? true : false; maximum_per_allocation = maximum & ~OBJECTS_UNLIMITED_OBJECTS; 8005d3c: a1 81 60 00 and r12,r12,r1 /* * Unlimited and maximum of zero is illogical. */ if ( information->auto_extend && maximum_per_allocation == 0) { 8005d40: 44 40 00 06 be r2,r0,8005d58 <_Objects_Initialize_information+0xc8> 8005d44: 5d 80 00 05 bne r12,r0,8005d58 <_Objects_Initialize_information+0xc8><== ALWAYS TAKEN _Internal_error_Occurred( 8005d48: 34 01 00 00 mvi r1,0 <== NOT EXECUTED 8005d4c: 34 02 00 01 mvi r2,1 <== NOT EXECUTED 8005d50: 34 03 00 13 mvi r3,19 <== NOT EXECUTED 8005d54: fb ff fe 13 calli 80055a0 <_Internal_error_Occurred> <== NOT EXECUTED information->allocation_size = maximum_per_allocation; /* * Provide a null local table entry for the case of any empty table. */ information->local_table = &null_local_table; 8005d58: 78 01 08 01 mvhi r1,0x801 8005d5c: 38 21 97 24 ori r1,r1,0x9724 8005d60: 59 61 00 1c sw (r11+28),r1 8005d64: 34 02 00 18 mvi r2,24 8005d68: b9 c0 08 00 mv r1,r14 } /* * The allocation unit is the maximum value */ information->allocation_size = maximum_per_allocation; 8005d6c: 0d 6c 00 14 sh (r11+20),r12 8005d70: f8 00 44 73 calli 8016f3c <__ashlsi3> 8005d74: 78 0e 00 01 mvhi r14,0x1 8005d78: b8 2e 70 00 or r14,r1,r14 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | 8005d7c: 34 02 00 1b mvi r2,27 8005d80: b9 a0 08 00 mv r1,r13 8005d84: f8 00 44 6e calli 8016f3c <__ashlsi3> information->local_table = &null_local_table; /* * Calculate minimum and maximum Id's */ minimum_index = (maximum_per_allocation == 0) ? 0 : 1; 8005d88: 7d 82 00 00 cmpnei r2,r12,0 8005d8c: b9 c1 08 00 or r1,r14,r1 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | 8005d90: b8 22 08 00 or r1,r1,r2 information->minimum_id = 8005d94: 59 61 00 08 sw (r11+8),r1 /* * Calculate the maximum name length */ name_length = maximum_name_length; if ( name_length & (OBJECTS_NAME_ALIGNMENT-1) ) 8005d98: 22 01 00 03 andi r1,r16,0x3 8005d9c: ba 00 38 00 mv r7,r16 8005da0: 44 20 00 04 be r1,r0,8005db0 <_Objects_Initialize_information+0x120> name_length = (name_length + OBJECTS_NAME_ALIGNMENT) & 8005da4: 36 07 00 04 addi r7,r16,4 8005da8: 34 01 ff fc mvi r1,-4 8005dac: a0 e1 38 00 and r7,r7,r1 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 8005db0: 35 61 00 24 addi r1,r11,36 head->next = tail; 8005db4: 59 61 00 20 sw (r11+32),r1 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 8005db8: 35 61 00 20 addi r1,r11,32 ~(OBJECTS_NAME_ALIGNMENT-1); information->name_length = name_length; 8005dbc: 0d 67 00 3a sh (r11+58),r7 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 8005dc0: 59 60 00 24 sw (r11+36),r0 tail->previous = head; 8005dc4: 59 61 00 28 sw (r11+40),r1 _Chain_Initialize_empty( &information->Inactive ); /* * Initialize objects .. if there are any */ if ( maximum_per_allocation ) { 8005dc8: 45 80 00 03 be r12,r0,8005dd4 <_Objects_Initialize_information+0x144> /* * Always have the maximum size available so the current performance * figures are create are met. If the user moves past the maximum * number then a performance hit is taken. */ _Objects_Extend_information( information ); 8005dcc: b9 60 08 00 mv r1,r11 8005dd0: fb ff fe 6a calli 8005778 <_Objects_Extend_information> _Chain_Initialize_empty( &information->global_table[ index ] ); } else information->global_table = NULL; #endif } 8005dd4: 2b 9d 00 04 lw ra,(sp+4) 8005dd8: 2b 8b 00 1c lw r11,(sp+28) 8005ddc: 2b 8c 00 18 lw r12,(sp+24) 8005de0: 2b 8d 00 14 lw r13,(sp+20) 8005de4: 2b 8e 00 10 lw r14,(sp+16) 8005de8: 2b 8f 00 0c lw r15,(sp+12) 8005dec: 2b 90 00 08 lw r16,(sp+8) 8005df0: 37 9c 00 1c addi sp,sp,28 8005df4: c3 a0 00 00 ret =============================================================================== 08004e60 <_Objects_Set_name>: bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 8004e60: 37 9c ff ec addi sp,sp,-20 8004e64: 5b 8b 00 14 sw (sp+20),r11 8004e68: 5b 8c 00 10 sw (sp+16),r12 8004e6c: 5b 8d 00 0c sw (sp+12),r13 8004e70: 5b 8e 00 08 sw (sp+8),r14 8004e74: 5b 9d 00 04 sw (sp+4),ra 8004e78: b8 20 70 00 mv r14,r1 8004e7c: b8 40 68 00 mv r13,r2 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 8004e80: 2d c2 00 3a lhu r2,(r14+58) 8004e84: b8 60 08 00 mv r1,r3 bool _Objects_Set_name( Objects_Information *information, Objects_Control *the_object, const char *name ) { 8004e88: b8 60 58 00 mv r11,r3 size_t length; const char *s; s = name; length = strnlen( name, information->name_length ); 8004e8c: f8 00 27 4d calli 800ebc0 8004e90: b8 20 60 00 mv r12,r1 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { 8004e94: 41 c1 00 38 lbu r1,(r14+56) 8004e98: 44 20 00 12 be r1,r0,8004ee0 <_Objects_Set_name+0x80> <== NEVER TAKEN char *d; d = _Workspace_Allocate( length + 1 ); 8004e9c: 35 81 00 01 addi r1,r12,1 8004ea0: f8 00 07 cf calli 8006ddc <_Workspace_Allocate> 8004ea4: b8 20 70 00 mv r14,r1 if ( !d ) return false; 8004ea8: 34 03 00 00 mvi r3,0 #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { char *d; d = _Workspace_Allocate( length + 1 ); if ( !d ) 8004eac: 44 20 00 26 be r1,r0,8004f44 <_Objects_Set_name+0xe4> return false; if ( the_object->name.name_p ) { 8004eb0: 29 a1 00 0c lw r1,(r13+12) 8004eb4: 44 20 00 03 be r1,r0,8004ec0 <_Objects_Set_name+0x60> _Workspace_Free( (void *)the_object->name.name_p ); 8004eb8: f8 00 07 d4 calli 8006e08 <_Workspace_Free> the_object->name.name_p = NULL; 8004ebc: 59 a0 00 0c sw (r13+12),r0 } strncpy( d, name, length ); 8004ec0: b9 80 18 00 mv r3,r12 8004ec4: b9 c0 08 00 mv r1,r14 8004ec8: b9 60 10 00 mv r2,r11 d[length] = '\0'; 8004ecc: b5 cc 60 00 add r12,r14,r12 if ( the_object->name.name_p ) { _Workspace_Free( (void *)the_object->name.name_p ); the_object->name.name_p = NULL; } strncpy( d, name, length ); 8004ed0: f8 00 27 09 calli 800eaf4 d[length] = '\0'; 8004ed4: 31 80 00 00 sb (r12+0),r0 the_object->name.name_p = d; 8004ed8: 59 ae 00 0c sw (r13+12),r14 8004edc: e0 00 00 19 bi 8004f40 <_Objects_Set_name+0xe0> } else #endif { the_object->name.name_u32 = _Objects_Build_name( 8004ee0: 41 61 00 00 lbu r1,(r11+0) 8004ee4: 34 02 00 18 mvi r2,24 8004ee8: f8 00 59 24 calli 801b378 <__ashlsi3> 8004eec: 34 02 00 01 mvi r2,1 8004ef0: b8 20 70 00 mv r14,r1 8004ef4: 78 01 00 20 mvhi r1,0x20 8004ef8: 50 4c 00 04 bgeu r2,r12,8004f08 <_Objects_Set_name+0xa8> 8004efc: 41 61 00 01 lbu r1,(r11+1) 8004f00: 34 02 00 10 mvi r2,16 8004f04: f8 00 59 1d calli 801b378 <__ashlsi3> 8004f08: 34 02 00 02 mvi r2,2 8004f0c: b8 2e 70 00 or r14,r1,r14 8004f10: 34 01 20 00 mvi r1,8192 8004f14: 50 4c 00 04 bgeu r2,r12,8004f24 <_Objects_Set_name+0xc4> 8004f18: 41 61 00 02 lbu r1,(r11+2) 8004f1c: 34 02 00 08 mvi r2,8 8004f20: f8 00 59 16 calli 801b378 <__ashlsi3> 8004f24: 34 03 00 03 mvi r3,3 8004f28: b9 c1 08 00 or r1,r14,r1 8004f2c: 34 02 00 20 mvi r2,32 8004f30: 50 6c 00 02 bgeu r3,r12,8004f38 <_Objects_Set_name+0xd8> 8004f34: 41 62 00 03 lbu r2,(r11+3) 8004f38: b8 22 10 00 or r2,r1,r2 8004f3c: 59 a2 00 0c sw (r13+12),r2 ((3 < length) ? s[ 3 ] : ' ') ); } return true; 8004f40: 34 03 00 01 mvi r3,1 } 8004f44: b8 60 08 00 mv r1,r3 8004f48: 2b 9d 00 04 lw ra,(sp+4) 8004f4c: 2b 8b 00 14 lw r11,(sp+20) 8004f50: 2b 8c 00 10 lw r12,(sp+16) 8004f54: 2b 8d 00 0c lw r13,(sp+12) 8004f58: 2b 8e 00 08 lw r14,(sp+8) 8004f5c: 37 9c 00 14 addi sp,sp,20 8004f60: c3 a0 00 00 ret =============================================================================== 08003f54 <_POSIX_Condition_variables_Wait_support>: pthread_cond_t *cond, pthread_mutex_t *mutex, Watchdog_Interval timeout, bool already_timedout ) { 8003f54: 37 9c ff e0 addi sp,sp,-32 8003f58: 5b 8b 00 1c sw (sp+28),r11 8003f5c: 5b 8c 00 18 sw (sp+24),r12 8003f60: 5b 8d 00 14 sw (sp+20),r13 8003f64: 5b 8e 00 10 sw (sp+16),r14 8003f68: 5b 8f 00 0c sw (sp+12),r15 8003f6c: 5b 90 00 08 sw (sp+8),r16 8003f70: 5b 9d 00 04 sw (sp+4),ra 8003f74: b8 20 70 00 mv r14,r1 8003f78: b8 40 60 00 mv r12,r2 register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 8003f7c: b8 40 08 00 mv r1,r2 8003f80: 37 82 00 20 addi r2,sp,32 pthread_cond_t *cond, pthread_mutex_t *mutex, Watchdog_Interval timeout, bool already_timedout ) { 8003f84: b8 60 78 00 mv r15,r3 8003f88: 20 90 00 ff andi r16,r4,0xff register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 8003f8c: f8 00 00 62 calli 8004114 <_POSIX_Mutex_Get> return EINVAL; 8003f90: 34 0b 00 16 mvi r11,22 register POSIX_Condition_variables_Control *the_cond; Objects_Locations location; int status; int mutex_status; if ( !_POSIX_Mutex_Get( mutex, &location ) ) { 8003f94: 44 20 00 33 be r1,r0,8004060 <_POSIX_Condition_variables_Wait_support+0x10c><== NEVER TAKEN */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 8003f98: 78 05 08 01 mvhi r5,0x801 8003f9c: 38 a5 78 a8 ori r5,r5,0x78a8 8003fa0: 28 a1 00 00 lw r1,(r5+0) return EINVAL; } _Thread_Unnest_dispatch(); the_cond = _POSIX_Condition_variables_Get( cond, &location ); 8003fa4: 37 82 00 20 addi r2,sp,32 8003fa8: 34 21 ff ff addi r1,r1,-1 8003fac: 58 a1 00 00 sw (r5+0),r1 8003fb0: b9 c0 08 00 mv r1,r14 8003fb4: fb ff ff 4d calli 8003ce8 <_POSIX_Condition_variables_Get> switch ( location ) { 8003fb8: 2b 85 00 20 lw r5,(sp+32) return EINVAL; } _Thread_Unnest_dispatch(); the_cond = _POSIX_Condition_variables_Get( cond, &location ); 8003fbc: b8 20 68 00 mv r13,r1 switch ( location ) { 8003fc0: 5c a0 00 28 bne r5,r0,8004060 <_POSIX_Condition_variables_Wait_support+0x10c><== NEVER TAKEN case OBJECTS_LOCAL: if ( the_cond->Mutex && ( the_cond->Mutex != *mutex ) ) { 8003fc4: 28 21 00 14 lw r1,(r1+20) 8003fc8: 44 25 00 05 be r1,r5,8003fdc <_POSIX_Condition_variables_Wait_support+0x88> 8003fcc: 29 82 00 00 lw r2,(r12+0) 8003fd0: 44 22 00 03 be r1,r2,8003fdc <_POSIX_Condition_variables_Wait_support+0x88> _Thread_Enable_dispatch(); 8003fd4: f8 00 0d f1 calli 8007798 <_Thread_Enable_dispatch> return EINVAL; 8003fd8: e0 00 00 22 bi 8004060 <_POSIX_Condition_variables_Wait_support+0x10c> } (void) pthread_mutex_unlock( mutex ); 8003fdc: b9 80 08 00 mv r1,r12 8003fe0: f8 00 01 17 calli 800443c _Thread_Enable_dispatch(); return EINVAL; } */ if ( !already_timedout ) { 8003fe4: 5e 00 00 19 bne r16,r0,8004048 <_POSIX_Condition_variables_Wait_support+0xf4><== NEVER TAKEN the_cond->Mutex = *mutex; 8003fe8: 29 81 00 00 lw r1,(r12+0) _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 8003fec: 78 0b 08 01 mvhi r11,0x801 8003ff0: 39 6b 7d 74 ori r11,r11,0x7d74 8003ff4: 29 64 00 0c lw r4,(r11+12) return EINVAL; } */ if ( !already_timedout ) { the_cond->Mutex = *mutex; 8003ff8: 59 a1 00 14 sw (r13+20),r1 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; 8003ffc: 34 01 00 01 mvi r1,1 8004000: 59 a1 00 48 sw (r13+72),r1 _Thread_queue_Enter_critical_section( &the_cond->Wait_queue ); _Thread_Executing->Wait.return_code = 0; 8004004: 58 80 00 34 sw (r4+52),r0 _Thread_Executing->Wait.queue = &the_cond->Wait_queue; _Thread_Executing->Wait.id = *cond; 8004008: 29 c1 00 00 lw r1,(r14+0) 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; 800400c: 35 ad 00 18 addi r13,r13,24 _Thread_Executing->Wait.id = *cond; _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 8004010: 78 03 08 00 mvhi r3,0x800 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; 8004014: 58 81 00 20 sw (r4+32),r1 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; 8004018: 58 8d 00 44 sw (r4+68),r13 _Thread_Executing->Wait.id = *cond; _Thread_queue_Enqueue( &the_cond->Wait_queue, timeout ); 800401c: b9 a0 08 00 mv r1,r13 8004020: b9 e0 10 00 mv r2,r15 8004024: 38 63 82 04 ori r3,r3,0x8204 8004028: f8 00 0f 0c calli 8007c58 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); 800402c: f8 00 0d db calli 8007798 <_Thread_Enable_dispatch> * a POSIX signal, then pthread_cond_wait returns spuriously, * according to the POSIX standard. It means that pthread_cond_wait * returns a success status, except for the fact that it was not * woken up a pthread_cond_signal or a pthread_cond_broadcast. */ status = _Thread_Executing->Wait.return_code; 8004030: 29 61 00 0c lw r1,(r11+12) 8004034: 28 2b 00 34 lw r11,(r1+52) if ( status == EINTR ) status = 0; 8004038: 7d 61 00 04 cmpnei r1,r11,4 800403c: c8 01 08 00 sub r1,r0,r1 8004040: a1 61 58 00 and r11,r11,r1 8004044: e0 00 00 03 bi 8004050 <_POSIX_Condition_variables_Wait_support+0xfc> } else { _Thread_Enable_dispatch(); 8004048: f8 00 0d d4 calli 8007798 <_Thread_Enable_dispatch> status = ETIMEDOUT; 800404c: 34 0b 00 74 mvi r11,116 /* * When we get here the dispatch disable level is 0. */ mutex_status = pthread_mutex_lock( mutex ); 8004050: b9 80 08 00 mv r1,r12 8004054: f8 00 00 c7 calli 8004370 if ( mutex_status ) 8004058: 44 20 00 02 be r1,r0,8004060 <_POSIX_Condition_variables_Wait_support+0x10c> return EINVAL; 800405c: 34 0b 00 16 mvi r11,22 case OBJECTS_ERROR: break; } return EINVAL; } 8004060: b9 60 08 00 mv r1,r11 8004064: 2b 9d 00 04 lw ra,(sp+4) 8004068: 2b 8b 00 1c lw r11,(sp+28) 800406c: 2b 8c 00 18 lw r12,(sp+24) 8004070: 2b 8d 00 14 lw r13,(sp+20) 8004074: 2b 8e 00 10 lw r14,(sp+16) 8004078: 2b 8f 00 0c lw r15,(sp+12) 800407c: 2b 90 00 08 lw r16,(sp+8) 8004080: 37 9c 00 20 addi sp,sp,32 8004084: c3 a0 00 00 ret =============================================================================== 08008d7c <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { 8008d7c: 37 9c ff dc addi sp,sp,-36 8008d80: 5b 8b 00 18 sw (sp+24),r11 8008d84: 5b 8c 00 14 sw (sp+20),r12 8008d88: 5b 8d 00 10 sw (sp+16),r13 8008d8c: 5b 8e 00 0c sw (sp+12),r14 8008d90: 5b 8f 00 08 sw (sp+8),r15 8008d94: 5b 9d 00 04 sw (sp+4),ra 8008d98: b8 20 58 00 mv r11,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( 8008d9c: 78 01 08 02 mvhi r1,0x802 8008da0: b8 40 60 00 mv r12,r2 8008da4: b8 60 78 00 mv r15,r3 8008da8: b9 60 10 00 mv r2,r11 8008dac: 38 21 a2 58 ori r1,r1,0xa258 8008db0: 37 83 00 24 addi r3,sp,36 8008db4: 5b 86 00 1c sw (sp+28),r6 8008db8: b8 80 68 00 mv r13,r4 8008dbc: 20 ae 00 ff andi r14,r5,0xff 8008dc0: f8 00 0c c6 calli 800c0d8 <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { 8008dc4: 2b 82 00 24 lw r2,(sp+36) 8008dc8: 2b 86 00 1c lw r6,(sp+28) 8008dcc: 5c 40 00 2f bne r2,r0,8008e88 <_POSIX_Message_queue_Receive_support+0x10c> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { 8008dd0: 28 28 00 14 lw r8,(r1+20) 8008dd4: 34 02 00 01 mvi r2,1 8008dd8: 21 03 00 03 andi r3,r8,0x3 8008ddc: 5c 62 00 03 bne r3,r2,8008de8 <_POSIX_Message_queue_Receive_support+0x6c> _Thread_Enable_dispatch(); 8008de0: f8 00 10 41 calli 800cee4 <_Thread_Enable_dispatch> 8008de4: e0 00 00 29 bi 8008e88 <_POSIX_Message_queue_Receive_support+0x10c> rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; 8008de8: 28 27 00 10 lw r7,(r1+16) if ( msg_len < the_mq->Message_queue.maximum_message_size ) { 8008dec: 28 e1 00 68 lw r1,(r7+104) 8008df0: 51 e1 00 05 bgeu r15,r1,8008e04 <_POSIX_Message_queue_Receive_support+0x88> _Thread_Enable_dispatch(); 8008df4: f8 00 10 3c calli 800cee4 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); 8008df8: f8 00 2e e5 calli 801498c <__errno> 8008dfc: 34 02 00 7a mvi r2,122 8008e00: e0 00 00 24 bi 8008e90 <_POSIX_Message_queue_Receive_support+0x114> /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; 8008e04: 34 01 ff ff mvi r1,-1 8008e08: 5b 81 00 20 sw (sp+32),r1 /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) 8008e0c: 34 05 00 00 mvi r5,0 8008e10: 45 c0 00 03 be r14,r0,8008e1c <_POSIX_Message_queue_Receive_support+0xa0><== NEVER TAKEN do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; 8008e14: 21 05 40 00 andi r5,r8,0x4000 8008e18: 64 a5 00 00 cmpei r5,r5,0 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 8008e1c: b9 60 10 00 mv r2,r11 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 8008e20: 78 0b 08 02 mvhi r11,0x802 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 8008e24: 34 e1 00 1c addi r1,r7,28 8008e28: b9 80 18 00 mv r3,r12 8008e2c: 37 84 00 20 addi r4,sp,32 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 8008e30: 39 6b a2 c4 ori r11,r11,0xa2c4 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( 8008e34: f8 00 07 8b calli 800ac60 <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); 8008e38: f8 00 10 2b calli 800cee4 <_Thread_Enable_dispatch> *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); 8008e3c: 29 6c 00 0c lw r12,(r11+12) RTEMS_INLINE_ROUTINE unsigned int _POSIX_Message_queue_Priority_from_core( CORE_message_queue_Submit_types priority ) { /* absolute value without a library dependency */ return ((priority >= 0) ? priority : -priority); 8008e40: 34 02 00 1f mvi r2,31 8008e44: 29 81 00 24 lw r1,(r12+36) 8008e48: f8 00 6e 2e calli 8024700 <__ashrsi3> 8008e4c: 29 82 00 24 lw r2,(r12+36) 8008e50: 98 22 10 00 xor r2,r1,r2 8008e54: c8 41 08 00 sub r1,r2,r1 do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = 8008e58: 59 a1 00 00 sw (r13+0),r1 _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) 8008e5c: 29 81 00 34 lw r1,(r12+52) 8008e60: 5c 20 00 03 bne r1,r0,8008e6c <_POSIX_Message_queue_Receive_support+0xf0> return length_out; 8008e64: 2b 81 00 20 lw r1,(sp+32) 8008e68: e0 00 00 0c bi 8008e98 <_POSIX_Message_queue_Receive_support+0x11c> rtems_set_errno_and_return_minus_one( 8008e6c: f8 00 2e c8 calli 801498c <__errno> 8008e70: b8 20 60 00 mv r12,r1 8008e74: 29 61 00 0c lw r1,(r11+12) 8008e78: 28 21 00 34 lw r1,(r1+52) 8008e7c: f8 00 00 b9 calli 8009160 <_POSIX_Message_queue_Translate_core_message_queue_return_code> 8008e80: 59 81 00 00 sw (r12+0),r1 8008e84: e0 00 00 04 bi 8008e94 <_POSIX_Message_queue_Receive_support+0x118> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); 8008e88: f8 00 2e c1 calli 801498c <__errno> 8008e8c: 34 02 00 09 mvi r2,9 8008e90: 58 22 00 00 sw (r1+0),r2 8008e94: 34 01 ff ff mvi r1,-1 } 8008e98: 2b 9d 00 04 lw ra,(sp+4) 8008e9c: 2b 8b 00 18 lw r11,(sp+24) 8008ea0: 2b 8c 00 14 lw r12,(sp+20) 8008ea4: 2b 8d 00 10 lw r13,(sp+16) 8008ea8: 2b 8e 00 0c lw r14,(sp+12) 8008eac: 2b 8f 00 08 lw r15,(sp+8) 8008eb0: 37 9c 00 24 addi sp,sp,36 8008eb4: c3 a0 00 00 ret =============================================================================== 080085f8 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>: #include void _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( Thread_Control *the_thread ) { 80085f8: 37 9c ff fc addi sp,sp,-4 80085fc: 5b 9d 00 04 sw (sp+4),ra POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8008600: 28 22 01 20 lw r2,(r1+288) if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 8008604: 28 43 00 d8 lw r3,(r2+216) 8008608: 5c 60 00 0e bne r3,r0,8008640 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x48><== NEVER TAKEN 800860c: 28 44 00 dc lw r4,(r2+220) 8008610: 34 03 00 01 mvi r3,1 8008614: 5c 83 00 0b bne r4,r3,8008640 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x48> thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && 8008618: 28 42 00 e0 lw r2,(r2+224) 800861c: 44 40 00 09 be r2,r0,8008640 <_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; 8008620: 78 02 08 01 mvhi r2,0x801 8008624: 38 42 58 98 ori r2,r2,0x5898 8008628: 28 43 00 00 lw r3,(r2+0) 800862c: 34 63 ff ff addi r3,r3,-1 8008630: 58 43 00 00 sw (r2+0),r3 thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); 8008634: 34 02 ff ff mvi r2,-1 8008638: f8 00 02 62 calli 8008fc0 <_POSIX_Thread_Exit> 800863c: e0 00 00 02 bi 8008644 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x4c> } else _Thread_Enable_dispatch(); 8008640: fb ff f3 7d calli 8005434 <_Thread_Enable_dispatch> } 8008644: 2b 9d 00 04 lw ra,(sp+4) 8008648: 37 9c 00 04 addi sp,sp,4 800864c: c3 a0 00 00 ret =============================================================================== 0800a060 <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { 800a060: 37 9c ff e8 addi sp,sp,-24 800a064: 5b 8b 00 18 sw (sp+24),r11 800a068: 5b 8c 00 14 sw (sp+20),r12 800a06c: 5b 8d 00 10 sw (sp+16),r13 800a070: 5b 8e 00 0c sw (sp+12),r14 800a074: 5b 8f 00 08 sw (sp+8),r15 800a078: 5b 9d 00 04 sw (sp+4),ra 800a07c: b8 20 68 00 mv r13,r1 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 800a080: 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 ) { 800a084: b8 40 58 00 mv r11,r2 800a088: b8 60 70 00 mv r14,r3 800a08c: b8 80 78 00 mv r15,r4 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 800a090: fb ff ff ec calli 800a040 <_POSIX_Priority_Is_valid> return EINVAL; 800a094: 34 0c 00 16 mvi r12,22 struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) 800a098: 44 20 00 2a be r1,r0,800a140 <_POSIX_Thread_Translate_sched_param+0xe0><== NEVER TAKEN return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 800a09c: 59 c0 00 00 sw (r14+0),r0 *budget_callout = NULL; 800a0a0: 59 e0 00 00 sw (r15+0),r0 if ( policy == SCHED_OTHER ) { 800a0a4: 5d a0 00 04 bne r13,r0,800a0b4 <_POSIX_Thread_Translate_sched_param+0x54> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 800a0a8: 34 01 00 01 mvi r1,1 800a0ac: 59 c1 00 00 sw (r14+0),r1 800a0b0: e0 00 00 23 bi 800a13c <_POSIX_Thread_Translate_sched_param+0xdc> return 0; } if ( policy == SCHED_FIFO ) { 800a0b4: 34 01 00 01 mvi r1,1 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; 800a0b8: 34 0c 00 00 mvi r12,0 if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { 800a0bc: 45 a1 00 21 be r13,r1,800a140 <_POSIX_Thread_Translate_sched_param+0xe0> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { 800a0c0: 34 01 00 02 mvi r1,2 800a0c4: 5d a1 00 03 bne r13,r1,800a0d0 <_POSIX_Thread_Translate_sched_param+0x70> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; 800a0c8: 59 cd 00 00 sw (r14+0),r13 return 0; 800a0cc: e0 00 00 1d bi 800a140 <_POSIX_Thread_Translate_sched_param+0xe0> } if ( policy == SCHED_SPORADIC ) { 800a0d0: 34 01 00 04 mvi r1,4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; 800a0d4: 34 0c 00 16 mvi r12,22 if ( policy == SCHED_RR ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { 800a0d8: 5d a1 00 1a bne r13,r1,800a140 <_POSIX_Thread_Translate_sched_param+0xe0> if ( (param->sched_ss_repl_period.tv_sec == 0) && 800a0dc: 29 61 00 08 lw r1,(r11+8) 800a0e0: 5c 20 00 03 bne r1,r0,800a0ec <_POSIX_Thread_Translate_sched_param+0x8c> 800a0e4: 29 62 00 0c lw r2,(r11+12) 800a0e8: 44 41 00 16 be r2,r1,800a140 <_POSIX_Thread_Translate_sched_param+0xe0> (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 800a0ec: 29 61 00 10 lw r1,(r11+16) 800a0f0: 5c 20 00 04 bne r1,r0,800a100 <_POSIX_Thread_Translate_sched_param+0xa0> 800a0f4: 29 62 00 14 lw r2,(r11+20) (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; 800a0f8: 34 0c 00 16 mvi r12,22 if ( policy == SCHED_SPORADIC ) { if ( (param->sched_ss_repl_period.tv_sec == 0) && (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && 800a0fc: 44 41 00 11 be r2,r1,800a140 <_POSIX_Thread_Translate_sched_param+0xe0> (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 800a100: 35 61 00 08 addi r1,r11,8 800a104: fb ff f4 98 calli 8007364 <_Timespec_To_ticks> 800a108: b8 20 68 00 mv r13,r1 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) 800a10c: 35 61 00 10 addi r1,r11,16 800a110: fb ff f4 95 calli 8007364 <_Timespec_To_ticks> return EINVAL; 800a114: 34 0c 00 16 mvi r12,22 if ( (param->sched_ss_init_budget.tv_sec == 0) && (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < 800a118: 54 2d 00 0a bgu r1,r13,800a140 <_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 ) ) 800a11c: 29 61 00 04 lw r1,(r11+4) 800a120: fb ff ff c8 calli 800a040 <_POSIX_Priority_Is_valid> 800a124: 44 20 00 07 be r1,r0,800a140 <_POSIX_Thread_Translate_sched_param+0xe0> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; 800a128: 34 01 00 03 mvi r1,3 800a12c: 59 c1 00 00 sw (r14+0),r1 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; 800a130: 78 01 08 00 mvhi r1,0x800 800a134: 38 21 38 00 ori r1,r1,0x3800 800a138: 59 e1 00 00 sw (r15+0),r1 return 0; 800a13c: 34 0c 00 00 mvi r12,0 } return EINVAL; } 800a140: b9 80 08 00 mv r1,r12 800a144: 2b 9d 00 04 lw ra,(sp+4) 800a148: 2b 8b 00 18 lw r11,(sp+24) 800a14c: 2b 8c 00 14 lw r12,(sp+20) 800a150: 2b 8d 00 10 lw r13,(sp+16) 800a154: 2b 8e 00 0c lw r14,(sp+12) 800a158: 2b 8f 00 08 lw r15,(sp+8) 800a15c: 37 9c 00 18 addi sp,sp,24 800a160: c3 a0 00 00 ret =============================================================================== 08003480 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { 8003480: 37 9c ff a8 addi sp,sp,-88 8003484: 5b 8b 00 14 sw (sp+20),r11 8003488: 5b 8c 00 10 sw (sp+16),r12 800348c: 5b 8d 00 0c sw (sp+12),r13 8003490: 5b 8e 00 08 sw (sp+8),r14 8003494: 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; 8003498: 78 01 08 01 mvhi r1,0x801 800349c: 38 21 f0 a8 ori r1,r1,0xf0a8 maximum = Configuration_POSIX_API.number_of_initialization_threads; 80034a0: 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; 80034a4: 28 2c 00 34 lw r12,(r1+52) maximum = Configuration_POSIX_API.number_of_initialization_threads; if ( !user_threads || maximum == 0 ) 80034a8: 65 c2 00 00 cmpei r2,r14,0 80034ac: 65 81 00 00 cmpei r1,r12,0 80034b0: b8 41 08 00 or r1,r2,r1 80034b4: 5c 20 00 18 bne r1,r0,8003514 <_POSIX_Threads_Initialize_user_threads_body+0x94><== NEVER TAKEN 80034b8: 34 0d 00 00 mvi r13,0 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); 80034bc: 37 8b 00 18 addi r11,sp,24 80034c0: b9 60 08 00 mv r1,r11 80034c4: f8 00 1b 28 calli 800a164 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); 80034c8: 34 02 00 02 mvi r2,2 80034cc: b9 60 08 00 mv r1,r11 80034d0: f8 00 1b 32 calli 800a198 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); 80034d4: 29 82 00 04 lw r2,(r12+4) 80034d8: b9 60 08 00 mv r1,r11 80034dc: f8 00 1b 3b calli 800a1c8 status = pthread_create( 80034e0: 29 83 00 00 lw r3,(r12+0) 80034e4: 37 81 00 58 addi r1,sp,88 80034e8: b9 60 10 00 mv r2,r11 80034ec: 34 04 00 00 mvi r4,0 80034f0: fb ff fe ed calli 80030a4 80034f4: b8 20 18 00 mv r3,r1 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) 80034f8: 44 20 00 04 be r1,r0,8003508 <_POSIX_Threads_Initialize_user_threads_body+0x88> _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); 80034fc: 34 01 00 02 mvi r1,2 8003500: 34 02 00 01 mvi r2,1 8003504: f8 00 07 1e calli 800517c <_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++ ) { 8003508: 35 ad 00 01 addi r13,r13,1 800350c: 35 8c 00 08 addi r12,r12,8 8003510: 55 cd ff ec bgu r14,r13,80034c0 <_POSIX_Threads_Initialize_user_threads_body+0x40><== NEVER TAKEN NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); } } 8003514: 2b 9d 00 04 lw ra,(sp+4) 8003518: 2b 8b 00 14 lw r11,(sp+20) 800351c: 2b 8c 00 10 lw r12,(sp+16) 8003520: 2b 8d 00 0c lw r13,(sp+12) 8003524: 2b 8e 00 08 lw r14,(sp+8) 8003528: 37 9c 00 58 addi sp,sp,88 800352c: c3 a0 00 00 ret =============================================================================== 0800d4e8 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 800d4e8: 37 9c ff f4 addi sp,sp,-12 800d4ec: 5b 8b 00 0c sw (sp+12),r11 800d4f0: 5b 8c 00 08 sw (sp+8),r12 800d4f4: 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 ]; 800d4f8: 28 4c 01 20 lw r12,(r2+288) */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { 800d4fc: 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 ); 800d500: 35 81 00 98 addi r1,r12,152 800d504: f8 00 07 e0 calli 800f484 <_Timespec_To_ticks> the_thread->cpu_time_budget = ticks; 800d508: 59 61 00 78 sw (r11+120),r1 RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 800d50c: 78 01 08 01 mvhi r1,0x801 800d510: 38 21 90 a8 ori r1,r1,0x90a8 800d514: 40 21 00 00 lbu r1,(r1+0) 800d518: 29 82 00 88 lw r2,(r12+136) 800d51c: c8 22 10 00 sub r2,r1,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 ) { 800d520: 29 61 00 1c lw r1,(r11+28) 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; 800d524: 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 ) { 800d528: 5c 20 00 06 bne r1,r0,800d540 <_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 ) { 800d52c: 29 61 00 14 lw r1,(r11+20) 800d530: 50 41 00 04 bgeu r2,r1,800d540 <_POSIX_Threads_Sporadic_budget_TSR+0x58> _Thread_Change_priority( the_thread, new_priority, true ); 800d534: b9 60 08 00 mv r1,r11 800d538: 34 03 00 01 mvi r3,1 800d53c: fb ff e4 00 calli 800653c <_Thread_Change_priority> #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); 800d540: 35 81 00 90 addi r1,r12,144 800d544: f8 00 07 d0 calli 800f484 <_Timespec_To_ticks> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 800d548: 59 81 00 b4 sw (r12+180),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 800d54c: 78 01 08 01 mvhi r1,0x801 800d550: 38 21 9a 40 ori r1,r1,0x9a40 800d554: 35 82 00 a8 addi r2,r12,168 800d558: fb ff e9 52 calli 8007aa0 <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } 800d55c: 2b 9d 00 04 lw ra,(sp+4) 800d560: 2b 8b 00 0c lw r11,(sp+12) 800d564: 2b 8c 00 08 lw r12,(sp+8) 800d568: 37 9c 00 0c addi sp,sp,12 800d56c: c3 a0 00 00 ret =============================================================================== 0800d570 <_POSIX_Threads_Sporadic_budget_callout>: * _POSIX_Threads_Sporadic_budget_callout */ void _POSIX_Threads_Sporadic_budget_callout( Thread_Control *the_thread ) { 800d570: 37 9c ff fc addi sp,sp,-4 800d574: 5b 9d 00 04 sw (sp+4),ra /* * 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 */ 800d578: 34 02 ff ff mvi r2,-1 ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 800d57c: 28 25 01 20 lw r5,(r1+288) /* * 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 */ 800d580: 58 22 00 78 sw (r1+120),r2 800d584: 78 02 08 01 mvhi r2,0x801 800d588: 38 42 90 a8 ori r2,r2,0x90a8 800d58c: 40 44 00 00 lbu r4,(r2+0) 800d590: 28 a2 00 8c lw r2,(r5+140) 800d594: c8 82 10 00 sub r2,r4,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 ) { 800d598: 28 24 00 1c lw r4,(r1+28) * 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; 800d59c: 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 ) { 800d5a0: 5c 80 00 05 bne r4,r0,800d5b4 <_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 ) { 800d5a4: 28 23 00 14 lw r3,(r1+20) 800d5a8: 50 62 00 03 bgeu r3,r2,800d5b4 <_POSIX_Threads_Sporadic_budget_callout+0x44><== NEVER TAKEN _Thread_Change_priority( the_thread, new_priority, true ); 800d5ac: 34 03 00 01 mvi r3,1 800d5b0: fb ff e3 e3 calli 800653c <_Thread_Change_priority> #if 0 printk( "lower priority\n" ); #endif } } } 800d5b4: 2b 9d 00 04 lw ra,(sp+4) 800d5b8: 37 9c 00 04 addi sp,sp,4 800d5bc: c3 a0 00 00 ret =============================================================================== 08003180 <_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) { 8003180: 37 9c ff f8 addi sp,sp,-8 8003184: 5b 8b 00 08 sw (sp+8),r11 8003188: 5b 9d 00 04 sw (sp+4),ra bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 800318c: 28 41 00 68 lw r1,(r2+104) * This is the operation that is run when a timer expires */ void _POSIX_Timer_TSR( Objects_Id timer __attribute__((unused)), void *data) { 8003190: b8 40 58 00 mv r11,r2 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; 8003194: 34 21 00 01 addi r1,r1,1 8003198: 58 41 00 68 sw (r2+104),r1 /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || 800319c: 28 41 00 54 lw r1,(r2+84) 80031a0: 5c 20 00 03 bne r1,r0,80031ac <_POSIX_Timer_TSR+0x2c> 80031a4: 28 42 00 58 lw r2,(r2+88) 80031a8: 44 41 00 0d be r2,r1,80031dc <_POSIX_Timer_TSR+0x5c> <== NEVER TAKEN ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( 80031ac: 29 62 00 64 lw r2,(r11+100) 80031b0: 29 63 00 08 lw r3,(r11+8) 80031b4: 78 04 08 00 mvhi r4,0x800 80031b8: 35 61 00 10 addi r1,r11,16 80031bc: 38 84 31 80 ori r4,r4,0x3180 80031c0: b9 60 28 00 mv r5,r11 80031c4: f8 00 1a 6f calli 8009b80 <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) 80031c8: 44 20 00 0b be r1,r0,80031f4 <_POSIX_Timer_TSR+0x74> <== NEVER TAKEN return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); 80031cc: 35 61 00 6c addi r1,r11,108 80031d0: f8 00 04 82 calli 80043d8 <_TOD_Get> /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 80031d4: 34 01 00 03 mvi r1,3 80031d8: e0 00 00 02 bi 80031e0 <_POSIX_Timer_TSR+0x60> } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 80031dc: 34 01 00 04 mvi r1,4 <== NOT EXECUTED 80031e0: 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 ) ) { 80031e4: 29 62 00 44 lw r2,(r11+68) 80031e8: 29 61 00 38 lw r1,(r11+56) 80031ec: f8 00 19 15 calli 8009640 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; 80031f0: 59 60 00 68 sw (r11+104),r0 } 80031f4: 2b 9d 00 04 lw ra,(sp+4) 80031f8: 2b 8b 00 08 lw r11,(sp+8) 80031fc: 37 9c 00 08 addi sp,sp,8 8003200: c3 a0 00 00 ret =============================================================================== 08010b60 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 8010b60: 37 9c ff b0 addi sp,sp,-80 8010b64: 5b 8b 00 1c sw (sp+28),r11 8010b68: 5b 8c 00 18 sw (sp+24),r12 8010b6c: 5b 8d 00 14 sw (sp+20),r13 8010b70: 5b 8e 00 10 sw (sp+16),r14 8010b74: 5b 8f 00 0c sw (sp+12),r15 8010b78: 5b 90 00 08 sw (sp+8),r16 8010b7c: 5b 9d 00 04 sw (sp+4),ra siginfo_t siginfo_struct; sigset_t saved_signals_blocked; Thread_Wait_information stored_thread_wait_information; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 8010b80: 37 90 00 48 addi r16,sp,72 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 8010b84: 20 64 00 ff andi r4,r3,0xff siginfo_t siginfo_struct; sigset_t saved_signals_blocked; Thread_Wait_information stored_thread_wait_information; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 8010b88: 34 05 00 01 mvi r5,1 8010b8c: ba 00 18 00 mv r3,r16 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { 8010b90: b8 20 68 00 mv r13,r1 8010b94: b8 40 58 00 mv r11,r2 siginfo_t siginfo_struct; sigset_t saved_signals_blocked; Thread_Wait_information stored_thread_wait_information; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 8010b98: f8 00 00 37 calli 8010c74 <_POSIX_signals_Clear_signals> is_global, true ) ) return false; 8010b9c: 34 0f 00 00 mvi r15,0 { siginfo_t siginfo_struct; sigset_t saved_signals_blocked; Thread_Wait_information stored_thread_wait_information; if ( ! _POSIX_signals_Clear_signals( api, signo, &siginfo_struct, 8010ba0: 44 20 00 2b be r1,r0,8010c4c <_POSIX_signals_Check_signal+0xec> #endif /* * Just to prevent sending a signal which is currently being ignored. */ if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN ) 8010ba4: 34 02 00 01 mvi r2,1 8010ba8: b9 60 08 00 mv r1,r11 8010bac: f8 00 18 e4 calli 8016f3c <__ashlsi3> 8010bb0: 78 0c 08 01 mvhi r12,0x801 8010bb4: b4 2b 08 00 add r1,r1,r11 8010bb8: 34 02 00 02 mvi r2,2 8010bbc: f8 00 18 e0 calli 8016f3c <__ashlsi3> 8010bc0: 39 8c 9e 78 ori r12,r12,0x9e78 8010bc4: b5 81 60 00 add r12,r12,r1 8010bc8: 29 8e 00 08 lw r14,(r12+8) 8010bcc: 34 01 00 01 mvi r1,1 8010bd0: 45 c1 00 1f be r14,r1,8010c4c <_POSIX_signals_Check_signal+0xec><== NEVER TAKEN return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; 8010bd4: 29 af 00 d0 lw r15,(r13+208) api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 8010bd8: 29 81 00 04 lw r1,(r12+4) /* * We have to save the blocking information of the current wait queue * because the signal handler may subsequently go on and put the thread * on a wait queue, for its own purposes. */ memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait, 8010bdc: 34 03 00 28 mvi r3,40 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; 8010be0: b8 2f 08 00 or r1,r1,r15 8010be4: 59 a1 00 d0 sw (r13+208),r1 /* * We have to save the blocking information of the current wait queue * because the signal handler may subsequently go on and put the thread * on a wait queue, for its own purposes. */ memcpy( &stored_thread_wait_information, &_Thread_Executing->Wait, 8010be8: 78 01 08 01 mvhi r1,0x801 8010bec: 38 21 9e 2c ori r1,r1,0x9e2c 8010bf0: 28 22 00 0c lw r2,(r1+12) 8010bf4: 37 81 00 20 addi r1,sp,32 8010bf8: 34 42 00 20 addi r2,r2,32 8010bfc: f8 00 04 de calli 8011f74 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { 8010c00: 29 82 00 00 lw r2,(r12+0) 8010c04: 34 01 00 02 mvi r1,2 8010c08: 5c 41 00 06 bne r2,r1,8010c20 <_POSIX_signals_Check_signal+0xc0> case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( 8010c0c: b9 60 08 00 mv r1,r11 8010c10: ba 00 10 00 mv r2,r16 8010c14: 34 03 00 00 mvi r3,0 8010c18: d9 c0 00 00 call r14 signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; 8010c1c: e0 00 00 03 bi 8010c28 <_POSIX_signals_Check_signal+0xc8> default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); 8010c20: b9 60 08 00 mv r1,r11 8010c24: d9 c0 00 00 call r14 } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, 8010c28: 78 01 08 01 mvhi r1,0x801 8010c2c: 38 21 9e 2c ori r1,r1,0x9e2c 8010c30: 28 21 00 0c lw r1,(r1+12) 8010c34: 37 82 00 20 addi r2,sp,32 8010c38: 34 03 00 28 mvi r3,40 8010c3c: 34 21 00 20 addi r1,r1,32 8010c40: f8 00 04 cd calli 8011f74 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; 8010c44: 59 af 00 d0 sw (r13+208),r15 return true; 8010c48: 34 0f 00 01 mvi r15,1 } 8010c4c: b9 e0 08 00 mv r1,r15 8010c50: 2b 9d 00 04 lw ra,(sp+4) 8010c54: 2b 8b 00 1c lw r11,(sp+28) 8010c58: 2b 8c 00 18 lw r12,(sp+24) 8010c5c: 2b 8d 00 14 lw r13,(sp+20) 8010c60: 2b 8e 00 10 lw r14,(sp+16) 8010c64: 2b 8f 00 0c lw r15,(sp+12) 8010c68: 2b 90 00 08 lw r16,(sp+8) 8010c6c: 37 9c 00 50 addi sp,sp,80 8010c70: c3 a0 00 00 ret =============================================================================== 08011334 <_POSIX_signals_Clear_process_signals>: */ void _POSIX_signals_Clear_process_signals( int signo ) { 8011334: 37 9c ff ec addi sp,sp,-20 8011338: 5b 8b 00 14 sw (sp+20),r11 801133c: 5b 8c 00 10 sw (sp+16),r12 8011340: 5b 8d 00 0c sw (sp+12),r13 8011344: 5b 8e 00 08 sw (sp+8),r14 8011348: 5b 9d 00 04 sw (sp+4),ra 801134c: b8 20 60 00 mv r12,r1 clear_signal = true; mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); 8011350: 90 00 68 00 rcsr r13,IE 8011354: 34 01 ff fe mvi r1,-2 8011358: a1 a1 08 00 and r1,r13,r1 801135c: d0 01 00 00 wcsr IE,r1 if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { 8011360: 34 02 00 01 mvi r2,1 8011364: b9 80 08 00 mv r1,r12 8011368: f8 00 16 f5 calli 8016f3c <__ashlsi3> 801136c: b4 2c 70 00 add r14,r1,r12 8011370: 34 02 00 02 mvi r2,2 8011374: 78 0b 08 01 mvhi r11,0x801 8011378: b9 c0 08 00 mv r1,r14 801137c: f8 00 16 f0 calli 8016f3c <__ashlsi3> 8011380: 39 6b 9e 78 ori r11,r11,0x9e78 8011384: b5 61 08 00 add r1,r11,r1 8011388: 28 22 00 00 lw r2,(r1+0) 801138c: 34 01 00 02 mvi r1,2 8011390: 5c 41 00 0a bne r2,r1,80113b8 <_POSIX_signals_Clear_process_signals+0x84> } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } 8011394: 34 02 00 02 mvi r2,2 8011398: 78 0b 08 01 mvhi r11,0x801 801139c: b9 c0 08 00 mv r1,r14 80113a0: f8 00 16 e7 calli 8016f3c <__ashlsi3> 80113a4: 39 6b a0 70 ori r11,r11,0xa070 80113a8: b5 61 08 00 add r1,r11,r1 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 80113ac: 34 22 00 04 addi r2,r1,4 ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) 80113b0: 28 21 00 00 lw r1,(r1+0) 80113b4: 5c 22 00 0a bne r1,r2,80113dc <_POSIX_signals_Clear_process_signals+0xa8><== NEVER TAKEN 80113b8: 35 82 ff ff addi r2,r12,-1 clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; 80113bc: 78 0b 08 01 mvhi r11,0x801 80113c0: 34 01 00 01 mvi r1,1 80113c4: f8 00 16 de calli 8016f3c <__ashlsi3> 80113c8: 39 6b a0 6c ori r11,r11,0xa06c 80113cc: 29 62 00 00 lw r2,(r11+0) 80113d0: a4 20 08 00 not r1,r1 80113d4: a0 22 08 00 and r1,r1,r2 80113d8: 59 61 00 00 sw (r11+0),r1 } _ISR_Enable( level ); 80113dc: d0 0d 00 00 wcsr IE,r13 } 80113e0: 2b 9d 00 04 lw ra,(sp+4) 80113e4: 2b 8b 00 14 lw r11,(sp+20) 80113e8: 2b 8c 00 10 lw r12,(sp+16) 80113ec: 2b 8d 00 0c lw r13,(sp+12) 80113f0: 2b 8e 00 08 lw r14,(sp+8) 80113f4: 37 9c 00 14 addi sp,sp,20 80113f8: c3 a0 00 00 ret =============================================================================== 08003dcc <_POSIX_signals_Get_lowest>: #include int _POSIX_signals_Get_lowest( sigset_t set ) { 8003dcc: 37 9c ff f0 addi sp,sp,-16 8003dd0: 5b 8b 00 10 sw (sp+16),r11 8003dd4: 5b 8c 00 0c sw (sp+12),r12 8003dd8: 5b 8d 00 08 sw (sp+8),r13 8003ddc: 5b 9d 00 04 sw (sp+4),ra int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 8003de0: 34 0b 00 1b mvi r11,27 #include int _POSIX_signals_Get_lowest( sigset_t set ) { 8003de4: b8 20 60 00 mv r12,r1 int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 8003de8: 34 0d 00 20 mvi r13,32 8003dec: 34 01 00 01 mvi r1,1 8003df0: 35 62 ff ff addi r2,r11,-1 8003df4: f8 00 67 7f calli 801dbf0 <__ashlsi3> if ( set & signo_to_mask( signo ) ) { 8003df8: a0 2c 08 00 and r1,r1,r12 8003dfc: 5c 20 00 0c bne r1,r0,8003e2c <_POSIX_signals_Get_lowest+0x60><== NEVER TAKEN sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { 8003e00: 35 6b 00 01 addi r11,r11,1 8003e04: 5d 6d ff fa bne r11,r13,8003dec <_POSIX_signals_Get_lowest+0x20> 8003e08: 34 0b 00 01 mvi r11,1 */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 8003e0c: 34 0d 00 1b mvi r13,27 8003e10: 34 01 00 01 mvi r1,1 8003e14: 35 62 ff ff addi r2,r11,-1 8003e18: f8 00 67 76 calli 801dbf0 <__ashlsi3> if ( set & signo_to_mask( signo ) ) { 8003e1c: a0 2c 08 00 and r1,r1,r12 8003e20: 5c 20 00 03 bne r1,r0,8003e2c <_POSIX_signals_Get_lowest+0x60> */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { 8003e24: 35 6b 00 01 addi r11,r11,1 8003e28: 5d 6d ff fa bne r11,r13,8003e10 <_POSIX_signals_Get_lowest+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; } 8003e2c: b9 60 08 00 mv r1,r11 8003e30: 2b 9d 00 04 lw ra,(sp+4) 8003e34: 2b 8b 00 10 lw r11,(sp+16) 8003e38: 2b 8c 00 0c lw r12,(sp+12) 8003e3c: 2b 8d 00 08 lw r13,(sp+8) 8003e40: 37 9c 00 10 addi sp,sp,16 8003e44: c3 a0 00 00 ret =============================================================================== 08025f78 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 8025f78: 37 9c ff ec addi sp,sp,-20 8025f7c: 5b 8b 00 14 sw (sp+20),r11 8025f80: 5b 8c 00 10 sw (sp+16),r12 8025f84: 5b 8d 00 0c sw (sp+12),r13 8025f88: 5b 8e 00 08 sw (sp+8),r14 8025f8c: 5b 9d 00 04 sw (sp+4),ra 8025f90: b8 20 58 00 mv r11,r1 8025f94: b8 40 70 00 mv r14,r2 POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8025f98: 28 2c 01 20 lw r12,(r1+288) 8025f9c: 34 42 ff ff addi r2,r2,-1 8025fa0: 34 01 00 01 mvi r1,1 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { 8025fa4: b8 60 68 00 mv r13,r3 8025fa8: fb ff 6f bf calli 8001ea4 <__ashlsi3> /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { 8025fac: 78 03 08 02 mvhi r3,0x802 8025fb0: 38 63 77 d0 ori r3,r3,0x77d0 8025fb4: 29 64 00 10 lw r4,(r11+16) 8025fb8: 28 62 00 00 lw r2,(r3+0) 8025fbc: a0 82 18 00 and r3,r4,r2 8025fc0: 5c 62 00 1c bne r3,r2,8026030 <_POSIX_signals_Unblock_thread+0xb8> if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 8025fc4: 29 62 00 30 lw r2,(r11+48) 8025fc8: a0 22 10 00 and r2,r1,r2 8025fcc: 5c 40 00 06 bne r2,r0,8025fe4 <_POSIX_signals_Unblock_thread+0x6c> 8025fd0: 29 82 00 d0 lw r2,(r12+208) /* * This should only be reached via pthread_kill(). */ return false; 8025fd4: 34 0c 00 00 mvi r12,0 * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { 8025fd8: a4 40 10 00 not r2,r2 8025fdc: a0 22 08 00 and r1,r1,r2 8025fe0: 44 2c 00 39 be r1,r12,80260c4 <_POSIX_signals_Unblock_thread+0x14c> the_thread->Wait.return_code = EINTR; 8025fe4: 34 01 00 04 mvi r1,4 8025fe8: 59 61 00 34 sw (r11+52),r1 the_info = (siginfo_t *) the_thread->Wait.return_argument; 8025fec: 29 61 00 28 lw r1,(r11+40) if ( !info ) { 8025ff0: 5d a0 00 06 bne r13,r0,8026008 <_POSIX_signals_Unblock_thread+0x90> the_info->si_signo = signo; the_info->si_code = SI_USER; 8025ff4: 34 02 00 01 mvi r2,1 the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; 8025ff8: 58 2e 00 00 sw (r1+0),r14 the_info->si_code = SI_USER; 8025ffc: 58 22 00 04 sw (r1+4),r2 the_info->si_value.sival_int = 0; 8026000: 58 20 00 08 sw (r1+8),r0 8026004: e0 00 00 07 bi 8026020 <_POSIX_signals_Unblock_thread+0xa8> } else { *the_info = *info; 8026008: 29 a3 00 00 lw r3,(r13+0) 802600c: 29 a2 00 04 lw r2,(r13+4) 8026010: 29 a4 00 08 lw r4,(r13+8) 8026014: 58 23 00 00 sw (r1+0),r3 8026018: 58 22 00 04 sw (r1+4),r2 802601c: 58 24 00 08 sw (r1+8),r4 } _Thread_queue_Extract_with_proxy( the_thread ); 8026020: b9 60 08 00 mv r1,r11 8026024: fb ff 9a 1c calli 800c894 <_Thread_queue_Extract_with_proxy> return true; 8026028: 34 0c 00 01 mvi r12,1 802602c: e0 00 00 26 bi 80260c4 <_POSIX_signals_Unblock_thread+0x14c> } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 8026030: 29 82 00 d0 lw r2,(r12+208) } else if ( the_thread->current_state == STATES_READY ) { if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; 8026034: 34 0c 00 00 mvi r12,0 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { 8026038: a4 40 10 00 not r2,r2 802603c: a0 22 08 00 and r1,r1,r2 8026040: 44 20 00 21 be r1,r0,80260c4 <_POSIX_signals_Unblock_thread+0x14c> 8026044: 78 01 10 00 mvhi r1,0x1000 8026048: a0 81 08 00 and r1,r4,r1 * it is not blocked, THEN * we need to dispatch at the end of this ISR. * + Any other combination, do nothing. */ if ( _States_Is_interruptible_by_signal( the_thread->current_state ) ) { 802604c: 44 20 00 15 be r1,r0,80260a0 <_POSIX_signals_Unblock_thread+0x128> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 8026050: 78 02 08 02 mvhi r2,0x802 the_thread->Wait.return_code = EINTR; 8026054: 34 01 00 04 mvi r1,4 8026058: 38 42 75 84 ori r2,r2,0x7584 802605c: 59 61 00 34 sw (r11+52),r1 8026060: 28 41 00 00 lw r1,(r2+0) 8026064: a0 81 08 00 and r1,r4,r1 /* * In pthread_cond_wait, a thread will be blocking on a thread * queue, but is also interruptible by a POSIX signal. */ if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) ) 8026068: 44 20 00 04 be r1,r0,8026078 <_POSIX_signals_Unblock_thread+0x100> _Thread_queue_Extract_with_proxy( the_thread ); 802606c: b9 60 08 00 mv r1,r11 8026070: fb ff 9a 09 calli 800c894 <_Thread_queue_Extract_with_proxy> 8026074: e0 00 00 14 bi 80260c4 <_POSIX_signals_Unblock_thread+0x14c> */ RTEMS_INLINE_ROUTINE bool _States_Is_delaying ( States_Control the_states ) { return (the_states & STATES_DELAYING); 8026078: 20 84 00 08 andi r4,r4,0x8 else if ( _States_Is_delaying(the_thread->current_state) ) { 802607c: 44 8c 00 12 be r4,r12,80260c4 <_POSIX_signals_Unblock_thread+0x14c><== NEVER TAKEN (void) _Watchdog_Remove( &the_thread->Timer ); 8026080: 35 61 00 48 addi r1,r11,72 8026084: fb ff 9c db calli 800d3f0 <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 8026088: 78 03 08 02 mvhi r3,0x802 802608c: 38 63 73 d8 ori r3,r3,0x73d8 8026090: 28 62 00 00 lw r2,(r3+0) 8026094: b9 60 08 00 mv r1,r11 8026098: fb ff 96 cc calli 800bbc8 <_Thread_Clear_state> 802609c: e0 00 00 0a bi 80260c4 <_POSIX_signals_Unblock_thread+0x14c> _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { 80260a0: 5c 8c 00 09 bne r4,r12,80260c4 <_POSIX_signals_Unblock_thread+0x14c><== NEVER TAKEN if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 80260a4: 78 01 08 02 mvhi r1,0x802 80260a8: 38 21 9f 1c ori r1,r1,0x9f1c 80260ac: 28 22 00 08 lw r2,(r1+8) 80260b0: 44 4c 00 05 be r2,r12,80260c4 <_POSIX_signals_Unblock_thread+0x14c> 80260b4: 28 22 00 0c lw r2,(r1+12) 80260b8: 5d 62 00 03 bne r11,r2,80260c4 <_POSIX_signals_Unblock_thread+0x14c><== NEVER TAKEN _Thread_Dispatch_necessary = true; 80260bc: 34 02 00 01 mvi r2,1 80260c0: 30 22 00 18 sb (r1+24),r2 } } return false; } 80260c4: b9 80 08 00 mv r1,r12 80260c8: 2b 9d 00 04 lw ra,(sp+4) 80260cc: 2b 8b 00 14 lw r11,(sp+20) 80260d0: 2b 8c 00 10 lw r12,(sp+16) 80260d4: 2b 8d 00 0c lw r13,(sp+12) 80260d8: 2b 8e 00 08 lw r14,(sp+8) 80260dc: 37 9c 00 14 addi sp,sp,20 80260e0: c3 a0 00 00 ret =============================================================================== 0800426c <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { 800426c: 37 9c ff e8 addi sp,sp,-24 8004270: 5b 8b 00 14 sw (sp+20),r11 8004274: 5b 8c 00 10 sw (sp+16),r12 8004278: 5b 8d 00 0c sw (sp+12),r13 800427c: 5b 8e 00 08 sw (sp+8),r14 8004280: 5b 9d 00 04 sw (sp+4),ra rtems_initialization_tasks_table *user_tasks; /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; 8004284: 78 01 08 01 mvhi r1,0x801 8004288: 38 21 90 74 ori r1,r1,0x9074 800428c: 28 2b 00 2c lw r11,(r1+44) maximum = Configuration_RTEMS_API.number_of_initialization_tasks; 8004290: 28 2e 00 28 lw r14,(r1+40) /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) 8004294: 34 0d 00 00 mvi r13,0 8004298: 5d 60 00 1a bne r11,r0,8004300 <_RTEMS_tasks_Initialize_user_tasks_body+0x94> 800429c: e0 00 00 1a bi 8004304 <_RTEMS_tasks_Initialize_user_tasks_body+0x98> /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { return_value = rtems_task_create( 80042a0: 29 61 00 00 lw r1,(r11+0) 80042a4: 29 62 00 08 lw r2,(r11+8) 80042a8: 29 63 00 04 lw r3,(r11+4) 80042ac: 29 64 00 14 lw r4,(r11+20) 80042b0: 29 65 00 0c lw r5,(r11+12) 80042b4: 37 86 00 18 addi r6,sp,24 80042b8: f8 00 26 9a calli 800dd20 80042bc: b8 20 60 00 mv r12,r1 user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) 80042c0: 44 20 00 05 be r1,r0,80042d4 <_RTEMS_tasks_Initialize_user_tasks_body+0x68><== ALWAYS TAKEN _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); 80042c4: 34 01 00 01 mvi r1,1 <== NOT EXECUTED 80042c8: 34 02 00 01 mvi r2,1 <== NOT EXECUTED 80042cc: b9 80 18 00 mv r3,r12 <== NOT EXECUTED 80042d0: e0 00 00 0a bi 80042f8 <_RTEMS_tasks_Initialize_user_tasks_body+0x8c><== NOT EXECUTED return_value = rtems_task_start( 80042d4: 29 63 00 18 lw r3,(r11+24) 80042d8: 29 62 00 10 lw r2,(r11+16) 80042dc: 2b 81 00 18 lw r1,(sp+24) 80042e0: 35 6b 00 1c addi r11,r11,28 80042e4: f8 00 00 0f calli 8004320 80042e8: b8 20 18 00 mv r3,r1 id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) 80042ec: 44 2c 00 04 be r1,r12,80042fc <_RTEMS_tasks_Initialize_user_tasks_body+0x90> _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); 80042f0: 34 01 00 01 mvi r1,1 80042f4: 34 02 00 01 mvi r2,1 80042f8: f8 00 04 aa calli 80055a0 <_Internal_error_Occurred> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { 80042fc: 35 ad 00 01 addi r13,r13,1 8004300: 55 cd ff e8 bgu r14,r13,80042a0 <_RTEMS_tasks_Initialize_user_tasks_body+0x34> user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); } } 8004304: 2b 9d 00 04 lw ra,(sp+4) 8004308: 2b 8b 00 14 lw r11,(sp+20) 800430c: 2b 8c 00 10 lw r12,(sp+16) 8004310: 2b 8d 00 0c lw r13,(sp+12) 8004314: 2b 8e 00 08 lw r14,(sp+8) 8004318: 37 9c 00 18 addi sp,sp,24 800431c: c3 a0 00 00 ret =============================================================================== 08004608 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { 8004608: 37 9c ff f4 addi sp,sp,-12 800460c: 5b 8b 00 08 sw (sp+8),r11 8004610: 5b 9d 00 04 sw (sp+4),ra 8004614: b8 20 10 00 mv r2,r1 8004618: 78 01 08 02 mvhi r1,0x802 800461c: 38 21 18 d0 ori r1,r1,0x18d0 8004620: 37 83 00 0c addi r3,sp,12 8004624: f8 00 08 e2 calli 80069ac <_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 ) { 8004628: 2b 82 00 0c lw r2,(sp+12) 800462c: b8 20 58 00 mv r11,r1 8004630: 5c 40 00 22 bne r2,r0,80046b8 <_Rate_monotonic_Timeout+0xb0><== NEVER TAKEN case OBJECTS_LOCAL: the_thread = the_period->owner; 8004634: 28 21 00 40 lw r1,(r1+64) */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_period ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_PERIOD); 8004638: 28 23 00 10 lw r3,(r1+16) 800463c: 20 63 40 00 andi r3,r3,0x4000 if ( _States_Is_waiting_for_period( the_thread->current_state ) && 8004640: 44 62 00 09 be r3,r2,8004664 <_Rate_monotonic_Timeout+0x5c> 8004644: 28 23 00 20 lw r3,(r1+32) 8004648: 29 62 00 08 lw r2,(r11+8) 800464c: 5c 62 00 06 bne r3,r2,8004664 <_Rate_monotonic_Timeout+0x5c> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 8004650: 78 03 08 01 mvhi r3,0x801 8004654: 38 63 ec 5c ori r3,r3,0xec5c 8004658: 28 62 00 00 lw r2,(r3+0) 800465c: f8 00 0b 6b calli 8007408 <_Thread_Clear_state> 8004660: e0 00 00 06 bi 8004678 <_Rate_monotonic_Timeout+0x70> _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 ) { 8004664: 29 62 00 38 lw r2,(r11+56) 8004668: 34 01 00 01 mvi r1,1 800466c: 5c 41 00 0c bne r2,r1,800469c <_Rate_monotonic_Timeout+0x94> the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; 8004670: 34 01 00 03 mvi r1,3 8004674: 59 61 00 38 sw (r11+56),r1 _Rate_monotonic_Initiate_statistics( the_period ); 8004678: b9 60 08 00 mv r1,r11 800467c: fb ff fe 2e calli 8003f34 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8004680: 29 61 00 3c lw r1,(r11+60) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8004684: 35 62 00 10 addi r2,r11,16 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8004688: 59 61 00 1c sw (r11+28),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 800468c: 78 01 08 02 mvhi r1,0x802 8004690: 38 21 1a d8 ori r1,r1,0x1ad8 8004694: f8 00 10 fd calli 8008a88 <_Watchdog_Insert> 8004698: e0 00 00 03 bi 80046a4 <_Rate_monotonic_Timeout+0x9c> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; 800469c: 34 01 00 04 mvi r1,4 80046a0: 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; 80046a4: 78 01 08 02 mvhi r1,0x802 80046a8: 38 21 19 f8 ori r1,r1,0x19f8 80046ac: 28 22 00 00 lw r2,(r1+0) 80046b0: 34 42 ff ff addi r2,r2,-1 80046b4: 58 22 00 00 sw (r1+0),r2 case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } 80046b8: 2b 9d 00 04 lw ra,(sp+4) 80046bc: 2b 8b 00 08 lw r11,(sp+8) 80046c0: 37 9c 00 0c addi sp,sp,12 80046c4: c3 a0 00 00 ret =============================================================================== 08003fc8 <_Rate_monotonic_Update_statistics>: void _Rate_monotonic_Update_statistics( Rate_monotonic_Control *the_period ) { 8003fc8: 37 9c ff e4 addi sp,sp,-28 8003fcc: 5b 8b 00 0c sw (sp+12),r11 8003fd0: 5b 8c 00 08 sw (sp+8),r12 8003fd4: 5b 9d 00 04 sw (sp+4),ra 8003fd8: b8 20 58 00 mv r11,r1 /* * Update the counts. */ stats = &the_period->Statistics; stats->count++; 8003fdc: 28 21 00 54 lw r1,(r1+84) if ( the_period->state == RATE_MONOTONIC_EXPIRED ) 8003fe0: 29 62 00 38 lw r2,(r11+56) /* * Update the counts. */ stats = &the_period->Statistics; stats->count++; 8003fe4: 34 21 00 01 addi r1,r1,1 8003fe8: 59 61 00 54 sw (r11+84),r1 if ( the_period->state == RATE_MONOTONIC_EXPIRED ) 8003fec: 34 01 00 04 mvi r1,4 8003ff0: 5c 41 00 04 bne r2,r1,8004000 <_Rate_monotonic_Update_statistics+0x38> stats->missed_count++; 8003ff4: 29 61 00 58 lw r1,(r11+88) 8003ff8: 34 21 00 01 addi r1,r1,1 8003ffc: 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 ); 8004000: 37 8c 00 18 addi r12,sp,24 stats->missed_count++; /* * Grab status for time statistics. */ valid_status = 8004004: b9 60 08 00 mv r1,r11 8004008: 37 82 00 10 addi r2,sp,16 800400c: b9 80 18 00 mv r3,r12 8004010: fb ff ff 90 calli 8003e50 <_Rate_monotonic_Get_status> _Rate_monotonic_Get_status( the_period, &since_last_period, &executed ); if (!valid_status) 8004014: 44 20 00 28 be r1,r0,80040b4 <_Rate_monotonic_Update_statistics+0xec><== NEVER TAKEN /* * Update CPU time */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Add_to( &stats->total_cpu_time, &executed ); 8004018: b9 80 10 00 mv r2,r12 800401c: 35 61 00 6c addi r1,r11,108 8004020: f8 00 11 37 calli 80084fc <_Timespec_Add_to> if ( _Timestamp_Less_than( &executed, &stats->min_cpu_time ) ) 8004024: b9 80 08 00 mv r1,r12 8004028: 35 62 00 5c addi r2,r11,92 800402c: f8 00 11 92 calli 8008674 <_Timespec_Less_than> 8004030: 44 20 00 05 be r1,r0,8004044 <_Rate_monotonic_Update_statistics+0x7c> stats->min_cpu_time = executed; 8004034: 2b 81 00 18 lw r1,(sp+24) 8004038: 59 61 00 5c sw (r11+92),r1 800403c: 2b 81 00 1c lw r1,(sp+28) 8004040: 59 61 00 60 sw (r11+96),r1 if ( _Timestamp_Greater_than( &executed, &stats->max_cpu_time ) ) 8004044: 37 81 00 18 addi r1,sp,24 8004048: 35 62 00 64 addi r2,r11,100 800404c: f8 00 11 7f calli 8008648 <_Timespec_Greater_than> 8004050: 44 20 00 05 be r1,r0,8004064 <_Rate_monotonic_Update_statistics+0x9c> stats->max_cpu_time = executed; 8004054: 2b 81 00 18 lw r1,(sp+24) 8004058: 59 61 00 64 sw (r11+100),r1 800405c: 2b 81 00 1c lw r1,(sp+28) 8004060: 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 ); 8004064: 37 8c 00 10 addi r12,sp,16 8004068: b9 80 10 00 mv r2,r12 800406c: 35 61 00 84 addi r1,r11,132 8004070: f8 00 11 23 calli 80084fc <_Timespec_Add_to> if ( _Timestamp_Less_than( &since_last_period, &stats->min_wall_time ) ) 8004074: b9 80 08 00 mv r1,r12 8004078: 35 62 00 74 addi r2,r11,116 800407c: f8 00 11 7e calli 8008674 <_Timespec_Less_than> 8004080: 44 20 00 05 be r1,r0,8004094 <_Rate_monotonic_Update_statistics+0xcc> stats->min_wall_time = since_last_period; 8004084: 2b 81 00 10 lw r1,(sp+16) 8004088: 59 61 00 74 sw (r11+116),r1 800408c: 2b 81 00 14 lw r1,(sp+20) 8004090: 59 61 00 78 sw (r11+120),r1 if ( _Timestamp_Greater_than( &since_last_period, &stats->max_wall_time ) ) 8004094: 37 81 00 10 addi r1,sp,16 8004098: 35 62 00 7c addi r2,r11,124 800409c: f8 00 11 6b calli 8008648 <_Timespec_Greater_than> 80040a0: 44 20 00 05 be r1,r0,80040b4 <_Rate_monotonic_Update_statistics+0xec> stats->max_wall_time = since_last_period; 80040a4: 2b 81 00 10 lw r1,(sp+16) 80040a8: 59 61 00 7c sw (r11+124),r1 80040ac: 2b 81 00 14 lw r1,(sp+20) 80040b0: 59 61 00 80 sw (r11+128),r1 stats->min_wall_time = since_last_period; if ( since_last_period > stats->max_wall_time ) stats->max_wall_time = since_last_period; #endif } 80040b4: 2b 9d 00 04 lw ra,(sp+4) 80040b8: 2b 8b 00 0c lw r11,(sp+12) 80040bc: 2b 8c 00 08 lw r12,(sp+8) 80040c0: 37 9c 00 1c addi sp,sp,28 80040c4: c3 a0 00 00 ret =============================================================================== 0800ee20 <_Scheduler_priority_Block>: void _Scheduler_priority_Block( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { 800ee20: 37 9c ff ec addi sp,sp,-20 800ee24: 5b 8b 00 14 sw (sp+20),r11 800ee28: 5b 8c 00 10 sw (sp+16),r12 800ee2c: 5b 8d 00 0c sw (sp+12),r13 800ee30: 5b 8e 00 08 sw (sp+8),r14 800ee34: 5b 9d 00 04 sw (sp+4),ra 800ee38: b8 40 60 00 mv r12,r2 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Ready_queue_extract( Thread_Control *the_thread ) { Chain_Control *ready = the_thread->scheduler.priority->ready_chain; 800ee3c: 28 42 00 8c lw r2,(r2+140) 800ee40: 28 43 00 00 lw r3,(r2+0) if ( _Chain_Has_only_one_node( ready ) ) { 800ee44: 28 64 00 00 lw r4,(r3+0) 800ee48: 28 62 00 08 lw r2,(r3+8) 800ee4c: 5c 82 00 13 bne r4,r2,800ee98 <_Scheduler_priority_Block+0x78> RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 800ee50: 34 62 00 04 addi r2,r3,4 head->next = tail; 800ee54: 58 62 00 00 sw (r3+0),r2 head->previous = NULL; 800ee58: 58 60 00 04 sw (r3+4),r0 tail->previous = head; 800ee5c: 58 63 00 08 sw (r3+8),r3 _Chain_Initialize_empty( ready ); _Priority_bit_map_Remove( &the_thread->scheduler.priority->Priority_map ); 800ee60: 29 82 00 8c lw r2,(r12+140) RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; 800ee64: 28 44 00 04 lw r4,(r2+4) 800ee68: 2c 45 00 0e lhu r5,(r2+14) 800ee6c: 2c 83 00 00 lhu r3,(r4+0) 800ee70: a0 65 18 00 and r3,r3,r5 800ee74: 0c 83 00 00 sh (r4+0),r3 if ( *the_priority_map->minor == 0 ) 800ee78: 5c 60 00 0c bne r3,r0,800eea8 <_Scheduler_priority_Block+0x88> _Priority_Major_bit_map &= the_priority_map->block_major; 800ee7c: 78 03 08 01 mvhi r3,0x801 800ee80: 38 63 9e 48 ori r3,r3,0x9e48 800ee84: 2c 64 00 00 lhu r4,(r3+0) 800ee88: 2c 42 00 0c lhu r2,(r2+12) 800ee8c: a0 44 10 00 and r2,r2,r4 800ee90: 0c 62 00 00 sh (r3+0),r2 800ee94: e0 00 00 05 bi 800eea8 <_Scheduler_priority_Block+0x88> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; 800ee98: 29 83 00 00 lw r3,(r12+0) previous = the_node->previous; 800ee9c: 29 82 00 04 lw r2,(r12+4) next->previous = previous; 800eea0: 58 62 00 04 sw (r3+4),r2 previous->next = next; 800eea4: 58 43 00 00 sw (r2+0),r3 RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); 800eea8: 78 02 08 01 mvhi r2,0x801 800eeac: 38 42 9e 2c ori r2,r2,0x9e2c { _Scheduler_priority_Ready_queue_extract(the_thread); /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) 800eeb0: 28 42 00 10 lw r2,(r2+16) 800eeb4: 5d 82 00 39 bne r12,r2,800ef98 <_Scheduler_priority_Block+0x178> RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 800eeb8: 78 02 08 01 mvhi r2,0x801 800eebc: 38 42 9e 48 ori r2,r2,0x9e48 _Scheduler_priority_Block_body(the_scheduler, the_thread); } 800eec0: 28 2e 00 00 lw r14,(r1+0) 800eec4: 2c 41 00 00 lhu r1,(r2+0) 800eec8: 78 0b 08 01 mvhi r11,0x801 800eecc: 34 02 00 ff mvi r2,255 800eed0: 20 21 ff ff andi r1,r1,0xffff 800eed4: 39 6b 80 3c ori r11,r11,0x803c 800eed8: 54 22 00 05 bgu r1,r2,800eeec <_Scheduler_priority_Block+0xcc> 800eedc: b5 61 58 00 add r11,r11,r1 800eee0: 41 6d 00 00 lbu r13,(r11+0) 800eee4: 35 ad 00 08 addi r13,r13,8 800eee8: e0 00 00 05 bi 800eefc <_Scheduler_priority_Block+0xdc> 800eeec: 34 02 00 08 mvi r2,8 800eef0: f8 00 20 61 calli 8017074 <__lshrsi3> 800eef4: b5 61 58 00 add r11,r11,r1 800eef8: 41 6d 00 00 lbu r13,(r11+0) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 800eefc: 34 02 00 01 mvi r2,1 800ef00: 78 0b 08 01 mvhi r11,0x801 800ef04: b9 a0 08 00 mv r1,r13 800ef08: f8 00 20 0d calli 8016f3c <__ashlsi3> 800ef0c: 39 6b 9e 50 ori r11,r11,0x9e50 800ef10: b5 61 58 00 add r11,r11,r1 800ef14: 2d 62 00 00 lhu r2,(r11+0) 800ef18: 34 01 00 ff mvi r1,255 800ef1c: 78 0b 08 01 mvhi r11,0x801 800ef20: 39 6b 80 3c ori r11,r11,0x803c 800ef24: 54 41 00 05 bgu r2,r1,800ef38 <_Scheduler_priority_Block+0x118> 800ef28: b5 62 58 00 add r11,r11,r2 800ef2c: 41 6b 00 00 lbu r11,(r11+0) 800ef30: 35 6b 00 08 addi r11,r11,8 800ef34: e0 00 00 06 bi 800ef4c <_Scheduler_priority_Block+0x12c> 800ef38: b8 40 08 00 mv r1,r2 800ef3c: 34 02 00 08 mvi r2,8 800ef40: f8 00 20 4d calli 8017074 <__lshrsi3> 800ef44: b5 61 58 00 add r11,r11,r1 800ef48: 41 6b 00 00 lbu r11,(r11+0) return (_Priority_Bits_index( major ) << 4) + 800ef4c: 34 02 00 04 mvi r2,4 800ef50: b9 a0 08 00 mv r1,r13 800ef54: f8 00 1f fa calli 8016f3c <__ashlsi3> 800ef58: b5 61 58 00 add r11,r11,r1 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 800ef5c: 34 02 00 01 mvi r2,1 800ef60: b9 60 08 00 mv r1,r11 800ef64: f8 00 1f f6 calli 8016f3c <__ashlsi3> 800ef68: 34 02 00 02 mvi r2,2 800ef6c: b4 2b 08 00 add r1,r1,r11 800ef70: f8 00 1f f3 calli 8016f3c <__ashlsi3> 800ef74: b5 c1 08 00 add r1,r14,r1 800ef78: 28 23 00 00 lw r3,(r1+0) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 800ef7c: 34 21 00 04 addi r1,r1,4 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; 800ef80: 34 02 00 00 mvi r2,0 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 800ef84: 44 61 00 02 be r3,r1,800ef8c <_Scheduler_priority_Block+0x16c><== NEVER TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 800ef88: b8 60 10 00 mv r2,r3 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 800ef8c: 78 01 08 01 mvhi r1,0x801 800ef90: 38 21 9e 2c ori r1,r1,0x9e2c 800ef94: 58 22 00 10 sw (r1+16),r2 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 800ef98: 78 01 08 01 mvhi r1,0x801 800ef9c: 38 21 9e 2c ori r1,r1,0x9e2c /* TODO: flash critical section */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(the_scheduler); if ( _Thread_Is_executing( the_thread ) ) 800efa0: 28 22 00 0c lw r2,(r1+12) 800efa4: 5d 82 00 03 bne r12,r2,800efb0 <_Scheduler_priority_Block+0x190> _Thread_Dispatch_necessary = true; 800efa8: 34 02 00 01 mvi r2,1 800efac: 30 22 00 18 sb (r1+24),r2 800efb0: 2b 9d 00 04 lw ra,(sp+4) 800efb4: 2b 8b 00 14 lw r11,(sp+20) 800efb8: 2b 8c 00 10 lw r12,(sp+16) 800efbc: 2b 8d 00 0c lw r13,(sp+12) 800efc0: 2b 8e 00 08 lw r14,(sp+8) 800efc4: 37 9c 00 14 addi sp,sp,20 800efc8: c3 a0 00 00 ret =============================================================================== 080061f4 <_Scheduler_priority_Schedule>: */ void _Scheduler_priority_Schedule( Scheduler_Control *the_scheduler ) { 80061f4: 37 9c ff f0 addi sp,sp,-16 80061f8: 5b 8b 00 10 sw (sp+16),r11 80061fc: 5b 8c 00 0c sw (sp+12),r12 8006200: 5b 8d 00 08 sw (sp+8),r13 8006204: 5b 9d 00 04 sw (sp+4),ra RTEMS_INLINE_ROUTINE Priority_Control _Priority_bit_map_Get_highest( void ) { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); 8006208: 78 02 08 01 mvhi r2,0x801 800620c: 38 42 9e 48 ori r2,r2,0x9e48 _Scheduler_priority_Schedule_body( the_scheduler ); } 8006210: 28 2d 00 00 lw r13,(r1+0) 8006214: 2c 41 00 00 lhu r1,(r2+0) 8006218: 78 0b 08 01 mvhi r11,0x801 800621c: 34 02 00 ff mvi r2,255 8006220: 20 21 ff ff andi r1,r1,0xffff 8006224: 39 6b 80 3c ori r11,r11,0x803c 8006228: 54 22 00 05 bgu r1,r2,800623c <_Scheduler_priority_Schedule+0x48> 800622c: b5 61 58 00 add r11,r11,r1 8006230: 41 6c 00 00 lbu r12,(r11+0) 8006234: 35 8c 00 08 addi r12,r12,8 8006238: e0 00 00 05 bi 800624c <_Scheduler_priority_Schedule+0x58> 800623c: 34 02 00 08 mvi r2,8 8006240: f8 00 43 8d calli 8017074 <__lshrsi3> 8006244: b5 61 58 00 add r11,r11,r1 8006248: 41 6c 00 00 lbu r12,(r11+0) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); 800624c: 34 02 00 01 mvi r2,1 8006250: 78 0b 08 01 mvhi r11,0x801 8006254: b9 80 08 00 mv r1,r12 8006258: f8 00 43 39 calli 8016f3c <__ashlsi3> 800625c: 39 6b 9e 50 ori r11,r11,0x9e50 8006260: b5 61 58 00 add r11,r11,r1 8006264: 2d 62 00 00 lhu r2,(r11+0) 8006268: 34 01 00 ff mvi r1,255 800626c: 78 0b 08 01 mvhi r11,0x801 8006270: 39 6b 80 3c ori r11,r11,0x803c 8006274: 54 41 00 05 bgu r2,r1,8006288 <_Scheduler_priority_Schedule+0x94> 8006278: b5 62 58 00 add r11,r11,r2 800627c: 41 6b 00 00 lbu r11,(r11+0) 8006280: 35 6b 00 08 addi r11,r11,8 8006284: e0 00 00 06 bi 800629c <_Scheduler_priority_Schedule+0xa8> 8006288: b8 40 08 00 mv r1,r2 800628c: 34 02 00 08 mvi r2,8 8006290: f8 00 43 79 calli 8017074 <__lshrsi3> 8006294: b5 61 58 00 add r11,r11,r1 8006298: 41 6b 00 00 lbu r11,(r11+0) return (_Priority_Bits_index( major ) << 4) + 800629c: 34 02 00 04 mvi r2,4 80062a0: b9 80 08 00 mv r1,r12 80062a4: f8 00 43 26 calli 8016f3c <__ashlsi3> 80062a8: b5 61 58 00 add r11,r11,r1 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 80062ac: 34 02 00 01 mvi r2,1 80062b0: b9 60 08 00 mv r1,r11 80062b4: f8 00 43 22 calli 8016f3c <__ashlsi3> 80062b8: 34 02 00 02 mvi r2,2 80062bc: b4 2b 08 00 add r1,r1,r11 80062c0: f8 00 43 1f calli 8016f3c <__ashlsi3> 80062c4: b5 a1 08 00 add r1,r13,r1 80062c8: 28 23 00 00 lw r3,(r1+0) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 80062cc: 34 21 00 04 addi r1,r1,4 return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; 80062d0: 34 02 00 00 mvi r2,0 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) 80062d4: 44 61 00 02 be r3,r1,80062dc <_Scheduler_priority_Schedule+0xe8><== NEVER TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); 80062d8: b8 60 10 00 mv r2,r3 RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body( Scheduler_Control *the_scheduler ) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( 80062dc: 78 01 08 01 mvhi r1,0x801 80062e0: 38 21 9e 2c ori r1,r1,0x9e2c 80062e4: 58 22 00 10 sw (r1+16),r2 80062e8: 2b 9d 00 04 lw ra,(sp+4) 80062ec: 2b 8b 00 10 lw r11,(sp+16) 80062f0: 2b 8c 00 0c lw r12,(sp+12) 80062f4: 2b 8d 00 08 lw r13,(sp+8) 80062f8: 37 9c 00 10 addi sp,sp,16 80062fc: c3 a0 00 00 ret =============================================================================== 08004248 <_TOD_Validate>: */ bool _TOD_Validate( const rtems_time_of_day *the_tod ) { 8004248: 37 9c ff f0 addi sp,sp,-16 800424c: 5b 8b 00 10 sw (sp+16),r11 8004250: 5b 8c 00 0c sw (sp+12),r12 8004254: 5b 8d 00 08 sw (sp+8),r13 8004258: 5b 9d 00 04 sw (sp+4),ra 800425c: 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(); 8004260: 78 01 08 02 mvhi r1,0x802 8004264: 38 21 10 c4 ori r1,r1,0x10c4 8004268: 28 22 00 0c lw r2,(r1+12) (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) ) return false; 800426c: 34 0c 00 00 mvi r12,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) || 8004270: 45 60 00 22 be r11,r0,80042f8 <_TOD_Validate+0xb0> <== NEVER TAKEN ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / 8004274: 78 03 08 01 mvhi r3,0x801 8004278: 38 63 ea 2c ori r3,r3,0xea2c 800427c: 28 61 00 00 lw r1,(r3+0) 8004280: f8 00 64 44 calli 801d390 <__udivsi3> rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || 8004284: 29 62 00 18 lw r2,(r11+24) 8004288: 50 41 00 1c bgeu r2,r1,80042f8 <_TOD_Validate+0xb0> (the_tod->ticks >= ticks_per_second) || 800428c: 29 62 00 14 lw r2,(r11+20) 8004290: 34 01 00 3b mvi r1,59 8004294: 54 41 00 19 bgu r2,r1,80042f8 <_TOD_Validate+0xb0> (the_tod->second >= TOD_SECONDS_PER_MINUTE) || 8004298: 29 62 00 10 lw r2,(r11+16) 800429c: 54 41 00 17 bgu r2,r1,80042f8 <_TOD_Validate+0xb0> (the_tod->minute >= TOD_MINUTES_PER_HOUR) || 80042a0: 29 62 00 0c lw r2,(r11+12) 80042a4: 34 01 00 17 mvi r1,23 80042a8: 54 41 00 14 bgu r2,r1,80042f8 <_TOD_Validate+0xb0> (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || 80042ac: 29 61 00 04 lw r1,(r11+4) rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || 80042b0: 44 20 00 12 be r1,r0,80042f8 <_TOD_Validate+0xb0> <== NEVER TAKEN (the_tod->month == 0) || 80042b4: 34 02 00 0c mvi r2,12 80042b8: 54 22 00 10 bgu r1,r2,80042f8 <_TOD_Validate+0xb0> (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || 80042bc: 29 62 00 00 lw r2,(r11+0) (the_tod->ticks >= ticks_per_second) || (the_tod->second >= TOD_SECONDS_PER_MINUTE) || (the_tod->minute >= TOD_MINUTES_PER_HOUR) || (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || (the_tod->month > TOD_MONTHS_PER_YEAR) || 80042c0: 34 03 07 c3 mvi r3,1987 80042c4: 50 62 00 0d bgeu r3,r2,80042f8 <_TOD_Validate+0xb0> (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) 80042c8: 29 6d 00 08 lw r13,(r11+8) (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) || 80042cc: 45 a0 00 0b be r13,r0,80042f8 <_TOD_Validate+0xb0> <== NEVER TAKEN 80042d0: 78 0b 08 01 mvhi r11,0x801 (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) 80042d4: 20 42 00 03 andi r2,r2,0x3 80042d8: 39 6b f2 e4 ori r11,r11,0xf2e4 80042dc: 5c 40 00 02 bne r2,r0,80042e4 <_TOD_Validate+0x9c> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; 80042e0: 34 21 00 0d addi r1,r1,13 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; 80042e4: 34 02 00 02 mvi r2,2 80042e8: fb ff f3 ee calli 80012a0 <__ashlsi3> 80042ec: b5 61 08 00 add r1,r11,r1 80042f0: 28 2c 00 00 lw r12,(r1+0) * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( 80042f4: f1 8d 60 00 cmpgeu r12,r12,r13 if ( the_tod->day > days_in_month ) return false; return true; } 80042f8: b9 80 08 00 mv r1,r12 80042fc: 2b 9d 00 04 lw ra,(sp+4) 8004300: 2b 8b 00 10 lw r11,(sp+16) 8004304: 2b 8c 00 0c lw r12,(sp+12) 8004308: 2b 8d 00 08 lw r13,(sp+8) 800430c: 37 9c 00 10 addi sp,sp,16 8004310: c3 a0 00 00 ret =============================================================================== 0800653c <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 800653c: 37 9c ff e8 addi sp,sp,-24 8006540: 5b 8b 00 14 sw (sp+20),r11 8006544: 5b 8c 00 10 sw (sp+16),r12 8006548: 5b 8d 00 0c sw (sp+12),r13 800654c: 5b 8e 00 08 sw (sp+8),r14 8006550: 5b 9d 00 04 sw (sp+4),ra */ /* * Save original state */ original_state = the_thread->current_state; 8006554: 28 2e 00 10 lw r14,(r1+16) void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 8006558: b8 20 58 00 mv r11,r1 /* * 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 ); 800655c: 5b 82 00 18 sw (sp+24),r2 void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { 8006560: 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 ); 8006564: f8 00 03 c1 calli 8007468 <_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 ) 8006568: 29 61 00 14 lw r1,(r11+20) 800656c: 2b 82 00 18 lw r2,(sp+24) 8006570: 44 22 00 03 be r1,r2,800657c <_Thread_Change_priority+0x40> _Thread_Set_priority( the_thread, new_priority ); 8006574: b9 60 08 00 mv r1,r11 8006578: f8 00 03 97 calli 80073d4 <_Thread_Set_priority> _ISR_Disable( level ); 800657c: 90 00 60 00 rcsr r12,IE 8006580: 34 05 ff fe mvi r5,-2 8006584: a1 85 28 00 and r5,r12,r5 8006588: 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; 800658c: 29 61 00 10 lw r1,(r11+16) if ( state != STATES_TRANSIENT ) { 8006590: 34 02 00 04 mvi r2,4 8006594: 21 c4 00 04 andi r4,r14,0x4 8006598: 44 22 00 0f be r1,r2,80065d4 <_Thread_Change_priority+0x98> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) 800659c: 5c 80 00 04 bne r4,r0,80065ac <_Thread_Change_priority+0x70><== NEVER TAKEN RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); 80065a0: 34 02 ff fb mvi r2,-5 80065a4: a0 22 10 00 and r2,r1,r2 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 80065a8: 59 62 00 10 sw (r11+16),r2 _ISR_Enable( level ); 80065ac: d0 0c 00 00 wcsr IE,r12 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 80065b0: 78 03 08 01 mvhi r3,0x801 80065b4: 38 63 81 b4 ori r3,r3,0x81b4 80065b8: 28 62 00 00 lw r2,(r3+0) 80065bc: a0 22 08 00 and r1,r1,r2 if ( _States_Is_waiting_on_thread_queue( state ) ) { 80065c0: 44 20 00 3d be r1,r0,80066b4 <_Thread_Change_priority+0x178> _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); 80065c4: 29 61 00 44 lw r1,(r11+68) 80065c8: b9 60 10 00 mv r2,r11 80065cc: f8 00 03 4d calli 8007300 <_Thread_queue_Requeue> 80065d0: e0 00 00 39 bi 80066b4 <_Thread_Change_priority+0x178> } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { 80065d4: 5c 80 00 28 bne r4,r0,8006674 <_Thread_Change_priority+0x138><== NEVER TAKEN 80065d8: 78 02 08 01 mvhi r2,0x801 * Ready Queue with interrupts off. * * FIXME: hard-coded for priority scheduling. Might be ok since this * function is specific to priority scheduling? */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); 80065dc: 59 60 00 10 sw (r11+16),r0 80065e0: 29 61 00 8c lw r1,(r11+140) 80065e4: 38 42 9e 48 ori r2,r2,0x9e48 if ( prepend_it ) 80065e8: 45 a4 00 12 be r13,r4,8006630 <_Thread_Change_priority+0xf4> RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 80065ec: 28 23 00 04 lw r3,(r1+4) 80065f0: 2c 24 00 0a lhu r4,(r1+10) 80065f4: 2c 66 00 00 lhu r6,(r3+0) 80065f8: b8 c4 20 00 or r4,r6,r4 80065fc: 0c 64 00 00 sh (r3+0),r4 _Priority_Major_bit_map |= the_priority_map->ready_major; 8006600: 2c 43 00 00 lhu r3,(r2+0) 8006604: 2c 24 00 08 lhu r4,(r1+8) Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); _Chain_Prepend_unprotected( the_thread->scheduler.priority->ready_chain, 8006608: 28 21 00 00 lw r1,(r1+0) 800660c: b8 83 18 00 or r3,r4,r3 8006610: 20 63 ff ff andi r3,r3,0xffff 8006614: 0c 43 00 00 sh (r2+0),r3 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; 8006618: 28 22 00 00 lw r2,(r1+0) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; 800661c: 59 61 00 04 sw (r11+4),r1 before_node = after_node->next; after_node->next = the_node; 8006620: 58 2b 00 00 sw (r1+0),r11 the_node->next = before_node; 8006624: 59 62 00 00 sw (r11+0),r2 before_node->previous = the_node; 8006628: 58 4b 00 04 sw (r2+4),r11 800662c: e0 00 00 12 bi 8006674 <_Thread_Change_priority+0x138> RTEMS_INLINE_ROUTINE void _Priority_bit_map_Add ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor |= the_priority_map->ready_minor; 8006630: 28 23 00 04 lw r3,(r1+4) 8006634: 2c 24 00 0a lhu r4,(r1+10) 8006638: 2c 66 00 00 lhu r6,(r3+0) 800663c: b8 c4 20 00 or r4,r6,r4 8006640: 0c 64 00 00 sh (r3+0),r4 _Priority_Major_bit_map |= the_priority_map->ready_major; 8006644: 2c 24 00 08 lhu r4,(r1+8) 8006648: 2c 43 00 00 lhu r3,(r2+0) Thread_Control *the_thread ) { _Priority_bit_map_Add( &the_thread->scheduler.priority->Priority_map ); _Chain_Append_unprotected( the_thread->scheduler.priority->ready_chain, 800664c: 28 21 00 00 lw r1,(r1+0) 8006650: b8 83 18 00 or r3,r4,r3 8006654: 20 63 ff ff andi r3,r3,0xffff 8006658: 0c 43 00 00 sh (r2+0),r3 Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 800665c: 28 22 00 08 lw r2,(r1+8) RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 8006660: 34 23 00 04 addi r3,r1,4 Chain_Node *old_last = tail->previous; the_node->next = tail; 8006664: 59 63 00 00 sw (r11+0),r3 tail->previous = the_node; 8006668: 58 2b 00 08 sw (r1+8),r11 old_last->next = the_node; 800666c: 58 4b 00 00 sw (r2+0),r11 the_node->previous = old_last; 8006670: 59 62 00 04 sw (r11+4),r2 _Scheduler_priority_Ready_queue_enqueue_first( the_thread ); else _Scheduler_priority_Ready_queue_enqueue( the_thread ); } _ISR_Flash( level ); 8006674: d0 0c 00 00 wcsr IE,r12 8006678: d0 05 00 00 wcsr IE,r5 */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( Scheduler_Control *the_scheduler ) { the_scheduler->Operations.schedule( the_scheduler ); 800667c: 78 01 08 01 mvhi r1,0x801 8006680: 38 21 99 e4 ori r1,r1,0x99e4 8006684: 28 22 00 04 lw r2,(r1+4) 8006688: d8 40 00 00 call r2 * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); 800668c: 78 01 08 01 mvhi r1,0x801 8006690: 38 21 9e 2c ori r1,r1,0x9e2c 8006694: 28 22 00 0c lw r2,(r1+12) * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Scheduler_Schedule(&_Scheduler); if ( !_Thread_Is_executing_also_the_heir() && 8006698: 28 23 00 10 lw r3,(r1+16) 800669c: 44 43 00 05 be r2,r3,80066b0 <_Thread_Change_priority+0x174> 80066a0: 40 42 00 74 lbu r2,(r2+116) 80066a4: 44 40 00 03 be r2,r0,80066b0 <_Thread_Change_priority+0x174> _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; 80066a8: 34 02 00 01 mvi r2,1 80066ac: 30 22 00 18 sb (r1+24),r2 _ISR_Enable( level ); 80066b0: d0 0c 00 00 wcsr IE,r12 } 80066b4: 2b 9d 00 04 lw ra,(sp+4) 80066b8: 2b 8b 00 14 lw r11,(sp+20) 80066bc: 2b 8c 00 10 lw r12,(sp+16) 80066c0: 2b 8d 00 0c lw r13,(sp+12) 80066c4: 2b 8e 00 08 lw r14,(sp+8) 80066c8: 37 9c 00 18 addi sp,sp,24 80066cc: c3 a0 00 00 ret =============================================================================== 0800bdf0 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { 800bdf0: 37 9c ff f8 addi sp,sp,-8 800bdf4: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 800bdf8: 37 82 00 08 addi r2,sp,8 800bdfc: f8 00 00 7c calli 800bfec <_Thread_Get> switch ( location ) { 800be00: 2b 82 00 08 lw r2,(sp+8) 800be04: 5c 40 00 0a bne r2,r0,800be2c <_Thread_Delay_ended+0x3c> <== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( 800be08: 78 03 08 02 mvhi r3,0x802 800be0c: 38 63 75 8c ori r3,r3,0x758c 800be10: 28 62 00 00 lw r2,(r3+0) 800be14: fb ff ff 6d calli 800bbc8 <_Thread_Clear_state> 800be18: 78 01 08 02 mvhi r1,0x802 800be1c: 38 21 9a 50 ori r1,r1,0x9a50 800be20: 28 22 00 00 lw r2,(r1+0) 800be24: 34 42 ff ff addi r2,r2,-1 800be28: 58 22 00 00 sw (r1+0),r2 | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Thread_Unnest_dispatch(); break; } } 800be2c: 2b 9d 00 04 lw ra,(sp+4) 800be30: 37 9c 00 08 addi sp,sp,8 800be34: c3 a0 00 00 ret =============================================================================== 080067b8 <_Thread_Dispatch>: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { 80067b8: 37 9c ff c0 addi sp,sp,-64 80067bc: 5b 8b 00 30 sw (sp+48),r11 80067c0: 5b 8c 00 2c sw (sp+44),r12 80067c4: 5b 8d 00 28 sw (sp+40),r13 80067c8: 5b 8e 00 24 sw (sp+36),r14 80067cc: 5b 8f 00 20 sw (sp+32),r15 80067d0: 5b 90 00 1c sw (sp+28),r16 80067d4: 5b 91 00 18 sw (sp+24),r17 80067d8: 5b 92 00 14 sw (sp+20),r18 80067dc: 5b 93 00 10 sw (sp+16),r19 80067e0: 5b 94 00 0c sw (sp+12),r20 80067e4: 5b 95 00 08 sw (sp+8),r21 80067e8: 5b 9d 00 04 sw (sp+4),ra Thread_Control *executing; Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; 80067ec: 78 01 08 01 mvhi r1,0x801 80067f0: 38 21 9e 2c ori r1,r1,0x9e2c 80067f4: 28 2d 00 0c lw r13,(r1+12) _ISR_Disable( level ); 80067f8: 90 00 20 00 rcsr r4,IE 80067fc: 34 01 ff fe mvi r1,-2 8006800: a0 81 08 00 and r1,r4,r1 8006804: d0 01 00 00 wcsr IE,r1 while ( _Thread_Dispatch_necessary == true ) { 8006808: 78 0c 08 01 mvhi r12,0x801 heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 800680c: 78 11 08 01 mvhi r17,0x801 #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; 8006810: 78 0f 08 01 mvhi r15,0x801 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( 8006814: 78 0e 08 01 mvhi r14,0x801 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 8006818: 78 10 08 01 mvhi r16,0x801 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 800681c: 39 8c 9e 2c ori r12,r12,0x9e2c heir = _Thread_Heir; _Thread_Dispatch_disable_level = 1; 8006820: 3a 31 99 60 ori r17,r17,0x9960 8006824: 34 14 00 01 mvi r20,1 #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; 8006828: 39 ef 98 f8 ori r15,r15,0x98f8 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 800682c: 37 93 00 3c addi r19,sp,60 _Timestamp_Subtract( 8006830: 39 ce 9a 2c ori r14,r14,0x9a2c 8006834: 37 92 00 34 addi r18,sp,52 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 8006838: 3a 10 9a 04 ori r16,r16,0x9a04 #endif #endif executing = _Thread_Executing; _ISR_Disable( level ); 800683c: 34 15 ff fe mvi r21,-2 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 8006840: e0 00 00 28 bi 80068e0 <_Thread_Dispatch+0x128> heir = _Thread_Heir; 8006844: 29 8b 00 10 lw r11,(r12+16) _Thread_Dispatch_disable_level = 1; 8006848: 5a 34 00 00 sw (r17+0),r20 _Thread_Dispatch_necessary = false; 800684c: 31 80 00 18 sb (r12+24),r0 _Thread_Executing = heir; 8006850: 59 8b 00 0c sw (r12+12),r11 /* * When the heir and executing are the same, then we are being * requested to do the post switch dispatching. This is normally * done to dispatch signals. */ if ( heir == executing ) 8006854: 45 6d 00 26 be r11,r13,80068ec <_Thread_Dispatch+0x134> */ #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 ) 8006858: 29 61 00 7c lw r1,(r11+124) 800685c: 5c 34 00 03 bne r1,r20,8006868 <_Thread_Dispatch+0xb0> heir->cpu_time_budget = _Thread_Ticks_per_timeslice; 8006860: 29 e1 00 00 lw r1,(r15+0) 8006864: 59 61 00 78 sw (r11+120),r1 _ISR_Enable( level ); 8006868: d0 04 00 00 wcsr IE,r4 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); 800686c: ba 60 08 00 mv r1,r19 8006870: f8 00 1f 88 calli 800e690 <_TOD_Get_uptime> _Timestamp_Subtract( 8006874: b9 c0 08 00 mv r1,r14 8006878: ba 60 10 00 mv r2,r19 800687c: ba 40 18 00 mv r3,r18 8006880: f8 00 03 8e calli 80076b8 <_Timespec_Subtract> &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); 8006884: 35 a1 00 84 addi r1,r13,132 8006888: ba 40 10 00 mv r2,r18 800688c: f8 00 03 72 calli 8007654 <_Timespec_Add_to> _Thread_Time_of_last_context_switch = uptime; 8006890: 2b 81 00 3c lw r1,(sp+60) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 8006894: 2a 04 00 00 lw r4,(r16+0) &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; 8006898: 59 c1 00 00 sw (r14+0),r1 800689c: 2b 81 00 40 lw r1,(sp+64) 80068a0: 59 c1 00 04 sw (r14+4),r1 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { 80068a4: 44 80 00 05 be r4,r0,80068b8 <_Thread_Dispatch+0x100> <== NEVER TAKEN executing->libc_reent = *_Thread_libc_reent; 80068a8: 28 81 00 00 lw r1,(r4+0) 80068ac: 59 a1 01 18 sw (r13+280),r1 *_Thread_libc_reent = heir->libc_reent; 80068b0: 29 61 01 18 lw r1,(r11+280) 80068b4: 58 81 00 00 sw (r4+0),r1 } _User_extensions_Thread_switch( executing, heir ); 80068b8: b9 a0 08 00 mv r1,r13 80068bc: b9 60 10 00 mv r2,r11 80068c0: f8 00 04 5d calli 8007a34 <_User_extensions_Thread_switch> if ( executing->fp_context != NULL ) _Context_Save_fp( &executing->fp_context ); #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); 80068c4: 35 a1 00 c4 addi r1,r13,196 80068c8: 35 62 00 c4 addi r2,r11,196 80068cc: f8 00 05 3d calli 8007dc0 <_CPU_Context_switch> if ( executing->fp_context != NULL ) _Context_Restore_fp( &executing->fp_context ); #endif #endif executing = _Thread_Executing; 80068d0: 29 8d 00 0c lw r13,(r12+12) _ISR_Disable( level ); 80068d4: 90 00 20 00 rcsr r4,IE 80068d8: a0 95 08 00 and r1,r4,r21 80068dc: d0 01 00 00 wcsr IE,r1 Thread_Control *heir; ISR_Level level; executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { 80068e0: 41 81 00 18 lbu r1,(r12+24) 80068e4: 20 21 00 ff andi r1,r1,0xff 80068e8: 5c 20 ff d7 bne r1,r0,8006844 <_Thread_Dispatch+0x8c> _ISR_Disable( level ); } post_switch: _Thread_Dispatch_disable_level = 0; 80068ec: 78 01 08 01 mvhi r1,0x801 80068f0: 38 21 99 60 ori r1,r1,0x9960 80068f4: 58 20 00 00 sw (r1+0),r0 _ISR_Enable( level ); 80068f8: d0 04 00 00 wcsr IE,r4 _API_extensions_Run_postswitch(); 80068fc: fb ff f8 3f calli 80049f8 <_API_extensions_Run_postswitch> } 8006900: 2b 9d 00 04 lw ra,(sp+4) 8006904: 2b 8b 00 30 lw r11,(sp+48) 8006908: 2b 8c 00 2c lw r12,(sp+44) 800690c: 2b 8d 00 28 lw r13,(sp+40) 8006910: 2b 8e 00 24 lw r14,(sp+36) 8006914: 2b 8f 00 20 lw r15,(sp+32) 8006918: 2b 90 00 1c lw r16,(sp+28) 800691c: 2b 91 00 18 lw r17,(sp+24) 8006920: 2b 92 00 14 lw r18,(sp+20) 8006924: 2b 93 00 10 lw r19,(sp+16) 8006928: 2b 94 00 0c lw r20,(sp+12) 800692c: 2b 95 00 08 lw r21,(sp+8) 8006930: 37 9c 00 40 addi sp,sp,64 8006934: c3 a0 00 00 ret =============================================================================== 08011218 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { 8011218: 37 9c ff f4 addi sp,sp,-12 801121c: 5b 8b 00 0c sw (sp+12),r11 8011220: 5b 8c 00 08 sw (sp+8),r12 8011224: 5b 9d 00 04 sw (sp+4),ra #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; 8011228: 78 01 08 01 mvhi r1,0x801 801122c: 38 21 9e 2c ori r1,r1,0x9e2c 8011230: 28 2b 00 0c lw r11,(r1+12) /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; 8011234: 29 61 00 ac lw r1,(r11+172) _ISR_Set_level(level); 8011238: 64 21 00 00 cmpei r1,r1,0 801123c: d0 01 00 00 wcsr IE,r1 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; 8011240: 78 01 08 01 mvhi r1,0x801 8011244: 38 21 97 bc ori r1,r1,0x97bc 8011248: 40 2c 00 00 lbu r12,(r1+0) doneConstructors = 1; 801124c: 34 02 00 01 mvi r2,1 8011250: 30 22 00 00 sb (r1+0),r2 /* * 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 ); 8011254: b9 60 08 00 mv r1,r11 8011258: fb ff d9 6b calli 8007804 <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); 801125c: fb ff d5 b7 calli 8006938 <_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) */ { 8011260: 5d 80 00 02 bne r12,r0,8011268 <_Thread_Handler+0x50> INIT_NAME (); 8011264: fb ff bb 67 calli 8000000 } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { 8011268: 29 61 00 94 lw r1,(r11+148) 801126c: 5c 20 00 04 bne r1,r0,801127c <_Thread_Handler+0x64> executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( 8011270: 29 62 00 90 lw r2,(r11+144) 8011274: 29 61 00 9c lw r1,(r11+156) 8011278: e0 00 00 05 bi 801128c <_Thread_Handler+0x74> executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { 801127c: 34 02 00 01 mvi r2,1 8011280: 5c 22 00 05 bne r1,r2,8011294 <_Thread_Handler+0x7c> <== NEVER TAKEN executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( 8011284: 29 62 00 90 lw r2,(r11+144) 8011288: 29 61 00 98 lw r1,(r11+152) 801128c: 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 = 8011290: 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 ); 8011294: b9 60 08 00 mv r1,r11 8011298: fb ff d9 73 calli 8007864 <_User_extensions_Thread_exitted> _Internal_error_Occurred( 801129c: 34 01 00 00 mvi r1,0 80112a0: 34 02 00 01 mvi r2,1 80112a4: 34 03 00 05 mvi r3,5 80112a8: fb ff d0 be calli 80055a0 <_Internal_error_Occurred> =============================================================================== 0800a330 <_Thread_Resume>: void _Thread_Resume( Thread_Control *the_thread, bool force ) { 800a330: 37 9c ff f8 addi sp,sp,-8 800a334: 5b 8b 00 08 sw (sp+8),r11 800a338: 5b 9d 00 04 sw (sp+4),ra 800a33c: b8 20 10 00 mv r2,r1 ISR_Level level; States_Control current_state; _ISR_Disable( level ); 800a340: 90 00 58 00 rcsr r11,IE 800a344: 34 01 ff fe mvi r1,-2 800a348: a1 61 08 00 and r1,r11,r1 800a34c: d0 01 00 00 wcsr IE,r1 current_state = the_thread->current_state; 800a350: 28 41 00 10 lw r1,(r2+16) if ( current_state & STATES_SUSPENDED ) { 800a354: 20 23 00 02 andi r3,r1,0x2 800a358: 44 60 00 09 be r3,r0,800a37c <_Thread_Resume+0x4c> <== NEVER TAKEN RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); 800a35c: 34 03 ff fd mvi r3,-3 800a360: a0 23 08 00 and r1,r1,r3 current_state = the_thread->current_state = _States_Clear(STATES_SUSPENDED, current_state); 800a364: 58 41 00 10 sw (r2+16),r1 if ( _States_Is_ready( current_state ) ) { 800a368: 5c 20 00 05 bne r1,r0,800a37c <_Thread_Resume+0x4c> RTEMS_INLINE_ROUTINE void _Scheduler_Unblock( Scheduler_Control *the_scheduler, Thread_Control *the_thread ) { the_scheduler->Operations.unblock( the_scheduler, the_thread ); 800a36c: 78 01 08 01 mvhi r1,0x801 800a370: 38 21 9a 34 ori r1,r1,0x9a34 800a374: 28 23 00 10 lw r3,(r1+16) 800a378: d8 60 00 00 call r3 _Scheduler_Unblock( &_Scheduler, the_thread ); } } _ISR_Enable( level ); 800a37c: d0 0b 00 00 wcsr IE,r11 } 800a380: 2b 9d 00 04 lw ra,(sp+4) 800a384: 2b 8b 00 08 lw r11,(sp+8) 800a388: 37 9c 00 08 addi sp,sp,8 800a38c: c3 a0 00 00 ret =============================================================================== 0800bce8 <_Thread_Tickle_timeslice>: * * Output parameters: NONE */ void _Thread_Tickle_timeslice( void ) { 800bce8: 37 9c ff f8 addi sp,sp,-8 800bcec: 5b 8b 00 08 sw (sp+8),r11 800bcf0: 5b 9d 00 04 sw (sp+4),ra Thread_Control *executing; executing = _Thread_Executing; 800bcf4: 78 01 08 01 mvhi r1,0x801 800bcf8: 38 21 ae dc ori r1,r1,0xaedc 800bcfc: 28 2b 00 0c lw r11,(r1+12) /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) 800bd00: 41 61 00 74 lbu r1,(r11+116) 800bd04: 44 20 00 1e be r1,r0,800bd7c <_Thread_Tickle_timeslice+0x94> return; if ( !_States_Is_ready( executing->current_state ) ) 800bd08: 29 61 00 10 lw r1,(r11+16) 800bd0c: 5c 20 00 1c bne r1,r0,800bd7c <_Thread_Tickle_timeslice+0x94><== NEVER TAKEN /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { 800bd10: 29 61 00 7c lw r1,(r11+124) 800bd14: 44 20 00 1a be r1,r0,800bd7c <_Thread_Tickle_timeslice+0x94> 800bd18: 34 02 00 02 mvi r2,2 800bd1c: 50 41 00 04 bgeu r2,r1,800bd2c <_Thread_Tickle_timeslice+0x44> 800bd20: 34 02 00 03 mvi r2,3 800bd24: 5c 22 00 16 bne r1,r2,800bd7c <_Thread_Tickle_timeslice+0x94><== NEVER TAKEN 800bd28: e0 00 00 0e bi 800bd60 <_Thread_Tickle_timeslice+0x78> 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 ) { 800bd2c: 29 61 00 78 lw r1,(r11+120) 800bd30: 34 21 ff ff addi r1,r1,-1 800bd34: 59 61 00 78 sw (r11+120),r1 800bd38: 48 20 00 11 bg r1,r0,800bd7c <_Thread_Tickle_timeslice+0x94> * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield( &_Scheduler ); 800bd3c: 78 01 08 01 mvhi r1,0x801 800bd40: 38 21 aa 94 ori r1,r1,0xaa94 800bd44: 28 22 00 08 lw r2,(r1+8) 800bd48: d8 40 00 00 call r2 * executing thread's timeslice is reset. Otherwise, the * currently executing thread is placed at the rear of the * FIFO for this priority and a new heir is selected. */ _Scheduler_Yield( ); executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 800bd4c: 78 01 08 01 mvhi r1,0x801 800bd50: 38 21 a9 a8 ori r1,r1,0xa9a8 800bd54: 28 21 00 00 lw r1,(r1+0) 800bd58: 59 61 00 78 sw (r11+120),r1 800bd5c: e0 00 00 08 bi 800bd7c <_Thread_Tickle_timeslice+0x94> } break; #if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: if ( --executing->cpu_time_budget == 0 ) 800bd60: 29 61 00 78 lw r1,(r11+120) 800bd64: 34 21 ff ff addi r1,r1,-1 800bd68: 59 61 00 78 sw (r11+120),r1 800bd6c: 5c 20 00 04 bne r1,r0,800bd7c <_Thread_Tickle_timeslice+0x94> (*executing->budget_callout)( executing ); 800bd70: 29 62 00 80 lw r2,(r11+128) 800bd74: b9 60 08 00 mv r1,r11 800bd78: d8 40 00 00 call r2 break; #endif } } 800bd7c: 2b 9d 00 04 lw ra,(sp+4) 800bd80: 2b 8b 00 08 lw r11,(sp+8) 800bd84: 37 9c 00 08 addi sp,sp,8 800bd88: c3 a0 00 00 ret =============================================================================== 0800efcc <_Thread_blocking_operation_Cancel>: Thread_blocking_operation_States sync_state __attribute__((unused)), #endif Thread_Control *the_thread, ISR_Level level ) { 800efcc: 37 9c ff f8 addi sp,sp,-8 800efd0: 5b 8b 00 08 sw (sp+8),r11 800efd4: 5b 9d 00 04 sw (sp+4),ra 800efd8: b8 40 58 00 mv r11,r2 #endif /* * The thread is not waiting on anything after this completes. */ the_thread->Wait.queue = NULL; 800efdc: 58 40 00 44 sw (r2+68),r0 /* * If the sync state is timed out, this is very likely not needed. * But better safe than sorry when it comes to critical sections. */ if ( _Watchdog_Is_active( &the_thread->Timer ) ) { 800efe0: 28 42 00 50 lw r2,(r2+80) 800efe4: 34 01 00 02 mvi r1,2 800efe8: 5c 41 00 07 bne r2,r1,800f004 <_Thread_blocking_operation_Cancel+0x38><== ALWAYS TAKEN RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; 800efec: 34 01 00 03 mvi r1,3 <== NOT EXECUTED 800eff0: 59 61 00 50 sw (r11+80),r1 <== NOT EXECUTED _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); 800eff4: d0 03 00 00 wcsr IE,r3 <== NOT EXECUTED (void) _Watchdog_Remove( &the_thread->Timer ); 800eff8: 35 61 00 48 addi r1,r11,72 <== NOT EXECUTED 800effc: fb ff e3 08 calli 8007c1c <_Watchdog_Remove> <== NOT EXECUTED 800f000: e0 00 00 02 bi 800f008 <_Thread_blocking_operation_Cancel+0x3c><== NOT EXECUTED } else _ISR_Enable( level ); 800f004: d0 03 00 00 wcsr IE,r3 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); 800f008: 78 03 08 01 mvhi r3,0x801 800f00c: 38 63 81 bc ori r3,r3,0x81bc 800f010: 28 62 00 00 lw r2,(r3+0) 800f014: b9 60 08 00 mv r1,r11 800f018: f8 00 00 05 calli 800f02c <_Thread_Clear_state> #if defined(RTEMS_MULTIPROCESSING) if ( !_Objects_Is_local_id( the_thread->Object.id ) ) _Thread_MP_Free_proxy( the_thread ); #endif } 800f01c: 2b 9d 00 04 lw ra,(sp+4) 800f020: 2b 8b 00 08 lw r11,(sp+8) 800f024: 37 9c 00 08 addi sp,sp,8 800f028: c3 a0 00 00 ret =============================================================================== 0800f258 <_Thread_queue_Enqueue_fifo>: ) { Thread_blocking_operation_States sync_state; ISR_Level level; _ISR_Disable( level ); 800f258: 90 00 20 00 rcsr r4,IE 800f25c: 34 05 ff fe mvi r5,-2 800f260: a0 85 28 00 and r5,r4,r5 800f264: d0 05 00 00 wcsr IE,r5 sync_state = the_thread_queue->sync_state; 800f268: 28 25 00 30 lw r5,(r1+48) the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; if (sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) { 800f26c: 34 06 00 01 mvi r6,1 ISR_Level level; _ISR_Disable( level ); sync_state = the_thread_queue->sync_state; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 800f270: 58 20 00 30 sw (r1+48),r0 if (sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED) { 800f274: 5c a6 00 0a bne r5,r6,800f29c <_Thread_queue_Enqueue_fifo+0x44><== NEVER TAKEN Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; 800f278: 28 23 00 08 lw r3,(r1+8) RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); 800f27c: 34 26 00 04 addi r6,r1,4 Chain_Node *old_last = tail->previous; the_node->next = tail; 800f280: 58 46 00 00 sw (r2+0),r6 tail->previous = the_node; 800f284: 58 22 00 08 sw (r1+8),r2 old_last->next = the_node; 800f288: 58 62 00 00 sw (r3+0),r2 the_node->previous = old_last; 800f28c: 58 43 00 04 sw (r2+4),r3 _Chain_Append_unprotected( &the_thread_queue->Queues.Fifo, &the_thread->Object.Node ); the_thread->Wait.queue = the_thread_queue; 800f290: 58 41 00 44 sw (r2+68),r1 the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; _ISR_Enable( level ); 800f294: d0 04 00 00 wcsr IE,r4 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 800f298: e0 00 00 02 bi 800f2a0 <_Thread_queue_Enqueue_fifo+0x48> * 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; 800f29c: 58 64 00 00 sw (r3+0),r4 <== NOT EXECUTED return sync_state; } 800f2a0: b8 a0 08 00 mv r1,r5 800f2a4: c3 a0 00 00 ret =============================================================================== 08006fb0 <_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 ) { 8006fb0: 37 9c ff cc addi sp,sp,-52 8006fb4: 5b 8b 00 34 sw (sp+52),r11 8006fb8: 5b 8c 00 30 sw (sp+48),r12 8006fbc: 5b 8d 00 2c sw (sp+44),r13 8006fc0: 5b 8e 00 28 sw (sp+40),r14 8006fc4: 5b 8f 00 24 sw (sp+36),r15 8006fc8: 5b 90 00 20 sw (sp+32),r16 8006fcc: 5b 91 00 1c sw (sp+28),r17 8006fd0: 5b 92 00 18 sw (sp+24),r18 8006fd4: 5b 93 00 14 sw (sp+20),r19 8006fd8: 5b 94 00 10 sw (sp+16),r20 8006fdc: 5b 95 00 0c sw (sp+12),r21 8006fe0: 5b 96 00 08 sw (sp+8),r22 8006fe4: 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; 8006fe8: 28 50 00 14 lw r16,(r2+20) Thread_blocking_operation_States _Thread_queue_Enqueue_priority ( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread, ISR_Level *level_p ) { 8006fec: b8 20 68 00 mv r13,r1 RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); 8006ff0: 34 41 00 3c addi r1,r2,60 head->next = tail; 8006ff4: 58 41 00 38 sw (r2+56),r1 */ RTEMS_INLINE_ROUTINE void _Chain_Initialize_empty( Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); 8006ff8: 34 41 00 38 addi r1,r2,56 Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; tail->previous = head; 8006ffc: 58 41 00 40 sw (r2+64),r1 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 8007000: 58 40 00 3c sw (r2+60),r0 8007004: b8 40 60 00 mv r12,r2 RTEMS_INLINE_ROUTINE uint32_t _Thread_queue_Header_number ( Priority_Control the_priority ) { return (the_priority / TASK_QUEUE_DATA_PRIORITIES_PER_HEADER); 8007008: ba 00 08 00 mv r1,r16 800700c: 34 02 00 06 mvi r2,6 8007010: b8 60 a8 00 mv r21,r3 8007014: f8 00 40 18 calli 8017074 <__lshrsi3> 8007018: b8 20 70 00 mv r14,r1 the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 800701c: 78 12 08 01 mvhi r18,0x801 RTEMS_INLINE_ROUTINE bool _Thread_queue_Is_reverse_search ( Priority_Control the_priority ) { return ( the_priority & TASK_QUEUE_DATA_REVERSE_SEARCH_MASK ); 8007020: 22 01 00 20 andi r1,r16,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 ]; block_state = the_thread_queue->state; 8007024: 29 b3 00 38 lw r19,(r13+56) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 8007028: 3a 52 90 a8 ori r18,r18,0x90a8 _ISR_Disable( level ); 800702c: 34 16 ff fe mvi r22,-2 priority = the_thread->current_priority; header_index = _Thread_queue_Header_number( priority ); header = &the_thread_queue->Queues.Priority[ header_index ]; block_state = the_thread_queue->state; if ( _Thread_queue_Is_reverse_search( priority ) ) 8007030: 5c 20 00 30 bne r1,r0,80070f0 <_Thread_queue_Enqueue_priority+0x140> goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); 8007034: 34 14 ff fe mvi r20,-2 8007038: 90 00 78 00 rcsr r15,IE 800703c: a1 f4 90 00 and r18,r15,r20 8007040: d0 12 00 00 wcsr IE,r18 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 8007044: 34 02 00 01 mvi r2,1 8007048: b9 c0 08 00 mv r1,r14 800704c: f8 00 3f bc calli 8016f3c <__ashlsi3> 8007050: b4 2e 08 00 add r1,r1,r14 8007054: 34 02 00 02 mvi r2,2 8007058: f8 00 3f b9 calli 8016f3c <__ashlsi3> 800705c: b5 a1 08 00 add r1,r13,r1 goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); 8007060: 28 2b 00 00 lw r11,(r1+0) if ( _Thread_queue_Is_reverse_search( priority ) ) goto restart_reverse_search; restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; 8007064: 34 11 ff ff mvi r17,-1 _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 8007068: e0 00 00 0b bi 8007094 <_Thread_queue_Enqueue_priority+0xe4> search_priority = search_thread->current_priority; 800706c: 29 71 00 14 lw r17,(r11+20) if ( priority <= search_priority ) 8007070: 52 30 00 12 bgeu r17,r16,80070b8 <_Thread_queue_Enqueue_priority+0x108> break; search_priority = search_thread->current_priority; if ( priority <= search_priority ) break; #endif _ISR_Flash( level ); 8007074: d0 0f 00 00 wcsr IE,r15 8007078: d0 12 00 00 wcsr IE,r18 RTEMS_INLINE_ROUTINE bool _States_Are_set ( States_Control the_states, States_Control mask ) { return ( (the_states & mask) != STATES_READY); 800707c: 29 61 00 10 lw r1,(r11+16) 8007080: a2 61 08 00 and r1,r19,r1 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 8007084: 5c 20 00 03 bne r1,r0,8007090 <_Thread_queue_Enqueue_priority+0xe0><== ALWAYS TAKEN _ISR_Enable( level ); 8007088: d0 0f 00 00 wcsr IE,r15 <== NOT EXECUTED goto restart_forward_search; 800708c: e3 ff ff eb bi 8007038 <_Thread_queue_Enqueue_priority+0x88><== NOT EXECUTED } search_thread = (Thread_Control *)search_thread->Object.Node.next; 8007090: 29 6b 00 00 lw r11,(r11+0) RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Tail(the_chain)); 8007094: 34 02 00 01 mvi r2,1 8007098: b9 c0 08 00 mv r1,r14 800709c: f8 00 3f a8 calli 8016f3c <__ashlsi3> 80070a0: b4 2e 08 00 add r1,r1,r14 80070a4: 34 02 00 02 mvi r2,2 80070a8: f8 00 3f a5 calli 8016f3c <__ashlsi3> 80070ac: b5 a1 08 00 add r1,r13,r1 80070b0: 34 21 00 04 addi r1,r1,4 restart_forward_search: search_priority = PRIORITY_MINIMUM - 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_First( header ); while ( !_Chain_Is_tail( header, (Chain_Node *)search_thread ) ) { 80070b4: 5d 61 ff ee bne r11,r1,800706c <_Thread_queue_Enqueue_priority+0xbc> } search_thread = (Thread_Control *)search_thread->Object.Node.next; } if ( the_thread_queue->sync_state != 80070b8: 29 a3 00 30 lw r3,(r13+48) 80070bc: 34 02 00 01 mvi r2,1 80070c0: b9 e0 08 00 mv r1,r15 80070c4: 5c 62 00 43 bne r3,r2,80071d0 <_Thread_queue_Enqueue_priority+0x220><== NEVER TAKEN THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 80070c8: 59 a0 00 30 sw (r13+48),r0 if ( priority == search_priority ) 80070cc: 46 11 00 38 be r16,r17,80071ac <_Thread_queue_Enqueue_priority+0x1fc> goto equal_priority; search_node = (Chain_Node *) search_thread; previous_node = search_node->previous; 80070d0: 29 61 00 04 lw r1,(r11+4) the_node = (Chain_Node *) the_thread; the_node->next = search_node; 80070d4: 59 8b 00 00 sw (r12+0),r11 the_node->previous = previous_node; 80070d8: 59 81 00 04 sw (r12+4),r1 previous_node->next = the_node; 80070dc: 58 2c 00 00 sw (r1+0),r12 search_node->previous = the_node; 80070e0: 59 6c 00 04 sw (r11+4),r12 the_thread->Wait.queue = the_thread_queue; 80070e4: 59 8d 00 44 sw (r12+68),r13 _ISR_Enable( level ); 80070e8: d0 0f 00 00 wcsr IE,r15 80070ec: e0 00 00 2e bi 80071a4 <_Thread_queue_Enqueue_priority+0x1f4> return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; 80070f0: 42 51 00 00 lbu r17,(r18+0) 80070f4: 36 31 00 01 addi r17,r17,1 _ISR_Disable( level ); 80070f8: 90 00 78 00 rcsr r15,IE 80070fc: a1 f6 a0 00 and r20,r15,r22 8007100: d0 14 00 00 wcsr IE,r20 * * WARNING! Returning with interrupts disabled! */ *level_p = level; return the_thread_queue->sync_state; } 8007104: 34 02 00 01 mvi r2,1 8007108: b9 c0 08 00 mv r1,r14 800710c: f8 00 3f 8c calli 8016f3c <__ashlsi3> 8007110: b4 2e 08 00 add r1,r1,r14 8007114: 34 02 00 02 mvi r2,2 8007118: f8 00 3f 89 calli 8016f3c <__ashlsi3> 800711c: b5 a1 08 00 add r1,r13,r1 restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); 8007120: 28 2b 00 08 lw r11,(r1+8) while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 8007124: e0 00 00 0b bi 8007150 <_Thread_queue_Enqueue_priority+0x1a0> search_priority = search_thread->current_priority; 8007128: 29 71 00 14 lw r17,(r11+20) if ( priority >= search_priority ) 800712c: 52 11 00 11 bgeu r16,r17,8007170 <_Thread_queue_Enqueue_priority+0x1c0> break; search_priority = search_thread->current_priority; if ( priority >= search_priority ) break; #endif _ISR_Flash( level ); 8007130: d0 0f 00 00 wcsr IE,r15 8007134: d0 14 00 00 wcsr IE,r20 8007138: 29 61 00 10 lw r1,(r11+16) 800713c: a2 61 08 00 and r1,r19,r1 if ( !_States_Are_set( search_thread->current_state, block_state) ) { 8007140: 5c 20 00 03 bne r1,r0,800714c <_Thread_queue_Enqueue_priority+0x19c><== ALWAYS TAKEN _ISR_Enable( level ); 8007144: d0 0f 00 00 wcsr IE,r15 <== NOT EXECUTED goto restart_reverse_search; 8007148: e3 ff ff ea bi 80070f0 <_Thread_queue_Enqueue_priority+0x140><== NOT EXECUTED } search_thread = (Thread_Control *) search_thread->Object.Node.previous; 800714c: 29 6b 00 04 lw r11,(r11+4) RTEMS_INLINE_ROUTINE bool _Chain_Is_head( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Head(the_chain)); 8007150: 34 02 00 01 mvi r2,1 8007154: b9 c0 08 00 mv r1,r14 8007158: f8 00 3f 79 calli 8016f3c <__ashlsi3> 800715c: b4 2e 08 00 add r1,r1,r14 8007160: 34 02 00 02 mvi r2,2 8007164: f8 00 3f 76 calli 8016f3c <__ashlsi3> 8007168: b5 a1 08 00 add r1,r13,r1 restart_reverse_search: search_priority = PRIORITY_MAXIMUM + 1; _ISR_Disable( level ); search_thread = (Thread_Control *) _Chain_Last( header ); while ( !_Chain_Is_head( header, (Chain_Node *)search_thread ) ) { 800716c: 5d 61 ff ef bne r11,r1,8007128 <_Thread_queue_Enqueue_priority+0x178> } search_thread = (Thread_Control *) search_thread->Object.Node.previous; } if ( the_thread_queue->sync_state != 8007170: 29 a3 00 30 lw r3,(r13+48) 8007174: 34 02 00 01 mvi r2,1 8007178: b9 e0 08 00 mv r1,r15 800717c: 5c 62 00 15 bne r3,r2,80071d0 <_Thread_queue_Enqueue_priority+0x220><== NEVER TAKEN THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) goto synchronize; the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_SYNCHRONIZED; 8007180: 59 a0 00 30 sw (r13+48),r0 if ( priority == search_priority ) 8007184: 46 11 00 0a be r16,r17,80071ac <_Thread_queue_Enqueue_priority+0x1fc> goto equal_priority; search_node = (Chain_Node *) search_thread; next_node = search_node->next; 8007188: 29 61 00 00 lw r1,(r11+0) the_node = (Chain_Node *) the_thread; the_node->next = next_node; the_node->previous = search_node; 800718c: 59 8b 00 04 sw (r12+4),r11 search_node = (Chain_Node *) search_thread; next_node = search_node->next; the_node = (Chain_Node *) the_thread; the_node->next = next_node; 8007190: 59 81 00 00 sw (r12+0),r1 the_node->previous = search_node; search_node->next = the_node; 8007194: 59 6c 00 00 sw (r11+0),r12 next_node->previous = the_node; 8007198: 58 2c 00 04 sw (r1+4),r12 the_thread->Wait.queue = the_thread_queue; 800719c: 59 8d 00 44 sw (r12+68),r13 _ISR_Enable( level ); 80071a0: d0 0f 00 00 wcsr IE,r15 return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; 80071a4: 34 01 00 01 mvi r1,1 80071a8: e0 00 00 0c bi 80071d8 <_Thread_queue_Enqueue_priority+0x228> equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); previous_node = search_node->previous; 80071ac: 29 61 00 40 lw r1,(r11+64) the_thread->Wait.queue = the_thread_queue; _ISR_Enable( level ); return THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED; equal_priority: /* add at end of priority group */ search_node = _Chain_Tail( &search_thread->Wait.Block2n ); 80071b0: 35 62 00 3c addi r2,r11,60 previous_node = search_node->previous; the_node = (Chain_Node *) the_thread; the_node->next = search_node; 80071b4: 59 82 00 00 sw (r12+0),r2 the_node->previous = previous_node; 80071b8: 59 81 00 04 sw (r12+4),r1 previous_node->next = the_node; 80071bc: 58 2c 00 00 sw (r1+0),r12 search_node->previous = the_node; 80071c0: 59 6c 00 40 sw (r11+64),r12 the_thread->Wait.queue = the_thread_queue; 80071c4: 59 8d 00 44 sw (r12+68),r13 _ISR_Enable( level ); 80071c8: d0 0f 00 00 wcsr IE,r15 80071cc: e3 ff ff f6 bi 80071a4 <_Thread_queue_Enqueue_priority+0x1f4> * 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; 80071d0: 5a a1 00 00 sw (r21+0),r1 <== NOT EXECUTED return the_thread_queue->sync_state; 80071d4: 29 a1 00 30 lw r1,(r13+48) <== NOT EXECUTED } 80071d8: 2b 9d 00 04 lw ra,(sp+4) 80071dc: 2b 8b 00 34 lw r11,(sp+52) 80071e0: 2b 8c 00 30 lw r12,(sp+48) 80071e4: 2b 8d 00 2c lw r13,(sp+44) 80071e8: 2b 8e 00 28 lw r14,(sp+40) 80071ec: 2b 8f 00 24 lw r15,(sp+36) 80071f0: 2b 90 00 20 lw r16,(sp+32) 80071f4: 2b 91 00 1c lw r17,(sp+28) 80071f8: 2b 92 00 18 lw r18,(sp+24) 80071fc: 2b 93 00 14 lw r19,(sp+20) 8007200: 2b 94 00 10 lw r20,(sp+16) 8007204: 2b 95 00 0c lw r21,(sp+12) 8007208: 2b 96 00 08 lw r22,(sp+8) 800720c: 37 9c 00 34 addi sp,sp,52 8007210: c3 a0 00 00 ret =============================================================================== 08006eec <_Thread_queue_Enqueue_with_handler>: void _Thread_queue_Enqueue_with_handler( Thread_queue_Control *the_thread_queue, Watchdog_Interval timeout, Thread_queue_Timeout_callout handler ) { 8006eec: 37 9c ff e8 addi sp,sp,-24 8006ef0: 5b 8b 00 14 sw (sp+20),r11 8006ef4: 5b 8c 00 10 sw (sp+16),r12 8006ef8: 5b 8d 00 0c sw (sp+12),r13 8006efc: 5b 8e 00 08 sw (sp+8),r14 8006f00: 5b 9d 00 04 sw (sp+4),ra 8006f04: b8 20 60 00 mv r12,r1 Thread_queue_Control *, Thread_Control *, ISR_Level * ); the_thread = _Thread_Executing; 8006f08: 78 01 08 01 mvhi r1,0x801 8006f0c: 38 21 9e 2c ori r1,r1,0x9e2c 8006f10: 28 2b 00 0c lw r11,(r1+12) void _Thread_queue_Enqueue_with_handler( Thread_queue_Control *the_thread_queue, Watchdog_Interval timeout, Thread_queue_Timeout_callout handler ) { 8006f14: b8 40 68 00 mv r13,r2 else #endif /* * Set the blocking state for this thread queue in the thread. */ _Thread_Set_state( the_thread, the_thread_queue->state ); 8006f18: 29 82 00 38 lw r2,(r12+56) 8006f1c: b9 60 08 00 mv r1,r11 void _Thread_queue_Enqueue_with_handler( Thread_queue_Control *the_thread_queue, Watchdog_Interval timeout, Thread_queue_Timeout_callout handler ) { 8006f20: b8 60 70 00 mv r14,r3 else #endif /* * Set the blocking state for this thread queue in the thread. */ _Thread_Set_state( the_thread, the_thread_queue->state ); 8006f24: f8 00 01 38 calli 8007404 <_Thread_Set_state> /* * If the thread wants to timeout, then schedule its timer. */ if ( timeout ) { 8006f28: 45 a0 00 0b be r13,r0,8006f54 <_Thread_queue_Enqueue_with_handler+0x68> _Watchdog_Initialize( 8006f2c: 29 61 00 08 lw r1,(r11+8) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 8006f30: 59 60 00 50 sw (r11+80),r0 the_watchdog->routine = routine; 8006f34: 59 6e 00 64 sw (r11+100),r14 the_watchdog->id = id; 8006f38: 59 61 00 68 sw (r11+104),r1 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8006f3c: 78 01 08 01 mvhi r1,0x801 ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; the_watchdog->user_data = user_data; 8006f40: 59 60 00 6c sw (r11+108),r0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8006f44: 59 6d 00 54 sw (r11+84),r13 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8006f48: 38 21 9a 40 ori r1,r1,0x9a40 8006f4c: 35 62 00 48 addi r2,r11,72 8006f50: f8 00 02 d4 calli 8007aa0 <_Watchdog_Insert> } /* * Now enqueue the thread per the discipline for this thread queue. */ if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) 8006f54: 29 82 00 34 lw r2,(r12+52) enqueue_p = _Thread_queue_Enqueue_priority; else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */ enqueue_p = _Thread_queue_Enqueue_fifo; 8006f58: 78 04 08 00 mvhi r4,0x800 } /* * Now enqueue the thread per the discipline for this thread queue. */ if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) 8006f5c: 34 01 00 01 mvi r1,1 enqueue_p = _Thread_queue_Enqueue_priority; else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */ enqueue_p = _Thread_queue_Enqueue_fifo; 8006f60: 38 84 f2 58 ori r4,r4,0xf258 } /* * Now enqueue the thread per the discipline for this thread queue. */ if ( the_thread_queue->discipline == THREAD_QUEUE_DISCIPLINE_PRIORITY ) 8006f64: 5c 41 00 03 bne r2,r1,8006f70 <_Thread_queue_Enqueue_with_handler+0x84> enqueue_p = _Thread_queue_Enqueue_priority; 8006f68: 78 04 08 00 mvhi r4,0x800 8006f6c: 38 84 6f b0 ori r4,r4,0x6fb0 else /* must be THREAD_QUEUE_DISCIPLINE_FIFO */ enqueue_p = _Thread_queue_Enqueue_fifo; sync_state = (*enqueue_p)( the_thread_queue, the_thread, &level ); 8006f70: b9 60 10 00 mv r2,r11 8006f74: b9 80 08 00 mv r1,r12 8006f78: 37 83 00 18 addi r3,sp,24 8006f7c: d8 80 00 00 call r4 if ( sync_state != THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) 8006f80: 34 02 00 01 mvi r2,1 8006f84: 44 22 00 04 be r1,r2,8006f94 <_Thread_queue_Enqueue_with_handler+0xa8><== ALWAYS TAKEN _Thread_blocking_operation_Cancel( sync_state, the_thread, level ); 8006f88: 2b 83 00 18 lw r3,(sp+24) <== NOT EXECUTED 8006f8c: b9 60 10 00 mv r2,r11 <== NOT EXECUTED 8006f90: f8 00 20 0f calli 800efcc <_Thread_blocking_operation_Cancel><== NOT EXECUTED } 8006f94: 2b 9d 00 04 lw ra,(sp+4) 8006f98: 2b 8b 00 14 lw r11,(sp+20) 8006f9c: 2b 8c 00 10 lw r12,(sp+16) 8006fa0: 2b 8d 00 0c lw r13,(sp+12) 8006fa4: 2b 8e 00 08 lw r14,(sp+8) 8006fa8: 37 9c 00 18 addi sp,sp,24 8006fac: c3 a0 00 00 ret =============================================================================== 0800f3e0 <_Thread_queue_Process_timeout>: #include void _Thread_queue_Process_timeout( Thread_Control *the_thread ) { 800f3e0: 37 9c ff fc addi sp,sp,-4 800f3e4: 5b 9d 00 04 sw (sp+4),ra 800f3e8: b8 20 10 00 mv r2,r1 Thread_queue_Control *the_thread_queue = the_thread->Wait.queue; 800f3ec: 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 && 800f3f0: 28 24 00 30 lw r4,(r1+48) 800f3f4: 44 80 00 0c be r4,r0,800f424 <_Thread_queue_Process_timeout+0x44> RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 800f3f8: 78 03 08 01 mvhi r3,0x801 800f3fc: 38 63 9e 2c ori r3,r3,0x9e2c 800f400: 28 63 00 0c lw r3,(r3+12) 800f404: 5c 43 00 08 bne r2,r3,800f424 <_Thread_queue_Process_timeout+0x44><== NEVER TAKEN _Thread_Is_executing( the_thread ) ) { if ( the_thread_queue->sync_state != THREAD_BLOCKING_OPERATION_SATISFIED ) { 800f408: 34 03 00 03 mvi r3,3 800f40c: 44 83 00 09 be r4,r3,800f430 <_Thread_queue_Process_timeout+0x50><== ALWAYS TAKEN the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; 800f410: 28 23 00 3c lw r3,(r1+60) <== NOT EXECUTED 800f414: 58 43 00 34 sw (r2+52),r3 <== NOT EXECUTED the_thread_queue->sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; 800f418: 34 02 00 02 mvi r2,2 <== NOT EXECUTED 800f41c: 58 22 00 30 sw (r1+48),r2 <== NOT EXECUTED 800f420: e0 00 00 04 bi 800f430 <_Thread_queue_Process_timeout+0x50><== NOT EXECUTED } } else { the_thread->Wait.return_code = the_thread->Wait.queue->timeout_status; 800f424: 28 23 00 3c lw r3,(r1+60) 800f428: 58 43 00 34 sw (r2+52),r3 _Thread_queue_Extract( the_thread->Wait.queue, the_thread ); 800f42c: f8 00 07 a0 calli 80112ac <_Thread_queue_Extract> } } 800f430: 2b 9d 00 04 lw ra,(sp+4) 800f434: 37 9c 00 04 addi sp,sp,4 800f438: c3 a0 00 00 ret =============================================================================== 08007300 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { 8007300: 37 9c ff ec addi sp,sp,-20 8007304: 5b 8b 00 10 sw (sp+16),r11 8007308: 5b 8c 00 0c sw (sp+12),r12 800730c: 5b 8d 00 08 sw (sp+8),r13 8007310: 5b 9d 00 04 sw (sp+4),ra 8007314: b8 20 58 00 mv r11,r1 8007318: 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 ) 800731c: 44 20 00 19 be r1,r0,8007380 <_Thread_queue_Requeue+0x80> <== 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 ) { 8007320: 28 22 00 34 lw r2,(r1+52) 8007324: 34 01 00 01 mvi r1,1 8007328: 5c 41 00 16 bne r2,r1,8007380 <_Thread_queue_Requeue+0x80> <== NEVER TAKEN Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); 800732c: 90 00 68 00 rcsr r13,IE 8007330: 34 01 ff fe mvi r1,-2 8007334: a1 a1 08 00 and r1,r13,r1 8007338: d0 01 00 00 wcsr IE,r1 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); 800733c: 78 03 08 01 mvhi r3,0x801 8007340: 38 63 81 b4 ori r3,r3,0x81b4 8007344: 29 82 00 10 lw r2,(r12+16) 8007348: 28 61 00 00 lw r1,(r3+0) 800734c: a0 41 08 00 and r1,r2,r1 if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { 8007350: 44 20 00 0b be r1,r0,800737c <_Thread_queue_Requeue+0x7c> <== NEVER TAKEN 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; 8007354: 34 01 00 01 mvi r1,1 8007358: 59 61 00 30 sw (r11+48),r1 _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); 800735c: b9 80 10 00 mv r2,r12 8007360: b9 60 08 00 mv r1,r11 8007364: 34 03 00 01 mvi r3,1 8007368: f8 00 1f d0 calli 800f2a8 <_Thread_queue_Extract_priority_helper> (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); 800736c: b9 60 08 00 mv r1,r11 8007370: b9 80 10 00 mv r2,r12 8007374: 37 83 00 14 addi r3,sp,20 8007378: fb ff ff 0e calli 8006fb0 <_Thread_queue_Enqueue_priority> } _ISR_Enable( level ); 800737c: d0 0d 00 00 wcsr IE,r13 } } 8007380: 2b 9d 00 04 lw ra,(sp+4) 8007384: 2b 8b 00 10 lw r11,(sp+16) 8007388: 2b 8c 00 0c lw r12,(sp+12) 800738c: 2b 8d 00 08 lw r13,(sp+8) 8007390: 37 9c 00 14 addi sp,sp,20 8007394: c3 a0 00 00 ret =============================================================================== 08007398 <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { 8007398: 37 9c ff f8 addi sp,sp,-8 800739c: 5b 9d 00 04 sw (sp+4),ra Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); 80073a0: 37 82 00 08 addi r2,sp,8 80073a4: fb ff fd 72 calli 800696c <_Thread_Get> switch ( location ) { 80073a8: 2b 82 00 08 lw r2,(sp+8) 80073ac: 5c 40 00 07 bne r2,r0,80073c8 <_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 ); 80073b0: f8 00 20 0c calli 800f3e0 <_Thread_queue_Process_timeout> */ RTEMS_INLINE_ROUTINE void _Thread_Unnest_dispatch( void ) { RTEMS_COMPILER_MEMORY_BARRIER(); _Thread_Dispatch_disable_level -= 1; 80073b4: 78 01 08 01 mvhi r1,0x801 80073b8: 38 21 99 60 ori r1,r1,0x9960 80073bc: 28 22 00 00 lw r2,(r1+0) 80073c0: 34 42 ff ff addi r2,r2,-1 80073c4: 58 22 00 00 sw (r1+0),r2 _Thread_Unnest_dispatch(); break; } } 80073c8: 2b 9d 00 04 lw ra,(sp+4) 80073cc: 37 9c 00 08 addi sp,sp,8 80073d0: c3 a0 00 00 ret =============================================================================== 080146bc <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 80146bc: 37 9c ff a8 addi sp,sp,-88 80146c0: 5b 8b 00 40 sw (sp+64),r11 80146c4: 5b 8c 00 3c sw (sp+60),r12 80146c8: 5b 8d 00 38 sw (sp+56),r13 80146cc: 5b 8e 00 34 sw (sp+52),r14 80146d0: 5b 8f 00 30 sw (sp+48),r15 80146d4: 5b 90 00 2c sw (sp+44),r16 80146d8: 5b 91 00 28 sw (sp+40),r17 80146dc: 5b 92 00 24 sw (sp+36),r18 80146e0: 5b 93 00 20 sw (sp+32),r19 80146e4: 5b 94 00 1c sw (sp+28),r20 80146e8: 5b 95 00 18 sw (sp+24),r21 80146ec: 5b 96 00 14 sw (sp+20),r22 80146f0: 5b 97 00 10 sw (sp+16),r23 80146f4: 5b 98 00 0c sw (sp+12),r24 80146f8: 5b 99 00 08 sw (sp+8),r25 80146fc: 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; 8014700: 78 10 08 04 mvhi r16,0x804 * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { 8014704: b8 20 58 00 mv r11,r1 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 8014708: 37 82 00 54 addi r2,sp,84 801470c: 37 81 00 50 addi r1,sp,80 8014710: 37 8f 00 44 addi r15,sp,68 8014714: 37 91 00 48 addi r17,sp,72 static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 8014718: 78 0e 08 04 mvhi r14,0x804 801471c: 5b 82 00 50 sw (sp+80),r2 head->previous = NULL; 8014720: 5b 80 00 54 sw (sp+84),r0 tail->previous = head; 8014724: 5b 81 00 58 sw (sp+88),r1 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 8014728: 5b 91 00 44 sw (sp+68),r17 head->previous = NULL; 801472c: 5b 80 00 48 sw (sp+72),r0 tail->previous = head; 8014730: 5b 8f 00 4c sw (sp+76),r15 Chain_Control *tmp; /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; 8014734: b8 20 c8 00 mv r25,r1 static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 8014738: 3a 10 0e 10 ori r16,r16,0xe10 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 801473c: 35 73 00 30 addi r19,r11,48 static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); 8014740: 39 ce 0d 88 ori r14,r14,0xd88 /* * 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 ); 8014744: 35 6d 00 68 addi r13,r11,104 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 ) { 8014748: 34 18 00 03 mvi r24,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 ); 801474c: 34 12 ff fe mvi r18,-2 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_tail( const Chain_Control *the_chain ) { return &the_chain->Tail.Node; 8014750: b8 40 b8 00 mv r23,r2 _Thread_Set_state( ts->thread, STATES_DELAYING ); _Timer_server_Reset_interval_system_watchdog( ts ); _Timer_server_Reset_tod_system_watchdog( ts ); _Thread_Enable_dispatch(); ts->active = true; 8014754: 34 16 00 01 mvi r22,1 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 8014758: 35 75 00 08 addi r21,r11,8 static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 801475c: 35 74 00 40 addi r20,r11,64 Chain_Control *tmp; /* * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; 8014760: 59 79 00 78 sw (r11+120),r25 static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; 8014764: 2a 02 00 00 lw r2,(r16+0) /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; 8014768: 29 63 00 3c lw r3,(r11+60) watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 801476c: ba 60 08 00 mv r1,r19 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; 8014770: 59 62 00 3c sw (r11+60),r2 _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); 8014774: c8 43 10 00 sub r2,r2,r3 8014778: b9 e0 18 00 mv r3,r15 801477c: f8 00 15 86 calli 8019d94 <_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; 8014780: 29 64 00 74 lw r4,(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(); 8014784: 29 cc 00 00 lw r12,(r14+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 ) { 8014788: 50 8c 00 06 bgeu r4,r12,80147a0 <_Timer_server_Body+0xe4> /* * 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 ); 801478c: b9 a0 08 00 mv r1,r13 8014790: c9 84 10 00 sub r2,r12,r4 8014794: b9 e0 18 00 mv r3,r15 8014798: f8 00 15 7f calli 8019d94 <_Watchdog_Adjust_to_chain> 801479c: e0 00 00 06 bi 80147b4 <_Timer_server_Body+0xf8> } else if ( snapshot < last_snapshot ) { 80147a0: 51 84 00 05 bgeu r12,r4,80147b4 <_Timer_server_Body+0xf8> /* * 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 ); 80147a4: b9 a0 08 00 mv r1,r13 80147a8: 34 02 00 01 mvi r2,1 80147ac: c8 8c 18 00 sub r3,r4,r12 80147b0: f8 00 15 42 calli 8019cb8 <_Watchdog_Adjust> } watchdogs->last_snapshot = snapshot; 80147b4: 59 6c 00 74 sw (r11+116),r12 static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 80147b8: 34 0c 00 01 mvi r12,1 } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); 80147bc: 29 63 00 78 lw r3,(r11+120) 80147c0: b8 60 08 00 mv r1,r3 80147c4: f8 00 03 84 calli 80155d4 <_Chain_Get> 80147c8: b8 20 10 00 mv r2,r1 if ( timer == NULL ) { 80147cc: 44 20 00 09 be r1,r0,80147f0 <_Timer_server_Body+0x134> <== ALWAYS TAKEN static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 80147d0: 28 23 00 38 lw r3,(r1+56) <== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 80147d4: ba 60 08 00 mv r1,r19 <== NOT EXECUTED static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 80147d8: 44 6c 00 03 be r3,r12,80147e4 <_Timer_server_Body+0x128> <== NOT EXECUTED _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 80147dc: 5c 78 ff f8 bne r3,r24,80147bc <_Timer_server_Body+0x100> <== NOT EXECUTED _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 80147e0: b9 a0 08 00 mv r1,r13 <== NOT EXECUTED 80147e4: 34 42 00 10 addi r2,r2,16 <== NOT EXECUTED 80147e8: f8 00 15 90 calli 8019e28 <_Watchdog_Insert> <== NOT EXECUTED 80147ec: e3 ff ff f4 bi 80147bc <_Timer_server_Body+0x100> <== 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 ); 80147f0: 90 00 20 00 rcsr r4,IE 80147f4: a0 92 08 00 and r1,r4,r18 80147f8: d0 01 00 00 wcsr IE,r1 tmp = ts->insert_chain; 80147fc: 29 61 00 78 lw r1,(r11+120) if ( _Chain_Is_empty( insert_chain ) ) { 8014800: 2b 81 00 50 lw r1,(sp+80) 8014804: 34 03 00 01 mvi r3,1 8014808: 5c 37 00 03 bne r1,r23,8014814 <_Timer_server_Body+0x158> <== NEVER TAKEN ts->insert_chain = NULL; 801480c: 59 60 00 78 sw (r11+120),r0 do_loop = false; 8014810: 34 03 00 00 mvi r3,0 } _ISR_Enable( level ); 8014814: d0 04 00 00 wcsr IE,r4 * Afterwards all timer inserts are directed to this chain and the interval * and TOD chains will be no more modified by other parties. */ ts->insert_chain = insert_chain; while ( do_loop ) { 8014818: 5c 60 ff d3 bne r3,r0,8014764 <_Timer_server_Body+0xa8> <== NEVER TAKEN _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 ) ) { 801481c: 2b 81 00 44 lw r1,(sp+68) 8014820: 44 31 00 13 be r1,r17,801486c <_Timer_server_Body+0x1b0> /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); 8014824: 90 00 18 00 rcsr r3,IE 8014828: a0 72 08 00 and r1,r3,r18 801482c: d0 01 00 00 wcsr IE,r1 initialized = false; } #endif return status; } 8014830: 2b 82 00 44 lw r2,(sp+68) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) 8014834: 44 51 00 0c be r2,r17,8014864 <_Timer_server_Body+0x1a8> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; 8014838: 28 44 00 00 lw r4,(r2+0) head->next = new_first; 801483c: 5b 84 00 44 sw (sp+68),r4 new_first->previous = head; 8014840: 58 8f 00 04 sw (r4+4),r15 * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { 8014844: 44 40 00 08 be r2,r0,8014864 <_Timer_server_Body+0x1a8> <== NEVER TAKEN watchdog->state = WATCHDOG_INACTIVE; 8014848: 58 40 00 08 sw (r2+8),r0 _ISR_Enable( level ); 801484c: d0 03 00 00 wcsr IE,r3 /* * 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 ); 8014850: 28 43 00 1c lw r3,(r2+28) 8014854: 28 41 00 20 lw r1,(r2+32) 8014858: 28 42 00 24 lw r2,(r2+36) 801485c: d8 60 00 00 call r3 } 8014860: e3 ff ff f1 bi 8014824 <_Timer_server_Body+0x168> watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; _ISR_Enable( level ); } else { _ISR_Enable( level ); 8014864: d0 03 00 00 wcsr IE,r3 8014868: e3 ff ff be bi 8014760 <_Timer_server_Body+0xa4> * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; 801486c: 31 60 00 7c sb (r11+124),r0 /* * Block until there is something to do. */ _Thread_Disable_dispatch(); 8014870: fb ff ff 53 calli 80145bc <_Thread_Disable_dispatch> _Thread_Set_state( ts->thread, STATES_DELAYING ); 8014874: 29 61 00 00 lw r1,(r11+0) 8014878: 34 02 00 08 mvi r2,8 801487c: f8 00 12 d7 calli 80193d8 <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); 8014880: b9 60 08 00 mv r1,r11 8014884: fb ff ff 54 calli 80145d4 <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); 8014888: b9 60 08 00 mv r1,r11 801488c: fb ff ff 6f calli 8014648 <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); 8014890: f8 00 0f d6 calli 80187e8 <_Thread_Enable_dispatch> static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 8014894: ba a0 08 00 mv r1,r21 _Thread_Set_state( ts->thread, STATES_DELAYING ); _Timer_server_Reset_interval_system_watchdog( ts ); _Timer_server_Reset_tod_system_watchdog( ts ); _Thread_Enable_dispatch(); ts->active = true; 8014898: 31 76 00 7c sb (r11+124),r22 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); 801489c: f8 00 15 c2 calli 8019fa4 <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); 80148a0: ba 80 08 00 mv r1,r20 80148a4: f8 00 15 c0 calli 8019fa4 <_Watchdog_Remove> 80148a8: e3 ff ff ae bi 8014760 <_Timer_server_Body+0xa4> =============================================================================== 080148ac <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 80148ac: 37 9c ff f4 addi sp,sp,-12 80148b0: 5b 8b 00 0c sw (sp+12),r11 80148b4: 5b 8c 00 08 sw (sp+8),r12 80148b8: 5b 9d 00 04 sw (sp+4),ra 80148bc: b8 20 58 00 mv r11,r1 if ( ts->insert_chain == NULL ) { 80148c0: 28 21 00 78 lw r1,(r1+120) static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { 80148c4: b8 40 60 00 mv r12,r2 if ( ts->insert_chain == NULL ) { 80148c8: 5c 20 00 43 bne r1,r0,80149d4 <_Timer_server_Schedule_operation_method+0x128><== NEVER TAKEN * is the reference point for the delta chain. Thus if we do not update the * reference point we have to add DT to the initial delta of the watchdog * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); 80148cc: fb ff ff 3c calli 80145bc <_Thread_Disable_dispatch> if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { 80148d0: 29 81 00 38 lw r1,(r12+56) 80148d4: 34 02 00 01 mvi r2,1 80148d8: 5c 22 00 1d bne r1,r2,801494c <_Timer_server_Schedule_operation_method+0xa0> /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 80148dc: 90 00 10 00 rcsr r2,IE 80148e0: 34 01 ff fe mvi r1,-2 80148e4: a0 41 08 00 and r1,r2,r1 80148e8: d0 01 00 00 wcsr IE,r1 snapshot = _Watchdog_Ticks_since_boot; 80148ec: 78 01 08 04 mvhi r1,0x804 80148f0: 38 21 0e 10 ori r1,r1,0xe10 80148f4: 28 23 00 00 lw r3,(r1+0) initialized = false; } #endif return status; } 80148f8: 29 61 00 30 lw r1,(r11+48) * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = _Watchdog_Ticks_since_boot; last_snapshot = ts->Interval_watchdogs.last_snapshot; 80148fc: 29 65 00 3c lw r5,(r11+60) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 8014900: 35 64 00 34 addi r4,r11,52 if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { 8014904: 44 24 00 07 be r1,r4,8014920 <_Timer_server_Schedule_operation_method+0x74> /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; 8014908: 28 26 00 10 lw r6,(r1+16) first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; 801490c: c8 65 28 00 sub r5,r3,r5 delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { delta_interval -= delta; } else { delta_interval = 0; 8014910: 34 04 00 00 mvi r4,0 * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { 8014914: 50 a6 00 02 bgeu r5,r6,801491c <_Timer_server_Schedule_operation_method+0x70> delta_interval -= delta; 8014918: c8 c5 20 00 sub r4,r6,r5 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; 801491c: 58 24 00 10 sw (r1+16),r4 } ts->Interval_watchdogs.last_snapshot = snapshot; 8014920: 59 63 00 3c sw (r11+60),r3 _ISR_Enable( level ); 8014924: d0 02 00 00 wcsr IE,r2 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); 8014928: 35 61 00 30 addi r1,r11,48 801492c: 35 82 00 10 addi r2,r12,16 8014930: f8 00 15 3e calli 8019e28 <_Watchdog_Insert> if ( !ts->active ) { 8014934: 41 61 00 7c lbu r1,(r11+124) 8014938: 20 21 00 ff andi r1,r1,0xff 801493c: 5c 20 00 24 bne r1,r0,80149cc <_Timer_server_Schedule_operation_method+0x120> _Timer_server_Reset_interval_system_watchdog( ts ); 8014940: b9 60 08 00 mv r1,r11 8014944: fb ff ff 24 calli 80145d4 <_Timer_server_Reset_interval_system_watchdog> 8014948: e0 00 00 21 bi 80149cc <_Timer_server_Schedule_operation_method+0x120> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { 801494c: 34 02 00 03 mvi r2,3 8014950: 5c 22 00 1f bne r1,r2,80149cc <_Timer_server_Schedule_operation_method+0x120> /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); 8014954: 90 00 30 00 rcsr r6,IE 8014958: 34 01 ff fe mvi r1,-2 801495c: a0 c1 08 00 and r1,r6,r1 8014960: d0 01 00 00 wcsr IE,r1 initialized = false; } #endif return status; } 8014964: 29 62 00 68 lw r2,(r11+104) /* * 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(); 8014968: 78 01 08 04 mvhi r1,0x804 last_snapshot = ts->TOD_watchdogs.last_snapshot; 801496c: 29 65 00 74 lw r5,(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(); 8014970: 38 21 0d 88 ori r1,r1,0xd88 8014974: 35 63 00 6c addi r3,r11,108 8014978: 28 21 00 00 lw r1,(r1+0) last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { 801497c: 44 43 00 0a be r2,r3,80149a4 <_Timer_server_Schedule_operation_method+0xf8> first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; 8014980: 28 44 00 10 lw r4,(r2+16) } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; 8014984: b4 85 18 00 add r3,r4,r5 delta_interval += delta; 8014988: 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 ) { 801498c: 50 a1 00 05 bgeu r5,r1,80149a0 <_Timer_server_Schedule_operation_method+0xf4> /* * We advanced in time. */ delta = snapshot - last_snapshot; 8014990: c8 25 28 00 sub r5,r1,r5 if (delta_interval > delta) { delta_interval -= delta; } else { delta_interval = 0; 8014994: 34 03 00 00 mvi r3,0 if ( snapshot > last_snapshot ) { /* * We advanced in time. */ delta = snapshot - last_snapshot; if (delta_interval > delta) { 8014998: 50 a4 00 02 bgeu r5,r4,80149a0 <_Timer_server_Schedule_operation_method+0xf4><== NEVER TAKEN delta_interval -= delta; 801499c: c8 85 18 00 sub r3,r4,r5 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; 80149a0: 58 43 00 10 sw (r2+16),r3 } ts->TOD_watchdogs.last_snapshot = snapshot; 80149a4: 59 61 00 74 sw (r11+116),r1 _ISR_Enable( level ); 80149a8: d0 06 00 00 wcsr IE,r6 _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); 80149ac: 35 61 00 68 addi r1,r11,104 80149b0: 35 82 00 10 addi r2,r12,16 80149b4: f8 00 15 1d calli 8019e28 <_Watchdog_Insert> if ( !ts->active ) { 80149b8: 41 61 00 7c lbu r1,(r11+124) 80149bc: 20 21 00 ff andi r1,r1,0xff 80149c0: 5c 20 00 03 bne r1,r0,80149cc <_Timer_server_Schedule_operation_method+0x120> _Timer_server_Reset_tod_system_watchdog( ts ); 80149c4: b9 60 08 00 mv r1,r11 80149c8: fb ff ff 20 calli 8014648 <_Timer_server_Reset_tod_system_watchdog> } } _Thread_Enable_dispatch(); 80149cc: f8 00 0f 87 calli 80187e8 <_Thread_Enable_dispatch> 80149d0: e0 00 00 03 bi 80149dc <_Timer_server_Schedule_operation_method+0x130> * 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 ); 80149d4: 29 61 00 78 lw r1,(r11+120) <== NOT EXECUTED 80149d8: f8 00 02 e9 calli 801557c <_Chain_Append> <== NOT EXECUTED } } 80149dc: 2b 9d 00 04 lw ra,(sp+4) 80149e0: 2b 8b 00 0c lw r11,(sp+12) 80149e4: 2b 8c 00 08 lw r12,(sp+8) 80149e8: 37 9c 00 0c addi sp,sp,12 80149ec: c3 a0 00 00 ret =============================================================================== 08007700 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { 8007700: 37 9c ff ec addi sp,sp,-20 8007704: 5b 8b 00 14 sw (sp+20),r11 8007708: 5b 8c 00 10 sw (sp+16),r12 800770c: 5b 8d 00 0c sw (sp+12),r13 8007710: 5b 8e 00 08 sw (sp+8),r14 8007714: 5b 9d 00 04 sw (sp+4),ra User_extensions_Control *extension; uint32_t i; uint32_t number_of_extensions; User_extensions_Table *initial_extensions; number_of_extensions = Configuration.number_of_initial_extensions; 8007718: 78 02 08 01 mvhi r2,0x801 800771c: 38 42 90 ac ori r2,r2,0x90ac 8007720: 28 4e 00 3c lw r14,(r2+60) initial_extensions = Configuration.User_extension_table; 8007724: 28 4b 00 40 lw r11,(r2+64) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 8007728: 78 03 08 01 mvhi r3,0x801 800772c: 78 02 08 01 mvhi r2,0x801 8007730: 38 42 9a dc ori r2,r2,0x9adc 8007734: 38 63 9a e0 ori r3,r3,0x9ae0 8007738: 58 43 00 00 sw (r2+0),r3 head->previous = NULL; 800773c: 58 40 00 04 sw (r2+4),r0 tail->previous = head; 8007740: 58 42 00 08 sw (r2+8),r2 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 8007744: 78 03 08 01 mvhi r3,0x801 8007748: 78 02 08 01 mvhi r2,0x801 800774c: 38 42 99 64 ori r2,r2,0x9964 8007750: 38 63 99 68 ori r3,r3,0x9968 8007754: 58 43 00 00 sw (r2+0),r3 head->previous = NULL; 8007758: 58 40 00 04 sw (r2+4),r0 tail->previous = head; 800775c: 58 42 00 08 sw (r2+8),r2 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { 8007760: 45 60 00 22 be r11,r0,80077e8 <_User_extensions_Handler_initialization+0xe8><== NEVER TAKEN extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) 8007764: 34 02 00 34 mvi r2,52 8007768: b9 c0 08 00 mv r1,r14 800776c: f8 00 3e 69 calli 8017110 <__mulsi3> 8007770: b8 20 68 00 mv r13,r1 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( 8007774: f8 00 01 84 calli 8007d84 <_Workspace_Allocate_or_fatal_error> number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 8007778: b9 a0 18 00 mv r3,r13 800777c: 34 02 00 00 mvi r2,0 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( 8007780: b8 20 60 00 mv r12,r1 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 8007784: 34 0d 00 00 mvi r13,0 extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ); memset ( 8007788: f8 00 2a 3c calli 8012078 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 800778c: e0 00 00 16 bi 80077e4 <_User_extensions_Handler_initialization+0xe4> RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; 8007790: 29 61 00 1c lw r1,(r11+28) 8007794: 29 68 00 00 lw r8,(r11+0) 8007798: 29 67 00 04 lw r7,(r11+4) 800779c: 29 66 00 08 lw r6,(r11+8) 80077a0: 29 65 00 0c lw r5,(r11+12) 80077a4: 29 64 00 10 lw r4,(r11+16) 80077a8: 29 63 00 14 lw r3,(r11+20) 80077ac: 29 62 00 18 lw r2,(r11+24) 80077b0: 59 81 00 30 sw (r12+48),r1 80077b4: 59 88 00 14 sw (r12+20),r8 80077b8: 59 87 00 18 sw (r12+24),r7 80077bc: 59 86 00 1c sw (r12+28),r6 80077c0: 59 85 00 20 sw (r12+32),r5 80077c4: 59 84 00 24 sw (r12+36),r4 80077c8: 59 83 00 28 sw (r12+40),r3 80077cc: 59 82 00 2c sw (r12+44),r2 _User_extensions_Add_set( extension ); 80077d0: b9 80 08 00 mv r1,r12 80077d4: f8 00 1f 4a calli 800f4fc <_User_extensions_Add_set> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; 80077d8: 35 8c 00 34 addi r12,r12,52 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { 80077dc: 35 ad 00 01 addi r13,r13,1 80077e0: 35 6b 00 20 addi r11,r11,32 80077e4: 55 cd ff eb bgu r14,r13,8007790 <_User_extensions_Handler_initialization+0x90> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; } } } 80077e8: 2b 9d 00 04 lw ra,(sp+4) 80077ec: 2b 8b 00 14 lw r11,(sp+20) 80077f0: 2b 8c 00 10 lw r12,(sp+16) 80077f4: 2b 8d 00 0c lw r13,(sp+12) 80077f8: 2b 8e 00 08 lw r14,(sp+8) 80077fc: 37 9c 00 14 addi sp,sp,20 8007800: c3 a0 00 00 ret =============================================================================== 080088a0 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { 80088a0: 37 9c ff e4 addi sp,sp,-28 80088a4: 5b 8b 00 1c sw (sp+28),r11 80088a8: 5b 8c 00 18 sw (sp+24),r12 80088ac: 5b 8d 00 14 sw (sp+20),r13 80088b0: 5b 8e 00 10 sw (sp+16),r14 80088b4: 5b 8f 00 0c sw (sp+12),r15 80088b8: 5b 90 00 08 sw (sp+8),r16 80088bc: 5b 9d 00 04 sw (sp+4),ra 80088c0: b8 20 60 00 mv r12,r1 80088c4: b8 60 58 00 mv r11,r3 ISR_Level level; _ISR_Disable( level ); 80088c8: 90 00 08 00 rcsr r1,IE 80088cc: 34 03 ff fe mvi r3,-2 80088d0: a0 23 18 00 and r3,r1,r3 80088d4: d0 03 00 00 wcsr IE,r3 } } _ISR_Enable( level ); } 80088d8: 29 83 00 00 lw r3,(r12+0) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 80088dc: 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 ) ) { 80088e0: 44 6e 00 1d be r3,r14,8008954 <_Watchdog_Adjust+0xb4> switch ( direction ) { 80088e4: 44 40 00 04 be r2,r0,80088f4 <_Watchdog_Adjust+0x54> 80088e8: 34 04 00 01 mvi r4,1 80088ec: 5c 44 00 1a bne r2,r4,8008954 <_Watchdog_Adjust+0xb4> <== NEVER TAKEN 80088f0: e0 00 00 04 bi 8008900 <_Watchdog_Adjust+0x60> 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; 80088f4: 34 10 00 01 mvi r16,1 _ISR_Enable( level ); _Watchdog_Tickle( header ); _ISR_Disable( level ); 80088f8: 34 0f ff fe mvi r15,-2 80088fc: e0 00 00 15 bi 8008950 <_Watchdog_Adjust+0xb0> * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; 8008900: 28 62 00 10 lw r2,(r3+16) 8008904: b4 4b 58 00 add r11,r2,r11 8008908: 58 6b 00 10 sw (r3+16),r11 break; 800890c: e0 00 00 12 bi 8008954 <_Watchdog_Adjust+0xb4> RTEMS_INLINE_ROUTINE Watchdog_Control *_Watchdog_First( Chain_Control *header ) { return ( (Watchdog_Control *) _Chain_First( header ) ); 8008910: 29 82 00 00 lw r2,(r12+0) case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { 8008914: 28 4d 00 10 lw r13,(r2+16) 8008918: 51 6d 00 04 bgeu r11,r13,8008928 <_Watchdog_Adjust+0x88> _Watchdog_First( header )->delta_interval -= units; 800891c: c9 ab 58 00 sub r11,r13,r11 8008920: 58 4b 00 10 sw (r2+16),r11 break; 8008924: e0 00 00 0c bi 8008954 <_Watchdog_Adjust+0xb4> } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; 8008928: 58 50 00 10 sw (r2+16),r16 _ISR_Enable( level ); 800892c: d0 01 00 00 wcsr IE,r1 _Watchdog_Tickle( header ); 8008930: b9 80 08 00 mv r1,r12 8008934: f8 00 00 9a calli 8008b9c <_Watchdog_Tickle> _ISR_Disable( level ); 8008938: 90 00 08 00 rcsr r1,IE 800893c: a0 2f 10 00 and r2,r1,r15 8008940: d0 02 00 00 wcsr IE,r2 if ( _Chain_Is_empty( header ) ) 8008944: 29 82 00 00 lw r2,(r12+0) 8008948: 44 4e 00 03 be r2,r14,8008954 <_Watchdog_Adjust+0xb4> while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; 800894c: c9 6d 58 00 sub r11,r11,r13 switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { 8008950: 5d 60 ff f0 bne r11,r0,8008910 <_Watchdog_Adjust+0x70> <== ALWAYS TAKEN } break; } } _ISR_Enable( level ); 8008954: d0 01 00 00 wcsr IE,r1 } 8008958: 2b 9d 00 04 lw ra,(sp+4) 800895c: 2b 8b 00 1c lw r11,(sp+28) 8008960: 2b 8c 00 18 lw r12,(sp+24) 8008964: 2b 8d 00 14 lw r13,(sp+20) 8008968: 2b 8e 00 10 lw r14,(sp+16) 800896c: 2b 8f 00 0c lw r15,(sp+12) 8008970: 2b 90 00 08 lw r16,(sp+8) 8008974: 37 9c 00 1c addi sp,sp,28 8008978: c3 a0 00 00 ret =============================================================================== 08007c1c <_Watchdog_Remove>: { ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); 8007c1c: 90 00 28 00 rcsr r5,IE 8007c20: 34 02 ff fe mvi r2,-2 8007c24: a0 a2 10 00 and r2,r5,r2 8007c28: d0 02 00 00 wcsr IE,r2 previous_state = the_watchdog->state; 8007c2c: 28 23 00 08 lw r3,(r1+8) switch ( previous_state ) { 8007c30: 34 02 00 01 mvi r2,1 8007c34: 44 62 00 05 be r3,r2,8007c48 <_Watchdog_Remove+0x2c> 8007c38: 44 60 00 1b be r3,r0,8007ca4 <_Watchdog_Remove+0x88> 8007c3c: 34 02 00 03 mvi r2,3 8007c40: 54 62 00 19 bgu r3,r2,8007ca4 <_Watchdog_Remove+0x88> <== NEVER TAKEN 8007c44: e0 00 00 03 bi 8007c50 <_Watchdog_Remove+0x34> /* * 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; 8007c48: 58 20 00 08 sw (r1+8),r0 break; 8007c4c: e0 00 00 16 bi 8007ca4 <_Watchdog_Remove+0x88> } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } 8007c50: 28 22 00 00 lw r2,(r1+0) break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; 8007c54: 58 20 00 08 sw (r1+8),r0 next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) 8007c58: 28 44 00 00 lw r4,(r2+0) 8007c5c: 44 80 00 05 be r4,r0,8007c70 <_Watchdog_Remove+0x54> next_watchdog->delta_interval += the_watchdog->delta_interval; 8007c60: 28 46 00 10 lw r6,(r2+16) 8007c64: 28 24 00 10 lw r4,(r1+16) 8007c68: b4 c4 20 00 add r4,r6,r4 8007c6c: 58 44 00 10 sw (r2+16),r4 if ( _Watchdog_Sync_count ) 8007c70: 78 04 08 01 mvhi r4,0x801 8007c74: 38 84 9a 8c ori r4,r4,0x9a8c 8007c78: 28 84 00 00 lw r4,(r4+0) 8007c7c: 44 80 00 07 be r4,r0,8007c98 <_Watchdog_Remove+0x7c> _Watchdog_Sync_level = _ISR_Nest_level; 8007c80: 78 04 08 01 mvhi r4,0x801 8007c84: 38 84 9e 2c ori r4,r4,0x9e2c 8007c88: 28 86 00 08 lw r6,(r4+8) 8007c8c: 78 04 08 01 mvhi r4,0x801 8007c90: 38 84 9a 24 ori r4,r4,0x9a24 8007c94: 58 86 00 00 sw (r4+0),r6 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; 8007c98: 28 24 00 04 lw r4,(r1+4) next->previous = previous; 8007c9c: 58 44 00 04 sw (r2+4),r4 previous->next = next; 8007ca0: 58 82 00 00 sw (r4+0),r2 _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; 8007ca4: 78 02 08 01 mvhi r2,0x801 8007ca8: 38 42 9a 90 ori r2,r2,0x9a90 8007cac: 28 42 00 00 lw r2,(r2+0) 8007cb0: 58 22 00 18 sw (r1+24),r2 _ISR_Enable( level ); 8007cb4: d0 05 00 00 wcsr IE,r5 return( previous_state ); } 8007cb8: b8 60 08 00 mv r1,r3 8007cbc: c3 a0 00 00 ret =============================================================================== 080084ec <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { 80084ec: 37 9c ff ec addi sp,sp,-20 80084f0: 5b 8b 00 14 sw (sp+20),r11 80084f4: 5b 8c 00 10 sw (sp+16),r12 80084f8: 5b 8d 00 0c sw (sp+12),r13 80084fc: 5b 8e 00 08 sw (sp+8),r14 8008500: 5b 9d 00 04 sw (sp+4),ra 8008504: b8 20 70 00 mv r14,r1 8008508: b8 40 60 00 mv r12,r2 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); 800850c: 90 00 68 00 rcsr r13,IE 8008510: 34 01 ff fe mvi r1,-2 8008514: a1 a1 08 00 and r1,r13,r1 8008518: d0 01 00 00 wcsr IE,r1 printk( "Watchdog Chain: %s %p\n", name, header ); 800851c: 78 01 08 01 mvhi r1,0x801 8008520: b9 80 18 00 mv r3,r12 8008524: 38 21 ee 24 ori r1,r1,0xee24 8008528: b9 c0 10 00 mv r2,r14 800852c: fb ff eb a8 calli 80033cc printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } 8008530: 29 8b 00 00 lw r11,(r12+0) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 8008534: 35 8c 00 04 addi r12,r12,4 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { 8008538: 45 6c 00 0b be r11,r12,8008564 <_Watchdog_Report_chain+0x78> node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); 800853c: b9 60 10 00 mv r2,r11 8008540: 34 01 00 00 mvi r1,0 8008544: f8 00 00 13 calli 8008590 <_Watchdog_Report> _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; node != _Chain_Tail(header) ; node = node->next ) 8008548: 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 = _Chain_First( header ) ; 800854c: 5d 6c ff fc bne r11,r12,800853c <_Watchdog_Report_chain+0x50><== NEVER TAKEN { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); 8008550: 78 01 08 01 mvhi r1,0x801 8008554: 38 21 ee 3c ori r1,r1,0xee3c 8008558: b9 c0 10 00 mv r2,r14 800855c: fb ff eb 9c calli 80033cc 8008560: e0 00 00 04 bi 8008570 <_Watchdog_Report_chain+0x84> } else { printk( "Chain is empty\n" ); 8008564: 78 01 08 01 mvhi r1,0x801 8008568: 38 21 ee 4c ori r1,r1,0xee4c 800856c: fb ff eb 98 calli 80033cc } _ISR_Enable( level ); 8008570: d0 0d 00 00 wcsr IE,r13 } 8008574: 2b 9d 00 04 lw ra,(sp+4) 8008578: 2b 8b 00 14 lw r11,(sp+20) 800857c: 2b 8c 00 10 lw r12,(sp+16) 8008580: 2b 8d 00 0c lw r13,(sp+12) 8008584: 2b 8e 00 08 lw r14,(sp+8) 8008588: 37 9c 00 14 addi sp,sp,20 800858c: c3 a0 00 00 ret =============================================================================== 0800c468 <_Watchdog_Tickle>: */ void _Watchdog_Tickle( Chain_Control *header ) { 800c468: 37 9c ff e4 addi sp,sp,-28 800c46c: 5b 8b 00 1c sw (sp+28),r11 800c470: 5b 8c 00 18 sw (sp+24),r12 800c474: 5b 8d 00 14 sw (sp+20),r13 800c478: 5b 8e 00 10 sw (sp+16),r14 800c47c: 5b 8f 00 0c sw (sp+12),r15 800c480: 5b 90 00 08 sw (sp+8),r16 800c484: 5b 9d 00 04 sw (sp+4),ra 800c488: b8 20 60 00 mv r12,r1 * See the comment in watchdoginsert.c and watchdogadjust.c * about why it's safe not to declare header a pointer to * volatile data - till, 2003/7 */ _ISR_Disable( level ); 800c48c: 90 00 18 00 rcsr r3,IE 800c490: 34 01 ff fe mvi r1,-2 800c494: a0 61 08 00 and r1,r3,r1 800c498: d0 01 00 00 wcsr IE,r1 } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); } 800c49c: 29 8b 00 00 lw r11,(r12+0) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 800c4a0: 35 8e 00 04 addi r14,r12,4 * See the comment in watchdoginsert.c and watchdogadjust.c * about why it's safe not to declare header a pointer to * volatile data - till, 2003/7 */ _ISR_Disable( level ); 800c4a4: b8 60 10 00 mv r2,r3 if ( _Chain_Is_empty( header ) ) 800c4a8: 45 6e 00 1a be r11,r14,800c510 <_Watchdog_Tickle+0xa8> * to be inserted has already had its delta_interval adjusted to 0, and * so is added to the head of the chain with a delta_interval of 0. * * Steven Johnson - 12/2005 (gcc-3.2.3 -O3 on powerpc) */ if (the_watchdog->delta_interval != 0) { 800c4ac: 29 61 00 10 lw r1,(r11+16) 800c4b0: 44 20 00 04 be r1,r0,800c4c0 <_Watchdog_Tickle+0x58> the_watchdog->delta_interval--; 800c4b4: 34 21 ff ff addi r1,r1,-1 800c4b8: 59 61 00 10 sw (r11+16),r1 if ( the_watchdog->delta_interval != 0 ) 800c4bc: 5c 20 00 15 bne r1,r0,800c510 <_Watchdog_Tickle+0xa8> */ void _Watchdog_Tickle( Chain_Control *header ) { 800c4c0: b8 60 68 00 mv r13,r3 do { watchdog_state = _Watchdog_Remove( the_watchdog ); _ISR_Enable( level ); switch( watchdog_state ) { 800c4c4: 34 10 00 02 mvi r16,2 case WATCHDOG_REMOVE_IT: break; } _ISR_Disable( level ); 800c4c8: 34 0f ff fe mvi r15,-2 800c4cc: e0 00 00 02 bi 800c4d4 <_Watchdog_Tickle+0x6c> 800c4d0: b8 40 68 00 mv r13,r2 if ( the_watchdog->delta_interval != 0 ) goto leave; } do { watchdog_state = _Watchdog_Remove( the_watchdog ); 800c4d4: b9 60 08 00 mv r1,r11 800c4d8: fb ff ff bb calli 800c3c4 <_Watchdog_Remove> _ISR_Enable( level ); 800c4dc: d0 0d 00 00 wcsr IE,r13 switch( watchdog_state ) { 800c4e0: 5c 30 00 05 bne r1,r16,800c4f4 <_Watchdog_Tickle+0x8c> <== NEVER TAKEN case WATCHDOG_ACTIVE: (*the_watchdog->routine)( 800c4e4: 29 63 00 1c lw r3,(r11+28) 800c4e8: 29 61 00 20 lw r1,(r11+32) 800c4ec: 29 62 00 24 lw r2,(r11+36) 800c4f0: d8 60 00 00 call r3 case WATCHDOG_REMOVE_IT: break; } _ISR_Disable( level ); 800c4f4: 90 00 10 00 rcsr r2,IE 800c4f8: a0 4f 08 00 and r1,r2,r15 800c4fc: d0 01 00 00 wcsr IE,r1 } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); } 800c500: 29 8b 00 00 lw r11,(r12+0) _ISR_Disable( level ); the_watchdog = _Watchdog_First( header ); } while ( !_Chain_Is_empty( header ) && (the_watchdog->delta_interval == 0) ); 800c504: 45 6e 00 03 be r11,r14,800c510 <_Watchdog_Tickle+0xa8> } _ISR_Disable( level ); the_watchdog = _Watchdog_First( header ); } while ( !_Chain_Is_empty( header ) && 800c508: 29 61 00 10 lw r1,(r11+16) 800c50c: 44 20 ff f1 be r1,r0,800c4d0 <_Watchdog_Tickle+0x68> (the_watchdog->delta_interval == 0) ); leave: _ISR_Enable(level); 800c510: d0 02 00 00 wcsr IE,r2 } 800c514: 2b 9d 00 04 lw ra,(sp+4) 800c518: 2b 8b 00 1c lw r11,(sp+28) 800c51c: 2b 8c 00 18 lw r12,(sp+24) 800c520: 2b 8d 00 14 lw r13,(sp+20) 800c524: 2b 8e 00 10 lw r14,(sp+16) 800c528: 2b 8f 00 0c lw r15,(sp+12) 800c52c: 2b 90 00 08 lw r16,(sp+8) 800c530: 37 9c 00 1c addi sp,sp,28 800c534: c3 a0 00 00 ret =============================================================================== 08003978 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 8003978: 37 9c ff e8 addi sp,sp,-24 800397c: 5b 8b 00 18 sw (sp+24),r11 8003980: 5b 8c 00 14 sw (sp+20),r12 8003984: 5b 8d 00 10 sw (sp+16),r13 8003988: 5b 8e 00 0c sw (sp+12),r14 800398c: 5b 8f 00 08 sw (sp+8),r15 8003990: 5b 9d 00 04 sw (sp+4),ra rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 8003994: 78 0b 08 01 mvhi r11,0x801 8003998: 39 6b 78 38 ori r11,r11,0x7838 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 800399c: b8 20 70 00 mv r14,r1 rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 80039a0: b9 60 08 00 mv r1,r11 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { 80039a4: b8 40 60 00 mv r12,r2 rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); 80039a8: f8 00 04 c9 calli 8004ccc if (fcntl (fildes, F_GETFD) < 0) { 80039ac: b9 c0 08 00 mv r1,r14 80039b0: 34 02 00 01 mvi r2,1 80039b4: f8 00 1d df calli 800b130 80039b8: 4c 20 00 06 bge r1,r0,80039d0 pthread_mutex_unlock(&aio_request_queue.mutex); 80039bc: b9 60 08 00 mv r1,r11 80039c0: f8 00 04 f6 calli 8004d98 rtems_set_errno_and_return_minus_one (EBADF); 80039c4: f8 00 2e e4 calli 800f554 <__errno> 80039c8: 34 02 00 09 mvi r2,9 80039cc: e0 00 00 32 bi 8003a94 } /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { 80039d0: 5d 80 00 2b bne r12,r0,8003a7c AIO_printf ("Cancel all requests\n"); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 80039d4: 78 01 08 01 mvhi r1,0x801 80039d8: 38 21 78 80 ori r1,r1,0x7880 80039dc: b9 c0 10 00 mv r2,r14 80039e0: 34 03 00 00 mvi r3,0 80039e4: f8 00 00 c1 calli 8003ce8 80039e8: b8 20 68 00 mv r13,r1 if (r_chain == NULL) { 80039ec: 5c 2c 00 17 bne r1,r12,8003a48 AIO_printf ("Request chain not on [WQ]\n"); if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 80039f0: 29 62 00 54 lw r2,(r11+84) 80039f4: 78 01 08 01 mvhi r1,0x801 80039f8: 38 21 78 90 ori r1,r1,0x7890 80039fc: 44 41 00 3f be r2,r1,8003af8 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 8003a00: 78 01 08 01 mvhi r1,0x801 8003a04: 38 21 78 8c ori r1,r1,0x788c 8003a08: b9 c0 10 00 mv r2,r14 8003a0c: 34 03 00 00 mvi r3,0 8003a10: f8 00 00 b6 calli 8003ce8 8003a14: b8 20 60 00 mv r12,r1 if (r_chain == NULL) { 8003a18: 44 2d 00 38 be r1,r13,8003af8 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 8003a1c: f8 00 0a 86 calli 8006434 <_Chain_Extract> } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 8003a20: b9 80 08 00 mv r1,r12 8003a24: f8 00 01 b2 calli 80040ec pthread_mutex_destroy (&r_chain->mutex); 8003a28: 35 8d 00 1c addi r13,r12,28 8003a2c: b9 a0 08 00 mv r1,r13 8003a30: f8 00 03 ed calli 80049e4 pthread_cond_destroy (&r_chain->mutex); 8003a34: b9 a0 08 00 mv r1,r13 8003a38: f8 00 02 ec calli 80045e8 free (r_chain); 8003a3c: b9 80 08 00 mv r1,r12 8003a40: fb ff f9 c8 calli 8002160 8003a44: e0 00 00 0a bi 8003a6c return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 8003a48: 34 2c 00 1c addi r12,r1,28 8003a4c: b9 80 08 00 mv r1,r12 8003a50: f8 00 04 9f calli 8004ccc 8003a54: b9 a0 08 00 mv r1,r13 8003a58: f8 00 0a 77 calli 8006434 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); 8003a5c: b9 a0 08 00 mv r1,r13 8003a60: f8 00 01 a3 calli 80040ec pthread_mutex_unlock (&r_chain->mutex); 8003a64: b9 80 08 00 mv r1,r12 8003a68: f8 00 04 cc calli 8004d98 pthread_mutex_unlock (&aio_request_queue.mutex); 8003a6c: b9 60 08 00 mv r1,r11 8003a70: f8 00 04 ca calli 8004d98 return AIO_CANCELED; 8003a74: 34 0c 00 00 mvi r12,0 8003a78: e0 00 00 2f bi 8003b34 } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { 8003a7c: 29 8f 00 00 lw r15,(r12+0) 8003a80: 45 ee 00 08 be r15,r14,8003aa0 pthread_mutex_unlock (&aio_request_queue.mutex); 8003a84: b9 60 08 00 mv r1,r11 8003a88: f8 00 04 c4 calli 8004d98 rtems_set_errno_and_return_minus_one (EINVAL); 8003a8c: f8 00 2e b2 calli 800f554 <__errno> 8003a90: 34 02 00 16 mvi r2,22 8003a94: 58 22 00 00 sw (r1+0),r2 8003a98: 34 0c ff ff mvi r12,-1 8003a9c: e0 00 00 26 bi 8003b34 } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); 8003aa0: 78 01 08 01 mvhi r1,0x801 8003aa4: 38 21 78 80 ori r1,r1,0x7880 8003aa8: b9 e0 10 00 mv r2,r15 8003aac: 34 03 00 00 mvi r3,0 8003ab0: f8 00 00 8e calli 8003ce8 8003ab4: b8 20 68 00 mv r13,r1 if (r_chain == NULL) { 8003ab8: 5c 20 00 14 bne r1,r0,8003b08 if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { 8003abc: 29 62 00 54 lw r2,(r11+84) 8003ac0: 78 01 08 01 mvhi r1,0x801 8003ac4: 38 21 78 90 ori r1,r1,0x7890 8003ac8: 44 41 00 0c be r2,r1,8003af8 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); 8003acc: 78 01 08 01 mvhi r1,0x801 8003ad0: 38 21 78 8c ori r1,r1,0x788c 8003ad4: b9 e0 10 00 mv r2,r15 8003ad8: 34 03 00 00 mvi r3,0 8003adc: f8 00 00 83 calli 8003ce8 if (r_chain == NULL) { 8003ae0: 44 20 ff e9 be r1,r0,8003a84 rtems_set_errno_and_return_minus_one (EINVAL); } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 8003ae4: b9 80 10 00 mv r2,r12 8003ae8: 34 21 00 08 addi r1,r1,8 8003aec: f8 00 01 9e calli 8004164 8003af0: b8 20 60 00 mv r12,r1 8003af4: e0 00 00 0e bi 8003b2c pthread_mutex_unlock (&aio_request_queue.mutex); return result; } else { pthread_mutex_unlock (&aio_request_queue.mutex); 8003af8: b9 60 08 00 mv r1,r11 8003afc: f8 00 04 a7 calli 8004d98 return AIO_ALLDONE; 8003b00: 34 0c 00 02 mvi r12,2 8003b04: e0 00 00 0c bi 8003b34 } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); 8003b08: 34 2e 00 1c addi r14,r1,28 8003b0c: b9 c0 08 00 mv r1,r14 8003b10: f8 00 04 6f calli 8004ccc result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); 8003b14: b9 80 10 00 mv r2,r12 8003b18: 35 a1 00 08 addi r1,r13,8 8003b1c: f8 00 01 92 calli 8004164 8003b20: b8 20 60 00 mv r12,r1 pthread_mutex_unlock (&r_chain->mutex); 8003b24: b9 c0 08 00 mv r1,r14 8003b28: f8 00 04 9c calli 8004d98 pthread_mutex_unlock (&aio_request_queue.mutex); 8003b2c: b9 60 08 00 mv r1,r11 8003b30: f8 00 04 9a calli 8004d98 return result; } return AIO_ALLDONE; } 8003b34: b9 80 08 00 mv r1,r12 8003b38: 2b 9d 00 04 lw ra,(sp+4) 8003b3c: 2b 8b 00 18 lw r11,(sp+24) 8003b40: 2b 8c 00 14 lw r12,(sp+20) 8003b44: 2b 8d 00 10 lw r13,(sp+16) 8003b48: 2b 8e 00 0c lw r14,(sp+12) 8003b4c: 2b 8f 00 08 lw r15,(sp+8) 8003b50: 37 9c 00 18 addi sp,sp,24 8003b54: c3 a0 00 00 ret =============================================================================== 08003b60 : int aio_fsync( int op, struct aiocb *aiocbp ) { 8003b60: 37 9c ff f4 addi sp,sp,-12 8003b64: 5b 8b 00 0c sw (sp+12),r11 8003b68: 5b 8c 00 08 sw (sp+8),r12 8003b6c: 5b 9d 00 04 sw (sp+4),ra 8003b70: b8 40 58 00 mv r11,r2 rtems_aio_request *req; int mode; if (op != O_SYNC) 8003b74: 34 02 20 00 mvi r2,8192 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); 8003b78: 34 0c 00 16 mvi r12,22 ) { rtems_aio_request *req; int mode; if (op != O_SYNC) 8003b7c: 5c 22 00 09 bne r1,r2,8003ba0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); 8003b80: 29 61 00 00 lw r1,(r11+0) 8003b84: 34 02 00 03 mvi r2,3 8003b88: f8 00 1d 6a calli 800b130 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 8003b8c: 20 21 00 03 andi r1,r1,0x3 8003b90: 34 21 ff ff addi r1,r1,-1 8003b94: 34 02 00 01 mvi r2,1 8003b98: 50 41 00 09 bgeu r2,r1,8003bbc rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); 8003b9c: 34 0c 00 09 mvi r12,9 8003ba0: 34 01 ff ff mvi r1,-1 8003ba4: 59 6c 00 2c sw (r11+44),r12 8003ba8: 59 61 00 30 sw (r11+48),r1 8003bac: f8 00 2e 6a calli 800f554 <__errno> 8003bb0: 58 2c 00 00 sw (r1+0),r12 8003bb4: 34 01 ff ff mvi r1,-1 8003bb8: e0 00 00 09 bi 8003bdc req = malloc (sizeof (rtems_aio_request)); 8003bbc: 34 01 00 18 mvi r1,24 8003bc0: fb ff fb 20 calli 8002840 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 8003bc4: 34 0c 00 0b mvi r12,11 mode = fcntl (aiocbp->aio_fildes, F_GETFL); if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) 8003bc8: 44 20 ff f6 be r1,r0,8003ba0 <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 8003bcc: 58 2b 00 14 sw (r1+20),r11 req->aiocbp->aio_lio_opcode = LIO_SYNC; 8003bd0: 34 02 00 03 mvi r2,3 8003bd4: 59 62 00 28 sw (r11+40),r2 return rtems_aio_enqueue (req); 8003bd8: f8 00 01 7f calli 80041d4 } 8003bdc: 2b 9d 00 04 lw ra,(sp+4) 8003be0: 2b 8b 00 0c lw r11,(sp+12) 8003be4: 2b 8c 00 08 lw r12,(sp+8) 8003be8: 37 9c 00 0c addi sp,sp,12 8003bec: c3 a0 00 00 ret =============================================================================== 0800442c : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { 800442c: 37 9c ff f4 addi sp,sp,-12 8004430: 5b 8b 00 0c sw (sp+12),r11 8004434: 5b 8c 00 08 sw (sp+8),r12 8004438: 5b 9d 00 04 sw (sp+4),ra 800443c: b8 20 58 00 mv r11,r1 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 8004440: 28 21 00 00 lw r1,(r1+0) 8004444: 34 02 00 03 mvi r2,3 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); 8004448: 34 0c 00 09 mvi r12,9 aio_read (struct aiocb *aiocbp) { rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 800444c: f8 00 1b 39 calli 800b130 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) 8004450: 20 21 00 03 andi r1,r1,0x3 8004454: 7c 22 00 02 cmpnei r2,r1,2 8004458: 7c 21 00 00 cmpnei r1,r1,0 800445c: a0 41 08 00 and r1,r2,r1 8004460: 5c 20 00 04 bne r1,r0,8004470 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 8004464: 29 6c 00 10 lw r12,(r11+16) 8004468: 45 81 00 09 be r12,r1,800448c rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); 800446c: 34 0c 00 16 mvi r12,22 8004470: 34 01 ff ff mvi r1,-1 8004474: 59 6c 00 2c sw (r11+44),r12 8004478: 59 61 00 30 sw (r11+48),r1 800447c: f8 00 2c 36 calli 800f554 <__errno> 8004480: 58 2c 00 00 sw (r1+0),r12 8004484: 34 01 ff ff mvi r1,-1 8004488: e0 00 00 0d bi 80044bc if (aiocbp->aio_offset < 0) 800448c: 29 61 00 04 lw r1,(r11+4) 8004490: 4c 2c 00 02 bge r1,r12,8004498 8004494: e3 ff ff f6 bi 800446c rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 8004498: 34 01 00 18 mvi r1,24 800449c: fb ff f8 e9 calli 8002840 if (req == NULL) 80044a0: 5c 2c 00 03 bne r1,r12,80044ac <== ALWAYS TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 80044a4: 34 0c 00 0b mvi r12,11 <== NOT EXECUTED 80044a8: e3 ff ff f2 bi 8004470 <== NOT EXECUTED req->aiocbp = aiocbp; 80044ac: 58 2b 00 14 sw (r1+20),r11 req->aiocbp->aio_lio_opcode = LIO_READ; 80044b0: 34 02 00 01 mvi r2,1 80044b4: 59 62 00 28 sw (r11+40),r2 return rtems_aio_enqueue (req); 80044b8: fb ff ff 47 calli 80041d4 } 80044bc: 2b 9d 00 04 lw ra,(sp+4) 80044c0: 2b 8b 00 0c lw r11,(sp+12) 80044c4: 2b 8c 00 08 lw r12,(sp+8) 80044c8: 37 9c 00 0c addi sp,sp,12 80044cc: c3 a0 00 00 ret =============================================================================== 080044d8 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { 80044d8: 37 9c ff f4 addi sp,sp,-12 80044dc: 5b 8b 00 0c sw (sp+12),r11 80044e0: 5b 8c 00 08 sw (sp+8),r12 80044e4: 5b 9d 00 04 sw (sp+4),ra 80044e8: b8 20 58 00 mv r11,r1 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); 80044ec: 28 21 00 00 lw r1,(r1+0) 80044f0: 34 02 00 03 mvi r2,3 80044f4: f8 00 1b 0f calli 800b130 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) 80044f8: 20 21 00 03 andi r1,r1,0x3 80044fc: 34 21 ff ff addi r1,r1,-1 8004500: 34 02 00 01 mvi r2,1 8004504: 50 41 00 03 bgeu r2,r1,8004510 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); 8004508: 34 0c 00 09 mvi r12,9 800450c: e0 00 00 04 bi 800451c if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) 8004510: 29 61 00 10 lw r1,(r11+16) 8004514: 44 20 00 09 be r1,r0,8004538 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); 8004518: 34 0c 00 16 mvi r12,22 800451c: 34 01 ff ff mvi r1,-1 8004520: 59 6c 00 2c sw (r11+44),r12 8004524: 59 61 00 30 sw (r11+48),r1 8004528: f8 00 2c 0b calli 800f554 <__errno> 800452c: 58 2c 00 00 sw (r1+0),r12 8004530: 34 01 ff ff mvi r1,-1 8004534: e0 00 00 0c bi 8004564 if (aiocbp->aio_offset < 0) 8004538: 29 62 00 04 lw r2,(r11+4) 800453c: 4c 41 00 02 bge r2,r1,8004544 8004540: e3 ff ff f6 bi 8004518 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); 8004544: 34 01 00 18 mvi r1,24 8004548: fb ff f8 be calli 8002840 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); 800454c: 34 0c 00 0b mvi r12,11 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) 8004550: 44 20 ff f3 be r1,r0,800451c <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; 8004554: 58 2b 00 14 sw (r1+20),r11 req->aiocbp->aio_lio_opcode = LIO_WRITE; 8004558: 34 02 00 02 mvi r2,2 800455c: 59 62 00 28 sw (r11+40),r2 return rtems_aio_enqueue (req); 8004560: fb ff ff 1d calli 80041d4 } 8004564: 2b 9d 00 04 lw ra,(sp+4) 8004568: 2b 8b 00 0c lw r11,(sp+12) 800456c: 2b 8c 00 08 lw r12,(sp+8) 8004570: 37 9c 00 0c addi sp,sp,12 8004574: c3 a0 00 00 ret =============================================================================== 08002db0 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { 8002db0: 37 9c ff fc addi sp,sp,-4 8002db4: 5b 9d 00 04 sw (sp+4),ra 8002db8: b8 20 18 00 mv r3,r1 8002dbc: b8 40 08 00 mv r1,r2 if ( !tp ) 8002dc0: 44 40 00 11 be r2,r0,8002e04 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 8002dc4: 34 02 00 01 mvi r2,1 8002dc8: 5c 62 00 03 bne r3,r2,8002dd4 _TOD_Get(tp); 8002dcc: f8 00 06 fb calli 80049b8 <_TOD_Get> 8002dd0: e0 00 00 06 bi 8002de8 return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { 8002dd4: 34 02 00 04 mvi r2,4 8002dd8: 44 62 00 03 be r3,r2,8002de4 <== NEVER TAKEN return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME ) { 8002ddc: 34 02 00 02 mvi r2,2 8002de0: 5c 62 00 04 bne r3,r2,8002df0 _TOD_Get_uptime_as_timespec( tp ); 8002de4: f8 00 07 17 calli 8004a40 <_TOD_Get_uptime_as_timespec> return 0; 8002de8: 34 01 00 00 mvi r1,0 8002dec: e0 00 00 0a bi 8002e14 } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME ) 8002df0: 34 01 00 03 mvi r1,3 8002df4: 5c 61 00 04 bne r3,r1,8002e04 rtems_set_errno_and_return_minus_one( ENOSYS ); 8002df8: f8 00 2a b7 calli 800d8d4 <__errno> 8002dfc: 34 02 00 58 mvi r2,88 8002e00: e0 00 00 03 bi 8002e0c #endif rtems_set_errno_and_return_minus_one( EINVAL ); 8002e04: f8 00 2a b4 calli 800d8d4 <__errno> 8002e08: 34 02 00 16 mvi r2,22 8002e0c: 58 22 00 00 sw (r1+0),r2 8002e10: 34 01 ff ff mvi r1,-1 return 0; } 8002e14: 2b 9d 00 04 lw ra,(sp+4) 8002e18: 37 9c 00 04 addi sp,sp,4 8002e1c: c3 a0 00 00 ret =============================================================================== 08002e20 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { 8002e20: 37 9c ff fc addi sp,sp,-4 8002e24: 5b 9d 00 04 sw (sp+4),ra if ( !tp ) 8002e28: 44 40 00 1a be r2,r0,8002e90 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { 8002e2c: 34 03 00 01 mvi r3,1 8002e30: 5c 23 00 11 bne r1,r3,8002e74 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) 8002e34: 78 04 08 01 mvhi r4,0x801 8002e38: 38 84 ea ec ori r4,r4,0xeaec 8002e3c: 28 43 00 00 lw r3,(r2+0) 8002e40: 28 81 00 00 lw r1,(r4+0) 8002e44: 54 61 00 02 bgu r3,r1,8002e4c 8002e48: e0 00 00 12 bi 8002e90 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002e4c: 78 01 08 02 mvhi r1,0x802 8002e50: 38 21 08 e8 ori r1,r1,0x8e8 8002e54: 28 23 00 00 lw r3,(r1+0) 8002e58: 34 63 00 01 addi r3,r3,1 8002e5c: 58 23 00 00 sw (r1+0),r3 rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); 8002e60: b8 40 08 00 mv r1,r2 8002e64: f8 00 07 14 calli 8004ab4 <_TOD_Set> _Thread_Enable_dispatch(); 8002e68: f8 00 0d 3f calli 8006364 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; 8002e6c: 34 01 00 00 mvi r1,0 8002e70: e0 00 00 0c bi 8002ea0 _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME ) 8002e74: 34 02 00 02 mvi r2,2 8002e78: 44 22 00 03 be r1,r2,8002e84 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME ) 8002e7c: 34 02 00 03 mvi r2,3 8002e80: 5c 22 00 04 bne r1,r2,8002e90 rtems_set_errno_and_return_minus_one( ENOSYS ); 8002e84: f8 00 2a 94 calli 800d8d4 <__errno> 8002e88: 34 02 00 58 mvi r2,88 8002e8c: e0 00 00 03 bi 8002e98 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); 8002e90: f8 00 2a 91 calli 800d8d4 <__errno> 8002e94: 34 02 00 16 mvi r2,22 8002e98: 58 22 00 00 sw (r1+0),r2 8002e9c: 34 01 ff ff mvi r1,-1 return 0; } 8002ea0: 2b 9d 00 04 lw ra,(sp+4) 8002ea4: 37 9c 00 04 addi sp,sp,4 8002ea8: c3 a0 00 00 ret =============================================================================== 08025c60 : int killinfo( pid_t pid, int sig, const union sigval *value ) { 8025c60: 37 9c ff dc addi sp,sp,-36 8025c64: 5b 8b 00 18 sw (sp+24),r11 8025c68: 5b 8c 00 14 sw (sp+20),r12 8025c6c: 5b 8d 00 10 sw (sp+16),r13 8025c70: 5b 8e 00 0c sw (sp+12),r14 8025c74: 5b 8f 00 08 sw (sp+8),r15 8025c78: 5b 9d 00 04 sw (sp+4),ra 8025c7c: b8 20 60 00 mv r12,r1 8025c80: b8 40 58 00 mv r11,r2 8025c84: 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() ) 8025c88: fb ff fe e8 calli 8025828 8025c8c: 45 81 00 04 be r12,r1,8025c9c rtems_set_errno_and_return_minus_one( ESRCH ); 8025c90: fb ff b4 ea calli 8013038 <__errno> 8025c94: 34 02 00 03 mvi r2,3 8025c98: e0 00 00 04 bi 8025ca8 /* * Validate the signal passed. */ if ( !sig ) 8025c9c: 5d 60 00 06 bne r11,r0,8025cb4 rtems_set_errno_and_return_minus_one( EINVAL ); 8025ca0: fb ff b4 e6 calli 8013038 <__errno> 8025ca4: 34 02 00 16 mvi r2,22 8025ca8: 58 22 00 00 sw (r1+0),r2 8025cac: 34 01 ff ff mvi r1,-1 8025cb0: e0 00 00 9f bi 8025f2c static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 8025cb4: 35 6f ff ff addi r15,r11,-1 if ( !is_valid_signo(sig) ) 8025cb8: 34 01 00 1f mvi r1,31 8025cbc: 50 2f 00 02 bgeu r1,r15,8025cc4 8025cc0: e3 ff ff f8 bi 8025ca0 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 ) 8025cc4: 34 02 00 01 mvi r2,1 8025cc8: b9 60 08 00 mv r1,r11 8025ccc: fb ff 70 76 calli 8001ea4 <__ashlsi3> 8025cd0: 34 02 00 02 mvi r2,2 8025cd4: 78 0c 08 02 mvhi r12,0x802 8025cd8: b4 2b 08 00 add r1,r1,r11 8025cdc: fb ff 70 72 calli 8001ea4 <__ashlsi3> 8025ce0: 39 8c 9f 68 ori r12,r12,0x9f68 8025ce4: b5 81 08 00 add r1,r12,r1 8025ce8: 28 22 00 08 lw r2,(r1+8) 8025cec: 34 0e 00 01 mvi r14,1 return 0; 8025cf0: 34 01 00 00 mvi r1,0 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 ) 8025cf4: 44 4e 00 8e be r2,r14,8025f2c /* * 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 ) ) 8025cf8: 65 62 00 04 cmpei r2,r11,4 8025cfc: 65 61 00 08 cmpei r1,r11,8 8025d00: b8 41 08 00 or r1,r2,r1 8025d04: 5c 20 00 03 bne r1,r0,8025d10 8025d08: 34 01 00 0b mvi r1,11 8025d0c: 5d 61 00 05 bne r11,r1,8025d20 return pthread_kill( pthread_self(), sig ); 8025d10: f8 00 01 3a calli 80261f8 8025d14: b9 60 10 00 mv r2,r11 8025d18: f8 00 00 f3 calli 80260e4 8025d1c: e0 00 00 84 bi 8025f2c static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); 8025d20: 34 01 00 01 mvi r1,1 8025d24: b9 e0 10 00 mv r2,r15 8025d28: fb ff 70 5f calli 8001ea4 <__ashlsi3> /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; 8025d2c: 5b 8b 00 1c sw (sp+28),r11 siginfo->si_code = SI_USER; 8025d30: 5b 8e 00 20 sw (sp+32),r14 8025d34: b8 20 60 00 mv r12,r1 if ( !value ) { 8025d38: 5d a0 00 03 bne r13,r0,8025d44 siginfo->si_value.sival_int = 0; 8025d3c: 5b 80 00 24 sw (sp+36),r0 8025d40: e0 00 00 03 bi 8025d4c } else { siginfo->si_value = *value; 8025d44: 29 a1 00 00 lw r1,(r13+0) 8025d48: 5b 81 00 24 sw (sp+36),r1 8025d4c: 78 01 08 02 mvhi r1,0x802 8025d50: 38 21 9a 50 ori r1,r1,0x9a50 8025d54: 28 22 00 00 lw r2,(r1+0) 8025d58: 34 42 00 01 addi r2,r2,1 8025d5c: 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; 8025d60: 78 01 08 02 mvhi r1,0x802 8025d64: 38 21 9f 1c ori r1,r1,0x9f1c 8025d68: 28 23 00 0c lw r3,(r1+12) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { 8025d6c: 28 61 01 20 lw r1,(r3+288) 8025d70: 28 21 00 d0 lw r1,(r1+208) 8025d74: a4 20 08 00 not r1,r1 8025d78: a1 81 08 00 and r1,r12,r1 8025d7c: 5c 20 00 3f bne r1,r0,8025e78 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } 8025d80: 78 01 08 02 mvhi r1,0x802 8025d84: 38 21 a0 f4 ori r1,r1,0xa0f4 8025d88: 28 22 00 00 lw r2,(r1+0) /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); 8025d8c: 78 01 08 02 mvhi r1,0x802 8025d90: 38 21 a0 f8 ori r1,r1,0xa0f8 8025d94: e0 00 00 0b bi 8025dc0 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 8025d98: 28 44 00 30 lw r4,(r2+48) for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; 8025d9c: b8 40 18 00 mv r3,r2 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8025da0: 28 45 01 20 lw r5,(r2+288) #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) 8025da4: a1 84 20 00 and r4,r12,r4 8025da8: 5c 80 00 34 bne r4,r0,8025e78 /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) 8025dac: 28 a5 00 d0 lw r5,(r5+208) 8025db0: a4 a0 28 00 not r5,r5 8025db4: a1 85 28 00 and r5,r12,r5 8025db8: 5c a4 00 30 bne r5,r4,8025e78 the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { 8025dbc: 28 42 00 00 lw r2,(r2+0) /* XXX violation of visibility -- need to define thread queue support */ the_chain = &_POSIX_signals_Wait_queue.Queues.Fifo; for ( the_node = _Chain_First( the_chain ); 8025dc0: 5c 41 ff f6 bne r2,r1,8025d98 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 8025dc4: 78 01 08 02 mvhi r1,0x802 8025dc8: 38 21 90 c0 ori r1,r1,0x90c0 8025dcc: 40 21 00 00 lbu r1,(r1+0) */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 8025dd0: 78 02 08 02 mvhi r2,0x802 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 8025dd4: 78 04 08 02 mvhi r4,0x802 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 8025dd8: 38 42 99 ec ori r2,r2,0x99ec * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; 8025ddc: 34 21 00 01 addi r1,r1,1 8025de0: 38 84 99 f4 ori r4,r4,0x99f4 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( 8025de4: 34 4d 00 10 addi r13,r2,16 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; 8025de8: 34 03 00 00 mvi r3,0 */ RTEMS_INLINE_ROUTINE bool _States_Is_interruptible_by_signal ( States_Control the_states ) { return (the_states & STATES_INTERRUPTIBLE_BY_SIGNAL); 8025dec: 78 08 10 00 mvhi r8,0x1000 for (the_api = OBJECTS_CLASSIC_API; the_api <= OBJECTS_APIS_LAST; the_api++) { /* * This can occur when no one is interested and an API is not configured. */ if ( !_Objects_Information_table[ the_api ] ) 8025df0: 28 85 00 00 lw r5,(r4+0) 8025df4: 44 a0 00 1e be r5,r0,8025e6c <== NEVER TAKEN continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; 8025df8: 28 a5 00 04 lw r5,(r5+4) #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 8025dfc: 34 06 00 01 mvi r6,1 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; 8025e00: 2c ae 00 10 lhu r14,(r5+16) 8025e04: 28 a7 00 1c lw r7,(r5+28) object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 8025e08: e0 00 00 18 bi 8025e68 the_thread = (Thread_Control *) object_table[ index ]; 8025e0c: 28 e2 00 04 lw r2,(r7+4) if ( !the_thread ) 8025e10: 44 40 00 14 be r2,r0,8025e60 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) 8025e14: 28 45 00 14 lw r5,(r2+20) 8025e18: 54 a1 00 12 bgu r5,r1,8025e60 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) 8025e1c: 28 49 01 20 lw r9,(r2+288) 8025e20: 29 29 00 d0 lw r9,(r9+208) 8025e24: a5 20 48 00 not r9,r9 8025e28: a1 89 48 00 and r9,r12,r9 8025e2c: 45 20 00 0d be r9,r0,8025e60 * * 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 ) { 8025e30: 54 25 00 0a bgu r1,r5,8025e58 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { 8025e34: 44 60 00 0b be r3,r0,8025e60 <== NEVER TAKEN 8025e38: 28 69 00 10 lw r9,(r3+16) 8025e3c: 45 20 00 09 be r9,r0,8025e60 <== NEVER TAKEN /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 8025e40: 28 4a 00 10 lw r10,(r2+16) 8025e44: 45 40 00 05 be r10,r0,8025e58 8025e48: a1 28 48 00 and r9,r9,r8 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { 8025e4c: 5d 20 00 05 bne r9,r0,8025e60 8025e50: a1 48 50 00 and r10,r10,r8 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { 8025e54: 45 49 00 03 be r10,r9,8025e60 */ if ( interested && !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { 8025e58: b8 a0 08 00 mv r1,r5 8025e5c: b8 40 18 00 mv r3,r2 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { 8025e60: 34 c6 00 01 addi r6,r6,1 8025e64: 34 e7 00 04 addi r7,r7,4 8025e68: 51 c6 ff e9 bgeu r14,r6,8025e0c 8025e6c: 34 84 00 04 addi r4,r4,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++) { 8025e70: 5c 8d ff e0 bne r4,r13,8025df0 } } } } if ( interested ) { 8025e74: 44 60 00 06 be r3,r0,8025e8c /* * 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 ) ) { 8025e78: b8 60 08 00 mv r1,r3 8025e7c: b9 60 10 00 mv r2,r11 8025e80: 37 83 00 1c addi r3,sp,28 8025e84: f8 00 00 3d calli 8025f78 <_POSIX_signals_Unblock_thread> 8025e88: 5c 20 00 27 bne r1,r0,8025f24 /* * 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 ); 8025e8c: b9 80 08 00 mv r1,r12 8025e90: f8 00 00 2f calli 8025f4c <_POSIX_signals_Set_process_signals> if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { 8025e94: b9 60 08 00 mv r1,r11 8025e98: 34 02 00 01 mvi r2,1 8025e9c: fb ff 70 02 calli 8001ea4 <__ashlsi3> 8025ea0: b4 2b 58 00 add r11,r1,r11 8025ea4: 34 02 00 02 mvi r2,2 8025ea8: 78 0c 08 02 mvhi r12,0x802 8025eac: b9 60 08 00 mv r1,r11 8025eb0: fb ff 6f fd calli 8001ea4 <__ashlsi3> 8025eb4: 39 8c 9f 68 ori r12,r12,0x9f68 8025eb8: b5 81 08 00 add r1,r12,r1 8025ebc: 28 22 00 00 lw r2,(r1+0) 8025ec0: 34 01 00 02 mvi r1,2 8025ec4: 5c 41 00 18 bne r2,r1,8025f24 psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); 8025ec8: 78 01 08 02 mvhi r1,0x802 8025ecc: 38 21 a0 e8 ori r1,r1,0xa0e8 8025ed0: fb ff 8f e0 calli 8009e50 <_Chain_Get> 8025ed4: b8 20 60 00 mv r12,r1 if ( !psiginfo ) { 8025ed8: 5c 20 00 05 bne r1,r0,8025eec _Thread_Enable_dispatch(); 8025edc: fb ff 98 37 calli 800bfb8 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); 8025ee0: fb ff b4 56 calli 8013038 <__errno> 8025ee4: 34 02 00 0b mvi r2,11 8025ee8: e3 ff ff 70 bi 8025ca8 } psiginfo->Info = *siginfo; 8025eec: 2b 81 00 1c lw r1,(sp+28) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 8025ef0: 34 02 00 02 mvi r2,2 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; 8025ef4: 59 81 00 08 sw (r12+8),r1 8025ef8: 2b 81 00 20 lw r1,(sp+32) 8025efc: 59 81 00 0c sw (r12+12),r1 8025f00: 2b 81 00 24 lw r1,(sp+36) 8025f04: 59 81 00 10 sw (r12+16),r1 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); 8025f08: b9 60 08 00 mv r1,r11 8025f0c: fb ff 6f e6 calli 8001ea4 <__ashlsi3> 8025f10: 78 02 08 02 mvhi r2,0x802 8025f14: 38 42 a1 60 ori r2,r2,0xa160 8025f18: b4 22 08 00 add r1,r1,r2 8025f1c: b9 80 10 00 mv r2,r12 8025f20: fb ff 8f b6 calli 8009df8 <_Chain_Append> } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); 8025f24: fb ff 98 25 calli 800bfb8 <_Thread_Enable_dispatch> return 0; 8025f28: 34 01 00 00 mvi r1,0 } 8025f2c: 2b 9d 00 04 lw ra,(sp+4) 8025f30: 2b 8b 00 18 lw r11,(sp+24) 8025f34: 2b 8c 00 14 lw r12,(sp+20) 8025f38: 2b 8d 00 10 lw r13,(sp+16) 8025f3c: 2b 8e 00 0c lw r14,(sp+12) 8025f40: 2b 8f 00 08 lw r15,(sp+8) 8025f44: 37 9c 00 24 addi sp,sp,36 8025f48: c3 a0 00 00 ret =============================================================================== 08008430 : pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) return EINVAL; 8008430: 34 03 00 16 mvi r3,22 int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) 8008434: 44 20 00 0c be r1,r0,8008464 8008438: 28 24 00 00 lw r4,(r1+0) 800843c: 44 80 00 0a be r4,r0,8008464 return EINVAL; switch ( policy ) { 8008440: 48 02 00 08 bg r0,r2,8008460 8008444: 34 03 00 02 mvi r3,2 8008448: 4c 62 00 03 bge r3,r2,8008454 800844c: 34 03 00 04 mvi r3,4 8008450: 5c 43 00 04 bne r2,r3,8008460 <== NEVER TAKEN case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; 8008454: 58 22 00 14 sw (r1+20),r2 return 0; 8008458: 34 03 00 00 mvi r3,0 800845c: e0 00 00 02 bi 8008464 default: return ENOTSUP; 8008460: 34 03 00 86 mvi r3,134 } } 8008464: b8 60 08 00 mv r1,r3 8008468: c3 a0 00 00 ret =============================================================================== 08003410 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 8003410: 37 9c ff dc addi sp,sp,-36 8003414: 5b 8b 00 14 sw (sp+20),r11 8003418: 5b 8c 00 10 sw (sp+16),r12 800341c: 5b 8d 00 0c sw (sp+12),r13 8003420: 5b 8e 00 08 sw (sp+8),r14 8003424: 5b 9d 00 04 sw (sp+4),ra /* * Error check parameters */ if ( !barrier ) return EINVAL; 8003428: 34 04 00 16 mvi r4,22 int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { 800342c: b8 20 68 00 mv r13,r1 8003430: b8 60 58 00 mv r11,r3 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) 8003434: 44 20 00 2a be r1,r0,80034dc return EINVAL; if ( count == 0 ) 8003438: 44 60 00 29 be r3,r0,80034dc return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 800343c: 5c 40 00 05 bne r2,r0,8003450 the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); 8003440: 37 8c 00 18 addi r12,sp,24 8003444: b9 80 08 00 mv r1,r12 8003448: fb ff ff bb calli 8003334 the_attr = &my_attr; 800344c: b9 80 10 00 mv r2,r12 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 8003450: 28 41 00 00 lw r1,(r2+0) return EINVAL; 8003454: 34 04 00 16 mvi r4,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 8003458: 44 20 00 21 be r1,r0,80034dc return EINVAL; switch ( the_attr->process_shared ) { 800345c: 28 4e 00 04 lw r14,(r2+4) 8003460: 5d c0 00 1f bne r14,r0,80034dc <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8003464: 78 02 08 01 mvhi r2,0x801 8003468: 38 42 68 a8 ori r2,r2,0x68a8 800346c: 28 41 00 00 lw r1,(r2+0) } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; 8003470: 5b 80 00 20 sw (sp+32),r0 the_attributes.maximum_count = count; 8003474: 5b 8b 00 24 sw (sp+36),r11 8003478: 34 21 00 01 addi r1,r1,1 800347c: 58 41 00 00 sw (r2+0),r1 * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) _Objects_Allocate( &_POSIX_Barrier_Information ); 8003480: 78 0c 08 01 mvhi r12,0x801 8003484: 39 8c 6b fc ori r12,r12,0x6bfc 8003488: b9 80 08 00 mv r1,r12 800348c: f8 00 07 e3 calli 8005418 <_Objects_Allocate> 8003490: b8 20 58 00 mv r11,r1 */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { 8003494: 5c 2e 00 04 bne r1,r14,80034a4 _Thread_Enable_dispatch(); 8003498: f8 00 0c 63 calli 8006624 <_Thread_Enable_dispatch> return EAGAIN; 800349c: 34 04 00 0b mvi r4,11 80034a0: e0 00 00 0f bi 80034dc } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); 80034a4: 34 21 00 10 addi r1,r1,16 80034a8: 37 82 00 20 addi r2,sp,32 80034ac: f8 00 04 e8 calli 800484c <_CORE_barrier_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 80034b0: 29 6e 00 08 lw r14,(r11+8) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 80034b4: 29 8c 00 1c lw r12,(r12+28) 80034b8: 34 02 00 02 mvi r2,2 80034bc: 21 c1 ff ff andi r1,r14,0xffff 80034c0: f8 00 3d fa calli 8012ca8 <__ashlsi3> 80034c4: b5 81 08 00 add r1,r12,r1 80034c8: 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; 80034cc: 59 60 00 0c sw (r11+12),r0 ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; 80034d0: 59 ae 00 00 sw (r13+0),r14 _Thread_Enable_dispatch(); 80034d4: f8 00 0c 54 calli 8006624 <_Thread_Enable_dispatch> return 0; 80034d8: 34 04 00 00 mvi r4,0 } 80034dc: b8 80 08 00 mv r1,r4 80034e0: 2b 9d 00 04 lw ra,(sp+4) 80034e4: 2b 8b 00 14 lw r11,(sp+20) 80034e8: 2b 8c 00 10 lw r12,(sp+16) 80034ec: 2b 8d 00 0c lw r13,(sp+12) 80034f0: 2b 8e 00 08 lw r14,(sp+8) 80034f4: 37 9c 00 24 addi sp,sp,36 80034f8: c3 a0 00 00 ret =============================================================================== 08002c8c : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { 8002c8c: 37 9c ff f4 addi sp,sp,-12 8002c90: 5b 8b 00 0c sw (sp+12),r11 8002c94: 5b 8c 00 08 sw (sp+8),r12 8002c98: 5b 9d 00 04 sw (sp+4),ra 8002c9c: b8 20 58 00 mv r11,r1 8002ca0: 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 ) 8002ca4: 44 20 00 13 be r1,r0,8002cf0 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002ca8: 78 03 08 01 mvhi r3,0x801 8002cac: 38 63 68 90 ori r3,r3,0x6890 8002cb0: 28 61 00 00 lw r1,(r3+0) 8002cb4: 34 21 00 01 addi r1,r1,1 8002cb8: 58 61 00 00 sw (r3+0),r1 return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); 8002cbc: 34 01 00 10 mvi r1,16 8002cc0: f8 00 11 87 calli 80072dc <_Workspace_Allocate> 8002cc4: b8 20 10 00 mv r2,r1 if ( handler ) { 8002cc8: 44 20 00 09 be r1,r0,8002cec <== NEVER TAKEN thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 8002ccc: 78 03 08 01 mvhi r3,0x801 8002cd0: 38 63 6d 5c ori r3,r3,0x6d5c 8002cd4: 28 61 00 0c lw r1,(r3+12) handler_stack = &thread_support->Cancellation_Handlers; 8002cd8: 28 21 01 20 lw r1,(r1+288) handler->routine = routine; 8002cdc: 58 4b 00 08 sw (r2+8),r11 handler->arg = arg; 8002ce0: 58 4c 00 0c sw (r2+12),r12 _Chain_Append( handler_stack, &handler->Node ); 8002ce4: 34 21 00 e4 addi r1,r1,228 8002ce8: f8 00 04 f8 calli 80040c8 <_Chain_Append> } _Thread_Enable_dispatch(); 8002cec: f8 00 0c 3d calli 8005de0 <_Thread_Enable_dispatch> } 8002cf0: 2b 9d 00 04 lw ra,(sp+4) 8002cf4: 2b 8b 00 0c lw r11,(sp+12) 8002cf8: 2b 8c 00 08 lw r12,(sp+8) 8002cfc: 37 9c 00 0c addi sp,sp,12 8002d00: c3 a0 00 00 ret =============================================================================== 08003d54 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { 8003d54: 37 9c ff ec addi sp,sp,-20 8003d58: 5b 8b 00 14 sw (sp+20),r11 8003d5c: 5b 8c 00 10 sw (sp+16),r12 8003d60: 5b 8d 00 0c sw (sp+12),r13 8003d64: 5b 8e 00 08 sw (sp+8),r14 8003d68: 5b 9d 00 04 sw (sp+4),ra 8003d6c: b8 20 70 00 mv r14,r1 8003d70: b8 40 58 00 mv r11,r2 POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; 8003d74: 5c 40 00 03 bne r2,r0,8003d80 else the_attr = &_POSIX_Condition_variables_Default_attributes; 8003d78: 78 0b 08 01 mvhi r11,0x801 8003d7c: 39 6b 5a d8 ori r11,r11,0x5ad8 /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 8003d80: 29 63 00 04 lw r3,(r11+4) 8003d84: 34 02 00 01 mvi r2,1 return EINVAL; 8003d88: 34 01 00 16 mvi r1,22 else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) 8003d8c: 44 62 00 26 be r3,r2,8003e24 <== NEVER TAKEN return EINVAL; if ( !the_attr->is_initialized ) 8003d90: 29 62 00 00 lw r2,(r11+0) 8003d94: 44 40 00 24 be r2,r0,8003e24 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8003d98: 78 02 08 01 mvhi r2,0x801 8003d9c: 38 42 78 a8 ori r2,r2,0x78a8 8003da0: 28 41 00 00 lw r1,(r2+0) 8003da4: 34 21 00 01 addi r1,r1,1 8003da8: 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 *) _Objects_Allocate( &_POSIX_Condition_variables_Information ); 8003dac: 78 0d 08 01 mvhi r13,0x801 8003db0: 39 ad 7c 94 ori r13,r13,0x7c94 8003db4: b9 a0 08 00 mv r1,r13 8003db8: f8 00 09 84 calli 80063c8 <_Objects_Allocate> 8003dbc: b8 20 60 00 mv r12,r1 _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { 8003dc0: 5c 20 00 04 bne r1,r0,8003dd0 _Thread_Enable_dispatch(); 8003dc4: f8 00 0e 75 calli 8007798 <_Thread_Enable_dispatch> return ENOMEM; 8003dc8: 34 01 00 0c mvi r1,12 8003dcc: e0 00 00 16 bi 8003e24 the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 8003dd0: 78 04 08 01 mvhi r4,0x801 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 8003dd4: 29 61 00 04 lw r1,(r11+4) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 8003dd8: 38 84 5a e0 ori r4,r4,0x5ae0 8003ddc: 28 83 00 00 lw r3,(r4+0) if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; 8003de0: 59 81 00 10 sw (r12+16),r1 the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( 8003de4: 34 04 00 74 mvi r4,116 8003de8: 35 81 00 18 addi r1,r12,24 8003dec: 34 02 00 00 mvi r2,0 return ENOMEM; } the_cond->process_shared = the_attr->process_shared; the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; 8003df0: 59 80 00 14 sw (r12+20),r0 _Thread_queue_Initialize( 8003df4: f8 00 10 b4 calli 80080c4 <_Thread_queue_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 8003df8: 29 8b 00 08 lw r11,(r12+8) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8003dfc: 29 ad 00 1c lw r13,(r13+28) 8003e00: 34 02 00 02 mvi r2,2 8003e04: 21 61 ff ff andi r1,r11,0xffff 8003e08: f8 00 3f 5f calli 8013b84 <__ashlsi3> 8003e0c: b5 a1 10 00 add r2,r13,r1 8003e10: 58 4c 00 00 sw (r2+0),r12 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; 8003e14: 59 80 00 0c sw (r12+12),r0 &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; 8003e18: 59 cb 00 00 sw (r14+0),r11 _Thread_Enable_dispatch(); 8003e1c: f8 00 0e 5f calli 8007798 <_Thread_Enable_dispatch> return 0; 8003e20: 34 01 00 00 mvi r1,0 } 8003e24: 2b 9d 00 04 lw ra,(sp+4) 8003e28: 2b 8b 00 14 lw r11,(sp+20) 8003e2c: 2b 8c 00 10 lw r12,(sp+16) 8003e30: 2b 8d 00 0c lw r13,(sp+12) 8003e34: 2b 8e 00 08 lw r14,(sp+8) 8003e38: 37 9c 00 14 addi sp,sp,20 8003e3c: c3 a0 00 00 ret =============================================================================== 08003bc8 : int pthread_condattr_destroy( pthread_condattr_t *attr ) { if ( !attr || attr->is_initialized == false ) return EINVAL; 8003bc8: 34 02 00 16 mvi r2,22 int pthread_condattr_destroy( pthread_condattr_t *attr ) { if ( !attr || attr->is_initialized == false ) 8003bcc: 44 20 00 05 be r1,r0,8003be0 8003bd0: 28 23 00 00 lw r3,(r1+0) 8003bd4: 44 60 00 03 be r3,r0,8003be0 <== NEVER TAKEN return EINVAL; attr->is_initialized = false; 8003bd8: 58 20 00 00 sw (r1+0),r0 return 0; 8003bdc: 34 02 00 00 mvi r2,0 } 8003be0: b8 40 08 00 mv r1,r2 8003be4: c3 a0 00 00 ret =============================================================================== 080030a4 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 80030a4: 37 9c ff a0 addi sp,sp,-96 80030a8: 5b 8b 00 3c sw (sp+60),r11 80030ac: 5b 8c 00 38 sw (sp+56),r12 80030b0: 5b 8d 00 34 sw (sp+52),r13 80030b4: 5b 8e 00 30 sw (sp+48),r14 80030b8: 5b 8f 00 2c sw (sp+44),r15 80030bc: 5b 90 00 28 sw (sp+40),r16 80030c0: 5b 91 00 24 sw (sp+36),r17 80030c4: 5b 92 00 20 sw (sp+32),r18 80030c8: 5b 93 00 1c sw (sp+28),r19 80030cc: 5b 94 00 18 sw (sp+24),r20 80030d0: 5b 95 00 14 sw (sp+20),r21 80030d4: 5b 9d 00 10 sw (sp+16),ra struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) return EFAULT; 80030d8: 34 0d 00 0e mvi r13,14 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { 80030dc: b8 20 88 00 mv r17,r1 80030e0: b8 60 80 00 mv r16,r3 80030e4: b8 80 90 00 mv r18,r4 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) 80030e8: 44 60 00 a5 be r3,r0,800337c return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; 80030ec: b8 40 58 00 mv r11,r2 80030f0: 5c 40 00 03 bne r2,r0,80030fc 80030f4: 78 0b 08 01 mvhi r11,0x801 80030f8: 39 6b d9 fc ori r11,r11,0xd9fc if ( !the_attr->is_initialized ) 80030fc: 29 61 00 00 lw r1,(r11+0) return EINVAL; 8003100: 34 0d 00 16 mvi r13,22 if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; if ( !the_attr->is_initialized ) 8003104: 44 20 00 9e be r1,r0,800337c * 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) ) 8003108: 29 61 00 04 lw r1,(r11+4) 800310c: 44 20 00 06 be r1,r0,8003124 8003110: 78 02 08 01 mvhi r2,0x801 8003114: 38 42 f0 e0 ori r2,r2,0xf0e0 8003118: 29 63 00 08 lw r3,(r11+8) 800311c: 28 41 00 00 lw r1,(r2+0) 8003120: 54 23 00 97 bgu r1,r3,800337c * 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 ) { 8003124: 29 62 00 10 lw r2,(r11+16) 8003128: 34 01 00 01 mvi r1,1 800312c: 44 41 00 05 be r2,r1,8003140 8003130: 34 01 00 02 mvi r1,2 schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; break; default: return EINVAL; 8003134: 34 0d 00 16 mvi r13,22 * 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 ) { 8003138: 5c 41 00 91 bne r2,r1,800337c 800313c: e0 00 00 14 bi 800318c case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 8003140: 78 02 08 01 mvhi r2,0x801 8003144: 38 42 fd 64 ori r2,r2,0xfd64 8003148: 28 41 00 0c lw r1,(r2+12) 800314c: 28 22 01 20 lw r2,(r1+288) schedpolicy = api->schedpolicy; schedparam = api->schedparam; 8003150: 28 48 00 88 lw r8,(r2+136) 8003154: 28 47 00 8c lw r7,(r2+140) 8003158: 28 46 00 90 lw r6,(r2+144) 800315c: 28 45 00 94 lw r5,(r2+148) 8003160: 28 44 00 98 lw r4,(r2+152) 8003164: 28 43 00 9c lw r3,(r2+156) * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; schedpolicy = api->schedpolicy; 8003168: 28 4f 00 84 lw r15,(r2+132) schedparam = api->schedparam; 800316c: 28 41 00 a0 lw r1,(r2+160) 8003170: 5b 88 00 40 sw (sp+64),r8 8003174: 5b 87 00 44 sw (sp+68),r7 8003178: 5b 86 00 48 sw (sp+72),r6 800317c: 5b 85 00 4c sw (sp+76),r5 8003180: 5b 84 00 50 sw (sp+80),r4 8003184: 5b 83 00 54 sw (sp+84),r3 8003188: e0 00 00 0f bi 80031c4 break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 800318c: 29 67 00 18 lw r7,(r11+24) 8003190: 29 66 00 1c lw r6,(r11+28) 8003194: 29 65 00 20 lw r5,(r11+32) 8003198: 29 64 00 24 lw r4,(r11+36) 800319c: 29 63 00 28 lw r3,(r11+40) 80031a0: 29 62 00 2c lw r2,(r11+44) schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; 80031a4: 29 6f 00 14 lw r15,(r11+20) schedparam = the_attr->schedparam; 80031a8: 29 61 00 30 lw r1,(r11+48) 80031ac: 5b 87 00 40 sw (sp+64),r7 80031b0: 5b 86 00 44 sw (sp+68),r6 80031b4: 5b 85 00 48 sw (sp+72),r5 80031b8: 5b 84 00 4c sw (sp+76),r4 80031bc: 5b 83 00 50 sw (sp+80),r3 80031c0: 5b 82 00 54 sw (sp+84),r2 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 80031c4: 29 6c 00 0c lw r12,(r11+12) schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; 80031c8: 5b 81 00 58 sw (sp+88),r1 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) return ENOTSUP; 80031cc: 34 0d 00 86 mvi r13,134 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) 80031d0: 5d 80 00 6b bne r12,r0,800337c return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 80031d4: 2b 81 00 40 lw r1,(sp+64) return EINVAL; 80031d8: 34 0d 00 16 mvi r13,22 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) 80031dc: f8 00 1b 99 calli 800a040 <_POSIX_Priority_Is_valid> 80031e0: 44 2c 00 67 be r1,r12,800337c <== NEVER TAKEN RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); 80031e4: 78 02 08 01 mvhi r2,0x801 80031e8: 38 42 f0 e4 ori r2,r2,0xf0e4 80031ec: 40 54 00 00 lbu r20,(r2+0) core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 80031f0: b9 e0 08 00 mv r1,r15 80031f4: 37 82 00 40 addi r2,sp,64 80031f8: 37 83 00 60 addi r3,sp,96 80031fc: 37 84 00 5c addi r4,sp,92 * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); 8003200: 2b 93 00 40 lw r19,(sp+64) /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( 8003204: f8 00 1b 97 calli 800a060 <_POSIX_Thread_Translate_sched_param> 8003208: b8 20 68 00 mv r13,r1 schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) 800320c: 5c 20 00 5c bne r1,r0,800337c <== NEVER TAKEN #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); 8003210: 78 0c 08 01 mvhi r12,0x801 8003214: 39 8c f9 58 ori r12,r12,0xf958 8003218: 29 81 00 00 lw r1,(r12+0) 800321c: f8 00 04 f5 calli 80045f0 <_API_Mutex_Lock> * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); 8003220: 78 02 08 01 mvhi r2,0x801 8003224: b8 40 08 00 mv r1,r2 8003228: 38 21 fa 6c ori r1,r1,0xfa6c 800322c: f8 00 08 05 calli 8005240 <_Objects_Allocate> 8003230: b8 20 70 00 mv r14,r1 * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { 8003234: 5c 2d 00 03 bne r1,r13,8003240 _RTEMS_Unlock_allocator(); 8003238: 29 81 00 00 lw r1,(r12+0) 800323c: e0 00 00 21 bi 80032c0 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 8003240: 78 02 08 01 mvhi r2,0x801 8003244: 38 42 f0 e0 ori r2,r2,0xf0e0 8003248: 28 41 00 00 lw r1,(r2+0) /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 800324c: 29 6c 00 08 lw r12,(r11+8) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 8003250: 34 02 00 01 mvi r2,1 8003254: f8 00 63 6f calli 801c010 <__ashlsi3> /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 8003258: 29 75 00 04 lw r21,(r11+4) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) 800325c: b8 20 28 00 mv r5,r1 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( 8003260: 50 2c 00 02 bgeu r1,r12,8003268 8003264: b9 80 28 00 mv r5,r12 8003268: 2b 81 00 5c lw r1,(sp+92) 800326c: 78 0c 08 01 mvhi r12,0x801 8003270: 2b 88 00 60 lw r8,(sp+96) 8003274: 39 8c fa 6c ori r12,r12,0xfa6c 8003278: 5b 81 00 04 sw (sp+4),r1 800327c: b8 a0 20 00 mv r4,r5 8003280: b9 80 08 00 mv r1,r12 8003284: b9 c0 10 00 mv r2,r14 8003288: ba a0 18 00 mv r3,r21 800328c: 34 05 00 00 mvi r5,0 8003290: ca 93 30 00 sub r6,r20,r19 8003294: 34 07 00 01 mvi r7,1 8003298: 5b 80 00 08 sw (sp+8),r0 800329c: 5b 80 00 0c sw (sp+12),r0 80032a0: f8 00 0c c5 calli 80065b4 <_Thread_Initialize> budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { 80032a4: 5c 20 00 0a bne r1,r0,80032cc <== ALWAYS TAKEN RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); 80032a8: b9 80 08 00 mv r1,r12 <== NOT EXECUTED 80032ac: b9 c0 10 00 mv r2,r14 <== NOT EXECUTED 80032b0: f8 00 08 e0 calli 8005630 <_Objects_Free> <== NOT EXECUTED _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); 80032b4: 78 01 08 01 mvhi r1,0x801 <== NOT EXECUTED 80032b8: 38 21 f9 58 ori r1,r1,0xf958 <== NOT EXECUTED 80032bc: 28 21 00 00 lw r1,(r1+0) <== NOT EXECUTED 80032c0: f8 00 04 e9 calli 8004664 <_API_Mutex_Unlock> return EAGAIN; 80032c4: 34 0d 00 0b mvi r13,11 80032c8: e0 00 00 2d bi 800337c } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 80032cc: 29 cc 01 20 lw r12,(r14+288) api->Attributes = *the_attr; 80032d0: b9 60 10 00 mv r2,r11 80032d4: 34 03 00 40 mvi r3,64 80032d8: b9 80 08 00 mv r1,r12 80032dc: f8 00 2a dd calli 800de50 api->detachstate = the_attr->detachstate; 80032e0: 29 61 00 3c lw r1,(r11+60) api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 80032e4: 34 02 00 01 mvi r2,1 */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; 80032e8: 59 8f 00 84 sw (r12+132),r15 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; 80032ec: 59 81 00 40 sw (r12+64),r1 api->schedpolicy = schedpolicy; api->schedparam = schedparam; 80032f0: 2b 81 00 40 lw r1,(sp+64) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 80032f4: ba 00 18 00 mv r3,r16 80032f8: ba 40 20 00 mv r4,r18 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 80032fc: 59 81 00 88 sw (r12+136),r1 8003300: 2b 81 00 44 lw r1,(sp+68) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 8003304: 34 05 00 00 mvi r5,0 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; 8003308: 59 81 00 8c sw (r12+140),r1 800330c: 2b 81 00 48 lw r1,(sp+72) 8003310: 59 81 00 90 sw (r12+144),r1 8003314: 2b 81 00 4c lw r1,(sp+76) 8003318: 59 81 00 94 sw (r12+148),r1 800331c: 2b 81 00 50 lw r1,(sp+80) 8003320: 59 81 00 98 sw (r12+152),r1 8003324: 2b 81 00 54 lw r1,(sp+84) 8003328: 59 81 00 9c sw (r12+156),r1 800332c: 2b 81 00 58 lw r1,(sp+88) 8003330: 59 81 00 a0 sw (r12+160),r1 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( 8003334: b9 c0 08 00 mv r1,r14 8003338: f8 00 0f 84 calli 8007148 <_Thread_Start> _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { 800333c: 34 01 00 04 mvi r1,4 8003340: 5d e1 00 09 bne r15,r1,8003364 _Watchdog_Insert_ticks( 8003344: 35 81 00 90 addi r1,r12,144 8003348: f8 00 10 07 calli 8007364 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 800334c: 78 02 08 01 mvhi r2,0x801 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8003350: 59 81 00 b4 sw (r12+180),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8003354: b8 40 08 00 mv r1,r2 8003358: 38 21 f9 78 ori r1,r1,0xf978 800335c: 35 82 00 a8 addi r2,r12,168 8003360: f8 00 11 36 calli 8007838 <_Watchdog_Insert> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; 8003364: 29 c1 00 08 lw r1,(r14+8) 8003368: 5a 21 00 00 sw (r17+0),r1 _RTEMS_Unlock_allocator(); 800336c: 78 01 08 01 mvhi r1,0x801 8003370: 38 21 f9 58 ori r1,r1,0xf958 8003374: 28 21 00 00 lw r1,(r1+0) 8003378: f8 00 04 bb calli 8004664 <_API_Mutex_Unlock> return 0; } 800337c: b9 a0 08 00 mv r1,r13 8003380: 2b 9d 00 10 lw ra,(sp+16) 8003384: 2b 8b 00 3c lw r11,(sp+60) 8003388: 2b 8c 00 38 lw r12,(sp+56) 800338c: 2b 8d 00 34 lw r13,(sp+52) 8003390: 2b 8e 00 30 lw r14,(sp+48) 8003394: 2b 8f 00 2c lw r15,(sp+44) 8003398: 2b 90 00 28 lw r16,(sp+40) 800339c: 2b 91 00 24 lw r17,(sp+36) 80033a0: 2b 92 00 20 lw r18,(sp+32) 80033a4: 2b 93 00 1c lw r19,(sp+28) 80033a8: 2b 94 00 18 lw r20,(sp+24) 80033ac: 2b 95 00 14 lw r21,(sp+20) 80033b0: 37 9c 00 60 addi sp,sp,96 80033b4: c3 a0 00 00 ret =============================================================================== 08010e94 : void pthread_exit( void *value_ptr ) { 8010e94: 37 9c ff fc addi sp,sp,-4 8010e98: 5b 9d 00 04 sw (sp+4),ra _POSIX_Thread_Exit( _Thread_Executing, value_ptr ); 8010e9c: 78 03 08 01 mvhi r3,0x801 8010ea0: 38 63 9e 2c ori r3,r3,0x9e2c } void pthread_exit( void *value_ptr ) { 8010ea4: b8 20 10 00 mv r2,r1 _POSIX_Thread_Exit( _Thread_Executing, value_ptr ); 8010ea8: 28 61 00 0c lw r1,(r3+12) 8010eac: fb ff ff d4 calli 8010dfc <_POSIX_Thread_Exit> } 8010eb0: 2b 9d 00 04 lw ra,(sp+4) 8010eb4: 37 9c 00 04 addi sp,sp,4 <== NOT EXECUTED 8010eb8: c3 a0 00 00 ret <== NOT EXECUTED =============================================================================== 0800565c : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { 800565c: 37 9c ff ec addi sp,sp,-20 8005660: 5b 8b 00 10 sw (sp+16),r11 8005664: 5b 8c 00 0c sw (sp+12),r12 8005668: 5b 8d 00 08 sw (sp+8),r13 800566c: 5b 9d 00 04 sw (sp+4),ra 8005670: b8 20 68 00 mv r13,r1 * * 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 ); 8005674: b8 40 08 00 mv r1,r2 8005678: 37 82 00 14 addi r2,sp,20 800567c: f8 00 00 41 calli 8005780 <_POSIX_Absolute_timeout_to_ticks> int _EXFUN(pthread_mutex_trylock, (pthread_mutex_t *__mutex)); int _EXFUN(pthread_mutex_unlock, (pthread_mutex_t *__mutex)); #if defined(_POSIX_TIMEOUTS) int _EXFUN(pthread_mutex_timedlock, 8005680: 64 2c 00 03 cmpei r12,r1,3 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 8005684: 2b 83 00 14 lw r3,(sp+20) * * 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 ); 8005688: b8 20 58 00 mv r11,r1 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); 800568c: b9 80 10 00 mv r2,r12 8005690: b9 a0 08 00 mv r1,r13 8005694: fb ff ff a3 calli 8005520 <_POSIX_Mutex_Lock_support> * This service only gives us the option to block. We used a polling * attempt to lock if the abstime was not in the future. If we did * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { 8005698: 5d 80 00 0b bne r12,r0,80056c4 800569c: 34 02 00 10 mvi r2,16 80056a0: 5c 22 00 09 bne r1,r2,80056c4 <== NEVER TAKEN if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 80056a4: 45 60 00 05 be r11,r0,80056b8 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 80056a8: 35 6b ff ff addi r11,r11,-1 80056ac: 34 02 00 01 mvi r2,1 80056b0: 50 4b 00 04 bgeu r2,r11,80056c0 <== ALWAYS TAKEN 80056b4: e0 00 00 04 bi 80056c4 <== NOT EXECUTED * not obtain the mutex, then not look at the status immediately, * make sure the right reason is returned. */ if ( !do_wait && (lock_status == EBUSY) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) return EINVAL; 80056b8: 34 01 00 16 mvi r1,22 <== NOT EXECUTED 80056bc: e0 00 00 02 bi 80056c4 <== NOT EXECUTED if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 80056c0: 34 01 00 74 mvi r1,116 } return lock_status; } 80056c4: 2b 9d 00 04 lw ra,(sp+4) 80056c8: 2b 8b 00 10 lw r11,(sp+16) 80056cc: 2b 8c 00 0c lw r12,(sp+12) 80056d0: 2b 8d 00 08 lw r13,(sp+8) 80056d4: 37 9c 00 14 addi sp,sp,20 80056d8: c3 a0 00 00 ret =============================================================================== 08002960 : const pthread_mutexattr_t *attr, int *type ) { if ( !attr ) return EINVAL; 8002960: 34 03 00 16 mvi r3,22 int pthread_mutexattr_gettype( const pthread_mutexattr_t *attr, int *type ) { if ( !attr ) 8002964: 44 20 00 07 be r1,r0,8002980 return EINVAL; if ( !attr->is_initialized ) 8002968: 28 24 00 00 lw r4,(r1+0) 800296c: 44 80 00 05 be r4,r0,8002980 return EINVAL; if ( !type ) 8002970: 44 40 00 04 be r2,r0,8002980 <== NEVER TAKEN return EINVAL; *type = attr->type; 8002974: 28 21 00 10 lw r1,(r1+16) return 0; 8002978: 34 03 00 00 mvi r3,0 return EINVAL; if ( !type ) return EINVAL; *type = attr->type; 800297c: 58 41 00 00 sw (r2+0),r1 return 0; } 8002980: b8 60 08 00 mv r1,r3 8002984: c3 a0 00 00 ret =============================================================================== 0800518c : pthread_mutexattr_t *attr, int pshared ) { if ( !attr || !attr->is_initialized ) return EINVAL; 800518c: 34 03 00 16 mvi r3,22 int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { if ( !attr || !attr->is_initialized ) 8005190: 44 20 00 07 be r1,r0,80051ac 8005194: 28 24 00 00 lw r4,(r1+0) 8005198: 44 80 00 05 be r4,r0,80051ac return EINVAL; switch ( pshared ) { 800519c: 34 04 00 01 mvi r4,1 80051a0: 54 44 00 03 bgu r2,r4,80051ac <== NEVER TAKEN case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 80051a4: 58 22 00 04 sw (r1+4),r2 return 0; 80051a8: 34 03 00 00 mvi r3,0 default: return EINVAL; } } 80051ac: b8 60 08 00 mv r1,r3 80051b0: c3 a0 00 00 ret =============================================================================== 080029d4 : pthread_mutexattr_t *attr, int type ) { if ( !attr || !attr->is_initialized ) return EINVAL; 80029d4: 34 03 00 16 mvi r3,22 int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { if ( !attr || !attr->is_initialized ) 80029d8: 44 20 00 07 be r1,r0,80029f4 80029dc: 28 24 00 00 lw r4,(r1+0) 80029e0: 44 80 00 05 be r4,r0,80029f4 <== NEVER TAKEN return EINVAL; switch ( type ) { 80029e4: 34 04 00 03 mvi r4,3 80029e8: 54 44 00 03 bgu r2,r4,80029f4 case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; 80029ec: 58 22 00 10 sw (r1+16),r2 return 0; 80029f0: 34 03 00 00 mvi r3,0 default: return EINVAL; } } 80029f4: b8 60 08 00 mv r1,r3 80029f8: c3 a0 00 00 ret =============================================================================== 080038a8 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { 80038a8: 37 9c ff ec addi sp,sp,-20 80038ac: 5b 8b 00 10 sw (sp+16),r11 80038b0: 5b 8c 00 0c sw (sp+12),r12 80038b4: 5b 8d 00 08 sw (sp+8),r13 80038b8: 5b 9d 00 04 sw (sp+4),ra 80038bc: b8 20 58 00 mv r11,r1 80038c0: b8 40 60 00 mv r12,r2 if ( !once_control || !init_routine ) 80038c4: 64 21 00 00 cmpei r1,r1,0 80038c8: 64 42 00 00 cmpei r2,r2,0 80038cc: b8 41 10 00 or r2,r2,r1 return EINVAL; 80038d0: 34 01 00 16 mvi r1,22 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) 80038d4: 5c 40 00 13 bne r2,r0,8003920 return EINVAL; if ( !once_control->init_executed ) { 80038d8: 29 6d 00 04 lw r13,(r11+4) once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; 80038dc: 34 01 00 00 mvi r1,0 ) { if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { 80038e0: 5d a2 00 10 bne r13,r2,8003920 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); 80038e4: 34 01 01 00 mvi r1,256 80038e8: 34 02 01 00 mvi r2,256 80038ec: 37 83 00 14 addi r3,sp,20 80038f0: f8 00 01 96 calli 8003f48 if ( !once_control->init_executed ) { 80038f4: 29 61 00 04 lw r1,(r11+4) 80038f8: 5c 2d 00 05 bne r1,r13,800390c <== NEVER TAKEN once_control->is_initialized = true; 80038fc: 34 01 00 01 mvi r1,1 8003900: 59 61 00 00 sw (r11+0),r1 once_control->init_executed = true; 8003904: 59 61 00 04 sw (r11+4),r1 (*init_routine)(); 8003908: d9 80 00 00 call r12 } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); 800390c: 2b 81 00 14 lw r1,(sp+20) 8003910: 34 02 01 00 mvi r2,256 8003914: 37 83 00 14 addi r3,sp,20 8003918: f8 00 01 8c calli 8003f48 } return 0; 800391c: 34 01 00 00 mvi r1,0 } 8003920: 2b 9d 00 04 lw ra,(sp+4) 8003924: 2b 8b 00 10 lw r11,(sp+16) 8003928: 2b 8c 00 0c lw r12,(sp+12) 800392c: 2b 8d 00 08 lw r13,(sp+8) 8003930: 37 9c 00 14 addi sp,sp,20 8003934: c3 a0 00 00 ret =============================================================================== 08004260 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 8004260: 37 9c ff e0 addi sp,sp,-32 8004264: 5b 8b 00 14 sw (sp+20),r11 8004268: 5b 8c 00 10 sw (sp+16),r12 800426c: 5b 8d 00 0c sw (sp+12),r13 8004270: 5b 8e 00 08 sw (sp+8),r14 8004274: 5b 9d 00 04 sw (sp+4),ra /* * Error check parameters */ if ( !rwlock ) return EINVAL; 8004278: 34 03 00 16 mvi r3,22 int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { 800427c: b8 20 68 00 mv r13,r1 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) 8004280: 44 20 00 28 be r1,r0,8004320 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { 8004284: 5c 40 00 05 bne r2,r0,8004298 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); 8004288: 37 8b 00 18 addi r11,sp,24 800428c: b9 60 08 00 mv r1,r11 8004290: f8 00 02 ff calli 8004e8c the_attr = &default_attr; 8004294: b9 60 10 00 mv r2,r11 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 8004298: 28 41 00 00 lw r1,(r2+0) return EINVAL; 800429c: 34 03 00 16 mvi r3,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) 80042a0: 44 20 00 20 be r1,r0,8004320 <== NEVER TAKEN return EINVAL; switch ( the_attr->process_shared ) { 80042a4: 28 4e 00 04 lw r14,(r2+4) 80042a8: 5d c0 00 1e bne r14,r0,8004320 <== NEVER TAKEN rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 80042ac: 78 02 08 01 mvhi r2,0x801 80042b0: 38 42 88 a8 ori r2,r2,0x88a8 80042b4: 28 41 00 00 lw r1,(r2+0) */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; 80042b8: 5b 80 00 20 sw (sp+32),r0 80042bc: 34 21 00 01 addi r1,r1,1 80042c0: 58 41 00 00 sw (r2+0),r1 * the inactive chain of free RWLock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void ) { return (POSIX_RWLock_Control *) _Objects_Allocate( &_POSIX_RWLock_Information ); 80042c4: 78 0c 08 01 mvhi r12,0x801 80042c8: 39 8c 8a 3c ori r12,r12,0x8a3c 80042cc: b9 80 08 00 mv r1,r12 80042d0: f8 00 09 a1 calli 8006954 <_Objects_Allocate> 80042d4: b8 20 58 00 mv r11,r1 */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { 80042d8: 5c 2e 00 04 bne r1,r14,80042e8 _Thread_Enable_dispatch(); 80042dc: f8 00 0e 21 calli 8007b60 <_Thread_Enable_dispatch> return EAGAIN; 80042e0: 34 03 00 0b mvi r3,11 80042e4: e0 00 00 0f bi 8004320 } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); 80042e8: 34 21 00 10 addi r1,r1,16 80042ec: 37 82 00 20 addi r2,sp,32 80042f0: f8 00 06 de calli 8005e68 <_CORE_RWLock_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 80042f4: 29 6e 00 08 lw r14,(r11+8) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 80042f8: 29 8c 00 1c lw r12,(r12+28) 80042fc: 34 02 00 02 mvi r2,2 8004300: 21 c1 ff ff andi r1,r14,0xffff 8004304: f8 00 40 fe calli 80146fc <__ashlsi3> 8004308: b5 81 08 00 add r1,r12,r1 800430c: 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; 8004310: 59 60 00 0c sw (r11+12),r0 &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; 8004314: 59 ae 00 00 sw (r13+0),r14 _Thread_Enable_dispatch(); 8004318: f8 00 0e 12 calli 8007b60 <_Thread_Enable_dispatch> return 0; 800431c: 34 03 00 00 mvi r3,0 } 8004320: b8 60 08 00 mv r1,r3 8004324: 2b 9d 00 04 lw ra,(sp+4) 8004328: 2b 8b 00 14 lw r11,(sp+20) 800432c: 2b 8c 00 10 lw r12,(sp+16) 8004330: 2b 8d 00 0c lw r13,(sp+12) 8004334: 2b 8e 00 08 lw r14,(sp+8) 8004338: 37 9c 00 20 addi sp,sp,32 800433c: c3 a0 00 00 ret =============================================================================== 080043c8 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 80043c8: 37 9c ff e0 addi sp,sp,-32 80043cc: 5b 8b 00 18 sw (sp+24),r11 80043d0: 5b 8c 00 14 sw (sp+20),r12 80043d4: 5b 8d 00 10 sw (sp+16),r13 80043d8: 5b 8e 00 0c sw (sp+12),r14 80043dc: 5b 8f 00 08 sw (sp+8),r15 80043e0: 5b 9d 00 04 sw (sp+4),ra 80043e4: b8 20 70 00 mv r14,r1 Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; 80043e8: 34 0b 00 16 mvi r11,22 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 80043ec: 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 ) 80043f0: 45 c0 00 25 be r14,r0,8004484 * * 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 ); 80043f4: 37 82 00 1c addi r2,sp,28 80043f8: f8 00 1c 13 calli 800b444 <_POSIX_Absolute_timeout_to_ticks> 80043fc: 29 c2 00 00 lw r2,(r14+0) 8004400: b8 20 60 00 mv r12,r1 8004404: 78 01 08 01 mvhi r1,0x801 8004408: 38 21 8a 3c ori r1,r1,0x8a3c 800440c: 37 83 00 20 addi r3,sp,32 8004410: f8 00 0a b6 calli 8006ee8 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 8004414: 2b 8f 00 20 lw r15,(sp+32) 8004418: 5d e0 00 1b bne r15,r0,8004484 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, 800441c: 65 8d 00 03 cmpei r13,r12,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( 8004420: 29 c2 00 00 lw r2,(r14+0) 8004424: 2b 84 00 1c lw r4,(sp+28) 8004428: 34 21 00 10 addi r1,r1,16 800442c: b9 a0 18 00 mv r3,r13 8004430: 34 05 00 00 mvi r5,0 8004434: f8 00 06 9a calli 8005e9c <_CORE_RWLock_Obtain_for_reading> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 8004438: f8 00 0d ca calli 8007b60 <_Thread_Enable_dispatch> if ( !do_wait ) { 800443c: 5d af 00 0c bne r13,r15,800446c if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { 8004440: 78 01 08 01 mvhi r1,0x801 8004444: 38 21 8d 74 ori r1,r1,0x8d74 8004448: 28 21 00 0c lw r1,(r1+12) 800444c: 28 22 00 34 lw r2,(r1+52) 8004450: 34 01 00 02 mvi r1,2 8004454: 5c 41 00 06 bne r2,r1,800446c if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 8004458: 45 8d 00 0b be r12,r13,8004484 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 800445c: 35 8c ff ff addi r12,r12,-1 8004460: 34 01 00 01 mvi r1,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 8004464: 34 0b 00 74 mvi r11,116 _Thread_Enable_dispatch(); if ( !do_wait ) { if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 8004468: 50 2c 00 07 bgeu r1,r12,8004484 <== ALWAYS TAKEN return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( (CORE_RWLock_Status) _Thread_Executing->Wait.return_code 800446c: 78 01 08 01 mvhi r1,0x801 8004470: 38 21 8d 74 ori r1,r1,0x8d74 8004474: 28 21 00 0c lw r1,(r1+12) status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( 8004478: 28 21 00 34 lw r1,(r1+52) 800447c: f8 00 00 43 calli 8004588 <_POSIX_RWLock_Translate_core_RWLock_return_code> 8004480: b8 20 58 00 mv r11,r1 case OBJECTS_ERROR: break; } return EINVAL; } 8004484: b9 60 08 00 mv r1,r11 8004488: 2b 9d 00 04 lw ra,(sp+4) 800448c: 2b 8b 00 18 lw r11,(sp+24) 8004490: 2b 8c 00 14 lw r12,(sp+20) 8004494: 2b 8d 00 10 lw r13,(sp+16) 8004498: 2b 8e 00 0c lw r14,(sp+12) 800449c: 2b 8f 00 08 lw r15,(sp+8) 80044a0: 37 9c 00 20 addi sp,sp,32 80044a4: c3 a0 00 00 ret =============================================================================== 080044a8 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 80044a8: 37 9c ff e0 addi sp,sp,-32 80044ac: 5b 8b 00 18 sw (sp+24),r11 80044b0: 5b 8c 00 14 sw (sp+20),r12 80044b4: 5b 8d 00 10 sw (sp+16),r13 80044b8: 5b 8e 00 0c sw (sp+12),r14 80044bc: 5b 8f 00 08 sw (sp+8),r15 80044c0: 5b 9d 00 04 sw (sp+4),ra 80044c4: b8 20 70 00 mv r14,r1 Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; 80044c8: 34 0b 00 16 mvi r11,22 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { 80044cc: 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 ) 80044d0: 45 c0 00 25 be r14,r0,8004564 * * 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 ); 80044d4: 37 82 00 1c addi r2,sp,28 80044d8: f8 00 1b db calli 800b444 <_POSIX_Absolute_timeout_to_ticks> 80044dc: 29 c2 00 00 lw r2,(r14+0) 80044e0: b8 20 60 00 mv r12,r1 80044e4: 78 01 08 01 mvhi r1,0x801 80044e8: 38 21 8a 3c ori r1,r1,0x8a3c 80044ec: 37 83 00 20 addi r3,sp,32 80044f0: f8 00 0a 7e calli 8006ee8 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { 80044f4: 2b 8f 00 20 lw r15,(sp+32) 80044f8: 5d e0 00 1b bne r15,r0,8004564 (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, 80044fc: 65 8d 00 03 cmpei r13,r12,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( 8004500: 29 c2 00 00 lw r2,(r14+0) 8004504: 2b 84 00 1c lw r4,(sp+28) 8004508: 34 21 00 10 addi r1,r1,16 800450c: b9 a0 18 00 mv r3,r13 8004510: 34 05 00 00 mvi r5,0 8004514: f8 00 06 a4 calli 8005fa4 <_CORE_RWLock_Obtain_for_writing> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); 8004518: f8 00 0d 92 calli 8007b60 <_Thread_Enable_dispatch> if ( !do_wait && 800451c: 5d af 00 0c bne r13,r15,800454c (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { 8004520: 78 01 08 01 mvhi r1,0x801 8004524: 38 21 8d 74 ori r1,r1,0x8d74 8004528: 28 21 00 0c lw r1,(r1+12) ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && 800452c: 28 22 00 34 lw r2,(r1+52) 8004530: 34 01 00 02 mvi r1,2 8004534: 5c 41 00 06 bne r2,r1,800454c (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) 8004538: 45 8d 00 0b be r12,r13,8004564 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 800453c: 35 8c ff ff addi r12,r12,-1 8004540: 34 01 00 01 mvi r1,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; 8004544: 34 0b 00 74 mvi r11,116 _Thread_Enable_dispatch(); if ( !do_wait && (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || 8004548: 50 2c 00 07 bgeu r1,r12,8004564 <== ALWAYS TAKEN status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( (CORE_RWLock_Status) _Thread_Executing->Wait.return_code 800454c: 78 01 08 01 mvhi r1,0x801 8004550: 38 21 8d 74 ori r1,r1,0x8d74 8004554: 28 21 00 0c lw r1,(r1+12) if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( 8004558: 28 21 00 34 lw r1,(r1+52) 800455c: f8 00 00 0b calli 8004588 <_POSIX_RWLock_Translate_core_RWLock_return_code> 8004560: b8 20 58 00 mv r11,r1 case OBJECTS_ERROR: break; } return EINVAL; } 8004564: b9 60 08 00 mv r1,r11 8004568: 2b 9d 00 04 lw ra,(sp+4) 800456c: 2b 8b 00 18 lw r11,(sp+24) 8004570: 2b 8c 00 14 lw r12,(sp+20) 8004574: 2b 8d 00 10 lw r13,(sp+16) 8004578: 2b 8e 00 0c lw r14,(sp+12) 800457c: 2b 8f 00 08 lw r15,(sp+8) 8004580: 37 9c 00 20 addi sp,sp,32 8004584: c3 a0 00 00 ret =============================================================================== 08004eac : pthread_rwlockattr_t *attr, int pshared ) { if ( !attr ) return EINVAL; 8004eac: 34 03 00 16 mvi r3,22 int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { if ( !attr ) 8004eb0: 44 20 00 07 be r1,r0,8004ecc return EINVAL; if ( !attr->is_initialized ) 8004eb4: 28 24 00 00 lw r4,(r1+0) 8004eb8: 44 80 00 05 be r4,r0,8004ecc return EINVAL; switch ( pshared ) { 8004ebc: 34 04 00 01 mvi r4,1 8004ec0: 54 44 00 03 bgu r2,r4,8004ecc <== NEVER TAKEN case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; 8004ec4: 58 22 00 04 sw (r1+4),r2 return 0; 8004ec8: 34 03 00 00 mvi r3,0 default: return EINVAL; } } 8004ecc: b8 60 08 00 mv r1,r3 8004ed0: c3 a0 00 00 ret =============================================================================== 08006128 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 8006128: 37 9c ff dc addi sp,sp,-36 800612c: 5b 8b 00 18 sw (sp+24),r11 8006130: 5b 8c 00 14 sw (sp+20),r12 8006134: 5b 8d 00 10 sw (sp+16),r13 8006138: 5b 8e 00 0c sw (sp+12),r14 800613c: 5b 8f 00 08 sw (sp+8),r15 8006140: 5b 9d 00 04 sw (sp+4),ra /* * Check all the parameters */ if ( !param ) return EINVAL; 8006144: 34 0e 00 16 mvi r14,22 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { 8006148: b8 20 58 00 mv r11,r1 800614c: b8 40 78 00 mv r15,r2 8006150: b8 60 60 00 mv r12,r3 int rc; /* * Check all the parameters */ if ( !param ) 8006154: 44 60 00 46 be r3,r0,800626c <== NEVER TAKEN return EINVAL; rc = _POSIX_Thread_Translate_sched_param( 8006158: b8 40 08 00 mv r1,r2 800615c: 37 84 00 20 addi r4,sp,32 8006160: b8 60 10 00 mv r2,r3 8006164: 37 83 00 24 addi r3,sp,36 8006168: f8 00 19 f5 calli 800c93c <_POSIX_Thread_Translate_sched_param> 800616c: b8 20 70 00 mv r14,r1 policy, param, &budget_algorithm, &budget_callout ); if ( rc ) 8006170: 5c 20 00 3f bne r1,r0,800626c <== NEVER TAKEN 8006174: 78 03 08 01 mvhi r3,0x801 8006178: b8 60 08 00 mv r1,r3 800617c: 38 21 aa cc ori r1,r1,0xaacc 8006180: b9 60 10 00 mv r2,r11 8006184: 37 83 00 1c addi r3,sp,28 8006188: f8 00 07 a5 calli 800801c <_Objects_Get> 800618c: b8 20 68 00 mv r13,r1 /* * Actually change the scheduling policy and parameters */ the_thread = _POSIX_Threads_Get( thread, &location ); switch ( location ) { 8006190: 2b 81 00 1c lw r1,(sp+28) 8006194: 5c 2e 00 35 bne r1,r14,8006268 <== NEVER TAKEN case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8006198: 29 ab 01 20 lw r11,(r13+288) if ( api->schedpolicy == SCHED_SPORADIC ) 800619c: 34 01 00 04 mvi r1,4 80061a0: 29 62 00 84 lw r2,(r11+132) 80061a4: 5c 41 00 03 bne r2,r1,80061b0 (void) _Watchdog_Remove( &api->Sporadic_timer ); 80061a8: 35 61 00 a8 addi r1,r11,168 80061ac: f8 00 10 41 calli 800a2b0 <_Watchdog_Remove> api->schedpolicy = policy; 80061b0: 59 6f 00 84 sw (r11+132),r15 api->schedparam = *param; 80061b4: 29 81 00 14 lw r1,(r12+20) 80061b8: 29 82 00 00 lw r2,(r12+0) 80061bc: 29 86 00 04 lw r6,(r12+4) 80061c0: 29 85 00 08 lw r5,(r12+8) 80061c4: 29 84 00 0c lw r4,(r12+12) 80061c8: 29 83 00 10 lw r3,(r12+16) 80061cc: 29 87 00 18 lw r7,(r12+24) 80061d0: 59 61 00 9c sw (r11+156),r1 the_thread->budget_algorithm = budget_algorithm; 80061d4: 2b 81 00 24 lw r1,(sp+36) if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; 80061d8: 59 62 00 88 sw (r11+136),r2 80061dc: 59 66 00 8c sw (r11+140),r6 80061e0: 59 65 00 90 sw (r11+144),r5 80061e4: 59 64 00 94 sw (r11+148),r4 80061e8: 59 63 00 98 sw (r11+152),r3 80061ec: 59 67 00 a0 sw (r11+160),r7 the_thread->budget_algorithm = budget_algorithm; 80061f0: 59 a1 00 7c sw (r13+124),r1 the_thread->budget_callout = budget_callout; 80061f4: 2b 81 00 20 lw r1,(sp+32) 80061f8: 59 a1 00 80 sw (r13+128),r1 switch ( api->schedpolicy ) { 80061fc: 48 0f 00 19 bg r0,r15,8006260 <== NEVER TAKEN 8006200: 34 01 00 02 mvi r1,2 8006204: 4c 2f 00 04 bge r1,r15,8006214 8006208: 34 01 00 04 mvi r1,4 800620c: 5d e1 00 15 bne r15,r1,8006260 <== NEVER TAKEN 8006210: e0 00 00 0e bi 8006248 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; 8006214: 78 01 08 01 mvhi r1,0x801 8006218: 38 21 a8 90 ori r1,r1,0xa890 800621c: 28 21 00 00 lw r1,(r1+0) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 8006220: 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; 8006224: 59 a1 00 78 sw (r13+120),r1 8006228: 78 01 08 01 mvhi r1,0x801 800622c: 38 21 a0 e4 ori r1,r1,0xa0e4 8006230: 40 21 00 00 lbu r1,(r1+0) 8006234: c8 22 10 00 sub r2,r1,r2 the_thread->real_priority = 8006238: 59 a2 00 18 sw (r13+24),r2 _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( 800623c: b9 a0 08 00 mv r1,r13 8006240: f8 00 09 96 calli 8008898 <_Thread_Change_priority> the_thread, the_thread->real_priority, true ); break; 8006244: e0 00 00 07 bi 8006260 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; 8006248: 59 62 00 a4 sw (r11+164),r2 _Watchdog_Remove( &api->Sporadic_timer ); 800624c: 35 61 00 a8 addi r1,r11,168 8006250: f8 00 10 18 calli 800a2b0 <_Watchdog_Remove> _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); 8006254: 34 01 00 00 mvi r1,0 8006258: b9 a0 10 00 mv r2,r13 800625c: fb ff ff 62 calli 8005fe4 <_POSIX_Threads_Sporadic_budget_TSR> break; } _Thread_Enable_dispatch(); 8006260: f8 00 0a c4 calli 8008d70 <_Thread_Enable_dispatch> return 0; 8006264: e0 00 00 02 bi 800626c #endif case OBJECTS_ERROR: break; } return ESRCH; 8006268: 34 0e 00 03 mvi r14,3 } 800626c: b9 c0 08 00 mv r1,r14 8006270: 2b 9d 00 04 lw ra,(sp+4) 8006274: 2b 8b 00 18 lw r11,(sp+24) 8006278: 2b 8c 00 14 lw r12,(sp+20) 800627c: 2b 8d 00 10 lw r13,(sp+16) 8006280: 2b 8e 00 0c lw r14,(sp+12) 8006284: 2b 8f 00 08 lw r15,(sp+8) 8006288: 37 9c 00 24 addi sp,sp,36 800628c: c3 a0 00 00 ret =============================================================================== 080035d4 : * * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { 80035d4: 37 9c ff f8 addi sp,sp,-8 80035d8: 5b 8b 00 08 sw (sp+8),r11 80035dc: 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() ) 80035e0: 78 01 08 01 mvhi r1,0x801 80035e4: 38 21 6d 5c ori r1,r1,0x6d5c 80035e8: 28 22 00 08 lw r2,(r1+8) 80035ec: 5c 40 00 14 bne r2,r0,800363c <== NEVER TAKEN return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; 80035f0: 28 21 00 0c lw r1,(r1+12) 80035f4: 28 22 01 20 lw r2,(r1+288) 80035f8: 78 01 08 01 mvhi r1,0x801 80035fc: 38 21 68 90 ori r1,r1,0x6890 8003600: 28 23 00 00 lw r3,(r1+0) 8003604: 34 63 00 01 addi r3,r3,1 8003608: 58 23 00 00 sw (r1+0),r3 _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 800360c: 28 41 00 d8 lw r1,(r2+216) */ void pthread_testcancel( void ) { POSIX_API_Control *thread_support; bool cancel = false; 8003610: 34 0b 00 00 mvi r11,0 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && 8003614: 5c 2b 00 03 bne r1,r11,8003620 <== 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)); 8003618: 28 4b 00 e0 lw r11,(r2+224) 800361c: 7d 6b 00 00 cmpnei r11,r11,0 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); 8003620: f8 00 09 f0 calli 8005de0 <_Thread_Enable_dispatch> if ( cancel ) 8003624: 45 60 00 06 be r11,r0,800363c _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); 8003628: 78 01 08 01 mvhi r1,0x801 800362c: 38 21 6d 5c ori r1,r1,0x6d5c 8003630: 28 21 00 0c lw r1,(r1+12) 8003634: 34 02 ff ff mvi r2,-1 8003638: f8 00 18 e3 calli 80099c4 <_POSIX_Thread_Exit> } 800363c: 2b 9d 00 04 lw ra,(sp+4) 8003640: 2b 8b 00 08 lw r11,(sp+8) 8003644: 37 9c 00 08 addi sp,sp,8 8003648: c3 a0 00 00 ret =============================================================================== 080041d4 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 80041d4: 37 9c ff bc addi sp,sp,-68 80041d8: 5b 8b 00 20 sw (sp+32),r11 80041dc: 5b 8c 00 1c sw (sp+28),r12 80041e0: 5b 8d 00 18 sw (sp+24),r13 80041e4: 5b 8e 00 14 sw (sp+20),r14 80041e8: 5b 8f 00 10 sw (sp+16),r15 80041ec: 5b 90 00 0c sw (sp+12),r16 80041f0: 5b 91 00 08 sw (sp+8),r17 80041f4: 5b 9d 00 04 sw (sp+4),ra struct sched_param param; /* The queue should be initialized */ AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED); result = pthread_mutex_lock (&aio_request_queue.mutex); 80041f8: 78 0c 08 01 mvhi r12,0x801 80041fc: 39 8c 78 38 ori r12,r12,0x7838 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { 8004200: b8 20 58 00 mv r11,r1 struct sched_param param; /* The queue should be initialized */ AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED); result = pthread_mutex_lock (&aio_request_queue.mutex); 8004204: b9 80 08 00 mv r1,r12 8004208: f8 00 02 b1 calli 8004ccc 800420c: b8 20 70 00 mv r14,r1 if (result != 0) { 8004210: 44 20 00 04 be r1,r0,8004220 <== ALWAYS TAKEN free (req); 8004214: b9 60 08 00 mv r1,r11 <== NOT EXECUTED 8004218: fb ff f7 d2 calli 8002160 <== NOT EXECUTED return result; 800421c: e0 00 00 79 bi 8004400 <== NOT EXECUTED } /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); 8004220: f8 00 05 46 calli 8005738 8004224: 37 82 00 40 addi r2,sp,64 8004228: 37 83 00 24 addi r3,sp,36 800422c: f8 00 04 04 calli 800523c req->caller_thread = pthread_self (); 8004230: f8 00 05 42 calli 8005738 req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 8004234: 29 62 00 14 lw r2,(r11+20) /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); 8004238: 59 61 00 10 sw (r11+16),r1 req->priority = param.sched_priority - req->aiocbp->aio_reqprio; 800423c: 2b 83 00 24 lw r3,(sp+36) 8004240: 28 41 00 10 lw r1,(r2+16) 8004244: c8 61 08 00 sub r1,r3,r1 8004248: 59 61 00 0c sw (r11+12),r1 req->policy = policy; 800424c: 2b 81 00 40 lw r1,(sp+64) 8004250: 59 61 00 08 sw (r11+8),r1 req->aiocbp->error_code = EINPROGRESS; 8004254: 34 01 00 77 mvi r1,119 8004258: 58 41 00 2c sw (r2+44),r1 req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && 800425c: 29 81 00 68 lw r1,(r12+104) req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; req->policy = policy; req->aiocbp->error_code = EINPROGRESS; req->aiocbp->return_value = 0; 8004260: 58 40 00 30 sw (r2+48),r0 if ((aio_request_queue.idle_threads == 0) && 8004264: 5c 2e 00 34 bne r1,r14,8004334 <== NEVER TAKEN 8004268: 29 83 00 64 lw r3,(r12+100) 800426c: 34 01 00 04 mvi r1,4 8004270: 48 61 00 31 bg r3,r1,8004334 aio_request_queue.active_threads < AIO_MAX_THREADS) /* we still have empty places on the active_threads chain */ { chain = &aio_request_queue.work_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 8004274: 28 42 00 00 lw r2,(r2+0) 8004278: 78 01 08 01 mvhi r1,0x801 800427c: 38 21 78 80 ori r1,r1,0x7880 8004280: 34 03 00 01 mvi r3,1 8004284: fb ff fe 99 calli 8003ce8 if (r_chain->new_fd == 1) { 8004288: 28 22 00 18 lw r2,(r1+24) if ((aio_request_queue.idle_threads == 0) && aio_request_queue.active_threads < AIO_MAX_THREADS) /* we still have empty places on the active_threads chain */ { chain = &aio_request_queue.work_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 800428c: b8 20 68 00 mv r13,r1 8004290: 34 31 00 08 addi r17,r1,8 8004294: 34 2f 00 1c addi r15,r1,28 8004298: 34 30 00 20 addi r16,r1,32 if (r_chain->new_fd == 1) { 800429c: 34 01 00 01 mvi r1,1 80042a0: 5c 41 00 1c bne r2,r1,8004310 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); 80042a4: b9 60 10 00 mv r2,r11 80042a8: ba 20 08 00 mv r1,r17 80042ac: f8 00 08 7b calli 8006498 <_Chain_Insert> rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); 80042b0: 34 02 00 00 mvi r2,0 chain = &aio_request_queue.work_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); if (r_chain->new_fd == 1) { rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; 80042b4: 59 a0 00 18 sw (r13+24),r0 pthread_mutex_init (&r_chain->mutex, NULL); 80042b8: b9 e0 08 00 mv r1,r15 80042bc: f8 00 02 27 calli 8004b58 pthread_cond_init (&r_chain->cond, NULL); 80042c0: 34 02 00 00 mvi r2,0 80042c4: ba 00 08 00 mv r1,r16 80042c8: f8 00 01 02 calli 80046d0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, 80042cc: 78 02 08 01 mvhi r2,0x801 80042d0: 78 03 08 00 mvhi r3,0x800 80042d4: 37 81 00 44 addi r1,sp,68 80042d8: 38 42 78 40 ori r2,r2,0x7840 80042dc: 38 63 3e 0c ori r3,r3,0x3e0c 80042e0: b9 a0 20 00 mv r4,r13 80042e4: f8 00 03 11 calli 8004f28 80042e8: b8 20 58 00 mv r11,r1 rtems_aio_handle, (void *) r_chain); if (result != 0) { 80042ec: 44 20 00 05 be r1,r0,8004300 <== ALWAYS TAKEN pthread_mutex_unlock (&aio_request_queue.mutex); 80042f0: b9 80 08 00 mv r1,r12 <== NOT EXECUTED 80042f4: f8 00 02 a9 calli 8004d98 <== NOT EXECUTED return result; 80042f8: b9 60 70 00 mv r14,r11 <== NOT EXECUTED 80042fc: e0 00 00 41 bi 8004400 <== NOT EXECUTED } ++aio_request_queue.active_threads; 8004300: 29 81 00 64 lw r1,(r12+100) 8004304: 34 21 00 01 addi r1,r1,1 8004308: 59 81 00 64 sw (r12+100),r1 800430c: e0 00 00 3a bi 80043f4 } else { /* put request in the fd chain it belongs to */ pthread_mutex_lock (&r_chain->mutex); 8004310: b9 e0 08 00 mv r1,r15 8004314: f8 00 02 6e calli 8004ccc rtems_aio_insert_prio (&r_chain->perfd, req); 8004318: ba 20 08 00 mv r1,r17 800431c: b9 60 10 00 mv r2,r11 8004320: fb ff ff 5d calli 8004094 pthread_cond_signal (&r_chain->cond); 8004324: ba 00 08 00 mv r1,r16 8004328: f8 00 01 25 calli 80047bc pthread_mutex_unlock (&r_chain->mutex); 800432c: b9 e0 08 00 mv r1,r15 8004330: e0 00 00 11 bi 8004374 else { /* the maximum number of threads has been already created even though some of them might be idle. The request belongs to one of the active fd chain */ r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, 8004334: 28 42 00 00 lw r2,(r2+0) 8004338: 78 01 08 01 mvhi r1,0x801 800433c: 38 21 78 80 ori r1,r1,0x7880 8004340: 34 03 00 00 mvi r3,0 8004344: fb ff fe 69 calli 8003ce8 8004348: b8 20 60 00 mv r12,r1 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) 800434c: 44 20 00 0c be r1,r0,800437c { pthread_mutex_lock (&r_chain->mutex); 8004350: 34 2d 00 1c addi r13,r1,28 8004354: b9 a0 08 00 mv r1,r13 8004358: f8 00 02 5d calli 8004ccc rtems_aio_insert_prio (&r_chain->perfd, req); 800435c: 35 81 00 08 addi r1,r12,8 8004360: b9 60 10 00 mv r2,r11 8004364: fb ff ff 4c calli 8004094 pthread_cond_signal (&r_chain->cond); 8004368: 35 81 00 20 addi r1,r12,32 800436c: f8 00 01 14 calli 80047bc pthread_mutex_unlock (&r_chain->mutex); 8004370: b9 a0 08 00 mv r1,r13 8004374: f8 00 02 89 calli 8004d98 8004378: e0 00 00 1f bi 80043f4 } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 800437c: 29 62 00 14 lw r2,(r11+20) 8004380: 78 01 08 01 mvhi r1,0x801 8004384: 34 03 00 01 mvi r3,1 8004388: 28 42 00 00 lw r2,(r2+0) 800438c: 38 21 78 8c ori r1,r1,0x788c 8004390: fb ff fe 56 calli 8003ce8 if (r_chain->new_fd == 1) { 8004394: 28 23 00 18 lw r3,(r1+24) 8004398: 34 02 00 01 mvi r2,1 } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); 800439c: b8 20 60 00 mv r12,r1 80043a0: 34 21 00 08 addi r1,r1,8 if (r_chain->new_fd == 1) { 80043a4: 5c 62 00 0b bne r3,r2,80043d0 80043a8: b9 60 10 00 mv r2,r11 80043ac: f8 00 08 3b calli 8006498 <_Chain_Insert> /* If this is a new fd chain we signal the idle threads that might be waiting for requests */ AIO_printf (" New chain on waiting queue \n "); rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); 80043b0: 35 81 00 1c addi r1,r12,28 if (r_chain->new_fd == 1) { /* If this is a new fd chain we signal the idle threads that might be waiting for requests */ AIO_printf (" New chain on waiting queue \n "); rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; 80043b4: 59 80 00 18 sw (r12+24),r0 pthread_mutex_init (&r_chain->mutex, NULL); 80043b8: 34 02 00 00 mvi r2,0 80043bc: f8 00 01 e7 calli 8004b58 pthread_cond_init (&r_chain->cond, NULL); 80043c0: 35 81 00 20 addi r1,r12,32 80043c4: 34 02 00 00 mvi r2,0 80043c8: f8 00 00 c2 calli 80046d0 80043cc: e0 00 00 03 bi 80043d8 } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); 80043d0: b9 60 10 00 mv r2,r11 80043d4: fb ff ff 30 calli 8004094 if (aio_request_queue.idle_threads > 0) 80043d8: 78 01 08 01 mvhi r1,0x801 80043dc: 38 21 78 38 ori r1,r1,0x7838 80043e0: 28 21 00 68 lw r1,(r1+104) 80043e4: 4c 01 00 04 bge r0,r1,80043f4 <== ALWAYS TAKEN pthread_cond_signal (&aio_request_queue.new_req); 80043e8: 78 01 08 01 mvhi r1,0x801 <== NOT EXECUTED 80043ec: 38 21 78 3c ori r1,r1,0x783c <== NOT EXECUTED 80043f0: f8 00 00 f3 calli 80047bc <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); 80043f4: 78 01 08 01 mvhi r1,0x801 80043f8: 38 21 78 38 ori r1,r1,0x7838 80043fc: f8 00 02 67 calli 8004d98 return 0; } 8004400: b9 c0 08 00 mv r1,r14 8004404: 2b 9d 00 04 lw ra,(sp+4) 8004408: 2b 8b 00 20 lw r11,(sp+32) 800440c: 2b 8c 00 1c lw r12,(sp+28) 8004410: 2b 8d 00 18 lw r13,(sp+24) 8004414: 2b 8e 00 14 lw r14,(sp+20) 8004418: 2b 8f 00 10 lw r15,(sp+16) 800441c: 2b 90 00 0c lw r16,(sp+12) 8004420: 2b 91 00 08 lw r17,(sp+8) 8004424: 37 9c 00 44 addi sp,sp,68 8004428: c3 a0 00 00 ret =============================================================================== 08003e0c : * NULL - if error */ static void * rtems_aio_handle (void *arg) { 8003e0c: 37 9c ff a4 addi sp,sp,-92 8003e10: 5b 8b 00 34 sw (sp+52),r11 8003e14: 5b 8c 00 30 sw (sp+48),r12 8003e18: 5b 8d 00 2c sw (sp+44),r13 8003e1c: 5b 8e 00 28 sw (sp+40),r14 8003e20: 5b 8f 00 24 sw (sp+36),r15 8003e24: 5b 90 00 20 sw (sp+32),r16 8003e28: 5b 91 00 1c sw (sp+28),r17 8003e2c: 5b 92 00 18 sw (sp+24),r18 8003e30: 5b 93 00 14 sw (sp+20),r19 8003e34: 5b 94 00 10 sw (sp+16),r20 8003e38: 5b 95 00 0c sw (sp+12),r21 8003e3c: 5b 96 00 08 sw (sp+8),r22 8003e40: 5b 9d 00 04 sw (sp+4),ra struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 8003e44: 78 0b 08 01 mvhi r11,0x801 pthread_cond_destroy (&r_chain->cond); free (r_chain); /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { 8003e48: 78 11 08 01 mvhi r17,0x801 --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 8003e4c: 78 10 08 01 mvhi r16,0x801 * NULL - if error */ static void * rtems_aio_handle (void *arg) { 8003e50: b8 20 60 00 mv r12,r1 struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); 8003e54: 39 6b 78 38 ori r11,r11,0x7838 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); 8003e58: 37 8e 00 54 addi r14,sp,84 &aio_request_queue.mutex, &timeout); /* If no requests were added to the chain we delete the fd chain from the queue and start working with idle fd chains */ if (result == ETIMEDOUT) { 8003e5c: 34 14 00 74 mvi r20,116 pthread_cond_destroy (&r_chain->cond); free (r_chain); /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { 8003e60: 3a 31 78 90 ori r17,r17,0x7890 --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 8003e64: 3a 10 78 3c ori r16,r16,0x783c node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 8003e68: 37 93 00 38 addi r19,sp,56 rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); switch (req->aiocbp->aio_lio_opcode) { 8003e6c: 34 16 00 02 mvi r22,2 default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; 8003e70: 34 12 ff ff mvi r18,-1 rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); switch (req->aiocbp->aio_lio_opcode) { 8003e74: 34 15 00 03 mvi r21,3 /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); 8003e78: 35 8f 00 1c addi r15,r12,28 8003e7c: b9 e0 08 00 mv r1,r15 8003e80: f8 00 03 93 calli 8004ccc if (result != 0) 8003e84: 5c 20 00 74 bne r1,r0,8004054 <== NEVER TAKEN } } AIO_printf ("Thread finished\n"); return NULL; } 8003e88: 29 8d 00 08 lw r13,(r12+8) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 8003e8c: 35 81 00 0c addi r1,r12,12 /* If the locked chain is not empty, take the first request extract it, unlock the chain and process the request, in this way the user can supply more requests to this fd chain */ if (!rtems_chain_is_empty (chain)) { 8003e90: 45 a1 00 2e be r13,r1,8003f48 node = rtems_chain_first (chain); req = (rtems_aio_request *) node; /* See _POSIX_PRIORITIZE_IO and _POSIX_PRIORITY_SCHEDULING discussion in rtems_aio_enqueue () */ pthread_getschedparam (pthread_self(), &policy, ¶m); 8003e94: f8 00 06 29 calli 8005738 8003e98: 37 82 00 5c addi r2,sp,92 8003e9c: ba 60 18 00 mv r3,r19 8003ea0: f8 00 04 e7 calli 800523c param.sched_priority = req->priority; 8003ea4: 29 a1 00 0c lw r1,(r13+12) 8003ea8: 5b 81 00 38 sw (sp+56),r1 pthread_setschedparam (pthread_self(), req->policy, ¶m); 8003eac: f8 00 06 23 calli 8005738 8003eb0: 29 a2 00 08 lw r2,(r13+8) 8003eb4: ba 60 18 00 mv r3,r19 8003eb8: f8 00 06 25 calli 800574c */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); 8003ebc: b9 a0 08 00 mv r1,r13 8003ec0: f8 00 09 5d calli 8006434 <_Chain_Extract> rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); 8003ec4: b9 e0 08 00 mv r1,r15 8003ec8: f8 00 03 b4 calli 8004d98 switch (req->aiocbp->aio_lio_opcode) { 8003ecc: 29 a4 00 14 lw r4,(r13+20) 8003ed0: 28 81 00 28 lw r1,(r4+40) 8003ed4: 44 36 00 0a be r1,r22,8003efc 8003ed8: 44 35 00 0f be r1,r21,8003f14 <== NEVER TAKEN 8003edc: 34 02 00 01 mvi r2,1 8003ee0: 5c 22 00 10 bne r1,r2,8003f20 <== NEVER TAKEN case LIO_READ: AIO_printf ("read\n"); result = pread (req->aiocbp->aio_fildes, 8003ee4: 28 82 00 08 lw r2,(r4+8) 8003ee8: 28 83 00 0c lw r3,(r4+12) 8003eec: 28 81 00 00 lw r1,(r4+0) 8003ef0: 28 84 00 04 lw r4,(r4+4) 8003ef4: f8 00 31 47 calli 8010410 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 8003ef8: e0 00 00 09 bi 8003f1c case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, 8003efc: 28 82 00 08 lw r2,(r4+8) 8003f00: 28 83 00 0c lw r3,(r4+12) 8003f04: 28 81 00 00 lw r1,(r4+0) 8003f08: 28 84 00 04 lw r4,(r4+4) 8003f0c: f8 00 31 85 calli 8010520 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; 8003f10: e0 00 00 03 bi 8003f1c case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); 8003f14: 28 81 00 00 lw r1,(r4+0) <== NOT EXECUTED 8003f18: f8 00 1d 11 calli 800b35c <== NOT EXECUTED break; default: result = -1; } if (result == -1) { 8003f1c: 5c 32 00 07 bne r1,r18,8003f38 <== ALWAYS TAKEN req->aiocbp->return_value = -1; 8003f20: 29 ad 00 14 lw r13,(r13+20) <== NOT EXECUTED 8003f24: 59 b2 00 30 sw (r13+48),r18 <== NOT EXECUTED req->aiocbp->error_code = errno; 8003f28: f8 00 2d 8b calli 800f554 <__errno> <== NOT EXECUTED 8003f2c: 28 21 00 00 lw r1,(r1+0) <== NOT EXECUTED 8003f30: 59 a1 00 2c sw (r13+44),r1 <== NOT EXECUTED 8003f34: e3 ff ff d1 bi 8003e78 <== NOT EXECUTED } else { req->aiocbp->return_value = result; 8003f38: 29 a2 00 14 lw r2,(r13+20) 8003f3c: 58 41 00 30 sw (r2+48),r1 req->aiocbp->error_code = 0; 8003f40: 58 40 00 2c sw (r2+44),r0 8003f44: e3 ff ff cd bi 8003e78 struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); 8003f48: b9 e0 08 00 mv r1,r15 8003f4c: f8 00 03 93 calli 8004d98 pthread_mutex_lock (&aio_request_queue.mutex); 8003f50: b9 60 08 00 mv r1,r11 8003f54: f8 00 03 5e calli 8004ccc if (rtems_chain_is_empty (chain)) 8003f58: 29 81 00 08 lw r1,(r12+8) 8003f5c: 5c 2d 00 3b bne r1,r13,8004048 <== NEVER TAKEN { clock_gettime (CLOCK_REALTIME, &timeout); 8003f60: b9 c0 10 00 mv r2,r14 8003f64: 34 01 00 01 mvi r1,1 8003f68: f8 00 01 84 calli 8004578 timeout.tv_sec += 3; 8003f6c: 2b 81 00 54 lw r1,(sp+84) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 8003f70: 35 8d 00 20 addi r13,r12,32 8003f74: b9 60 10 00 mv r2,r11 pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 8003f78: 34 21 00 03 addi r1,r1,3 8003f7c: 5b 81 00 54 sw (sp+84),r1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, 8003f80: b9 c0 18 00 mv r3,r14 8003f84: b9 a0 08 00 mv r1,r13 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; 8003f88: 5b 80 00 58 sw (sp+88),r0 result = pthread_cond_timedwait (&r_chain->cond, 8003f8c: f8 00 02 30 calli 800484c &aio_request_queue.mutex, &timeout); /* If no requests were added to the chain we delete the fd chain from the queue and start working with idle fd chains */ if (result == ETIMEDOUT) { 8003f90: 5c 34 00 2e bne r1,r20,8004048 <== NEVER TAKEN 8003f94: b9 80 08 00 mv r1,r12 8003f98: f8 00 09 27 calli 8006434 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); 8003f9c: b9 e0 08 00 mv r1,r15 8003fa0: f8 00 02 91 calli 80049e4 pthread_cond_destroy (&r_chain->cond); 8003fa4: b9 a0 08 00 mv r1,r13 8003fa8: f8 00 01 90 calli 80045e8 free (r_chain); 8003fac: b9 80 08 00 mv r1,r12 8003fb0: fb ff f8 6c calli 8002160 /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { 8003fb4: 29 61 00 54 lw r1,(r11+84) 8003fb8: 5c 31 00 19 bne r1,r17,800401c AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; 8003fbc: 29 61 00 68 lw r1,(r11+104) --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); 8003fc0: b9 c0 10 00 mv r2,r14 /* If the idle chain is empty sleep for 3 seconds and wait for a signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; 8003fc4: 34 21 00 01 addi r1,r1,1 8003fc8: 59 61 00 68 sw (r11+104),r1 --aio_request_queue.active_threads; 8003fcc: 29 61 00 64 lw r1,(r11+100) 8003fd0: 34 21 ff ff addi r1,r1,-1 8003fd4: 59 61 00 64 sw (r11+100),r1 clock_gettime (CLOCK_REALTIME, &timeout); 8003fd8: 34 01 00 01 mvi r1,1 8003fdc: f8 00 01 67 calli 8004578 timeout.tv_sec += 3; 8003fe0: 2b 81 00 54 lw r1,(sp+84) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 8003fe4: b9 60 10 00 mv r2,r11 8003fe8: b9 c0 18 00 mv r3,r14 AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; 8003fec: 34 21 00 03 addi r1,r1,3 8003ff0: 5b 81 00 54 sw (sp+84),r1 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, 8003ff4: ba 00 08 00 mv r1,r16 ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; 8003ff8: 5b 80 00 58 sw (sp+88),r0 result = pthread_cond_timedwait (&aio_request_queue.new_req, 8003ffc: f8 00 02 14 calli 800484c &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { 8004000: 5c 34 00 07 bne r1,r20,800401c <== NEVER TAKEN AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; 8004004: 29 61 00 68 lw r1,(r11+104) 8004008: 34 21 ff ff addi r1,r1,-1 800400c: 59 61 00 68 sw (r11+104),r1 pthread_mutex_unlock (&aio_request_queue.mutex); 8004010: b9 60 08 00 mv r1,r11 8004014: f8 00 03 61 calli 8004d98 return NULL; 8004018: e0 00 00 0f bi 8004054 } } /* Otherwise move this chain to the working chain and start the loop all over again */ AIO_printf ("Work on idle\n"); --aio_request_queue.idle_threads; 800401c: 29 61 00 68 lw r1,(r11+104) } } AIO_printf ("Thread finished\n"); return NULL; } 8004020: 29 6c 00 54 lw r12,(r11+84) } } /* Otherwise move this chain to the working chain and start the loop all over again */ AIO_printf ("Work on idle\n"); --aio_request_queue.idle_threads; 8004024: 34 21 ff ff addi r1,r1,-1 8004028: 59 61 00 68 sw (r11+104),r1 ++aio_request_queue.active_threads; 800402c: 29 61 00 64 lw r1,(r11+100) 8004030: 34 21 00 01 addi r1,r1,1 8004034: 59 61 00 64 sw (r11+100),r1 8004038: b9 80 08 00 mv r1,r12 800403c: f8 00 08 fe calli 8006434 <_Chain_Extract> node = rtems_chain_first (&aio_request_queue.idle_req); rtems_chain_extract (node); r_chain = (rtems_aio_request_chain *) node; rtems_aio_move_to_work (r_chain); 8004040: b9 80 08 00 mv r1,r12 8004044: fb ff ff 5f calli 8003dc0 } } /* If there was a request added in the initial fd chain then release the mutex and process it */ pthread_mutex_unlock (&aio_request_queue.mutex); 8004048: b9 60 08 00 mv r1,r11 800404c: f8 00 03 53 calli 8004d98 8004050: e3 ff ff 8a bi 8003e78 } } AIO_printf ("Thread finished\n"); return NULL; } 8004054: 34 01 00 00 mvi r1,0 8004058: 2b 9d 00 04 lw ra,(sp+4) 800405c: 2b 8b 00 34 lw r11,(sp+52) 8004060: 2b 8c 00 30 lw r12,(sp+48) 8004064: 2b 8d 00 2c lw r13,(sp+44) 8004068: 2b 8e 00 28 lw r14,(sp+40) 800406c: 2b 8f 00 24 lw r15,(sp+36) 8004070: 2b 90 00 20 lw r16,(sp+32) 8004074: 2b 91 00 1c lw r17,(sp+28) 8004078: 2b 92 00 18 lw r18,(sp+24) 800407c: 2b 93 00 14 lw r19,(sp+20) 8004080: 2b 94 00 10 lw r20,(sp+16) 8004084: 2b 95 00 0c lw r21,(sp+12) 8004088: 2b 96 00 08 lw r22,(sp+8) 800408c: 37 9c 00 5c addi sp,sp,92 8004090: c3 a0 00 00 ret =============================================================================== 08003bf0 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { 8003bf0: 37 9c ff f4 addi sp,sp,-12 8003bf4: 5b 8b 00 0c sw (sp+12),r11 8003bf8: 5b 8c 00 08 sw (sp+8),r12 8003bfc: 5b 9d 00 04 sw (sp+4),ra int result = 0; result = pthread_attr_init (&aio_request_queue.attr); 8003c00: 78 0c 08 01 mvhi r12,0x801 8003c04: 39 8c 78 40 ori r12,r12,0x7840 8003c08: b9 80 08 00 mv r1,r12 8003c0c: f8 00 04 b0 calli 8004ecc 8003c10: b8 20 58 00 mv r11,r1 if (result != 0) 8003c14: 5c 20 00 2f bne r1,r0,8003cd0 <== NEVER TAKEN return result; result = 8003c18: b9 80 08 00 mv r1,r12 8003c1c: 34 02 00 00 mvi r2,0 8003c20: f8 00 04 b8 calli 8004f00 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) 8003c24: 44 2b 00 03 be r1,r11,8003c30 <== ALWAYS TAKEN pthread_attr_destroy (&aio_request_queue.attr); 8003c28: b9 80 08 00 mv r1,r12 <== NOT EXECUTED 8003c2c: f8 00 04 a0 calli 8004eac <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); 8003c30: 78 01 08 01 mvhi r1,0x801 8003c34: 38 21 78 38 ori r1,r1,0x7838 8003c38: 34 02 00 00 mvi r2,0 8003c3c: f8 00 03 c7 calli 8004b58 if (result != 0) 8003c40: 44 20 00 04 be r1,r0,8003c50 <== ALWAYS TAKEN pthread_attr_destroy (&aio_request_queue.attr); 8003c44: 78 01 08 01 mvhi r1,0x801 <== NOT EXECUTED 8003c48: 38 21 78 40 ori r1,r1,0x7840 <== NOT EXECUTED 8003c4c: f8 00 04 98 calli 8004eac <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); 8003c50: 78 01 08 01 mvhi r1,0x801 8003c54: 38 21 78 3c ori r1,r1,0x783c 8003c58: 34 02 00 00 mvi r2,0 8003c5c: f8 00 02 9d calli 80046d0 8003c60: b8 20 58 00 mv r11,r1 if (result != 0) { 8003c64: 44 20 00 07 be r1,r0,8003c80 <== ALWAYS TAKEN pthread_mutex_destroy (&aio_request_queue.mutex); 8003c68: 78 01 08 01 mvhi r1,0x801 <== NOT EXECUTED 8003c6c: 38 21 78 38 ori r1,r1,0x7838 <== NOT EXECUTED 8003c70: f8 00 03 5d calli 80049e4 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); 8003c74: 78 01 08 01 mvhi r1,0x801 <== NOT EXECUTED 8003c78: 38 21 78 40 ori r1,r1,0x7840 <== NOT EXECUTED 8003c7c: f8 00 04 8c calli 8004eac <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 8003c80: 78 02 08 01 mvhi r2,0x801 8003c84: 78 01 08 01 mvhi r1,0x801 8003c88: 38 42 78 38 ori r2,r2,0x7838 8003c8c: 38 21 78 84 ori r1,r1,0x7884 8003c90: 58 41 00 48 sw (r2+72),r1 head->previous = NULL; tail->previous = head; 8003c94: 78 01 08 01 mvhi r1,0x801 8003c98: 38 21 78 80 ori r1,r1,0x7880 8003c9c: 58 41 00 50 sw (r2+80),r1 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; 8003ca0: 78 01 08 01 mvhi r1,0x801 8003ca4: 38 21 78 90 ori r1,r1,0x7890 8003ca8: 58 41 00 54 sw (r2+84),r1 head->previous = NULL; tail->previous = head; 8003cac: 78 01 08 01 mvhi r1,0x801 8003cb0: 38 21 78 8c ori r1,r1,0x788c 8003cb4: 58 41 00 5c sw (r2+92),r1 rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 8003cb8: 38 01 b0 0b mvu r1,0xb00b { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; 8003cbc: 58 40 00 4c sw (r2+76),r0 8003cc0: 58 40 00 58 sw (r2+88),r0 } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; 8003cc4: 58 40 00 64 sw (r2+100),r0 aio_request_queue.idle_threads = 0; 8003cc8: 58 40 00 68 sw (r2+104),r0 aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; 8003ccc: 58 41 00 60 sw (r2+96),r1 return result; } 8003cd0: b9 60 08 00 mv r1,r11 8003cd4: 2b 9d 00 04 lw ra,(sp+4) 8003cd8: 2b 8b 00 0c lw r11,(sp+12) 8003cdc: 2b 8c 00 08 lw r12,(sp+8) 8003ce0: 37 9c 00 0c addi sp,sp,12 8003ce4: c3 a0 00 00 ret =============================================================================== 08004094 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 8004094: 37 9c ff fc addi sp,sp,-4 8004098: 5b 9d 00 04 sw (sp+4),ra } } AIO_printf ("Thread finished\n"); return NULL; } 800409c: 28 23 00 00 lw r3,(r1+0) 80040a0: 34 25 00 04 addi r5,r1,4 * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { 80040a4: b8 40 20 00 mv r4,r2 rtems_chain_node *node; AIO_printf ("FD exists \n"); node = rtems_chain_first (chain); if (rtems_chain_is_empty (chain)) { 80040a8: 44 65 00 0d be r3,r5,80040dc <== NEVER TAKEN AIO_printf ("First in chain \n"); rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 80040ac: 28 61 00 14 lw r1,(r3+20) while (req->aiocbp->aio_reqprio > prio && 80040b0: 28 42 00 14 lw r2,(r2+20) if (rtems_chain_is_empty (chain)) { AIO_printf ("First in chain \n"); rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 80040b4: 28 21 00 10 lw r1,(r1+16) while (req->aiocbp->aio_reqprio > prio && 80040b8: 28 42 00 10 lw r2,(r2+16) 80040bc: e0 00 00 04 bi 80040cc } } AIO_printf ("Thread finished\n"); return NULL; } 80040c0: 28 63 00 00 lw r3,(r3+0) int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && !rtems_chain_is_tail (chain, node)) { node = rtems_chain_next (node); prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; 80040c4: 28 61 00 14 lw r1,(r3+20) <== NOT EXECUTED 80040c8: 28 21 00 10 lw r1,(r1+16) <== NOT EXECUTED rtems_chain_prepend (chain, &req->next_prio); } else { AIO_printf ("Add by priority \n"); int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && 80040cc: 4c 22 00 02 bge r1,r2,80040d4 <== ALWAYS TAKEN 80040d0: 5c 65 ff fc bne r3,r5,80040c0 RTEMS_INLINE_ROUTINE void rtems_chain_insert( rtems_chain_node *after_node, rtems_chain_node *the_node ) { _Chain_Insert( after_node, the_node ); 80040d4: 28 61 00 04 lw r1,(r3+4) 80040d8: b8 80 10 00 mv r2,r4 80040dc: f8 00 08 ef calli 8006498 <_Chain_Insert> } rtems_chain_insert (node->previous, &req->next_prio); } } 80040e0: 2b 9d 00 04 lw ra,(sp+4) 80040e4: 37 9c 00 04 addi sp,sp,4 80040e8: c3 a0 00 00 ret =============================================================================== 08003dc0 : * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { 8003dc0: 37 9c ff fc addi sp,sp,-4 8003dc4: 5b 9d 00 04 sw (sp+4),ra } } AIO_printf ("Thread finished\n"); return NULL; } 8003dc8: 78 03 08 01 mvhi r3,0x801 8003dcc: 38 63 78 38 ori r3,r3,0x7838 rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 8003dd0: 78 04 08 01 mvhi r4,0x801 * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { 8003dd4: b8 20 10 00 mv r2,r1 } } AIO_printf ("Thread finished\n"); return NULL; } 8003dd8: 28 63 00 48 lw r3,(r3+72) rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 8003ddc: 28 21 00 14 lw r1,(r1+20) 8003de0: 38 84 78 84 ori r4,r4,0x7884 8003de4: e0 00 00 02 bi 8003dec } } AIO_printf ("Thread finished\n"); return NULL; } 8003de8: 28 63 00 00 lw r3,(r3+0) rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; while (temp->fildes < r_chain->fildes && 8003dec: 28 65 00 14 lw r5,(r3+20) 8003df0: 4c a1 00 02 bge r5,r1,8003df8 8003df4: 5c 64 ff fd bne r3,r4,8003de8 <== ALWAYS TAKEN 8003df8: 28 61 00 04 lw r1,(r3+4) 8003dfc: f8 00 09 a7 calli 8006498 <_Chain_Insert> node = rtems_chain_next (node); temp = (rtems_aio_request_chain *) node; } rtems_chain_insert (rtems_chain_previous (node), &r_chain->next_fd); } 8003e00: 2b 9d 00 04 lw ra,(sp+4) 8003e04: 37 9c 00 04 addi sp,sp,4 8003e08: c3 a0 00 00 ret =============================================================================== 08004164 : * AIO_NOTCANCELED - if request was not canceled * AIO_CANCELED - if request was canceled */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { 8004164: 37 9c ff f8 addi sp,sp,-8 8004168: 5b 8b 00 08 sw (sp+8),r11 800416c: 5b 9d 00 04 sw (sp+4),ra } } AIO_printf ("Thread finished\n"); return NULL; } 8004170: 28 2b 00 00 lw r11,(r1+0) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); 8004174: 34 23 00 04 addi r3,r1,4 */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { if (rtems_chain_is_empty (chain)) return AIO_ALLDONE; 8004178: 34 01 00 02 mvi r1,2 * AIO_CANCELED - if request was canceled */ int rtems_aio_remove_req (rtems_chain_control *chain, struct aiocb *aiocbp) { if (rtems_chain_is_empty (chain)) 800417c: 5d 63 00 04 bne r11,r3,800418c 8004180: e0 00 00 11 bi 80041c4 } } AIO_printf ("Thread finished\n"); return NULL; } 8004184: 28 2b 00 00 lw r11,(r1+0) <== NOT EXECUTED rtems_chain_node *node = rtems_chain_first (chain); rtems_aio_request *current; current = (rtems_aio_request *) node; while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) { 8004188: 45 63 00 0e be r11,r3,80041c0 <== NOT EXECUTED 800418c: 29 64 00 14 lw r4,(r11+20) node = rtems_chain_next (node); current = (rtems_aio_request *) node; 8004190: b9 60 08 00 mv r1,r11 rtems_chain_node *node = rtems_chain_first (chain); rtems_aio_request *current; current = (rtems_aio_request *) node; while (!rtems_chain_is_tail (chain, node) && current->aiocbp != aiocbp) { 8004194: 5c 82 ff fc bne r4,r2,8004184 <== NEVER TAKEN 8004198: f8 00 08 a7 calli 8006434 <_Chain_Extract> if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; 800419c: 29 61 00 14 lw r1,(r11+20) 80041a0: 34 02 00 8c mvi r2,140 80041a4: 58 22 00 2c sw (r1+44),r2 current->aiocbp->return_value = -1; 80041a8: 34 02 ff ff mvi r2,-1 80041ac: 58 22 00 30 sw (r1+48),r2 free (current); 80041b0: b9 60 08 00 mv r1,r11 80041b4: fb ff f7 eb calli 8002160 } return AIO_CANCELED; 80041b8: 34 01 00 00 mvi r1,0 80041bc: e0 00 00 02 bi 80041c4 node = rtems_chain_next (node); current = (rtems_aio_request *) node; } if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; 80041c0: 34 01 00 01 mvi r1,1 <== NOT EXECUTED current->aiocbp->return_value = -1; free (current); } return AIO_CANCELED; } 80041c4: 2b 9d 00 04 lw ra,(sp+4) 80041c8: 2b 8b 00 08 lw r11,(sp+8) 80041cc: 37 9c 00 08 addi sp,sp,8 80041d0: c3 a0 00 00 ret =============================================================================== 080036d0 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 80036d0: 37 9c ff f4 addi sp,sp,-12 80036d4: 5b 8b 00 0c sw (sp+12),r11 80036d8: 5b 8c 00 08 sw (sp+8),r12 80036dc: 5b 9d 00 04 sw (sp+4),ra 80036e0: b8 60 60 00 mv r12,r3 80036e4: b8 80 58 00 mv r11,r4 RTEMS_INLINE_ROUTINE bool rtems_chain_append_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Append_with_empty_check( chain, node ); 80036e8: f8 00 01 a5 calli 8003d7c <_Chain_Append_with_empty_check> rtems_status_code sc = RTEMS_SUCCESSFUL; 80036ec: 34 05 00 00 mvi r5,0 bool was_empty = rtems_chain_append_with_empty_check( chain, node ); if ( was_empty ) { 80036f0: 44 20 00 05 be r1,r0,8003704 <== NEVER TAKEN sc = rtems_event_send( task, events ); 80036f4: b9 80 08 00 mv r1,r12 80036f8: b9 60 10 00 mv r2,r11 80036fc: f8 00 18 91 calli 8009940 8003700: b8 20 28 00 mv r5,r1 } return sc; } 8003704: b8 a0 08 00 mv r1,r5 8003708: 2b 9d 00 04 lw ra,(sp+4) 800370c: 2b 8b 00 0c lw r11,(sp+12) 8003710: 2b 8c 00 08 lw r12,(sp+8) 8003714: 37 9c 00 0c addi sp,sp,12 8003718: c3 a0 00 00 ret =============================================================================== 0800376c : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { 800376c: 37 9c ff e4 addi sp,sp,-28 8003770: 5b 8b 00 18 sw (sp+24),r11 8003774: 5b 8c 00 14 sw (sp+20),r12 8003778: 5b 8d 00 10 sw (sp+16),r13 800377c: 5b 8e 00 0c sw (sp+12),r14 8003780: 5b 8f 00 08 sw (sp+8),r15 8003784: 5b 9d 00 04 sw (sp+4),ra 8003788: b8 20 78 00 mv r15,r1 800378c: b8 40 70 00 mv r14,r2 8003790: b8 60 68 00 mv r13,r3 8003794: b8 80 60 00 mv r12,r4 8003798: e0 00 00 08 bi 80037b8 while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( 800379c: b9 c0 08 00 mv r1,r14 80037a0: 34 02 00 00 mvi r2,0 80037a4: b9 a0 18 00 mv r3,r13 80037a8: 37 84 00 1c addi r4,sp,28 80037ac: fb ff fd d2 calli 8002ef4 80037b0: b8 20 28 00 mv r5,r1 ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( 80037b4: 5c 2b 00 06 bne r1,r11,80037cc <== ALWAYS TAKEN */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); 80037b8: b9 e0 08 00 mv r1,r15 80037bc: f8 00 01 a6 calli 8003e54 <_Chain_Get> 80037c0: b8 20 58 00 mv r11,r1 sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL 80037c4: 44 20 ff f6 be r1,r0,800379c 80037c8: 34 05 00 00 mvi r5,0 } *node_ptr = node; return sc; } 80037cc: b8 a0 08 00 mv r1,r5 timeout, &out ); } *node_ptr = node; 80037d0: 59 8b 00 00 sw (r12+0),r11 return sc; } 80037d4: 2b 9d 00 04 lw ra,(sp+4) 80037d8: 2b 8b 00 18 lw r11,(sp+24) 80037dc: 2b 8c 00 14 lw r12,(sp+20) 80037e0: 2b 8d 00 10 lw r13,(sp+16) 80037e4: 2b 8e 00 0c lw r14,(sp+12) 80037e8: 2b 8f 00 08 lw r15,(sp+8) 80037ec: 37 9c 00 1c addi sp,sp,28 80037f0: c3 a0 00 00 ret =============================================================================== 080037f4 : rtems_chain_control *chain, rtems_chain_node *node, rtems_id task, rtems_event_set events ) { 80037f4: 37 9c ff f4 addi sp,sp,-12 80037f8: 5b 8b 00 0c sw (sp+12),r11 80037fc: 5b 8c 00 08 sw (sp+8),r12 8003800: 5b 9d 00 04 sw (sp+4),ra 8003804: b8 60 60 00 mv r12,r3 8003808: b8 80 58 00 mv r11,r4 RTEMS_INLINE_ROUTINE bool rtems_chain_prepend_with_empty_check( rtems_chain_control *chain, rtems_chain_node *node ) { return _Chain_Prepend_with_empty_check( chain, node ); 800380c: f8 00 01 ac calli 8003ebc <_Chain_Prepend_with_empty_check> rtems_status_code sc = RTEMS_SUCCESSFUL; 8003810: 34 05 00 00 mvi r5,0 bool was_empty = rtems_chain_prepend_with_empty_check( chain, node ); if (was_empty) { 8003814: 44 20 00 05 be r1,r0,8003828 <== NEVER TAKEN sc = rtems_event_send( task, events ); 8003818: b9 80 08 00 mv r1,r12 800381c: b9 60 10 00 mv r2,r11 8003820: f8 00 18 48 calli 8009940 8003824: b8 20 28 00 mv r5,r1 } return sc; } 8003828: b8 a0 08 00 mv r1,r5 800382c: 2b 9d 00 04 lw ra,(sp+4) 8003830: 2b 8b 00 0c lw r11,(sp+12) 8003834: 2b 8c 00 08 lw r12,(sp+8) 8003838: 37 9c 00 0c addi sp,sp,12 800383c: c3 a0 00 00 ret =============================================================================== 08010a04 : * error code - if unsuccessful */ rtems_status_code rtems_clock_set_nanoseconds_extension( rtems_nanoseconds_extension_routine routine ) { 8010a04: b8 20 18 00 mv r3,r1 if ( !routine ) return RTEMS_INVALID_ADDRESS; 8010a08: 34 01 00 09 mvi r1,9 */ rtems_status_code rtems_clock_set_nanoseconds_extension( rtems_nanoseconds_extension_routine routine ) { if ( !routine ) 8010a0c: 44 60 00 05 be r3,r0,8010a20 <== ALWAYS TAKEN return RTEMS_INVALID_ADDRESS; _Watchdog_Nanoseconds_since_tick_handler = routine; 8010a10: 78 02 08 03 mvhi r2,0x803 8010a14: 38 42 c1 40 ori r2,r2,0xc140 8010a18: 58 43 00 00 sw (r2+0),r3 return RTEMS_SUCCESSFUL; 8010a1c: 34 01 00 00 mvi r1,0 <== NOT EXECUTED } 8010a20: c3 a0 00 00 ret =============================================================================== 08006028 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { 8006028: 37 9c ff e4 addi sp,sp,-28 800602c: 5b 8b 00 1c sw (sp+28),r11 8006030: 5b 8c 00 18 sw (sp+24),r12 8006034: 5b 8d 00 14 sw (sp+20),r13 8006038: 5b 8e 00 10 sw (sp+16),r14 800603c: 5b 8f 00 0c sw (sp+12),r15 8006040: 5b 90 00 08 sw (sp+8),r16 8006044: 5b 9d 00 04 sw (sp+4),ra 8006048: b8 20 78 00 mv r15,r1 uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 800604c: 44 20 00 17 be r1,r0,80060a8 <== NEVER TAKEN #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 8006050: 78 02 08 02 mvhi r2,0x802 uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 8006054: 78 0b 08 02 mvhi r11,0x802 #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 8006058: 38 42 96 74 ori r2,r2,0x9674 uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) 800605c: 39 6b 96 78 ori r11,r11,0x9678 #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) 8006060: 34 50 00 10 addi r16,r2,16 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; 8006064: 29 61 00 00 lw r1,(r11+0) if ( !information ) 8006068: 34 0e 00 04 mvi r14,4 800606c: 34 0d 00 01 mvi r13,1 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; 8006070: 28 2c 00 04 lw r12,(r1+4) if ( !information ) 8006074: 5d 80 00 09 bne r12,r0,8006098 8006078: e0 00 00 0a bi 80060a0 continue; for ( i=1 ; i <= information->maximum ; i++ ) { the_thread = (Thread_Control *)information->local_table[ i ]; 800607c: 29 81 00 1c lw r1,(r12+28) 8006080: b4 2e 08 00 add r1,r1,r14 8006084: 28 21 00 00 lw r1,(r1+0) if ( !the_thread ) 8006088: 44 20 00 02 be r1,r0,8006090 continue; (*routine)(the_thread); 800608c: d9 e0 00 00 call r15 information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { 8006090: 35 ad 00 01 addi r13,r13,1 8006094: 35 ce 00 04 addi r14,r14,4 8006098: 2d 81 00 10 lhu r1,(r12+16) 800609c: 50 2d ff f8 bgeu r1,r13,800607c 80060a0: 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++ ) { 80060a4: 5d 70 ff f0 bne r11,r16,8006064 (*routine)(the_thread); } } } 80060a8: 2b 9d 00 04 lw ra,(sp+4) 80060ac: 2b 8b 00 1c lw r11,(sp+28) 80060b0: 2b 8c 00 18 lw r12,(sp+24) 80060b4: 2b 8d 00 14 lw r13,(sp+20) 80060b8: 2b 8e 00 10 lw r14,(sp+16) 80060bc: 2b 8f 00 0c lw r15,(sp+12) 80060c0: 2b 90 00 08 lw r16,(sp+8) 80060c4: 37 9c 00 1c addi sp,sp,28 80060c8: c3 a0 00 00 ret =============================================================================== 08011920 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 8011920: 37 9c ff d8 addi sp,sp,-40 8011924: 5b 8b 00 28 sw (sp+40),r11 8011928: 5b 8c 00 24 sw (sp+36),r12 801192c: 5b 8d 00 20 sw (sp+32),r13 8011930: 5b 8e 00 1c sw (sp+28),r14 8011934: 5b 8f 00 18 sw (sp+24),r15 8011938: 5b 90 00 14 sw (sp+20),r16 801193c: 5b 91 00 10 sw (sp+16),r17 8011940: 5b 92 00 0c sw (sp+12),r18 8011944: 5b 93 00 08 sw (sp+8),r19 8011948: 5b 9d 00 04 sw (sp+4),ra register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; 801194c: 34 07 00 03 mvi r7,3 uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { 8011950: b8 20 88 00 mv r17,r1 8011954: b8 40 70 00 mv r14,r2 8011958: b8 60 78 00 mv r15,r3 801195c: b8 80 60 00 mv r12,r4 8011960: b8 a0 98 00 mv r19,r5 8011964: b8 c0 80 00 mv r16,r6 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) 8011968: 44 20 00 36 be r1,r0,8011a40 return RTEMS_INVALID_NAME; if ( !starting_address ) return RTEMS_INVALID_ADDRESS; 801196c: 34 07 00 09 mvi r7,9 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !starting_address ) 8011970: 44 40 00 34 be r2,r0,8011a40 return RTEMS_INVALID_ADDRESS; if ( !id ) 8011974: 44 c0 00 33 be r6,r0,8011a40 <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 8011978: 64 82 00 00 cmpei r2,r4,0 801197c: 64 61 00 00 cmpei r1,r3,0 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; 8011980: 34 07 00 08 mvi r7,8 return RTEMS_INVALID_ADDRESS; if ( !id ) return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || 8011984: b8 41 08 00 or r1,r2,r1 8011988: 5c 20 00 2e bne r1,r0,8011a40 801198c: 54 83 00 2d bgu r4,r3,8011a40 */ RTEMS_INLINE_ROUTINE bool _Partition_Is_buffer_size_aligned ( uint32_t buffer_size ) { return ((buffer_size % CPU_PARTITION_ALIGNMENT) == 0); 8011990: 20 81 00 07 andi r1,r4,0x7 8011994: 5c 20 00 2b bne r1,r0,8011a40 ) { #if (CPU_ALIGNMENT == 0) return true; #else return (((uintptr_t)address % CPU_ALIGNMENT) == 0); 8011998: 21 d2 00 07 andi r18,r14,0x7 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) return RTEMS_INVALID_ADDRESS; 801199c: 34 07 00 09 mvi r7,9 if ( length == 0 || buffer_size == 0 || length < buffer_size || !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) 80119a0: 5e 41 00 28 bne r18,r1,8011a40 80119a4: 78 02 08 04 mvhi r2,0x804 80119a8: 38 42 0c e0 ori r2,r2,0xce0 80119ac: 28 41 00 00 lw r1,(r2+0) 80119b0: 34 21 00 01 addi r1,r1,1 80119b4: 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 ); 80119b8: 78 0d 08 04 mvhi r13,0x804 80119bc: 39 ad 0b 38 ori r13,r13,0xb38 80119c0: b9 a0 08 00 mv r1,r13 80119c4: f8 00 16 16 calli 801721c <_Objects_Allocate> 80119c8: b8 20 58 00 mv r11,r1 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { 80119cc: 5c 32 00 04 bne r1,r18,80119dc _Thread_Enable_dispatch(); 80119d0: f8 00 1b 86 calli 80187e8 <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; 80119d4: 34 07 00 05 mvi r7,5 80119d8: e0 00 00 1a bi 8011a40 } #endif the_partition->starting_address = starting_address; the_partition->length = length; the_partition->buffer_size = buffer_size; 80119dc: 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, length / buffer_size, buffer_size ); 80119e0: b9 80 10 00 mv r2,r12 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; 80119e4: 58 2e 00 10 sw (r1+16),r14 the_partition->length = length; 80119e8: 58 2f 00 14 sw (r1+20),r15 the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; 80119ec: 58 33 00 1c sw (r1+28),r19 the_partition->number_of_used_blocks = 0; 80119f0: 58 20 00 20 sw (r1+32),r0 _Chain_Initialize( &the_partition->Memory, starting_address, 80119f4: 34 32 00 24 addi r18,r1,36 length / buffer_size, buffer_size ); 80119f8: b9 e0 08 00 mv r1,r15 80119fc: f8 00 7f ce calli 8031934 <__udivsi3> 8011a00: b8 20 18 00 mv r3,r1 the_partition->length = length; the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; _Chain_Initialize( &the_partition->Memory, starting_address, 8011a04: b9 80 20 00 mv r4,r12 8011a08: ba 40 08 00 mv r1,r18 8011a0c: b9 c0 10 00 mv r2,r14 8011a10: f8 00 0f 00 calli 8015610 <_Chain_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 8011a14: 29 6c 00 08 lw r12,(r11+8) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8011a18: 29 ad 00 1c lw r13,(r13+28) 8011a1c: 34 02 00 02 mvi r2,2 8011a20: 21 81 ff ff andi r1,r12,0xffff 8011a24: fb ff f1 0c calli 800de54 <__ashlsi3> 8011a28: b5 a1 08 00 add r1,r13,r1 8011a2c: 58 2b 00 00 sw (r1+0),r11 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; 8011a30: 59 71 00 0c sw (r11+12),r17 &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; 8011a34: 5a 0c 00 00 sw (r16+0),r12 name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); 8011a38: f8 00 1b 6c calli 80187e8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 8011a3c: 34 07 00 00 mvi r7,0 } 8011a40: b8 e0 08 00 mv r1,r7 8011a44: 2b 9d 00 04 lw ra,(sp+4) 8011a48: 2b 8b 00 28 lw r11,(sp+40) 8011a4c: 2b 8c 00 24 lw r12,(sp+36) 8011a50: 2b 8d 00 20 lw r13,(sp+32) 8011a54: 2b 8e 00 1c lw r14,(sp+28) 8011a58: 2b 8f 00 18 lw r15,(sp+24) 8011a5c: 2b 90 00 14 lw r16,(sp+20) 8011a60: 2b 91 00 10 lw r17,(sp+16) 8011a64: 2b 92 00 0c lw r18,(sp+12) 8011a68: 2b 93 00 08 lw r19,(sp+8) 8011a6c: 37 9c 00 28 addi sp,sp,40 8011a70: c3 a0 00 00 ret =============================================================================== 0800b800 : rtems_status_code rtems_rate_monotonic_get_status( rtems_id id, rtems_rate_monotonic_period_status *status ) { 800b800: 37 9c ff e4 addi sp,sp,-28 800b804: 5b 8b 00 08 sw (sp+8),r11 800b808: 5b 9d 00 04 sw (sp+4),ra 800b80c: b8 20 18 00 mv r3,r1 800b810: b8 40 58 00 mv r11,r2 Rate_monotonic_Period_time_t since_last_period; Rate_monotonic_Control *the_period; bool valid_status; if ( !status ) return RTEMS_INVALID_ADDRESS; 800b814: 34 01 00 09 mvi r1,9 Objects_Locations location; Rate_monotonic_Period_time_t since_last_period; Rate_monotonic_Control *the_period; bool valid_status; if ( !status ) 800b818: 44 40 00 26 be r2,r0,800b8b0 <== NEVER TAKEN 800b81c: 78 01 08 02 mvhi r1,0x802 800b820: b8 60 10 00 mv r2,r3 800b824: 38 21 18 d0 ori r1,r1,0x18d0 800b828: 37 83 00 1c addi r3,sp,28 800b82c: fb ff ec 60 calli 80069ac <_Objects_Get> return RTEMS_INVALID_ADDRESS; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { 800b830: 2b 83 00 1c lw r3,(sp+28) 800b834: 5c 60 00 1e bne r3,r0,800b8ac <== NEVER TAKEN case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; 800b838: 28 24 00 40 lw r4,(r1+64) status->state = the_period->state; 800b83c: 28 22 00 38 lw r2,(r1+56) the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; 800b840: 28 84 00 08 lw r4,(r4+8) status->state = the_period->state; 800b844: 59 62 00 04 sw (r11+4),r2 the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: status->owner = the_period->owner->Object.id; 800b848: 59 64 00 00 sw (r11+0),r4 status->state = the_period->state; /* * If the period is inactive, there is no information. */ if ( status->state == RATE_MONOTONIC_INACTIVE ) { 800b84c: 5c 43 00 06 bne r2,r3,800b864 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timespec_Set_to_zero( &status->since_last_period ); 800b850: 59 60 00 08 sw (r11+8),r0 800b854: 59 60 00 0c sw (r11+12),r0 _Timespec_Set_to_zero( &status->executed_since_last_period ); 800b858: 59 60 00 10 sw (r11+16),r0 800b85c: 59 60 00 14 sw (r11+20),r0 800b860: e0 00 00 10 bi 800b8a0 } else { /* * Grab the current status. */ valid_status = 800b864: 37 82 00 0c addi r2,sp,12 800b868: 37 83 00 14 addi r3,sp,20 800b86c: fb ff e1 79 calli 8003e50 <_Rate_monotonic_Get_status> _Rate_monotonic_Get_status( the_period, &since_last_period, &executed ); if (!valid_status) { 800b870: 5c 20 00 04 bne r1,r0,800b880 _Thread_Enable_dispatch(); 800b874: fb ff ef aa calli 800771c <_Thread_Enable_dispatch> return RTEMS_NOT_DEFINED; 800b878: 34 01 00 0b mvi r1,11 800b87c: e0 00 00 0d bi 800b8b0 } #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_To_timespec( 800b880: 2b 81 00 0c lw r1,(sp+12) 800b884: 59 61 00 08 sw (r11+8),r1 800b888: 2b 81 00 10 lw r1,(sp+16) 800b88c: 59 61 00 0c sw (r11+12),r1 &since_last_period, &status->since_last_period ); _Timestamp_To_timespec( 800b890: 2b 81 00 14 lw r1,(sp+20) 800b894: 59 61 00 10 sw (r11+16),r1 800b898: 2b 81 00 18 lw r1,(sp+24) 800b89c: 59 61 00 14 sw (r11+20),r1 status->since_last_period = since_last_period; status->executed_since_last_period = executed; #endif } _Thread_Enable_dispatch(); 800b8a0: fb ff ef 9f calli 800771c <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 800b8a4: 34 01 00 00 mvi r1,0 800b8a8: e0 00 00 02 bi 800b8b0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 800b8ac: 34 01 00 04 mvi r1,4 } 800b8b0: 2b 9d 00 04 lw ra,(sp+4) 800b8b4: 2b 8b 00 08 lw r11,(sp+8) 800b8b8: 37 9c 00 1c addi sp,sp,28 800b8bc: c3 a0 00 00 ret =============================================================================== 080040c8 : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { 80040c8: 37 9c ff e8 addi sp,sp,-24 80040cc: 5b 8b 00 14 sw (sp+20),r11 80040d0: 5b 8c 00 10 sw (sp+16),r12 80040d4: 5b 8d 00 0c sw (sp+12),r13 80040d8: 5b 8e 00 08 sw (sp+8),r14 80040dc: 5b 9d 00 04 sw (sp+4),ra 80040e0: b8 20 60 00 mv r12,r1 Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) _Objects_Get( &_Rate_monotonic_Information, id, location ); 80040e4: 78 01 08 02 mvhi r1,0x802 80040e8: b8 40 68 00 mv r13,r2 80040ec: 38 21 18 d0 ori r1,r1,0x18d0 80040f0: b9 80 10 00 mv r2,r12 80040f4: 37 83 00 18 addi r3,sp,24 80040f8: f8 00 0a 2d calli 80069ac <_Objects_Get> 80040fc: 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 ) { 8004100: 2b 81 00 18 lw r1,(sp+24) 8004104: 5c 20 00 5f bne r1,r0,8004280 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); 8004108: 78 03 08 02 mvhi r3,0x802 800410c: 38 63 1e c4 ori r3,r3,0x1ec4 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { 8004110: 29 62 00 40 lw r2,(r11+64) 8004114: 28 61 00 0c lw r1,(r3+12) 8004118: 44 41 00 04 be r2,r1,8004128 _Thread_Enable_dispatch(); 800411c: f8 00 0d 80 calli 800771c <_Thread_Enable_dispatch> return RTEMS_NOT_OWNER_OF_RESOURCE; 8004120: 34 0c 00 17 mvi r12,23 8004124: e0 00 00 58 bi 8004284 } if ( length == RTEMS_PERIOD_STATUS ) { 8004128: 5d a0 00 0d bne r13,r0,800415c switch ( the_period->state ) { 800412c: 29 61 00 38 lw r1,(r11+56) 8004130: 34 02 00 04 mvi r2,4 8004134: 34 0c 00 00 mvi r12,0 8004138: 54 22 00 07 bgu r1,r2,8004154 <== NEVER TAKEN 800413c: 78 0b 08 01 mvhi r11,0x801 8004140: 34 02 00 02 mvi r2,2 8004144: fb ff f4 52 calli 800128c <__ashlsi3> 8004148: 39 6b ea f0 ori r11,r11,0xeaf0 800414c: b5 61 08 00 add r1,r11,r1 8004150: 28 2c 00 00 lw r12,(r1+0) case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); 8004154: f8 00 0d 72 calli 800771c <_Thread_Enable_dispatch> return( return_value ); 8004158: e0 00 00 4b bi 8004284 } _ISR_Disable( level ); 800415c: 90 00 70 00 rcsr r14,IE 8004160: 34 01 ff fe mvi r1,-2 8004164: a1 c1 08 00 and r1,r14,r1 8004168: d0 01 00 00 wcsr IE,r1 if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { 800416c: 29 63 00 38 lw r3,(r11+56) 8004170: 5c 60 00 13 bne r3,r0,80041bc _ISR_Enable( level ); 8004174: d0 0e 00 00 wcsr IE,r14 /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); 8004178: b9 60 08 00 mv r1,r11 800417c: fb ff ff 6e calli 8003f34 <_Rate_monotonic_Initiate_statistics> the_period->state = RATE_MONOTONIC_ACTIVE; 8004180: 34 01 00 02 mvi r1,2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 8004184: 78 03 08 00 mvhi r3,0x800 8004188: 59 61 00 38 sw (r11+56),r1 800418c: 38 63 46 08 ori r3,r3,0x4608 ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8004190: 78 01 08 02 mvhi r1,0x802 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 8004194: 59 60 00 18 sw (r11+24),r0 the_watchdog->routine = routine; 8004198: 59 63 00 2c sw (r11+44),r3 the_watchdog->id = id; 800419c: 59 6c 00 30 sw (r11+48),r12 the_watchdog->user_data = user_data; 80041a0: 59 60 00 34 sw (r11+52),r0 _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; 80041a4: 59 6d 00 3c sw (r11+60),r13 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 80041a8: 59 6d 00 1c sw (r11+28),r13 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 80041ac: 38 21 1a d8 ori r1,r1,0x1ad8 80041b0: 35 62 00 10 addi r2,r11,16 80041b4: f8 00 12 35 calli 8008a88 <_Watchdog_Insert> 80041b8: e0 00 00 1f bi 8004234 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { 80041bc: 34 01 00 02 mvi r1,2 80041c0: 5c 61 00 20 bne r3,r1,8004240 /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); 80041c4: b9 60 08 00 mv r1,r11 80041c8: fb ff ff 80 calli 8003fc8 <_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; 80041cc: 34 01 00 01 mvi r1,1 80041d0: 59 61 00 38 sw (r11+56),r1 the_period->next_length = length; 80041d4: 59 6d 00 3c sw (r11+60),r13 _ISR_Enable( level ); 80041d8: d0 0e 00 00 wcsr IE,r14 _Thread_Executing->Wait.id = the_period->Object.id; 80041dc: 78 01 08 02 mvhi r1,0x802 80041e0: 38 21 1e c4 ori r1,r1,0x1ec4 80041e4: 29 62 00 08 lw r2,(r11+8) 80041e8: 28 21 00 0c lw r1,(r1+12) 80041ec: 58 22 00 20 sw (r1+32),r2 _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 80041f0: 34 02 40 00 mvi r2,16384 80041f4: f8 00 0f ec calli 80081a4 <_Thread_Set_state> /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); 80041f8: 90 00 08 00 rcsr r1,IE 80041fc: 34 02 ff fe mvi r2,-2 8004200: a0 22 10 00 and r2,r1,r2 8004204: d0 02 00 00 wcsr IE,r2 local_state = the_period->state; the_period->state = RATE_MONOTONIC_ACTIVE; 8004208: 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; 800420c: 29 62 00 38 lw r2,(r11+56) the_period->state = RATE_MONOTONIC_ACTIVE; 8004210: 59 63 00 38 sw (r11+56),r3 _ISR_Enable( level ); 8004214: 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 ) 8004218: 34 01 00 03 mvi r1,3 800421c: 5c 41 00 06 bne r2,r1,8004234 _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); 8004220: 78 01 08 02 mvhi r1,0x802 8004224: 38 21 1e c4 ori r1,r1,0x1ec4 8004228: 28 21 00 0c lw r1,(r1+12) 800422c: 34 02 40 00 mvi r2,16384 8004230: f8 00 0c 76 calli 8007408 <_Thread_Clear_state> _Thread_Enable_dispatch(); 8004234: f8 00 0d 3a calli 800771c <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 8004238: 34 0c 00 00 mvi r12,0 800423c: e0 00 00 12 bi 8004284 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 8004240: 34 0c 00 04 mvi r12,4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { 8004244: 5c 6c 00 10 bne r3,r12,8004284 <== NEVER TAKEN /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); 8004248: b9 60 08 00 mv r1,r11 800424c: fb ff ff 5f calli 8003fc8 <_Rate_monotonic_Update_statistics> _ISR_Enable( level ); 8004250: d0 0e 00 00 wcsr IE,r14 the_period->state = RATE_MONOTONIC_ACTIVE; 8004254: 34 01 00 02 mvi r1,2 8004258: 59 61 00 38 sw (r11+56),r1 800425c: 78 01 08 02 mvhi r1,0x802 8004260: 38 21 1a d8 ori r1,r1,0x1ad8 8004264: 35 62 00 10 addi r2,r11,16 the_period->next_length = length; 8004268: 59 6d 00 3c sw (r11+60),r13 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 800426c: 59 6d 00 1c sw (r11+28),r13 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8004270: f8 00 12 06 calli 8008a88 <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_TIMEOUT; 8004274: 34 0c 00 06 mvi r12,6 the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); 8004278: f8 00 0d 29 calli 800771c <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; 800427c: e0 00 00 02 bi 8004284 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 8004280: 34 0c 00 04 mvi r12,4 } 8004284: b9 80 08 00 mv r1,r12 8004288: 2b 9d 00 04 lw ra,(sp+4) 800428c: 2b 8b 00 14 lw r11,(sp+20) 8004290: 2b 8c 00 10 lw r12,(sp+16) 8004294: 2b 8d 00 0c lw r13,(sp+12) 8004298: 2b 8e 00 08 lw r14,(sp+8) 800429c: 37 9c 00 18 addi sp,sp,24 80042a0: c3 a0 00 00 ret =============================================================================== 080042a4 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { 80042a4: 37 9c ff 5c addi sp,sp,-164 80042a8: 5b 8b 00 44 sw (sp+68),r11 80042ac: 5b 8c 00 40 sw (sp+64),r12 80042b0: 5b 8d 00 3c sw (sp+60),r13 80042b4: 5b 8e 00 38 sw (sp+56),r14 80042b8: 5b 8f 00 34 sw (sp+52),r15 80042bc: 5b 90 00 30 sw (sp+48),r16 80042c0: 5b 91 00 2c sw (sp+44),r17 80042c4: 5b 92 00 28 sw (sp+40),r18 80042c8: 5b 93 00 24 sw (sp+36),r19 80042cc: 5b 94 00 20 sw (sp+32),r20 80042d0: 5b 95 00 1c sw (sp+28),r21 80042d4: 5b 96 00 18 sw (sp+24),r22 80042d8: 5b 97 00 14 sw (sp+20),r23 80042dc: 5b 98 00 10 sw (sp+16),r24 80042e0: 5b 99 00 0c sw (sp+12),r25 80042e4: 5b 9b 00 08 sw (sp+8),fp 80042e8: 5b 9d 00 04 sw (sp+4),ra 80042ec: b8 20 60 00 mv r12,r1 80042f0: b8 40 58 00 mv r11,r2 rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) 80042f4: 44 40 00 72 be r2,r0,80044bc <== NEVER TAKEN return; (*print)( context, "Period information by period\n" ); 80042f8: 78 02 08 01 mvhi r2,0x801 80042fc: 38 42 eb 04 ori r2,r2,0xeb04 8004300: d9 60 00 00 call r11 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); 8004304: 78 02 08 01 mvhi r2,0x801 8004308: 38 42 eb 24 ori r2,r2,0xeb24 800430c: b9 80 08 00 mv r1,r12 8004310: d9 60 00 00 call r11 (*print)( context, "--- Wall times are in seconds ---\n" ); 8004314: 78 02 08 01 mvhi r2,0x801 8004318: 38 42 eb 48 ori r2,r2,0xeb48 800431c: b9 80 08 00 mv r1,r12 8004320: d9 60 00 00 call r11 Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " 8004324: 78 02 08 01 mvhi r2,0x801 8004328: 38 42 eb 6c ori r2,r2,0xeb6c 800432c: b9 80 08 00 mv r1,r12 8004330: d9 60 00 00 call r11 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " 8004334: 78 02 08 01 mvhi r2,0x801 8004338: b9 80 08 00 mv r1,r12 800433c: 38 42 eb b8 ori r2,r2,0xebb8 8004340: 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 ; 8004344: 78 01 08 02 mvhi r1,0x802 8004348: 38 21 18 d0 ori r1,r1,0x18d0 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, 800434c: 78 11 08 01 mvhi r17,0x801 struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); (*print)( context, 8004350: 78 10 08 01 mvhi r16,0x801 struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, 8004354: 78 0f 08 01 mvhi r15,0x801 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 8004358: 78 0e 08 01 mvhi r14,0x801 /* * 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 ; 800435c: 28 2d 00 08 lw r13,(r1+8) id <= _Rate_monotonic_Information.maximum_id ; 8004360: b8 20 a0 00 mv r20,r1 id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 8004364: 37 99 00 48 addi r25,sp,72 #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 8004368: 37 98 00 80 addi r24,sp,128 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 800436c: 37 93 00 a0 addi r19,sp,160 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 8004370: 3a 31 ec 04 ori r17,r17,0xec04 { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec cpu_average; struct timespec *min_cpu = &the_stats.min_cpu_time; struct timespec *max_cpu = &the_stats.max_cpu_time; struct timespec *total_cpu = &the_stats.total_cpu_time; 8004374: 37 97 00 60 addi r23,sp,96 _Timespec_Divide_by_integer( total_cpu, the_stats.count, &cpu_average ); 8004378: 37 92 00 98 addi r18,sp,152 (*print)( context, 800437c: 3a 10 ec 1c ori r16,r16,0xec1c { #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ struct timespec wall_average; struct timespec *min_wall = &the_stats.min_wall_time; struct timespec *max_wall = &the_stats.max_wall_time; struct timespec *total_wall = &the_stats.total_wall_time; 8004380: 37 96 00 78 addi r22,sp,120 _Timespec_Divide_by_integer(total_wall, the_stats.count, &wall_average); (*print)( context, 8004384: 39 ef ec 3c ori r15,r15,0xec3c /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); 8004388: 39 ce e1 40 ori r14,r14,0xe140 /* * 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 ; 800438c: e0 00 00 4a bi 80044b4 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); 8004390: b9 a0 08 00 mv r1,r13 8004394: bb 20 10 00 mv r2,r25 8004398: f8 00 1c e8 calli 800b738 800439c: b8 20 a8 00 mv r21,r1 if ( status != RTEMS_SUCCESSFUL ) 80043a0: 5c 20 00 44 bne r1,r0,80044b0 #if defined(RTEMS_DEBUG) status = rtems_rate_monotonic_get_status( id, &the_status ); if ( status != RTEMS_SUCCESSFUL ) continue; #else (void) rtems_rate_monotonic_get_status( id, &the_status ); 80043a4: bb 00 10 00 mv r2,r24 80043a8: b9 a0 08 00 mv r1,r13 80043ac: f8 00 1d 15 calli 800b800 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); 80043b0: 2b 81 00 80 lw r1,(sp+128) 80043b4: 34 02 00 05 mvi r2,5 80043b8: ba 60 18 00 mv r3,r19 80043bc: f8 00 00 c3 calli 80046c8 /* * Print part of report line that is not dependent on granularity */ (*print)( context, 80043c0: 2b 85 00 48 lw r5,(sp+72) 80043c4: 2b 86 00 4c lw r6,(sp+76) 80043c8: ba 20 10 00 mv r2,r17 80043cc: b9 80 08 00 mv r1,r12 80043d0: b9 a0 18 00 mv r3,r13 80043d4: ba 60 20 00 mv r4,r19 80043d8: d9 60 00 00 call r11 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { 80043dc: 2b 82 00 48 lw r2,(sp+72) 80043e0: 5c 55 00 05 bne r2,r21,80043f4 (*print)( context, "\n" ); 80043e4: b9 80 08 00 mv r1,r12 80043e8: b9 c0 10 00 mv r2,r14 80043ec: d9 60 00 00 call r11 continue; 80043f0: e0 00 00 30 bi 80044b0 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 ); 80043f4: ba 40 18 00 mv r3,r18 80043f8: ba e0 08 00 mv r1,r23 80043fc: f8 00 10 59 calli 8008560 <_Timespec_Divide_by_integer> (*print)( context, 8004400: 2b 81 00 54 lw r1,(sp+84) 8004404: 34 02 03 e8 mvi r2,1000 8004408: f8 00 62 48 calli 801cd28 <__divsi3> 800440c: b8 20 d8 00 mv fp,r1 8004410: 2b 81 00 5c lw r1,(sp+92) 8004414: 34 02 03 e8 mvi r2,1000 8004418: f8 00 62 44 calli 801cd28 <__divsi3> 800441c: b8 20 a8 00 mv r21,r1 8004420: 2b 81 00 9c lw r1,(sp+156) 8004424: 34 02 03 e8 mvi r2,1000 8004428: f8 00 62 40 calli 801cd28 <__divsi3> 800442c: 2b 85 00 58 lw r5,(sp+88) 8004430: 2b 87 00 98 lw r7,(sp+152) 8004434: 2b 83 00 50 lw r3,(sp+80) 8004438: b8 20 40 00 mv r8,r1 800443c: bb 60 20 00 mv r4,fp 8004440: ba a0 30 00 mv r6,r21 8004444: ba 00 10 00 mv r2,r16 8004448: b9 80 08 00 mv r1,r12 800444c: 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); 8004450: 2b 82 00 48 lw r2,(sp+72) 8004454: ba 40 18 00 mv r3,r18 8004458: ba c0 08 00 mv r1,r22 800445c: f8 00 10 41 calli 8008560 <_Timespec_Divide_by_integer> (*print)( context, 8004460: 2b 81 00 6c lw r1,(sp+108) 8004464: 34 02 03 e8 mvi r2,1000 8004468: f8 00 62 30 calli 801cd28 <__divsi3> 800446c: b8 20 d8 00 mv fp,r1 8004470: 2b 81 00 74 lw r1,(sp+116) 8004474: 34 02 03 e8 mvi r2,1000 8004478: f8 00 62 2c calli 801cd28 <__divsi3> 800447c: b8 20 a8 00 mv r21,r1 8004480: 2b 81 00 9c lw r1,(sp+156) 8004484: 34 02 03 e8 mvi r2,1000 8004488: f8 00 62 28 calli 801cd28 <__divsi3> 800448c: 2b 83 00 68 lw r3,(sp+104) 8004490: 2b 85 00 70 lw r5,(sp+112) 8004494: 2b 87 00 98 lw r7,(sp+152) 8004498: b8 20 40 00 mv r8,r1 800449c: b9 e0 10 00 mv r2,r15 80044a0: b9 80 08 00 mv r1,r12 80044a4: bb 60 20 00 mv r4,fp 80044a8: ba a0 30 00 mv r6,r21 80044ac: 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++ ) { 80044b0: 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 ; 80044b4: 2a 81 00 0c lw r1,(r20+12) 80044b8: 50 2d ff b6 bgeu r1,r13,8004390 the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } 80044bc: 2b 9d 00 04 lw ra,(sp+4) 80044c0: 2b 8b 00 44 lw r11,(sp+68) 80044c4: 2b 8c 00 40 lw r12,(sp+64) 80044c8: 2b 8d 00 3c lw r13,(sp+60) 80044cc: 2b 8e 00 38 lw r14,(sp+56) 80044d0: 2b 8f 00 34 lw r15,(sp+52) 80044d4: 2b 90 00 30 lw r16,(sp+48) 80044d8: 2b 91 00 2c lw r17,(sp+44) 80044dc: 2b 92 00 28 lw r18,(sp+40) 80044e0: 2b 93 00 24 lw r19,(sp+36) 80044e4: 2b 94 00 20 lw r20,(sp+32) 80044e8: 2b 95 00 1c lw r21,(sp+28) 80044ec: 2b 96 00 18 lw r22,(sp+24) 80044f0: 2b 97 00 14 lw r23,(sp+20) 80044f4: 2b 98 00 10 lw r24,(sp+16) 80044f8: 2b 99 00 0c lw r25,(sp+12) 80044fc: 2b 9b 00 08 lw fp,(sp+8) 8004500: 37 9c 00 a4 addi sp,sp,164 8004504: c3 a0 00 00 ret =============================================================================== 08013348 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 8013348: 37 9c ff f4 addi sp,sp,-12 801334c: 5b 8b 00 08 sw (sp+8),r11 8013350: 5b 9d 00 04 sw (sp+4),ra Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; 8013354: 34 03 00 0a mvi r3,10 rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { 8013358: 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 ) 801335c: 44 40 00 29 be r2,r0,8013400 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); 8013360: 37 82 00 0c addi r2,sp,12 8013364: f8 00 15 2e calli 801881c <_Thread_Get> switch ( location ) { 8013368: 2b 82 00 0c lw r2,(sp+12) case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 801336c: 34 03 00 04 mvi r3,4 if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); switch ( location ) { 8013370: 5c 40 00 24 bne r2,r0,8013400 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; 8013374: 28 23 01 1c lw r3,(r1+284) asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { 8013378: 28 64 00 0c lw r4,(r3+12) 801337c: 44 82 00 1f be r4,r2,80133f8 if ( asr->is_enabled ) { 8013380: 40 62 00 08 lbu r2,(r3+8) 8013384: 44 40 00 12 be r2,r0,80133cc rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 8013388: 90 00 10 00 rcsr r2,IE 801338c: 34 04 ff fe mvi r4,-2 8013390: a0 44 20 00 and r4,r2,r4 8013394: d0 04 00 00 wcsr IE,r4 *signal_set |= signals; 8013398: 28 64 00 14 lw r4,(r3+20) 801339c: b8 8b 58 00 or r11,r4,r11 80133a0: 58 6b 00 14 sw (r3+20),r11 _ISR_Enable( _level ); 80133a4: d0 02 00 00 wcsr IE,r2 _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) 80133a8: 78 02 08 04 mvhi r2,0x804 80133ac: 38 42 11 b4 ori r2,r2,0x11b4 80133b0: 28 43 00 08 lw r3,(r2+8) 80133b4: 44 60 00 0e be r3,r0,80133ec 80133b8: 28 43 00 0c lw r3,(r2+12) 80133bc: 5c 23 00 0c bne r1,r3,80133ec <== NEVER TAKEN _Thread_Dispatch_necessary = true; 80133c0: 34 01 00 01 mvi r1,1 80133c4: 30 41 00 18 sb (r2+24),r1 80133c8: e0 00 00 09 bi 80133ec rtems_signal_set *signal_set ) { ISR_Level _level; _ISR_Disable( _level ); 80133cc: 90 00 08 00 rcsr r1,IE 80133d0: 34 02 ff fe mvi r2,-2 80133d4: a0 22 10 00 and r2,r1,r2 80133d8: d0 02 00 00 wcsr IE,r2 *signal_set |= signals; 80133dc: 28 62 00 18 lw r2,(r3+24) 80133e0: b8 4b 58 00 or r11,r2,r11 80133e4: 58 6b 00 18 sw (r3+24),r11 _ISR_Enable( _level ); 80133e8: d0 01 00 00 wcsr IE,r1 } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); 80133ec: f8 00 14 ff calli 80187e8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 80133f0: 34 03 00 00 mvi r3,0 80133f4: e0 00 00 03 bi 8013400 } _Thread_Enable_dispatch(); 80133f8: f8 00 14 fc calli 80187e8 <_Thread_Enable_dispatch> return RTEMS_NOT_DEFINED; 80133fc: 34 03 00 0b mvi r3,11 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } 8013400: b8 60 08 00 mv r1,r3 8013404: 2b 9d 00 04 lw ra,(sp+4) 8013408: 2b 8b 00 08 lw r11,(sp+8) 801340c: 37 9c 00 0c addi sp,sp,12 8013410: c3 a0 00 00 ret =============================================================================== 0800df0c : rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { 800df0c: 37 9c ff e0 addi sp,sp,-32 800df10: 5b 8b 00 20 sw (sp+32),r11 800df14: 5b 8c 00 1c sw (sp+28),r12 800df18: 5b 8d 00 18 sw (sp+24),r13 800df1c: 5b 8e 00 14 sw (sp+20),r14 800df20: 5b 8f 00 10 sw (sp+16),r15 800df24: 5b 90 00 0c sw (sp+12),r16 800df28: 5b 91 00 08 sw (sp+8),r17 800df2c: 5b 9d 00 04 sw (sp+4),ra bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; 800df30: 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 ) { 800df34: b8 20 68 00 mv r13,r1 800df38: b8 40 70 00 mv r14,r2 800df3c: b8 60 80 00 mv r16,r3 ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) 800df40: 44 60 00 51 be r3,r0,800e084 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; 800df44: 78 01 08 01 mvhi r1,0x801 800df48: 38 21 9e 2c ori r1,r1,0x9e2c 800df4c: 28 2c 00 0c lw r12,(r1+12) api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 800df50: 41 8f 00 74 lbu r15,(r12+116) if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 800df54: 29 81 00 7c lw r1,(r12+124) if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; 800df58: 29 8b 01 1c lw r11,(r12+284) asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; 800df5c: 65 ef 00 00 cmpei r15,r15,0 800df60: c8 0f 78 00 sub r15,r0,r15 800df64: 21 ef 01 00 andi r15,r15,0x100 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) 800df68: 44 20 00 02 be r1,r0,800df70 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; 800df6c: 39 ef 02 00 ori r15,r15,0x200 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; 800df70: 41 71 00 08 lbu r17,(r11+8) old_mode |= _ISR_Get_level(); 800df74: fb ff e7 f8 calli 8007f54 <_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; 800df78: 66 31 00 00 cmpei r17,r17,0 800df7c: c8 11 88 00 sub r17,r0,r17 800df80: 22 31 04 00 andi r17,r17,0x400 800df84: ba 21 08 00 or r1,r17,r1 old_mode |= _ISR_Get_level(); 800df88: b8 2f 78 00 or r15,r1,r15 *previous_mode_set = old_mode; 800df8c: 5a 0f 00 00 sw (r16+0),r15 /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) 800df90: 21 c1 01 00 andi r1,r14,0x100 800df94: 44 20 00 04 be r1,r0,800dfa4 */ RTEMS_INLINE_ROUTINE bool _Modes_Is_preempt ( Modes_Control mode_set ) { return (mode_set & RTEMS_PREEMPT_MASK) == RTEMS_PREEMPT; 800df98: 21 a1 01 00 andi r1,r13,0x100 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; 800df9c: 64 21 00 00 cmpei r1,r1,0 800dfa0: 31 81 00 74 sb (r12+116),r1 if ( mask & RTEMS_TIMESLICE_MASK ) { 800dfa4: 21 c1 02 00 andi r1,r14,0x200 800dfa8: 44 20 00 0b be r1,r0,800dfd4 */ RTEMS_INLINE_ROUTINE bool _Modes_Is_timeslice ( Modes_Control mode_set ) { return (mode_set & RTEMS_TIMESLICE_MASK) == RTEMS_TIMESLICE; 800dfac: 21 a1 02 00 andi r1,r13,0x200 if ( _Modes_Is_timeslice(mode_set) ) { 800dfb0: 44 20 00 08 be r1,r0,800dfd0 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; 800dfb4: 34 01 00 01 mvi r1,1 800dfb8: 59 81 00 7c sw (r12+124),r1 executing->cpu_time_budget = _Thread_Ticks_per_timeslice; 800dfbc: 78 01 08 01 mvhi r1,0x801 800dfc0: 38 21 98 f8 ori r1,r1,0x98f8 800dfc4: 28 21 00 00 lw r1,(r1+0) 800dfc8: 59 81 00 78 sw (r12+120),r1 800dfcc: e0 00 00 02 bi 800dfd4 } else executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; 800dfd0: 59 80 00 7c sw (r12+124),r0 } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) 800dfd4: 21 c1 00 01 andi r1,r14,0x1 800dfd8: 44 20 00 04 be r1,r0,800dfe8 */ RTEMS_INLINE_ROUTINE ISR_Level _Modes_Get_interrupt_level ( Modes_Control mode_set ) { return ( mode_set & RTEMS_INTERRUPT_MASK ); 800dfdc: 21 a1 00 01 andi r1,r13,0x1 */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); 800dfe0: 64 21 00 00 cmpei r1,r1,0 800dfe4: d0 01 00 00 wcsr IE,r1 * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { 800dfe8: 21 ce 04 00 andi r14,r14,0x400 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 800dfec: 34 03 00 00 mvi r3,0 if ( mask & RTEMS_ASR_MASK ) { 800dff0: 45 c0 00 11 be r14,r0,800e034 */ RTEMS_INLINE_ROUTINE bool _Modes_Is_asr_disabled ( Modes_Control mode_set ) { return (mode_set & RTEMS_ASR_MASK) == RTEMS_NO_ASR; 800dff4: 21 ad 04 00 andi r13,r13,0x400 is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 800dff8: 41 61 00 08 lbu r1,(r11+8) * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( 800dffc: 65 ad 00 00 cmpei r13,r13,0 is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { 800e000: 44 2d 00 0d be r1,r13,800e034 asr->is_enabled = is_asr_enabled; 800e004: 31 6d 00 08 sb (r11+8),r13 ) { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); 800e008: 90 00 08 00 rcsr r1,IE 800e00c: 34 02 ff fe mvi r2,-2 800e010: a0 22 10 00 and r2,r1,r2 800e014: d0 02 00 00 wcsr IE,r2 _signals = information->signals_pending; 800e018: 29 62 00 18 lw r2,(r11+24) information->signals_pending = information->signals_posted; 800e01c: 29 63 00 14 lw r3,(r11+20) information->signals_posted = _signals; 800e020: 59 62 00 14 sw (r11+20),r2 rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; 800e024: 59 63 00 18 sw (r11+24),r3 information->signals_posted = _signals; _ISR_Enable( _level ); 800e028: d0 01 00 00 wcsr IE,r1 _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { 800e02c: 29 63 00 14 lw r3,(r11+20) /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; 800e030: 7c 63 00 00 cmpnei r3,r3,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 800e034: 78 01 08 01 mvhi r1,0x801 800e038: 38 21 9a d8 ori r1,r1,0x9ad8 800e03c: 28 22 00 00 lw r2,(r1+0) 800e040: 34 01 00 03 mvi r1,3 if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; 800e044: 34 04 00 00 mvi r4,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { 800e048: 5c 41 00 0f bne r2,r1,800e084 <== NEVER TAKEN bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; 800e04c: 78 01 08 01 mvhi r1,0x801 800e050: 38 21 9e 2c ori r1,r1,0x9e2c 800e054: 28 22 00 0c lw r2,(r1+12) if ( are_signals_pending || 800e058: 5c 60 00 05 bne r3,r0,800e06c 800e05c: 28 21 00 10 lw r1,(r1+16) 800e060: 44 41 00 09 be r2,r1,800e084 (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { 800e064: 40 41 00 74 lbu r1,(r2+116) 800e068: 44 20 00 07 be r1,r0,800e084 <== NEVER TAKEN _Thread_Dispatch_necessary = true; 800e06c: 78 01 08 01 mvhi r1,0x801 800e070: 38 21 9e 2c ori r1,r1,0x9e2c 800e074: 34 02 00 01 mvi r2,1 800e078: 30 22 00 18 sb (r1+24),r2 if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); 800e07c: fb ff e1 cf calli 80067b8 <_Thread_Dispatch> } return RTEMS_SUCCESSFUL; 800e080: 34 04 00 00 mvi r4,0 } 800e084: b8 80 08 00 mv r1,r4 800e088: 2b 9d 00 04 lw ra,(sp+4) 800e08c: 2b 8b 00 20 lw r11,(sp+32) 800e090: 2b 8c 00 1c lw r12,(sp+28) 800e094: 2b 8d 00 18 lw r13,(sp+24) 800e098: 2b 8e 00 14 lw r14,(sp+20) 800e09c: 2b 8f 00 10 lw r15,(sp+16) 800e0a0: 2b 90 00 0c lw r16,(sp+12) 800e0a4: 2b 91 00 08 lw r17,(sp+8) 800e0a8: 37 9c 00 20 addi sp,sp,32 800e0ac: c3 a0 00 00 ret =============================================================================== 0800849c : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { 800849c: 37 9c ff f0 addi sp,sp,-16 80084a0: 5b 8b 00 0c sw (sp+12),r11 80084a4: 5b 8c 00 08 sw (sp+8),r12 80084a8: 5b 9d 00 04 sw (sp+4),ra 80084ac: b8 40 58 00 mv r11,r2 80084b0: b8 60 60 00 mv r12,r3 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 80084b4: 44 40 00 06 be r2,r0,80084cc RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && ( the_priority <= RTEMS_MAXIMUM_PRIORITY ) ); 80084b8: 78 02 08 01 mvhi r2,0x801 80084bc: 38 42 a0 c0 ori r2,r2,0xa0c0 80084c0: 40 43 00 00 lbu r3,(r2+0) !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; 80084c4: 34 02 00 13 mvi r2,19 ) { register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && 80084c8: 55 63 00 16 bgu r11,r3,8008520 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) return RTEMS_INVALID_ADDRESS; 80084cc: 34 02 00 09 mvi r2,9 if ( new_priority != RTEMS_CURRENT_PRIORITY && !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) 80084d0: 45 80 00 14 be r12,r0,8008520 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); 80084d4: 37 82 00 10 addi r2,sp,16 80084d8: f8 00 0a 89 calli 800aefc <_Thread_Get> switch ( location ) { 80084dc: 2b 82 00 10 lw r2,(sp+16) 80084e0: 5c 40 00 0f bne r2,r0,800851c case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; 80084e4: 28 23 00 14 lw r3,(r1+20) 80084e8: 59 83 00 00 sw (r12+0),r3 if ( new_priority != RTEMS_CURRENT_PRIORITY ) { 80084ec: 45 62 00 09 be r11,r2,8008510 the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || 80084f0: 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; 80084f4: 58 2b 00 18 sw (r1+24),r11 if ( the_thread->resource_count == 0 || 80084f8: 44 40 00 03 be r2,r0,8008504 80084fc: 28 22 00 14 lw r2,(r1+20) 8008500: 51 62 00 04 bgeu r11,r2,8008510 <== ALWAYS TAKEN the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); 8008504: b9 60 10 00 mv r2,r11 8008508: 34 03 00 00 mvi r3,0 800850c: f8 00 09 20 calli 800a98c <_Thread_Change_priority> } _Thread_Enable_dispatch(); 8008510: f8 00 0a 6e calli 800aec8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 8008514: 34 02 00 00 mvi r2,0 8008518: e0 00 00 02 bi 8008520 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 800851c: 34 02 00 04 mvi r2,4 } 8008520: b8 40 08 00 mv r1,r2 8008524: 2b 9d 00 04 lw ra,(sp+4) 8008528: 2b 8b 00 0c lw r11,(sp+12) 800852c: 2b 8c 00 08 lw r12,(sp+8) 8008530: 37 9c 00 10 addi sp,sp,16 8008534: c3 a0 00 00 ret =============================================================================== 08013e78 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { 8013e78: 37 9c ff f8 addi sp,sp,-8 8013e7c: 5b 9d 00 04 sw (sp+4),ra 8013e80: b8 20 10 00 mv r2,r1 Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) _Objects_Get( &_Timer_Information, id, location ); 8013e84: 78 01 08 04 mvhi r1,0x804 8013e88: 38 21 15 e4 ori r1,r1,0x15e4 8013e8c: 37 83 00 08 addi r3,sp,8 8013e90: f8 00 0e 9d calli 8017904 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { 8013e94: 2b 82 00 08 lw r2,(sp+8) 8013e98: 5c 40 00 09 bne r2,r0,8013ebc case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) 8013e9c: 28 23 00 38 lw r3,(r1+56) 8013ea0: 34 02 00 04 mvi r2,4 8013ea4: 44 62 00 03 be r3,r2,8013eb0 <== NEVER TAKEN (void) _Watchdog_Remove( &the_timer->Ticker ); 8013ea8: 34 21 00 10 addi r1,r1,16 8013eac: f8 00 18 3e calli 8019fa4 <_Watchdog_Remove> _Thread_Enable_dispatch(); 8013eb0: f8 00 12 4e calli 80187e8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 8013eb4: 34 01 00 00 mvi r1,0 8013eb8: e0 00 00 02 bi 8013ec0 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 8013ebc: 34 01 00 04 mvi r1,4 } 8013ec0: 2b 9d 00 04 lw ra,(sp+4) 8013ec4: 37 9c 00 08 addi sp,sp,8 8013ec8: c3 a0 00 00 ret =============================================================================== 08014494 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 8014494: 37 9c ff dc addi sp,sp,-36 8014498: 5b 8b 00 20 sw (sp+32),r11 801449c: 5b 8c 00 1c sw (sp+28),r12 80144a0: 5b 8d 00 18 sw (sp+24),r13 80144a4: 5b 8e 00 14 sw (sp+20),r14 80144a8: 5b 8f 00 10 sw (sp+16),r15 80144ac: 5b 90 00 0c sw (sp+12),r16 80144b0: 5b 91 00 08 sw (sp+8),r17 80144b4: 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; 80144b8: 78 05 08 04 mvhi r5,0x804 80144bc: 38 a5 16 24 ori r5,r5,0x1624 80144c0: 28 ad 00 00 lw r13,(r5+0) rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { 80144c4: b8 20 78 00 mv r15,r1 80144c8: b8 40 60 00 mv r12,r2 80144cc: b8 60 80 00 mv r16,r3 80144d0: b8 80 88 00 mv r17,r4 Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; 80144d4: 34 0b 00 0e mvi r11,14 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) 80144d8: 45 a0 00 2e be r13,r0,8014590 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 80144dc: 78 05 08 04 mvhi r5,0x804 80144e0: 38 a5 0c f0 ori r5,r5,0xcf0 80144e4: 40 a1 00 00 lbu r1,(r5+0) return RTEMS_NOT_DEFINED; 80144e8: 34 0b 00 0b mvi r11,11 Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) 80144ec: 44 20 00 29 be r1,r0,8014590 <== NEVER TAKEN return RTEMS_NOT_DEFINED; if ( !routine ) return RTEMS_INVALID_ADDRESS; 80144f0: 34 0b 00 09 mvi r11,9 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) 80144f4: 44 60 00 27 be r3,r0,8014590 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 80144f8: b8 40 08 00 mv r1,r2 80144fc: fb ff f1 c1 calli 8010c00 <_TOD_Validate> return RTEMS_INVALID_CLOCK; 8014500: 34 0b 00 14 mvi r11,20 return RTEMS_NOT_DEFINED; if ( !routine ) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) 8014504: 44 20 00 23 be r1,r0,8014590 return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 8014508: b9 80 08 00 mv r1,r12 if ( seconds <= _TOD_Seconds_since_epoch() ) 801450c: 78 0c 08 04 mvhi r12,0x804 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 8014510: fb ff f1 7c calli 8010b00 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) 8014514: 39 8c 0d 88 ori r12,r12,0xd88 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); 8014518: b8 20 70 00 mv r14,r1 if ( seconds <= _TOD_Seconds_since_epoch() ) 801451c: 29 81 00 00 lw r1,(r12+0) 8014520: 50 2e 00 1c bgeu r1,r14,8014590 8014524: 78 01 08 04 mvhi r1,0x804 8014528: 38 21 15 e4 ori r1,r1,0x15e4 801452c: b9 e0 10 00 mv r2,r15 8014530: 37 83 00 24 addi r3,sp,36 8014534: f8 00 0c f4 calli 8017904 <_Objects_Get> 8014538: b8 20 58 00 mv r11,r1 return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { 801453c: 2b 81 00 24 lw r1,(sp+36) 8014540: 5c 20 00 13 bne r1,r0,801458c case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); 8014544: 35 61 00 10 addi r1,r11,16 8014548: f8 00 16 97 calli 8019fa4 <_Watchdog_Remove> the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; 801454c: 34 01 00 03 mvi r1,3 8014550: 59 61 00 38 sw (r11+56),r1 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); 8014554: 29 81 00 00 lw r1,(r12+0) (*timer_server->schedule_operation)( timer_server, the_timer ); 8014558: 29 a3 00 04 lw r3,(r13+4) 801455c: 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(); 8014560: c9 c1 70 00 sub r14,r14,r1 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 8014564: 59 60 00 18 sw (r11+24),r0 the_watchdog->routine = routine; 8014568: 59 70 00 2c sw (r11+44),r16 the_watchdog->id = id; 801456c: 59 6f 00 30 sw (r11+48),r15 the_watchdog->user_data = user_data; 8014570: 59 71 00 34 sw (r11+52),r17 8014574: 59 6e 00 1c sw (r11+28),r14 (*timer_server->schedule_operation)( timer_server, the_timer ); 8014578: b9 a0 08 00 mv r1,r13 801457c: d8 60 00 00 call r3 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; 8014580: 34 0b 00 00 mvi r11,0 _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 ); _Thread_Enable_dispatch(); 8014584: f8 00 10 99 calli 80187e8 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; 8014588: e0 00 00 02 bi 8014590 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; 801458c: 34 0b 00 04 mvi r11,4 } 8014590: b9 60 08 00 mv r1,r11 8014594: 2b 9d 00 04 lw ra,(sp+4) 8014598: 2b 8b 00 20 lw r11,(sp+32) 801459c: 2b 8c 00 1c lw r12,(sp+28) 80145a0: 2b 8d 00 18 lw r13,(sp+24) 80145a4: 2b 8e 00 14 lw r14,(sp+20) 80145a8: 2b 8f 00 10 lw r15,(sp+16) 80145ac: 2b 90 00 0c lw r16,(sp+12) 80145b0: 2b 91 00 08 lw r17,(sp+8) 80145b4: 37 9c 00 24 addi sp,sp,36 80145b8: c3 a0 00 00 ret =============================================================================== 0800394c : #include int sched_get_priority_max( int policy ) { 800394c: 37 9c ff fc addi sp,sp,-4 8003950: 5b 9d 00 04 sw (sp+4),ra switch ( policy ) { 8003954: 48 01 00 05 bg r0,r1,8003968 8003958: 34 02 00 02 mvi r2,2 800395c: 4c 41 00 08 bge r2,r1,800397c 8003960: 34 02 00 04 mvi r2,4 8003964: 44 22 00 06 be r1,r2,800397c <== ALWAYS TAKEN case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 8003968: f8 00 26 84 calli 800d378 <__errno> 800396c: 34 02 00 16 mvi r2,22 8003970: 58 22 00 00 sw (r1+0),r2 8003974: 34 01 ff ff mvi r1,-1 8003978: e0 00 00 05 bi 800398c } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; 800397c: 78 01 08 01 mvhi r1,0x801 8003980: 38 21 f0 e4 ori r1,r1,0xf0e4 8003984: 40 21 00 00 lbu r1,(r1+0) 8003988: 34 21 ff ff addi r1,r1,-1 } 800398c: 2b 9d 00 04 lw ra,(sp+4) 8003990: 37 9c 00 04 addi sp,sp,4 8003994: c3 a0 00 00 ret =============================================================================== 08003998 : #include int sched_get_priority_min( int policy ) { 8003998: 37 9c ff fc addi sp,sp,-4 800399c: 5b 9d 00 04 sw (sp+4),ra switch ( policy ) { 80039a0: 48 01 00 05 bg r0,r1,80039b4 80039a4: 34 02 00 02 mvi r2,2 80039a8: 4c 41 00 08 bge r2,r1,80039c8 <== ALWAYS TAKEN 80039ac: 34 02 00 04 mvi r2,4 <== NOT EXECUTED 80039b0: 44 22 00 06 be r1,r2,80039c8 <== NOT EXECUTED case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); 80039b4: f8 00 26 71 calli 800d378 <__errno> 80039b8: 34 02 00 16 mvi r2,22 80039bc: 58 22 00 00 sw (r1+0),r2 80039c0: 34 01 ff ff mvi r1,-1 80039c4: e0 00 00 02 bi 80039cc } return POSIX_SCHEDULER_MINIMUM_PRIORITY; 80039c8: 34 01 00 01 mvi r1,1 } 80039cc: 2b 9d 00 04 lw ra,(sp+4) 80039d0: 37 9c 00 04 addi sp,sp,4 80039d4: c3 a0 00 00 ret =============================================================================== 080039d8 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { 80039d8: 37 9c ff f4 addi sp,sp,-12 80039dc: 5b 8b 00 08 sw (sp+8),r11 80039e0: 5b 9d 00 04 sw (sp+4),ra 80039e4: b8 20 58 00 mv r11,r1 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) 80039e8: 44 20 00 08 be r1,r0,8003a08 <== NEVER TAKEN 80039ec: 5b 82 00 0c sw (sp+12),r2 80039f0: fb ff f8 af calli 8001cac 80039f4: 2b 82 00 0c lw r2,(sp+12) 80039f8: 45 61 00 04 be r11,r1,8003a08 rtems_set_errno_and_return_minus_one( ESRCH ); 80039fc: f8 00 26 5f calli 800d378 <__errno> 8003a00: 34 02 00 03 mvi r2,3 8003a04: e0 00 00 04 bi 8003a14 if ( !interval ) 8003a08: 5c 40 00 06 bne r2,r0,8003a20 rtems_set_errno_and_return_minus_one( EINVAL ); 8003a0c: f8 00 26 5b calli 800d378 <__errno> 8003a10: 34 02 00 16 mvi r2,22 8003a14: 58 22 00 00 sw (r1+0),r2 8003a18: 34 01 ff ff mvi r1,-1 8003a1c: e0 00 00 06 bi 8003a34 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); 8003a20: 78 01 08 01 mvhi r1,0x801 8003a24: 38 21 f8 30 ori r1,r1,0xf830 8003a28: 28 21 00 00 lw r1,(r1+0) 8003a2c: f8 00 0e 20 calli 80072ac <_Timespec_From_ticks> return 0; 8003a30: 34 01 00 00 mvi r1,0 } 8003a34: 2b 9d 00 04 lw ra,(sp+4) 8003a38: 2b 8b 00 08 lw r11,(sp+8) 8003a3c: 37 9c 00 0c addi sp,sp,12 8003a40: c3 a0 00 00 ret =============================================================================== 08006134 : int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { 8006134: 37 9c ff c0 addi sp,sp,-64 8006138: 5b 8b 00 18 sw (sp+24),r11 800613c: 5b 8c 00 14 sw (sp+20),r12 8006140: 5b 8d 00 10 sw (sp+16),r13 8006144: 5b 8e 00 0c sw (sp+12),r14 8006148: 5b 8f 00 08 sw (sp+8),r15 800614c: 5b 9d 00 04 sw (sp+4),ra 8006150: 5b 83 00 2c sw (sp+44),r3 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8006154: 78 03 08 02 mvhi r3,0x802 8006158: 5b 82 00 28 sw (sp+40),r2 800615c: 5b 84 00 30 sw (sp+48),r4 8006160: 5b 85 00 34 sw (sp+52),r5 8006164: 5b 86 00 38 sw (sp+56),r6 8006168: 5b 87 00 3c sw (sp+60),r7 800616c: 5b 88 00 40 sw (sp+64),r8 8006170: 38 63 4a 90 ori r3,r3,0x4a90 8006174: b8 20 60 00 mv r12,r1 8006178: 28 61 00 00 lw r1,(r3+0) 800617c: b8 40 70 00 mv r14,r2 8006180: 34 21 00 01 addi r1,r1,1 8006184: 58 61 00 00 sw (r3+0),r1 POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 8006188: 20 4f 02 00 andi r15,r2,0x200 /* unsigned int value */ ) { va_list arg; mode_t mode; unsigned int value = 0; 800618c: 34 0d 00 00 mvi r13,0 POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { 8006190: 45 e0 00 02 be r15,r0,8006198 va_start(arg, oflag); mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); 8006194: 2b 8d 00 30 lw r13,(sp+48) va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); 8006198: b9 80 08 00 mv r1,r12 800619c: 37 82 00 24 addi r2,sp,36 80061a0: f8 00 1b 07 calli 800cdbc <_POSIX_Semaphore_Name_to_id> 80061a4: 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 ) { 80061a8: 44 20 00 08 be r1,r0,80061c8 /* * 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) ) ) { 80061ac: 34 01 00 02 mvi r1,2 80061b0: 5d 61 00 02 bne r11,r1,80061b8 <== NEVER TAKEN 80061b4: 5d e0 00 1a bne r15,r0,800621c _Thread_Enable_dispatch(); 80061b8: f8 00 0a b9 calli 8008c9c <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); 80061bc: f8 00 2a 59 calli 8010b20 <__errno> 80061c0: 58 2b 00 00 sw (r1+0),r11 80061c4: e0 00 00 08 bi 80061e4 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { 80061c8: 21 ce 0a 00 andi r14,r14,0xa00 80061cc: 34 01 0a 00 mvi r1,2560 80061d0: 5d c1 00 07 bne r14,r1,80061ec _Thread_Enable_dispatch(); 80061d4: f8 00 0a b2 calli 8008c9c <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); 80061d8: f8 00 2a 52 calli 8010b20 <__errno> 80061dc: 34 02 00 11 mvi r2,17 80061e0: 58 22 00 00 sw (r1+0),r2 80061e4: 34 01 ff ff mvi r1,-1 80061e8: e0 00 00 18 bi 8006248 80061ec: 2b 82 00 24 lw r2,(sp+36) 80061f0: 78 01 08 02 mvhi r1,0x802 80061f4: 37 83 00 1c addi r3,sp,28 80061f8: 38 21 4c e4 ori r1,r1,0x4ce4 80061fc: f8 00 07 5c calli 8007f6c <_Objects_Get> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; 8006200: 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 ); 8006204: 5b 81 00 20 sw (sp+32),r1 the_semaphore->open_count += 1; 8006208: 34 42 00 01 addi r2,r2,1 800620c: 58 22 00 18 sw (r1+24),r2 _Thread_Enable_dispatch(); 8006210: f8 00 0a a3 calli 8008c9c <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); 8006214: f8 00 0a a2 calli 8008c9c <_Thread_Enable_dispatch> goto return_id; 8006218: e0 00 00 0a bi 8006240 /* * 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( 800621c: 34 02 00 00 mvi r2,0 8006220: b9 a0 18 00 mv r3,r13 8006224: 37 84 00 20 addi r4,sp,32 8006228: b9 80 08 00 mv r1,r12 800622c: f8 00 1a 80 calli 800cc2c <_POSIX_Semaphore_Create_support> 8006230: b8 20 58 00 mv r11,r1 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); 8006234: f8 00 0a 9a calli 8008c9c <_Thread_Enable_dispatch> if ( status == -1 ) return SEM_FAILED; 8006238: 34 01 ff ff mvi r1,-1 * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); if ( status == -1 ) 800623c: 45 61 00 03 be r11,r1,8006248 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; 8006240: 2b 81 00 20 lw r1,(sp+32) 8006244: 34 21 00 08 addi r1,r1,8 #endif return id; } 8006248: 2b 9d 00 04 lw ra,(sp+4) 800624c: 2b 8b 00 18 lw r11,(sp+24) 8006250: 2b 8c 00 14 lw r12,(sp+20) 8006254: 2b 8d 00 10 lw r13,(sp+16) 8006258: 2b 8e 00 0c lw r14,(sp+12) 800625c: 2b 8f 00 08 lw r15,(sp+8) 8006260: 37 9c 00 40 addi sp,sp,64 8006264: c3 a0 00 00 ret =============================================================================== 0800384c : int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { 800384c: 37 9c ff ec addi sp,sp,-20 8003850: 5b 8b 00 14 sw (sp+20),r11 8003854: 5b 8c 00 10 sw (sp+16),r12 8003858: 5b 8d 00 0c sw (sp+12),r13 800385c: 5b 8e 00 08 sw (sp+8),r14 8003860: 5b 9d 00 04 sw (sp+4),ra 8003864: b8 20 58 00 mv r11,r1 8003868: b8 40 60 00 mv r12,r2 800386c: b8 60 68 00 mv r13,r3 ISR_Level level; if ( oact ) 8003870: 44 60 00 0f be r3,r0,80038ac *oact = _POSIX_signals_Vectors[ sig ]; 8003874: 34 02 00 01 mvi r2,1 8003878: f8 00 67 29 calli 801d51c <__ashlsi3> 800387c: 34 02 00 02 mvi r2,2 8003880: 78 0e 08 02 mvhi r14,0x802 8003884: b4 2b 08 00 add r1,r1,r11 8003888: f8 00 67 25 calli 801d51c <__ashlsi3> 800388c: 39 ce 0e 00 ori r14,r14,0xe00 8003890: b5 c1 08 00 add r1,r14,r1 8003894: 28 23 00 00 lw r3,(r1+0) 8003898: 28 22 00 04 lw r2,(r1+4) 800389c: 28 21 00 08 lw r1,(r1+8) 80038a0: 59 a3 00 00 sw (r13+0),r3 80038a4: 59 a2 00 04 sw (r13+4),r2 80038a8: 59 a1 00 08 sw (r13+8),r1 if ( !sig ) 80038ac: 45 60 00 07 be r11,r0,80038c8 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 80038b0: 35 61 ff ff addi r1,r11,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) 80038b4: 34 02 00 1f mvi r2,31 80038b8: 50 41 00 02 bgeu r2,r1,80038c0 80038bc: e0 00 00 03 bi 80038c8 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) 80038c0: 34 01 00 09 mvi r1,9 80038c4: 5d 61 00 06 bne r11,r1,80038dc rtems_set_errno_and_return_minus_one( EINVAL ); 80038c8: f8 00 28 03 calli 800d8d4 <__errno> 80038cc: 34 02 00 16 mvi r2,22 80038d0: 58 22 00 00 sw (r1+0),r2 80038d4: 34 01 ff ff mvi r1,-1 80038d8: e0 00 00 31 bi 800399c * now (signals not posted when SIG_IGN). * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; 80038dc: 34 01 00 00 mvi r1,0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { 80038e0: 45 80 00 2f be r12,r0,800399c <== 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 ); 80038e4: 90 00 70 00 rcsr r14,IE 80038e8: 34 01 ff fe mvi r1,-2 80038ec: a1 c1 08 00 and r1,r14,r1 80038f0: d0 01 00 00 wcsr IE,r1 if ( act->sa_handler == SIG_DFL ) { 80038f4: 29 81 00 08 lw r1,(r12+8) 80038f8: 78 0d 08 02 mvhi r13,0x802 80038fc: 39 ad 0e 00 ori r13,r13,0xe00 8003900: 5c 20 00 16 bne r1,r0,8003958 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; 8003904: b9 60 08 00 mv r1,r11 8003908: 34 02 00 01 mvi r2,1 800390c: f8 00 67 04 calli 801d51c <__ashlsi3> 8003910: b4 2b 58 00 add r11,r1,r11 8003914: 34 02 00 02 mvi r2,2 8003918: b9 60 08 00 mv r1,r11 800391c: f8 00 67 00 calli 801d51c <__ashlsi3> 8003920: b5 a1 68 00 add r13,r13,r1 8003924: 34 02 00 02 mvi r2,2 8003928: 78 0c 08 01 mvhi r12,0x801 800392c: b9 60 08 00 mv r1,r11 8003930: f8 00 66 fb calli 801d51c <__ashlsi3> 8003934: 39 8c ef 24 ori r12,r12,0xef24 8003938: b5 81 08 00 add r1,r12,r1 800393c: 28 23 00 00 lw r3,(r1+0) 8003940: 28 22 00 04 lw r2,(r1+4) 8003944: 28 21 00 08 lw r1,(r1+8) 8003948: 59 a3 00 00 sw (r13+0),r3 800394c: 59 a2 00 04 sw (r13+4),r2 8003950: 59 a1 00 08 sw (r13+8),r1 8003954: e0 00 00 10 bi 8003994 } else { _POSIX_signals_Clear_process_signals( sig ); 8003958: b9 60 08 00 mv r1,r11 800395c: f8 00 18 99 calli 8009bc0 <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; 8003960: 34 02 00 01 mvi r2,1 8003964: b9 60 08 00 mv r1,r11 8003968: f8 00 66 ed calli 801d51c <__ashlsi3> 800396c: 34 02 00 02 mvi r2,2 8003970: b4 2b 08 00 add r1,r1,r11 8003974: f8 00 66 ea calli 801d51c <__ashlsi3> 8003978: 29 83 00 00 lw r3,(r12+0) 800397c: 29 82 00 04 lw r2,(r12+4) 8003980: 29 84 00 08 lw r4,(r12+8) 8003984: b5 a1 08 00 add r1,r13,r1 8003988: 58 23 00 00 sw (r1+0),r3 800398c: 58 22 00 04 sw (r1+4),r2 8003990: 58 24 00 08 sw (r1+8),r4 } _ISR_Enable( level ); 8003994: d0 0e 00 00 wcsr IE,r14 * now (signals not posted when SIG_IGN). * + If we are now ignoring a signal that was previously pending, * we clear the pending signal indicator. */ return 0; 8003998: 34 01 00 00 mvi r1,0 } 800399c: 2b 9d 00 04 lw ra,(sp+4) 80039a0: 2b 8b 00 14 lw r11,(sp+20) 80039a4: 2b 8c 00 10 lw r12,(sp+16) 80039a8: 2b 8d 00 0c lw r13,(sp+12) 80039ac: 2b 8e 00 08 lw r14,(sp+8) 80039b0: 37 9c 00 14 addi sp,sp,20 80039b4: c3 a0 00 00 ret =============================================================================== 08003e48 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { 8003e48: 37 9c ff dc addi sp,sp,-36 8003e4c: 5b 8b 00 18 sw (sp+24),r11 8003e50: 5b 8c 00 14 sw (sp+20),r12 8003e54: 5b 8d 00 10 sw (sp+16),r13 8003e58: 5b 8e 00 0c sw (sp+12),r14 8003e5c: 5b 8f 00 08 sw (sp+8),r15 8003e60: 5b 9d 00 04 sw (sp+4),ra 8003e64: b8 20 68 00 mv r13,r1 8003e68: b8 40 58 00 mv r11,r2 8003e6c: b8 60 60 00 mv r12,r3 ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) 8003e70: 44 20 00 09 be r1,r0,8003e94 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { 8003e74: 44 60 00 0b be r3,r0,8003ea0 if ( !_Timespec_Is_valid( timeout ) ) 8003e78: b8 60 08 00 mv r1,r3 8003e7c: f8 00 0e 48 calli 800779c <_Timespec_Is_valid> 8003e80: 44 20 00 05 be r1,r0,8003e94 rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); 8003e84: b9 80 08 00 mv r1,r12 8003e88: f8 00 0e 63 calli 8007814 <_Timespec_To_ticks> 8003e8c: b8 20 10 00 mv r2,r1 if ( !interval ) 8003e90: 5c 20 00 05 bne r1,r0,8003ea4 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); 8003e94: f8 00 28 5c calli 800e004 <__errno> 8003e98: 34 02 00 16 mvi r2,22 8003e9c: e0 00 00 61 bi 8004020 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; 8003ea0: 34 02 00 00 mvi r2,0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; 8003ea4: 5d 60 00 02 bne r11,r0,8003eac 8003ea8: 37 8b 00 1c addi r11,sp,28 the_thread = _Thread_Executing; 8003eac: 78 01 08 02 mvhi r1,0x802 8003eb0: 38 21 1d b4 ori r1,r1,0x1db4 8003eb4: 28 23 00 0c lw r3,(r1+12) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; 8003eb8: 28 6e 01 20 lw r14,(r3+288) * What if they are already pending? */ /* API signals pending? */ _ISR_Disable( level ); 8003ebc: 90 00 78 00 rcsr r15,IE 8003ec0: 34 01 ff fe mvi r1,-2 8003ec4: a1 e1 08 00 and r1,r15,r1 8003ec8: d0 01 00 00 wcsr IE,r1 if ( *set & api->signals_pending ) { 8003ecc: 29 a5 00 00 lw r5,(r13+0) 8003ed0: 29 c1 00 d4 lw r1,(r14+212) 8003ed4: a0 a1 20 00 and r4,r5,r1 8003ed8: 44 80 00 0f be r4,r0,8003f14 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); 8003edc: fb ff ff bc calli 8003dcc <_POSIX_signals_Get_lowest> 8003ee0: b8 20 10 00 mv r2,r1 8003ee4: 59 61 00 00 sw (r11+0),r1 _POSIX_signals_Clear_signals( 8003ee8: b9 60 18 00 mv r3,r11 8003eec: b9 c0 08 00 mv r1,r14 8003ef0: 34 04 00 00 mvi r4,0 8003ef4: 34 05 00 00 mvi r5,0 8003ef8: f8 00 19 b5 calli 800a5cc <_POSIX_signals_Clear_signals> the_info->si_signo, the_info, false, false ); _ISR_Enable( level ); 8003efc: d0 0f 00 00 wcsr IE,r15 the_info->si_code = SI_USER; 8003f00: 34 01 00 01 mvi r1,1 8003f04: 59 61 00 04 sw (r11+4),r1 the_info->si_value.sival_int = 0; 8003f08: 59 60 00 08 sw (r11+8),r0 return the_info->si_signo; 8003f0c: 29 6c 00 00 lw r12,(r11+0) 8003f10: e0 00 00 46 bi 8004028 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { 8003f14: 78 01 08 02 mvhi r1,0x802 8003f18: 38 21 1f f4 ori r1,r1,0x1ff4 8003f1c: 28 21 00 00 lw r1,(r1+0) 8003f20: a0 a1 28 00 and r5,r5,r1 8003f24: 44 a4 00 0f be r5,r4,8003f60 signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); 8003f28: fb ff ff a9 calli 8003dcc <_POSIX_signals_Get_lowest> 8003f2c: b8 20 60 00 mv r12,r1 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); 8003f30: b9 80 10 00 mv r2,r12 8003f34: b9 c0 08 00 mv r1,r14 8003f38: b9 60 18 00 mv r3,r11 8003f3c: 34 04 00 01 mvi r4,1 8003f40: 34 05 00 00 mvi r5,0 8003f44: f8 00 19 a2 calli 800a5cc <_POSIX_signals_Clear_signals> _ISR_Enable( level ); 8003f48: d0 0f 00 00 wcsr IE,r15 the_info->si_signo = signo; the_info->si_code = SI_USER; 8003f4c: 34 01 00 01 mvi r1,1 if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); _ISR_Enable( level ); the_info->si_signo = signo; 8003f50: 59 6c 00 00 sw (r11+0),r12 the_info->si_code = SI_USER; 8003f54: 59 61 00 04 sw (r11+4),r1 the_info->si_value.sival_int = 0; 8003f58: 59 60 00 08 sw (r11+8),r0 return signo; 8003f5c: e0 00 00 33 bi 8004028 } the_info->si_signo = -1; 8003f60: 34 01 ff ff mvi r1,-1 8003f64: 59 61 00 00 sw (r11+0),r1 8003f68: 78 01 08 02 mvhi r1,0x802 8003f6c: 38 21 18 e8 ori r1,r1,0x18e8 8003f70: 28 24 00 00 lw r4,(r1+0) 8003f74: 34 84 00 01 addi r4,r4,1 8003f78: 58 24 00 00 sw (r1+0),r4 _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; 8003f7c: 34 04 00 04 mvi r4,4 8003f80: 58 64 00 34 sw (r3+52),r4 the_thread->Wait.option = *set; 8003f84: 29 a4 00 00 lw r4,(r13+0) } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 8003f88: 78 01 08 02 mvhi r1,0x802 8003f8c: 38 21 1f 8c ori r1,r1,0x1f8c the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; 8003f90: 58 64 00 30 sw (r3+48),r4 the_thread->Wait.return_argument = the_info; 8003f94: 58 6b 00 28 sw (r3+40),r11 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; 8003f98: 58 61 00 44 sw (r3+68),r1 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; 8003f9c: 34 03 00 01 mvi r3,1 8003fa0: 58 23 00 30 sw (r1+48),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 ); 8003fa4: d0 0f 00 00 wcsr IE,r15 _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); 8003fa8: 78 01 08 02 mvhi r1,0x802 8003fac: 78 03 08 00 mvhi r3,0x800 8003fb0: 38 21 1f 8c ori r1,r1,0x1f8c 8003fb4: 38 63 73 d8 ori r3,r3,0x73d8 8003fb8: f8 00 0b de calli 8006f30 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); 8003fbc: f8 00 0a ad calli 8006a70 <_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 ); 8003fc0: 29 62 00 00 lw r2,(r11+0) 8003fc4: b9 c0 08 00 mv r1,r14 8003fc8: b9 60 18 00 mv r3,r11 8003fcc: 34 04 00 00 mvi r4,0 8003fd0: 34 05 00 00 mvi r5,0 8003fd4: f8 00 19 7e calli 800a5cc <_POSIX_signals_Clear_signals> /* Set errno only if return code is not EINTR or * if EINTR was caused by a signal being caught, which * was not in our set. */ if ( (_Thread_Executing->Wait.return_code != EINTR) 8003fd8: 78 01 08 02 mvhi r1,0x802 8003fdc: 38 21 1d b4 ori r1,r1,0x1db4 8003fe0: 28 21 00 0c lw r1,(r1+12) 8003fe4: 28 22 00 34 lw r2,(r1+52) 8003fe8: 34 01 00 04 mvi r1,4 8003fec: 5c 41 00 08 bne r2,r1,800400c || !(*set & signo_to_mask( the_info->si_signo )) ) { 8003ff0: 29 6c 00 00 lw r12,(r11+0) 8003ff4: 34 01 00 01 mvi r1,1 8003ff8: 35 82 ff ff addi r2,r12,-1 8003ffc: f8 00 66 fd calli 801dbf0 <__ashlsi3> 8004000: 29 a2 00 00 lw r2,(r13+0) 8004004: a0 22 08 00 and r1,r1,r2 8004008: 5c 20 00 08 bne r1,r0,8004028 errno = _Thread_Executing->Wait.return_code; 800400c: f8 00 27 fe calli 800e004 <__errno> 8004010: 78 02 08 02 mvhi r2,0x802 8004014: 38 42 1d b4 ori r2,r2,0x1db4 8004018: 28 42 00 0c lw r2,(r2+12) 800401c: 28 42 00 34 lw r2,(r2+52) 8004020: 58 22 00 00 sw (r1+0),r2 return -1; 8004024: 34 0c ff ff mvi r12,-1 } return the_info->si_signo; } 8004028: b9 80 08 00 mv r1,r12 800402c: 2b 9d 00 04 lw ra,(sp+4) 8004030: 2b 8b 00 18 lw r11,(sp+24) 8004034: 2b 8c 00 14 lw r12,(sp+20) 8004038: 2b 8d 00 10 lw r13,(sp+16) 800403c: 2b 8e 00 0c lw r14,(sp+12) 8004040: 2b 8f 00 08 lw r15,(sp+8) 8004044: 37 9c 00 24 addi sp,sp,36 8004048: c3 a0 00 00 ret =============================================================================== 080062dc : int sigwait( const sigset_t *set, int *sig ) { 80062dc: 37 9c ff f8 addi sp,sp,-8 80062e0: 5b 8b 00 08 sw (sp+8),r11 80062e4: 5b 9d 00 04 sw (sp+4),ra int status; status = sigtimedwait( set, NULL, NULL ); 80062e8: 34 03 00 00 mvi r3,0 int sigwait( const sigset_t *set, int *sig ) { 80062ec: b8 40 58 00 mv r11,r2 int status; status = sigtimedwait( set, NULL, NULL ); 80062f0: 34 02 00 00 mvi r2,0 80062f4: fb ff ff 72 calli 80060bc 80062f8: b8 20 18 00 mv r3,r1 if ( status != -1 ) { 80062fc: 34 01 ff ff mvi r1,-1 8006300: 44 61 00 05 be r3,r1,8006314 if ( sig ) *sig = status; return 0; 8006304: 34 01 00 00 mvi r1,0 int status; status = sigtimedwait( set, NULL, NULL ); if ( status != -1 ) { if ( sig ) 8006308: 45 60 00 05 be r11,r0,800631c <== NEVER TAKEN *sig = status; 800630c: 59 63 00 00 sw (r11+0),r3 8006310: e0 00 00 03 bi 800631c return 0; } return errno; 8006314: f8 00 26 c6 calli 800fe2c <__errno> 8006318: 28 21 00 00 lw r1,(r1+0) } 800631c: 2b 9d 00 04 lw ra,(sp+4) 8006320: 2b 8b 00 08 lw r11,(sp+8) 8006324: 37 9c 00 08 addi sp,sp,8 8006328: c3 a0 00 00 ret =============================================================================== 08002e34 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 8002e34: 37 9c ff ec addi sp,sp,-20 8002e38: 5b 8b 00 14 sw (sp+20),r11 8002e3c: 5b 8c 00 10 sw (sp+16),r12 8002e40: 5b 8d 00 0c sw (sp+12),r13 8002e44: 5b 8e 00 08 sw (sp+8),r14 8002e48: 5b 9d 00 04 sw (sp+4),ra 8002e4c: b8 40 60 00 mv r12,r2 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 8002e50: 34 02 00 01 mvi r2,1 int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { 8002e54: b8 60 68 00 mv r13,r3 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) 8002e58: 5c 22 00 0c bne r1,r2,8002e88 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) 8002e5c: 44 60 00 0b be r3,r0,8002e88 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { 8002e60: 45 80 00 0d be r12,r0,8002e94 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && 8002e64: 29 82 00 00 lw r2,(r12+0) 8002e68: 34 42 ff ff addi r2,r2,-1 8002e6c: 50 22 00 02 bgeu r1,r2,8002e74 <== ALWAYS TAKEN 8002e70: e0 00 00 06 bi 8002e88 <== 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 ) 8002e74: 29 81 00 04 lw r1,(r12+4) 8002e78: 44 20 00 04 be r1,r0,8002e88 <== NEVER TAKEN static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); 8002e7c: 34 21 ff ff addi r1,r1,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) 8002e80: 34 02 00 1f mvi r2,31 8002e84: 50 41 00 04 bgeu r2,r1,8002e94 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); 8002e88: f8 00 29 d6 calli 800d5e0 <__errno> 8002e8c: 34 02 00 16 mvi r2,22 8002e90: e0 00 00 0e bi 8002ec8 rtems_fatal_error_occurred( 99 ); } } #endif _Thread_Dispatch_disable_level += 1; 8002e94: 78 01 08 01 mvhi r1,0x801 8002e98: 38 21 f8 f8 ori r1,r1,0xf8f8 8002e9c: 28 22 00 00 lw r2,(r1+0) 8002ea0: 34 42 00 01 addi r2,r2,1 8002ea4: 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 ); 8002ea8: 78 01 08 01 mvhi r1,0x801 8002eac: 38 21 fb 8c ori r1,r1,0xfb8c 8002eb0: f8 00 07 11 calli 8004af4 <_Objects_Allocate> 8002eb4: b8 20 58 00 mv r11,r1 /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { 8002eb8: 5c 20 00 07 bne r1,r0,8002ed4 _Thread_Enable_dispatch(); 8002ebc: f8 00 0b 6d calli 8005c70 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); 8002ec0: f8 00 29 c8 calli 800d5e0 <__errno> 8002ec4: 34 02 00 0b mvi r2,11 8002ec8: 58 22 00 00 sw (r1+0),r2 8002ecc: 34 01 ff ff mvi r1,-1 8002ed0: e0 00 00 25 bi 8002f64 } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; 8002ed4: 34 01 00 02 mvi r1,2 8002ed8: 31 61 00 3c sb (r11+60),r1 ptimer->thread_id = _Thread_Executing->Object.id; 8002edc: 78 01 08 01 mvhi r1,0x801 8002ee0: 38 21 fd c4 ori r1,r1,0xfdc4 8002ee4: 28 21 00 0c lw r1,(r1+12) 8002ee8: 28 21 00 08 lw r1,(r1+8) 8002eec: 59 61 00 38 sw (r11+56),r1 if ( evp != NULL ) { 8002ef0: 45 80 00 07 be r12,r0,8002f0c ptimer->inf.sigev_notify = evp->sigev_notify; 8002ef4: 29 81 00 00 lw r1,(r12+0) 8002ef8: 59 61 00 40 sw (r11+64),r1 ptimer->inf.sigev_signo = evp->sigev_signo; 8002efc: 29 81 00 04 lw r1,(r12+4) 8002f00: 59 61 00 44 sw (r11+68),r1 ptimer->inf.sigev_value = evp->sigev_value; 8002f04: 29 81 00 08 lw r1,(r12+8) 8002f08: 59 61 00 48 sw (r11+72),r1 uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), 8002f0c: 29 6c 00 08 lw r12,(r11+8) _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; _Thread_Enable_dispatch(); return 0; } 8002f10: 78 01 08 01 mvhi r1,0x801 8002f14: 38 21 fb 8c ori r1,r1,0xfb8c #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; 8002f18: 28 2e 00 1c lw r14,(r1+28) 8002f1c: 34 02 00 02 mvi r2,2 ptimer->inf.sigev_notify = evp->sigev_notify; ptimer->inf.sigev_signo = evp->sigev_signo; ptimer->inf.sigev_value = evp->sigev_value; } ptimer->overrun = 0; 8002f20: 59 60 00 68 sw (r11+104),r0 ptimer->timer_data.it_value.tv_sec = 0; 8002f24: 59 60 00 5c sw (r11+92),r0 ptimer->timer_data.it_value.tv_nsec = 0; 8002f28: 59 60 00 60 sw (r11+96),r0 ptimer->timer_data.it_interval.tv_sec = 0; 8002f2c: 59 60 00 54 sw (r11+84),r0 ptimer->timer_data.it_interval.tv_nsec = 0; 8002f30: 59 60 00 58 sw (r11+88),r0 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 8002f34: 59 60 00 18 sw (r11+24),r0 the_watchdog->routine = routine; 8002f38: 59 60 00 2c sw (r11+44),r0 the_watchdog->id = id; 8002f3c: 59 60 00 30 sw (r11+48),r0 the_watchdog->user_data = user_data; 8002f40: 59 60 00 34 sw (r11+52),r0 8002f44: 21 81 ff ff andi r1,r12,0xffff 8002f48: f8 00 62 e7 calli 801bae4 <__ashlsi3> 8002f4c: b5 c1 08 00 add r1,r14,r1 8002f50: 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; 8002f54: 59 60 00 0c sw (r11+12),r0 _Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL ); _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; 8002f58: 59 ac 00 00 sw (r13+0),r12 _Thread_Enable_dispatch(); 8002f5c: f8 00 0b 45 calli 8005c70 <_Thread_Enable_dispatch> return 0; 8002f60: 34 01 00 00 mvi r1,0 } 8002f64: 2b 9d 00 04 lw ra,(sp+4) 8002f68: 2b 8b 00 14 lw r11,(sp+20) 8002f6c: 2b 8c 00 10 lw r12,(sp+16) 8002f70: 2b 8d 00 0c lw r13,(sp+12) 8002f74: 2b 8e 00 08 lw r14,(sp+8) 8002f78: 37 9c 00 14 addi sp,sp,20 8002f7c: c3 a0 00 00 ret =============================================================================== 08002f80 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { 8002f80: 37 9c ff cc addi sp,sp,-52 8002f84: 5b 8b 00 18 sw (sp+24),r11 8002f88: 5b 8c 00 14 sw (sp+20),r12 8002f8c: 5b 8d 00 10 sw (sp+16),r13 8002f90: 5b 8e 00 0c sw (sp+12),r14 8002f94: 5b 8f 00 08 sw (sp+8),r15 8002f98: 5b 9d 00 04 sw (sp+4),ra 8002f9c: b8 20 78 00 mv r15,r1 8002fa0: b8 40 58 00 mv r11,r2 8002fa4: b8 60 60 00 mv r12,r3 8002fa8: b8 80 68 00 mv r13,r4 Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) 8002fac: 44 60 00 69 be r3,r0,8003150 <== NEVER TAKEN /* * First, it verifies if the structure "value" is correct * if the number of nanoseconds is not correct return EINVAL */ if ( !_Timespec_Is_valid( &(value->it_value) ) ) { 8002fb0: 34 61 00 08 addi r1,r3,8 8002fb4: f8 00 0e b2 calli 8006a7c <_Timespec_Is_valid> 8002fb8: 44 20 00 66 be r1,r0,8003150 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { 8002fbc: b9 80 08 00 mv r1,r12 8002fc0: f8 00 0e af calli 8006a7c <_Timespec_Is_valid> 8002fc4: 44 20 00 63 be r1,r0,8003150 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { 8002fc8: 7d 62 00 00 cmpnei r2,r11,0 8002fcc: 7d 61 00 04 cmpnei r1,r11,4 8002fd0: a0 41 08 00 and r1,r2,r1 8002fd4: 5c 20 00 5f bne r1,r0,8003150 rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; 8002fd8: 29 81 00 0c lw r1,(r12+12) 8002fdc: 29 84 00 00 lw r4,(r12+0) 8002fe0: 29 83 00 04 lw r3,(r12+4) 8002fe4: 29 82 00 08 lw r2,(r12+8) 8002fe8: 5b 81 00 28 sw (sp+40),r1 8002fec: 5b 84 00 1c sw (sp+28),r4 8002ff0: 5b 83 00 20 sw (sp+32),r3 8002ff4: 5b 82 00 24 sw (sp+36),r2 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { 8002ff8: 34 01 00 04 mvi r1,4 8002ffc: 5d 61 00 0d bne r11,r1,8003030 struct timespec now; _TOD_Get( &now ); 8003000: 37 8b 00 2c addi r11,sp,44 8003004: b9 60 08 00 mv r1,r11 8003008: f8 00 04 f4 calli 80043d8 <_TOD_Get> /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) 800300c: 37 8e 00 24 addi r14,sp,36 8003010: b9 60 08 00 mv r1,r11 8003014: b9 c0 10 00 mv r2,r14 8003018: f8 00 0e 8e calli 8006a50 <_Timespec_Greater_than> 800301c: 5c 20 00 4d bne r1,r0,8003150 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); 8003020: b9 60 08 00 mv r1,r11 8003024: b9 c0 10 00 mv r2,r14 8003028: b9 c0 18 00 mv r3,r14 800302c: f8 00 0e a0 calli 8006aac <_Timespec_Subtract> timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) _Objects_Get( &_POSIX_Timer_Information, (Objects_Id) id, location ); 8003030: 78 03 08 01 mvhi r3,0x801 8003034: b8 60 08 00 mv r1,r3 8003038: b9 e0 10 00 mv r2,r15 800303c: 38 21 fb 8c ori r1,r1,0xfb8c 8003040: 37 83 00 34 addi r3,sp,52 8003044: f8 00 07 fb calli 8005030 <_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 ) { 8003048: 2b 82 00 34 lw r2,(sp+52) 800304c: b8 20 58 00 mv r11,r1 8003050: 5c 40 00 40 bne r2,r0,8003150 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 ) { 8003054: 2b 81 00 24 lw r1,(sp+36) 8003058: 5c 22 00 19 bne r1,r2,80030bc 800305c: 2b 8e 00 28 lw r14,(sp+40) 8003060: 5d c1 00 17 bne r14,r1,80030bc /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); 8003064: 35 61 00 10 addi r1,r11,16 8003068: f8 00 10 08 calli 8007088 <_Watchdog_Remove> /* The old data of the timer are returned */ if ( ovalue ) 800306c: 45 ae 00 09 be r13,r14,8003090 *ovalue = ptimer->timer_data; 8003070: 29 64 00 54 lw r4,(r11+84) 8003074: 29 63 00 58 lw r3,(r11+88) 8003078: 29 62 00 5c lw r2,(r11+92) 800307c: 29 61 00 60 lw r1,(r11+96) 8003080: 59 a4 00 00 sw (r13+0),r4 8003084: 59 a3 00 04 sw (r13+4),r3 8003088: 59 a2 00 08 sw (r13+8),r2 800308c: 59 a1 00 0c sw (r13+12),r1 /* The new data are set */ ptimer->timer_data = normalize; 8003090: 2b 81 00 1c lw r1,(sp+28) 8003094: 59 61 00 54 sw (r11+84),r1 8003098: 2b 81 00 20 lw r1,(sp+32) 800309c: 59 61 00 58 sw (r11+88),r1 80030a0: 2b 81 00 24 lw r1,(sp+36) 80030a4: 59 61 00 5c sw (r11+92),r1 80030a8: 2b 81 00 28 lw r1,(sp+40) 80030ac: 59 61 00 60 sw (r11+96),r1 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; 80030b0: 34 01 00 04 mvi r1,4 80030b4: 31 61 00 3c sb (r11+60),r1 80030b8: e0 00 00 23 bi 8003144 _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); 80030bc: b9 80 08 00 mv r1,r12 80030c0: f8 00 0e 8d calli 8006af4 <_Timespec_To_ticks> 80030c4: 59 61 00 64 sw (r11+100),r1 initial_period = _Timespec_To_ticks( &normalize.it_value ); 80030c8: 37 81 00 24 addi r1,sp,36 80030cc: f8 00 0e 8a calli 8006af4 <_Timespec_To_ticks> activated = _POSIX_Timer_Insert_helper( 80030d0: 29 63 00 08 lw r3,(r11+8) 80030d4: 78 04 08 00 mvhi r4,0x800 return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); initial_period = _Timespec_To_ticks( &normalize.it_value ); 80030d8: b8 20 10 00 mv r2,r1 activated = _POSIX_Timer_Insert_helper( 80030dc: 38 84 31 80 ori r4,r4,0x3180 80030e0: 35 61 00 10 addi r1,r11,16 80030e4: b9 60 28 00 mv r5,r11 80030e8: f8 00 1a a6 calli 8009b80 <_POSIX_Timer_Insert_helper> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { 80030ec: 44 20 00 16 be r1,r0,8003144 /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) 80030f0: 45 a0 00 09 be r13,r0,8003114 *ovalue = ptimer->timer_data; 80030f4: 29 64 00 54 lw r4,(r11+84) 80030f8: 29 63 00 58 lw r3,(r11+88) 80030fc: 29 62 00 5c lw r2,(r11+92) 8003100: 29 61 00 60 lw r1,(r11+96) 8003104: 59 a4 00 00 sw (r13+0),r4 8003108: 59 a3 00 04 sw (r13+4),r3 800310c: 59 a2 00 08 sw (r13+8),r2 8003110: 59 a1 00 0c sw (r13+12),r1 ptimer->timer_data = normalize; 8003114: 2b 81 00 1c lw r1,(sp+28) 8003118: 59 61 00 54 sw (r11+84),r1 800311c: 2b 81 00 20 lw r1,(sp+32) 8003120: 59 61 00 58 sw (r11+88),r1 8003124: 2b 81 00 24 lw r1,(sp+36) 8003128: 59 61 00 5c sw (r11+92),r1 800312c: 2b 81 00 28 lw r1,(sp+40) 8003130: 59 61 00 60 sw (r11+96),r1 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; 8003134: 34 01 00 03 mvi r1,3 8003138: 31 61 00 3c sb (r11+60),r1 _TOD_Get( &ptimer->time ); 800313c: 35 61 00 6c addi r1,r11,108 8003140: f8 00 04 a6 calli 80043d8 <_TOD_Get> _Thread_Enable_dispatch(); 8003144: f8 00 0a cb calli 8005c70 <_Thread_Enable_dispatch> return 0; 8003148: 34 01 00 00 mvi r1,0 800314c: e0 00 00 05 bi 8003160 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); 8003150: f8 00 29 24 calli 800d5e0 <__errno> 8003154: 34 02 00 16 mvi r2,22 8003158: 58 22 00 00 sw (r1+0),r2 800315c: 34 01 ff ff mvi r1,-1 } 8003160: 2b 9d 00 04 lw ra,(sp+4) 8003164: 2b 8b 00 18 lw r11,(sp+24) 8003168: 2b 8c 00 14 lw r12,(sp+20) 800316c: 2b 8d 00 10 lw r13,(sp+16) 8003170: 2b 8e 00 0c lw r14,(sp+12) 8003174: 2b 8f 00 08 lw r15,(sp+8) 8003178: 37 9c 00 34 addi sp,sp,52 800317c: c3 a0 00 00 ret =============================================================================== 08002d48 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 8002d48: 37 9c ff e8 addi sp,sp,-24 8002d4c: 5b 8b 00 10 sw (sp+16),r11 8002d50: 5b 8c 00 0c sw (sp+12),r12 8002d54: 5b 8d 00 08 sw (sp+8),r13 8002d58: 5b 9d 00 04 sw (sp+4),ra /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 8002d5c: 78 0b 08 01 mvhi r11,0x801 8002d60: 39 6b 71 88 ori r11,r11,0x7188 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { 8002d64: b8 20 68 00 mv r13,r1 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { 8002d68: 29 61 00 1c lw r1,(r11+28) 8002d6c: 5c 20 00 09 bne r1,r0,8002d90 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; 8002d70: 78 01 08 00 mvhi r1,0x800 8002d74: 38 21 2d 00 ori r1,r1,0x2d00 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; 8002d78: 59 60 00 08 sw (r11+8),r0 the_watchdog->routine = routine; 8002d7c: 59 61 00 1c sw (r11+28),r1 the_watchdog->id = id; 8002d80: 59 60 00 20 sw (r11+32),r0 the_watchdog->user_data = user_data; 8002d84: 59 60 00 24 sw (r11+36),r0 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 8002d88: 34 0c 00 00 mvi r12,0 8002d8c: e0 00 00 18 bi 8002dec if ( !the_timer->routine ) { _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); 8002d90: b9 60 08 00 mv r1,r11 8002d94: f8 00 0f 27 calli 8006a30 <_Watchdog_Remove> if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 8002d98: 34 21 ff fe addi r1,r1,-2 8002d9c: 34 02 00 01 mvi r2,1 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; 8002da0: 34 0c 00 00 mvi r12,0 _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); if ( (state == WATCHDOG_ACTIVE) || (state == WATCHDOG_REMOVE_IT) ) { 8002da4: 54 22 00 12 bgu r1,r2,8002dec <== NEVER TAKEN * 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); 8002da8: 29 61 00 0c lw r1,(r11+12) 8002dac: 29 62 00 14 lw r2,(r11+20) 8002db0: b4 41 10 00 add r2,r2,r1 8002db4: 29 61 00 18 lw r1,(r11+24) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); 8002db8: c8 41 08 00 sub r1,r2,r1 8002dbc: 37 82 00 14 addi r2,sp,20 8002dc0: f8 00 0d 52 calli 8006308 <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; 8002dc4: 78 03 08 01 mvhi r3,0x801 8002dc8: 38 63 4e 78 ori r3,r3,0x4e78 8002dcc: 28 62 00 00 lw r2,(r3+0) 8002dd0: 2b 81 00 14 lw r1,(sp+20) 8002dd4: f8 00 43 71 calli 8013b98 <__mulsi3> 8002dd8: b8 20 60 00 mv r12,r1 remaining += tp.tv_nsec / 1000; 8002ddc: 2b 81 00 18 lw r1,(sp+24) 8002de0: 34 02 03 e8 mvi r2,1000 8002de4: f8 00 43 79 calli 8013bc8 <__divsi3> 8002de8: b4 2c 60 00 add r12,r1,r12 /* * 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 ) { 8002dec: 45 a0 00 1a be r13,r0,8002e54 Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; 8002df0: 78 03 08 01 mvhi r3,0x801 8002df4: 38 63 4e 78 ori r3,r3,0x4e78 8002df8: 28 62 00 00 lw r2,(r3+0) 8002dfc: b9 a0 08 00 mv r1,r13 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); 8002e00: 37 8b 00 14 addi r11,sp,20 * 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; 8002e04: f8 00 43 ca calli 8013d2c <__udivsi3> tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 8002e08: 78 03 08 01 mvhi r3,0x801 8002e0c: 38 63 4e 78 ori r3,r3,0x4e78 8002e10: 28 62 00 00 lw r2,(r3+0) * 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; 8002e14: 5b 81 00 14 sw (sp+20),r1 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; 8002e18: b9 a0 08 00 mv r1,r13 8002e1c: f8 00 43 d4 calli 8013d6c <__umodsi3> 8002e20: 34 02 03 e8 mvi r2,1000 8002e24: f8 00 43 5d calli 8013b98 <__mulsi3> 8002e28: 5b 81 00 18 sw (sp+24),r1 ticks = _Timespec_To_ticks( &tp ); 8002e2c: b9 60 08 00 mv r1,r11 8002e30: f8 00 0d 64 calli 80063c0 <_Timespec_To_ticks> if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); 8002e34: b9 60 08 00 mv r1,r11 8002e38: f8 00 0d 62 calli 80063c0 <_Timespec_To_ticks> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; 8002e3c: 78 02 08 01 mvhi r2,0x801 8002e40: 38 42 71 88 ori r2,r2,0x7188 8002e44: 58 41 00 0c sw (r2+12),r1 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); 8002e48: 78 01 08 01 mvhi r1,0x801 8002e4c: 38 21 69 d8 ori r1,r1,0x69d8 8002e50: f8 00 0e 99 calli 80068b4 <_Watchdog_Insert> } return remaining; } 8002e54: b9 80 08 00 mv r1,r12 8002e58: 2b 9d 00 04 lw ra,(sp+4) 8002e5c: 2b 8b 00 10 lw r11,(sp+16) 8002e60: 2b 8c 00 0c lw r12,(sp+12) 8002e64: 2b 8d 00 08 lw r13,(sp+8) 8002e68: 37 9c 00 18 addi sp,sp,24 8002e6c: c3 a0 00 00 ret