=============================================================================== ffc0e7e0 : /** * We should ensure the ticks not be truncated by integer division. We * need to have it be greater than or equal to the requested time. It * should not be shorter. */ microseconds_per_tick = rtems_configuration_get_microseconds_per_tick(); ffc0e7e0: 3d 20 00 00 lis r9,0 ffc0e7e4: 80 09 20 28 lwz r0,8232(r9) ticks = microseconds / microseconds_per_tick; ffc0e7e8: 7d 23 03 96 divwu r9,r3,r0 if ( (microseconds % microseconds_per_tick) != 0 ) ffc0e7ec: 7c 09 01 d6 mullw r0,r9,r0 ffc0e7f0: 7f 83 00 00 cmpw cr7,r3,r0 ffc0e7f4: 41 9e 00 08 beq- cr7,ffc0e7fc <== ALWAYS TAKEN ticks += 1; ffc0e7f8: 39 29 00 01 addi r9,r9,1 <== NOT EXECUTED return ticks; } ffc0e7fc: 7d 23 4b 78 mr r3,r9 ffc0e800: 4e 80 00 20 blr =============================================================================== ffc09a50 : /** * We should ensure the ticks not be truncated by integer division. We * need to have it be greater than or equal to the requested time. It * should not be shorter. */ milliseconds_per_tick = rtems_configuration_get_milliseconds_per_tick(); ffc09a50: 3d 20 00 00 lis r9,0 ffc09a54: 81 29 20 10 lwz r9,8208(r9) ffc09a58: 38 00 03 e8 li r0,1000 ffc09a5c: 7c 09 03 96 divwu r0,r9,r0 ticks = milliseconds / milliseconds_per_tick; ffc09a60: 7d 23 03 96 divwu r9,r3,r0 if ( (milliseconds % milliseconds_per_tick) != 0 ) ffc09a64: 7c 09 01 d6 mullw r0,r9,r0 ffc09a68: 7f 83 00 00 cmpw cr7,r3,r0 ffc09a6c: 41 9e 00 08 beq- cr7,ffc09a74 <== ALWAYS TAKEN ticks += 1; ffc09a70: 39 29 00 01 addi r9,r9,1 <== NOT EXECUTED return ticks; } ffc09a74: 7d 23 4b 78 mr r3,r9 ffc09a78: 4e 80 00 20 blr =============================================================================== ffc0b144 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0b144: 7c 2b 0b 78 mr r11,r1 ffc0b148: 7c 08 02 a6 mflr r0 ffc0b14c: 94 21 ff f0 stwu r1,-16(r1) ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0b150: 3d 20 00 00 lis r9,0 */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0b154: 90 01 00 14 stw r0,20(r1) ffc0b158: 48 00 ce 61 bl ffc17fb8 <_savegpr_31> ffc0b15c: 7c 7f 1b 78 mr r31,r3 ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0b160: 81 69 31 30 lwz r11,12592(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0b164: 7c 00 00 a6 mfmsr r0 ffc0b168: 7d 30 42 a6 mfsprg r9,0 ffc0b16c: 7c 09 48 78 andc r9,r0,r9 ffc0b170: 7d 20 01 24 mtmsr r9 * If locked for reading and no waiters, then OK to read. * If any thread is waiting, then we wait. */ _ISR_Disable( level ); if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ ffc0b174: 81 23 00 44 lwz r9,68(r3) ffc0b178: 2f 89 00 00 cmpwi cr7,r9,0 ffc0b17c: 40 be 00 14 bne+ cr7,ffc0b190 <_CORE_RWLock_Release+0x4c> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0b180: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; ffc0b184: 38 00 00 02 li r0,2 ffc0b188: 90 0b 00 34 stw r0,52(r11) return CORE_RWLOCK_SUCCESSFUL; ffc0b18c: 48 00 00 a8 b ffc0b234 <_CORE_RWLock_Release+0xf0> } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { ffc0b190: 2f 89 00 01 cmpwi cr7,r9,1 ffc0b194: 40 9e 00 20 bne- cr7,ffc0b1b4 <_CORE_RWLock_Release+0x70> the_rwlock->number_of_readers -= 1; ffc0b198: 81 23 00 48 lwz r9,72(r3) ffc0b19c: 39 29 ff ff addi r9,r9,-1 if ( the_rwlock->number_of_readers != 0 ) { ffc0b1a0: 2f 89 00 00 cmpwi cr7,r9,0 _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { the_rwlock->number_of_readers -= 1; ffc0b1a4: 91 23 00 48 stw r9,72(r3) if ( the_rwlock->number_of_readers != 0 ) { ffc0b1a8: 41 be 00 0c beq+ cr7,ffc0b1b4 <_CORE_RWLock_Release+0x70> ffc0b1ac: 7c 00 01 24 mtmsr r0 /* must be unlocked again */ _ISR_Enable( level ); return CORE_RWLOCK_SUCCESSFUL; ffc0b1b0: 48 00 00 84 b ffc0b234 <_CORE_RWLock_Release+0xf0> } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; ffc0b1b4: 39 20 00 00 li r9,0 ffc0b1b8: 91 2b 00 34 stw r9,52(r11) /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; ffc0b1bc: 91 3f 00 44 stw r9,68(r31) ffc0b1c0: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); ffc0b1c4: 7f e3 fb 78 mr r3,r31 ffc0b1c8: 48 00 1e f5 bl ffc0d0bc <_Thread_queue_Dequeue> if ( next ) { ffc0b1cc: 2c 03 00 00 cmpwi r3,0 ffc0b1d0: 41 82 00 64 beq- ffc0b234 <_CORE_RWLock_Release+0xf0> if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { ffc0b1d4: 80 03 00 30 lwz r0,48(r3) ffc0b1d8: 2f 80 00 01 cmpwi cr7,r0,1 ffc0b1dc: 40 be 00 10 bne+ cr7,ffc0b1ec <_CORE_RWLock_Release+0xa8> the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; ffc0b1e0: 38 00 00 02 li r0,2 ffc0b1e4: 90 1f 00 44 stw r0,68(r31) return CORE_RWLOCK_SUCCESSFUL; ffc0b1e8: 48 00 00 4c b ffc0b234 <_CORE_RWLock_Release+0xf0> } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; ffc0b1ec: 81 3f 00 48 lwz r9,72(r31) ffc0b1f0: 38 09 00 01 addi r0,r9,1 ffc0b1f4: 90 1f 00 48 stw r0,72(r31) the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; ffc0b1f8: 38 00 00 01 li r0,1 ffc0b1fc: 90 1f 00 44 stw r0,68(r31) /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); ffc0b200: 7f e3 fb 78 mr r3,r31 ffc0b204: 48 00 24 15 bl ffc0d618 <_Thread_queue_First> if ( !next || ffc0b208: 7c 64 1b 79 mr. r4,r3 ffc0b20c: 41 82 00 28 beq- ffc0b234 <_CORE_RWLock_Release+0xf0> ffc0b210: 80 04 00 30 lwz r0,48(r4) ffc0b214: 2f 80 00 01 cmpwi cr7,r0,1 ffc0b218: 41 9e 00 1c beq- cr7,ffc0b234 <_CORE_RWLock_Release+0xf0><== NEVER TAKEN next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; ffc0b21c: 81 3f 00 48 lwz r9,72(r31) _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); ffc0b220: 7f e3 fb 78 mr r3,r31 while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); if ( !next || next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; ffc0b224: 38 09 00 01 addi r0,r9,1 ffc0b228: 90 1f 00 48 stw r0,72(r31) _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); ffc0b22c: 48 00 22 81 bl ffc0d4ac <_Thread_queue_Extract> } ffc0b230: 4b ff ff d0 b ffc0b200 <_CORE_RWLock_Release+0xbc> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0b234: 39 61 00 10 addi r11,r1,16 ffc0b238: 38 60 00 00 li r3,0 ffc0b23c: 4b ff 6a 04 b ffc01c40 <_restgpr_31_x> =============================================================================== ffc0b240 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0b240: 94 21 ff e8 stwu r1,-24(r1) ffc0b244: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0b248: 38 81 00 08 addi r4,r1,8 void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0b24c: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0b250: 48 00 1a f1 bl ffc0cd40 <_Thread_Get> switch ( location ) { ffc0b254: 80 01 00 08 lwz r0,8(r1) ffc0b258: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b25c: 40 9e 00 1c bne- cr7,ffc0b278 <_CORE_RWLock_Timeout+0x38><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); ffc0b260: 48 00 24 d1 bl ffc0d730 <_Thread_queue_Process_timeout> * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc0b264: 3d 20 00 00 lis r9,0 ffc0b268: 81 69 28 34 lwz r11,10292(r9) ffc0b26c: 38 0b ff ff addi r0,r11,-1 ffc0b270: 90 09 28 34 stw r0,10292(r9) return _Thread_Dispatch_disable_level; ffc0b274: 80 09 28 34 lwz r0,10292(r9) _Thread_Unnest_dispatch(); break; } } ffc0b278: 80 01 00 1c lwz r0,28(r1) ffc0b27c: 38 21 00 18 addi r1,r1,24 ffc0b280: 7c 08 03 a6 mtlr r0 ffc0b284: 4e 80 00 20 blr =============================================================================== ffc11b88 <_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 ) { ffc11b88: 94 21 ff e0 stwu r1,-32(r1) ffc11b8c: 7c 08 02 a6 mflr r0 ffc11b90: 90 01 00 24 stw r0,36(r1) size_t message_buffering_required = 0; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; the_message_queue->number_of_pending_messages = 0; ffc11b94: 38 00 00 00 li r0,0 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 ) { ffc11b98: bf 81 00 10 stmw r28,16(r1) ffc11b9c: 7c 7f 1b 78 mr r31,r3 ffc11ba0: 7c 9d 23 78 mr r29,r4 size_t message_buffering_required = 0; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; the_message_queue->number_of_pending_messages = 0; ffc11ba4: 90 03 00 48 stw r0,72(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)) { ffc11ba8: 7c dc 33 78 mr r28,r6 CORE_message_queue_Control *the_message_queue, CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; ffc11bac: 90 03 00 60 stw r0,96(r3) the_message_queue->notify_argument = the_argument; ffc11bb0: 90 03 00 64 stw r0,100(r3) ffc11bb4: 70 c0 00 03 andi. r0,r6,3 ) { size_t message_buffering_required = 0; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; ffc11bb8: 90 a3 00 44 stw r5,68(r3) the_message_queue->number_of_pending_messages = 0; the_message_queue->maximum_message_size = maximum_message_size; ffc11bbc: 90 c3 00 4c stw r6,76(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)) { ffc11bc0: 41 82 00 18 beq- ffc11bd8 <_CORE_message_queue_Initialize+0x50> allocated_message_size += sizeof(uint32_t); ffc11bc4: 3b 86 00 04 addi r28,r6,4 allocated_message_size &= ~(sizeof(uint32_t) - 1); ffc11bc8: 57 9c 00 3a rlwinm r28,r28,0,0,29 } if (allocated_message_size < maximum_message_size) ffc11bcc: 7f 9c 30 40 cmplw cr7,r28,r6 return false; ffc11bd0: 3b c0 00 00 li r30,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) ffc11bd4: 41 bc 00 80 blt+ cr7,ffc11c54 <_CORE_message_queue_Initialize+0xcc><== NEVER TAKEN /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ if ( !size_t_mult32_with_overflow( ffc11bd8: 3b 9c 00 14 addi r28,r28,20 size_t a, size_t b, size_t *c ) { long long x = (long long)a*b; ffc11bdc: 7d 45 e0 16 mulhwu r10,r5,r28 ffc11be0: 7d 65 e1 d6 mullw r11,r5,r28 if ( x > SIZE_MAX ) ffc11be4: 2f 8a 00 00 cmpwi cr7,r10,0 */ if ( !size_t_mult32_with_overflow( (size_t) maximum_pending_messages, allocated_message_size + sizeof(CORE_message_queue_Buffer_control), &message_buffering_required ) ) return false; ffc11be8: 3b c0 00 00 li r30,0 size_t *c ) { long long x = (long long)a*b; if ( x > SIZE_MAX ) ffc11bec: 41 9d 00 68 bgt- cr7,ffc11c54 <_CORE_message_queue_Initialize+0xcc> /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); ffc11bf0: 7d 63 5b 78 mr r3,r11 ffc11bf4: 90 a1 00 08 stw r5,8(r1) ffc11bf8: 48 00 33 ed bl ffc14fe4 <_Workspace_Allocate> if (the_message_queue->message_buffers == 0) ffc11bfc: 2f 83 00 00 cmpwi cr7,r3,0 return false; /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) ffc11c00: 90 7f 00 5c stw r3,92(r31) _Workspace_Allocate( message_buffering_required ); ffc11c04: 7c 64 1b 78 mr r4,r3 if (the_message_queue->message_buffers == 0) ffc11c08: 80 a1 00 08 lwz r5,8(r1) ffc11c0c: 41 9e 00 48 beq- cr7,ffc11c54 <_CORE_message_queue_Initialize+0xcc> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( ffc11c10: 38 7f 00 68 addi r3,r31,104 ffc11c14: 7f 86 e3 78 mr r6,r28 ffc11c18: 48 00 5a fd bl ffc17714 <_Chain_Initialize> allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( ffc11c1c: 80 9d 00 00 lwz r4,0(r29) 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 ); ffc11c20: 38 1f 00 50 addi r0,r31,80 head->next = tail; head->previous = NULL; ffc11c24: 93 df 00 54 stw r30,84(r31) 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 ); ffc11c28: 39 3f 00 54 addi r9,r31,84 ffc11c2c: 68 84 00 01 xori r4,r4,1 head->next = tail; ffc11c30: 91 3f 00 50 stw r9,80(r31) ffc11c34: 7c 84 00 34 cntlzw r4,r4 head->previous = NULL; tail->previous = head; ffc11c38: 90 1f 00 58 stw r0,88(r31) ffc11c3c: 7f e3 fb 78 mr r3,r31 ffc11c40: 54 84 d9 7e rlwinm r4,r4,27,5,31 ffc11c44: 38 a0 00 80 li r5,128 ffc11c48: 38 c0 00 06 li r6,6 ffc11c4c: 48 00 29 21 bl ffc1456c <_Thread_queue_Initialize> THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; ffc11c50: 3b c0 00 01 li r30,1 } ffc11c54: 39 61 00 20 addi r11,r1,32 ffc11c58: 7f c3 f3 78 mr r3,r30 ffc11c5c: 4b ff 3d 7c b ffc059d8 <_restgpr_28_x> =============================================================================== ffc090d8 <_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 ) { ffc090d8: 7c 08 02 a6 mflr r0 ffc090dc: 7c 2b 0b 78 mr r11,r1 ffc090e0: 94 21 ff f0 stwu r1,-16(r1) ffc090e4: 90 01 00 14 stw r0,20(r1) ffc090e8: 48 01 22 65 bl ffc1b34c <_savegpr_31> ffc090ec: 7c 7f 1b 78 mr r31,r3 ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { ffc090f0: 48 00 1d 79 bl ffc0ae68 <_Thread_queue_Dequeue> ffc090f4: 2f 83 00 00 cmpwi cr7,r3,0 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc090f8: 38 00 00 00 li r0,0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { ffc090fc: 40 be 00 38 bne+ cr7,ffc09134 <_CORE_semaphore_Surrender+0x5c> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc09100: 7d 60 00 a6 mfmsr r11 ffc09104: 7c 10 42 a6 mfsprg r0,0 ffc09108: 7d 60 00 78 andc r0,r11,r0 ffc0910c: 7c 00 01 24 mtmsr r0 (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) ffc09110: 81 3f 00 48 lwz r9,72(r31) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; ffc09114: 38 00 00 04 li r0,4 (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) ffc09118: 81 5f 00 40 lwz r10,64(r31) ffc0911c: 7f 89 50 40 cmplw cr7,r9,r10 ffc09120: 40 9c 00 10 bge- cr7,ffc09130 <_CORE_semaphore_Surrender+0x58><== NEVER TAKEN the_semaphore->count += 1; ffc09124: 39 29 00 01 addi r9,r9,1 ffc09128: 91 3f 00 48 stw r9,72(r31) { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc0912c: 38 00 00 00 li r0,0 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc09130: 7d 60 01 24 mtmsr r11 status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } ffc09134: 39 61 00 10 addi r11,r1,16 ffc09138: 7c 03 03 78 mr r3,r0 ffc0913c: 4b ff 74 08 b ffc00544 <_restgpr_31_x> =============================================================================== ffc07c5c <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { ffc07c5c: 7c 2b 0b 78 mr r11,r1 ffc07c60: 7c 08 02 a6 mflr r0 ffc07c64: 94 21 ff f0 stwu r1,-16(r1) ffc07c68: 90 01 00 14 stw r0,20(r1) ffc07c6c: 48 01 36 e1 bl ffc1b34c <_savegpr_31> ffc07c70: 7c 7f 1b 78 mr r31,r3 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 ]; ffc07c74: 81 03 01 30 lwz r8,304(r3) option_set = (rtems_option) the_thread->Wait.option; ffc07c78: 80 e3 00 30 lwz r7,48(r3) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc07c7c: 7c 00 00 a6 mfmsr r0 ffc07c80: 7d 30 42 a6 mfsprg r9,0 ffc07c84: 7c 09 48 78 andc r9,r0,r9 ffc07c88: 7d 20 01 24 mtmsr r9 _ISR_Disable( level ); pending_events = api->pending_events; ffc07c8c: 81 68 00 00 lwz r11,0(r8) event_condition = (rtems_event_set) the_thread->Wait.count; ffc07c90: 81 43 00 24 lwz r10,36(r3) seized_events = _Event_sets_Get( pending_events, event_condition ); /* * No events were seized in this operation */ if ( _Event_sets_Is_empty( seized_events ) ) { ffc07c94: 7d 49 58 39 and. r9,r10,r11 ffc07c98: 41 82 00 f4 beq- ffc07d8c <_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() && ffc07c9c: 3c c0 00 00 lis r6,0 ffc07ca0: 38 c6 31 44 addi r6,r6,12612 ffc07ca4: 80 a6 00 08 lwz r5,8(r6) ffc07ca8: 2f 85 00 00 cmpwi cr7,r5,0 ffc07cac: 41 9e 00 64 beq- cr7,ffc07d10 <_Event_Surrender+0xb4> ffc07cb0: 80 c6 00 0c lwz r6,12(r6) ffc07cb4: 7f 83 30 00 cmpw cr7,r3,r6 ffc07cb8: 40 be 00 58 bne+ cr7,ffc07d10 <_Event_Surrender+0xb4> _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || ffc07cbc: 3c c0 00 00 lis r6,0 ffc07cc0: 80 a6 28 54 lwz r5,10324(r6) /* * 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 ) && ffc07cc4: 2f 85 00 02 cmpwi cr7,r5,2 ffc07cc8: 41 9e 00 10 beq- cr7,ffc07cd8 <_Event_Surrender+0x7c> <== NEVER TAKEN ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { ffc07ccc: 80 c6 28 54 lwz r6,10324(r6) * 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) || ffc07cd0: 2f 86 00 01 cmpwi cr7,r6,1 ffc07cd4: 40 be 00 3c bne+ cr7,ffc07d10 <_Event_Surrender+0xb4> (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { ffc07cd8: 7f 89 50 00 cmpw cr7,r9,r10 ffc07cdc: 41 9e 00 0c beq- cr7,ffc07ce8 <_Event_Surrender+0x8c> ffc07ce0: 70 e5 00 02 andi. r5,r7,2 ffc07ce4: 41 82 00 a8 beq- ffc07d8c <_Event_Surrender+0x130> <== NEVER TAKEN 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) ); ffc07ce8: 7d 6b 48 78 andc r11,r11,r9 api->pending_events = _Event_sets_Clear( pending_events,seized_events ); ffc07cec: 91 68 00 00 stw r11,0(r8) the_thread->Wait.count = 0; ffc07cf0: 39 60 00 00 li r11,0 ffc07cf4: 91 7f 00 24 stw r11,36(r31) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc07cf8: 81 7f 00 28 lwz r11,40(r31) ffc07cfc: 91 2b 00 00 stw r9,0(r11) _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; ffc07d00: 39 60 00 03 li r11,3 ffc07d04: 3d 20 00 00 lis r9,0 ffc07d08: 91 69 28 54 stw r11,10324(r9) ffc07d0c: 48 00 00 80 b ffc07d8c <_Event_Surrender+0x130> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); ffc07d10: 80 df 00 10 lwz r6,16(r31) } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { ffc07d14: 70 c5 01 00 andi. r5,r6,256 ffc07d18: 41 82 00 74 beq- ffc07d8c <_Event_Surrender+0x130> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { ffc07d1c: 7f 89 50 00 cmpw cr7,r9,r10 ffc07d20: 41 9e 00 0c beq- cr7,ffc07d2c <_Event_Surrender+0xd0> ffc07d24: 70 ea 00 02 andi. r10,r7,2 ffc07d28: 41 82 00 64 beq- ffc07d8c <_Event_Surrender+0x130> <== NEVER TAKEN ffc07d2c: 7d 6b 48 78 andc r11,r11,r9 api->pending_events = _Event_sets_Clear( pending_events, seized_events ); ffc07d30: 91 68 00 00 stw r11,0(r8) the_thread->Wait.count = 0; ffc07d34: 39 60 00 00 li r11,0 ffc07d38: 91 7f 00 24 stw r11,36(r31) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc07d3c: 81 7f 00 28 lwz r11,40(r31) ffc07d40: 91 2b 00 00 stw r9,0(r11) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc07d44: 7d 20 00 a6 mfmsr r9 ffc07d48: 7c 00 01 24 mtmsr r0 ffc07d4c: 7d 20 01 24 mtmsr r9 _ISR_Flash( level ); if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { ffc07d50: 81 3f 00 50 lwz r9,80(r31) ffc07d54: 2f 89 00 02 cmpwi cr7,r9,2 ffc07d58: 41 9e 00 0c beq- cr7,ffc07d64 <_Event_Surrender+0x108> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc07d5c: 7c 00 01 24 mtmsr r0 ffc07d60: 48 00 00 18 b ffc07d78 <_Event_Surrender+0x11c> RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; ffc07d64: 39 20 00 03 li r9,3 ffc07d68: 91 3f 00 50 stw r9,80(r31) ffc07d6c: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); ffc07d70: 38 7f 00 48 addi r3,r31,72 ffc07d74: 48 00 3e 19 bl ffc0bb8c <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc07d78: 3c 80 10 03 lis r4,4099 ffc07d7c: 7f e3 fb 78 mr r3,r31 ffc07d80: 60 84 ff f8 ori r4,r4,65528 ffc07d84: 48 00 29 69 bl ffc0a6ec <_Thread_Clear_state> ffc07d88: 48 00 00 08 b ffc07d90 <_Event_Surrender+0x134> ffc07d8c: 7c 00 01 24 mtmsr r0 } return; } } _ISR_Enable( level ); } ffc07d90: 39 61 00 10 addi r11,r1,16 ffc07d94: 4b ff 87 b0 b ffc00544 <_restgpr_31_x> =============================================================================== ffc07d98 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { ffc07d98: 94 21 ff e8 stwu r1,-24(r1) ffc07d9c: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc07da0: 38 81 00 08 addi r4,r1,8 void _Event_Timeout( Objects_Id id, void *ignored ) { ffc07da4: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc07da8: 48 00 2d 45 bl ffc0aaec <_Thread_Get> switch ( location ) { ffc07dac: 80 01 00 08 lwz r0,8(r1) ffc07db0: 2f 80 00 00 cmpwi cr7,r0,0 ffc07db4: 40 9e 00 6c bne- cr7,ffc07e20 <_Event_Timeout+0x88> <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc07db8: 7d 60 00 a6 mfmsr r11 ffc07dbc: 7d 30 42 a6 mfsprg r9,0 ffc07dc0: 7d 69 48 78 andc r9,r11,r9 ffc07dc4: 7d 20 01 24 mtmsr r9 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc07dc8: 3d 20 00 00 lis r9,0 _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; ffc07dcc: 90 03 00 24 stw r0,36(r3) if ( _Thread_Is_executing( the_thread ) ) { ffc07dd0: 80 09 31 50 lwz r0,12624(r9) ffc07dd4: 7f 83 00 00 cmpw cr7,r3,r0 ffc07dd8: 40 be 00 1c bne+ cr7,ffc07df4 <_Event_Timeout+0x5c> if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) ffc07ddc: 3d 20 00 00 lis r9,0 ffc07de0: 80 09 28 54 lwz r0,10324(r9) ffc07de4: 2f 80 00 01 cmpwi cr7,r0,1 ffc07de8: 40 be 00 0c bne+ cr7,ffc07df4 <_Event_Timeout+0x5c> _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; ffc07dec: 38 00 00 02 li r0,2 ffc07df0: 90 09 28 54 stw r0,10324(r9) } the_thread->Wait.return_code = RTEMS_TIMEOUT; ffc07df4: 38 00 00 06 li r0,6 ffc07df8: 90 03 00 34 stw r0,52(r3) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc07dfc: 7d 60 01 24 mtmsr r11 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc07e00: 3c 80 10 03 lis r4,4099 ffc07e04: 60 84 ff f8 ori r4,r4,65528 ffc07e08: 48 00 28 e5 bl ffc0a6ec <_Thread_Clear_state> * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc07e0c: 3d 20 00 00 lis r9,0 ffc07e10: 81 69 28 0c lwz r11,10252(r9) ffc07e14: 38 0b ff ff addi r0,r11,-1 ffc07e18: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc07e1c: 80 09 28 0c lwz r0,10252(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc07e20: 80 01 00 1c lwz r0,28(r1) ffc07e24: 38 21 00 18 addi r1,r1,24 ffc07e28: 7c 08 03 a6 mtlr r0 ffc07e2c: 4e 80 00 20 blr =============================================================================== ffc0e53c <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc0e53c: 94 21 ff c0 stwu r1,-64(r1) ffc0e540: 7c 08 02 a6 mflr r0 ffc0e544: be c1 00 18 stmw r22,24(r1) Heap_Block *extend_first_block = NULL; Heap_Block *extend_last_block = NULL; uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const extend_area_begin = (uintptr_t) extend_area_begin_ptr; uintptr_t const extend_area_end = extend_area_begin + extend_area_size; ffc0e548: 7f c4 2a 14 add r30,r4,r5 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 ) { ffc0e54c: 7f 9e 20 40 cmplw cr7,r30,r4 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc0e550: 90 01 00 44 stw r0,68(r1) 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; ffc0e554: 3b 40 00 00 li r26,0 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc0e558: 7c d9 33 78 mr r25,r6 ffc0e55c: 7c 7f 1b 78 mr r31,r3 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; ffc0e560: 83 83 00 20 lwz r28,32(r3) Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc0e564: 7c 9d 23 78 mr r29,r4 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; ffc0e568: 93 41 00 0c stw r26,12(r1) 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; ffc0e56c: 38 00 00 00 li r0,0 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; Heap_Block *extend_last_block = NULL; ffc0e570: 93 41 00 08 stw r26,8(r1) uintptr_t const page_size = heap->page_size; ffc0e574: 83 63 00 10 lwz r27,16(r3) uintptr_t const min_block_size = heap->min_block_size; ffc0e578: 80 c3 00 14 lwz r6,20(r3) 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; ffc0e57c: 83 03 00 30 lwz r24,48(r3) uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { ffc0e580: 41 bc 02 70 blt+ cr7,ffc0e7f0 <_Heap_Extend+0x2b4> return false; } extend_area_ok = _Heap_Get_first_and_last_block( ffc0e584: 7c 83 23 78 mr r3,r4 ffc0e588: 38 e1 00 0c addi r7,r1,12 ffc0e58c: 7c a4 2b 78 mr r4,r5 ffc0e590: 39 01 00 08 addi r8,r1,8 ffc0e594: 7f 65 db 78 mr r5,r27 ffc0e598: 4b ff aa bd bl ffc09054 <_Heap_Get_first_and_last_block> &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { /* For simplicity we reject extend areas that are too small */ return false; ffc0e59c: 7f 40 d3 78 mr r0,r26 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { ffc0e5a0: 2f 83 00 00 cmpwi cr7,r3,0 ffc0e5a4: 41 9e 02 4c beq- cr7,ffc0e7f0 <_Heap_Extend+0x2b4> ffc0e5a8: 7f 89 e3 78 mr r9,r28 ffc0e5ac: 3a c0 00 00 li r22,0 ffc0e5b0: 39 40 00 00 li r10,0 ffc0e5b4: 3a e0 00 00 li r23,0 return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; ffc0e5b8: 7f 89 e0 00 cmpw cr7,r9,r28 ffc0e5bc: 7d 2b 4b 78 mr r11,r9 ffc0e5c0: 40 be 00 08 bne+ cr7,ffc0e5c8 <_Heap_Extend+0x8c> ffc0e5c4: 81 7f 00 18 lwz r11,24(r31) uintptr_t const sub_area_end = start_block->prev_size; ffc0e5c8: 80 09 00 00 lwz r0,0(r9) Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( ffc0e5cc: 7f 80 e8 40 cmplw cr7,r0,r29 ffc0e5d0: 40 9d 00 0c ble- cr7,ffc0e5dc <_Heap_Extend+0xa0> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ffc0e5d4: 7f 9e 58 40 cmplw cr7,r30,r11 ffc0e5d8: 41 9d 02 14 bgt- cr7,ffc0e7ec <_Heap_Extend+0x2b0> ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc0e5dc: 7f 9e 58 00 cmpw cr7,r30,r11 ffc0e5e0: 41 9e 00 10 beq- cr7,ffc0e5f0 <_Heap_Extend+0xb4> merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { ffc0e5e4: 7f 9e 00 40 cmplw cr7,r30,r0 ffc0e5e8: 41 9c 00 10 blt- cr7,ffc0e5f8 <_Heap_Extend+0xbc> ffc0e5ec: 48 00 00 10 b ffc0e5fc <_Heap_Extend+0xc0> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc0e5f0: 7d 37 4b 78 mr r23,r9 ffc0e5f4: 48 00 00 08 b ffc0e5fc <_Heap_Extend+0xc0> merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { ffc0e5f8: 7d 2a 4b 78 mr r10,r9 ffc0e5fc: 7d 60 db 96 divwu r11,r0,r27 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc0e600: 7f 80 e8 00 cmpw cr7,r0,r29 ffc0e604: 7d 6b d9 d6 mullw r11,r11,r27 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc0e608: 39 6b ff f8 addi r11,r11,-8 ffc0e60c: 40 be 00 10 bne+ cr7,ffc0e61c <_Heap_Extend+0xe0> start_block->prev_size = extend_area_end; ffc0e610: 93 c9 00 00 stw r30,0(r9) 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 ) ffc0e614: 7d 7a 5b 78 mr r26,r11 ffc0e618: 48 00 00 10 b ffc0e628 <_Heap_Extend+0xec> merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { ffc0e61c: 7f 80 e8 40 cmplw cr7,r0,r29 ffc0e620: 40 9c 00 08 bge- cr7,ffc0e628 <_Heap_Extend+0xec> ffc0e624: 7d 76 5b 78 mr r22,r11 - 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; ffc0e628: 81 2b 00 04 lwz r9,4(r11) ffc0e62c: 55 29 00 3c rlwinm r9,r9,0,0,30 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc0e630: 7d 29 5a 14 add r9,r9,r11 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); ffc0e634: 7f 89 e0 00 cmpw cr7,r9,r28 ffc0e638: 40 9e ff 80 bne+ cr7,ffc0e5b8 <_Heap_Extend+0x7c> if ( extend_area_begin < heap->area_begin ) { ffc0e63c: 80 1f 00 18 lwz r0,24(r31) ffc0e640: 7f 9d 00 40 cmplw cr7,r29,r0 ffc0e644: 40 9c 00 0c bge- cr7,ffc0e650 <_Heap_Extend+0x114> heap->area_begin = extend_area_begin; ffc0e648: 93 bf 00 18 stw r29,24(r31) ffc0e64c: 48 00 00 14 b ffc0e660 <_Heap_Extend+0x124> } else if ( heap->area_end < extend_area_end ) { ffc0e650: 80 1f 00 1c lwz r0,28(r31) ffc0e654: 7f 80 f0 40 cmplw cr7,r0,r30 ffc0e658: 40 9c 00 08 bge- cr7,ffc0e660 <_Heap_Extend+0x124> heap->area_end = extend_area_end; ffc0e65c: 93 df 00 1c stw r30,28(r31) } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; ffc0e660: 81 61 00 0c lwz r11,12(r1) ffc0e664: 81 21 00 08 lwz r9,8(r1) extend_first_block->prev_size = extend_area_end; ffc0e668: 93 cb 00 00 stw r30,0(r11) heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = ffc0e66c: 7c 0b 48 50 subf r0,r11,r9 (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; extend_first_block->size_and_flag = extend_first_block_size | HEAP_PREV_BLOCK_USED; ffc0e670: 60 08 00 01 ori r8,r0,1 _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; ffc0e674: 90 09 00 00 stw r0,0(r9) extend_last_block->size_and_flag = 0; ffc0e678: 38 00 00 00 li r0,0 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 = ffc0e67c: 91 0b 00 04 stw r8,4(r11) 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; ffc0e680: 90 09 00 04 stw r0,4(r9) _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { ffc0e684: 80 1f 00 20 lwz r0,32(r31) ffc0e688: 7f 80 58 40 cmplw cr7,r0,r11 ffc0e68c: 40 9d 00 0c ble- cr7,ffc0e698 <_Heap_Extend+0x15c> heap->first_block = extend_first_block; ffc0e690: 91 7f 00 20 stw r11,32(r31) ffc0e694: 48 00 00 14 b ffc0e6a8 <_Heap_Extend+0x16c> } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { ffc0e698: 80 1f 00 24 lwz r0,36(r31) ffc0e69c: 7f 80 48 40 cmplw cr7,r0,r9 ffc0e6a0: 40 9c 00 08 bge- cr7,ffc0e6a8 <_Heap_Extend+0x16c> heap->last_block = extend_last_block; ffc0e6a4: 91 3f 00 24 stw r9,36(r31) } if ( merge_below_block != NULL ) { ffc0e6a8: 2f 97 00 00 cmpwi cr7,r23,0 ffc0e6ac: 41 9e 00 48 beq- cr7,ffc0e6f4 <_Heap_Extend+0x1b8> Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; ffc0e6b0: 80 1f 00 10 lwz r0,16(r31) uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); ffc0e6b4: 3b bd 00 08 addi r29,r29,8 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; ffc0e6b8: 7d 3d 03 96 divwu r9,r29,r0 ffc0e6bc: 7d 29 01 d6 mullw r9,r9,r0 if ( remainder != 0 ) { ffc0e6c0: 7d 29 e8 51 subf. r9,r9,r29 ffc0e6c4: 41 82 00 0c beq- ffc0e6d0 <_Heap_Extend+0x194> <== NEVER TAKEN return value - remainder + alignment; ffc0e6c8: 7f bd 02 14 add r29,r29,r0 ffc0e6cc: 7f a9 e8 50 subf r29,r9,r29 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; ffc0e6d0: 80 17 00 00 lwz r0,0(r23) ) { 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 = ffc0e6d4: 38 9d ff f8 addi r4,r29,-8 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; _Heap_Free_block( heap, new_first_block ); ffc0e6d8: 7f e3 fb 78 mr r3,r31 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; ffc0e6dc: 90 1d ff f8 stw r0,-8(r29) 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 = ffc0e6e0: 7c 04 b8 50 subf r0,r4,r23 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; ffc0e6e4: 60 00 00 01 ori r0,r0,1 ffc0e6e8: 90 04 00 04 stw r0,4(r4) _Heap_Free_block( heap, new_first_block ); ffc0e6ec: 4b ff fe 15 bl ffc0e500 <_Heap_Free_block> ffc0e6f0: 48 00 00 1c b ffc0e70c <_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 ) { ffc0e6f4: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0e6f8: 41 9e 00 14 beq- cr7,ffc0e70c <_Heap_Extend+0x1d0> _Heap_Link_below( ffc0e6fc: 81 21 00 08 lwz r9,8(r1) { 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; ffc0e700: 7d 49 50 50 subf r10,r9,r10 ffc0e704: 61 4a 00 01 ori r10,r10,1 ) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = ffc0e708: 91 49 00 04 stw r10,4(r9) link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { ffc0e70c: 2f 9a 00 00 cmpwi cr7,r26,0 ffc0e710: 41 9e 00 4c beq- cr7,ffc0e75c <_Heap_Extend+0x220> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc0e714: 80 1f 00 10 lwz r0,16(r31) ) { 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, ffc0e718: 3b de ff f8 addi r30,r30,-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( ffc0e71c: 7f da f0 50 subf r30,r26,r30 ffc0e720: 7f de 03 96 divwu r30,r30,r0 ffc0e724: 7f de 01 d6 mullw r30,r30,r0 ); 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) ffc0e728: 80 1a 00 04 lwz r0,4(r26) | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); ffc0e72c: 7f e3 fb 78 mr r3,r31 ); 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) ffc0e730: 7c 1e 00 50 subf r0,r30,r0 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = ffc0e734: 7d 3e d2 14 add r9,r30,r26 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; ffc0e738: 60 00 00 01 ori r0,r0,1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = ffc0e73c: 90 09 00 04 stw r0,4(r9) (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 ); ffc0e740: 7f 44 d3 78 mr r4,r26 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; ffc0e744: 80 1a 00 04 lwz r0,4(r26) ffc0e748: 54 00 07 fe clrlwi r0,r0,31 block->size_and_flag = size | flag; ffc0e74c: 7f de 03 78 or r30,r30,r0 ffc0e750: 93 da 00 04 stw r30,4(r26) ffc0e754: 4b ff fd ad bl ffc0e500 <_Heap_Free_block> ffc0e758: 48 00 00 34 b ffc0e78c <_Heap_Extend+0x250> ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { ffc0e75c: 2f 96 00 00 cmpwi cr7,r22,0 ffc0e760: 41 9e 00 2c beq- cr7,ffc0e78c <_Heap_Extend+0x250> 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; ffc0e764: 81 76 00 04 lwz r11,4(r22) ) { 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 ); ffc0e768: 80 01 00 0c lwz r0,12(r1) ffc0e76c: 55 6b 07 fe clrlwi r11,r11,31 } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { _Heap_Link_above( ffc0e770: 81 21 00 08 lwz r9,8(r1) ) { 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 ); ffc0e774: 7c 16 00 50 subf r0,r22,r0 block->size_and_flag = size | flag; ffc0e778: 7d 60 03 78 or r0,r11,r0 ffc0e77c: 90 16 00 04 stw r0,4(r22) last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; ffc0e780: 80 09 00 04 lwz r0,4(r9) ffc0e784: 60 00 00 01 ori r0,r0,1 ffc0e788: 90 09 00 04 stw r0,4(r9) extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { ffc0e78c: 2f 97 00 00 cmpwi cr7,r23,0 ffc0e790: 40 be 00 18 bne+ cr7,ffc0e7a8 <_Heap_Extend+0x26c> ffc0e794: 2f 9a 00 00 cmpwi cr7,r26,0 ffc0e798: 40 be 00 10 bne+ cr7,ffc0e7a8 <_Heap_Extend+0x26c> _Heap_Free_block( heap, extend_first_block ); ffc0e79c: 80 81 00 0c lwz r4,12(r1) ffc0e7a0: 7f e3 fb 78 mr r3,r31 ffc0e7a4: 4b ff fd 5d bl ffc0e500 <_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 ffc0e7a8: 81 3f 00 24 lwz r9,36(r31) extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; if ( extended_size_ptr != NULL ) ffc0e7ac: 2f 99 00 00 cmpwi cr7,r25,0 * 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( ffc0e7b0: 80 1f 00 20 lwz r0,32(r31) 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; ffc0e7b4: 81 69 00 04 lwz r11,4(r9) * 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( ffc0e7b8: 7c 09 00 50 subf r0,r9,r0 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; ffc0e7bc: 55 6b 07 fe clrlwi r11,r11,31 block->size_and_flag = size | flag; ffc0e7c0: 7d 60 03 78 or r0,r11,r0 ffc0e7c4: 90 09 00 04 stw r0,4(r9) _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; ffc0e7c8: 80 1f 00 30 lwz r0,48(r31) ffc0e7cc: 7f 18 00 50 subf r24,r24,r0 /* Statistics */ stats->size += extended_size; ffc0e7d0: 80 1f 00 2c lwz r0,44(r31) ffc0e7d4: 7c 00 c2 14 add r0,r0,r24 ffc0e7d8: 90 1f 00 2c stw r0,44(r31) if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; ffc0e7dc: 38 00 00 01 li r0,1 extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; if ( extended_size_ptr != NULL ) ffc0e7e0: 41 9e 00 10 beq- cr7,ffc0e7f0 <_Heap_Extend+0x2b4> <== NEVER TAKEN *extended_size_ptr = extended_size; ffc0e7e4: 93 19 00 00 stw r24,0(r25) ffc0e7e8: 48 00 00 08 b ffc0e7f0 <_Heap_Extend+0x2b4> _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; ffc0e7ec: 38 00 00 00 li r0,0 if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } ffc0e7f0: 39 61 00 40 addi r11,r1,64 ffc0e7f4: 7c 03 03 78 mr r3,r0 ffc0e7f8: 4b ff 1c e0 b ffc004d8 <_restgpr_22_x> =============================================================================== ffc0e87c <_Heap_Free>: return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { ffc0e87c: 7c 2b 0b 78 mr r11,r1 ffc0e880: 94 21 ff f0 stwu r1,-16(r1) ffc0e884: 7c 08 02 a6 mflr r0 ffc0e888: 7c 69 1b 78 mr r9,r3 ffc0e88c: 48 00 ca c1 bl ffc1b34c <_savegpr_31> /* * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { ffc0e890: 7c 8b 23 79 mr. r11,r4 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { ffc0e894: 90 01 00 14 stw r0,20(r1) * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { return true; ffc0e898: 38 60 00 01 li r3,1 /* * If NULL return true so a free on NULL is considered a valid release. This * is a special case that could be handled by the in heap check how-ever that * would result in false being returned which is wrong. */ if ( alloc_begin_ptr == NULL ) { ffc0e89c: 41 82 01 e8 beq- ffc0ea84 <_Heap_Free+0x208> ffc0e8a0: 80 09 00 10 lwz r0,16(r9) 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 ffc0e8a4: 80 a9 00 20 lwz r5,32(r9) RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc0e8a8: 7d 6b 03 96 divwu r11,r11,r0 ffc0e8ac: 7d 6b 01 d6 mullw r11,r11,r0 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; ffc0e8b0: 38 00 00 00 li r0,0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc0e8b4: 39 6b ff f8 addi r11,r11,-8 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; ffc0e8b8: 7f 8b 28 40 cmplw cr7,r11,r5 ffc0e8bc: 41 9c 00 14 blt- cr7,ffc0e8d0 <_Heap_Free+0x54> ffc0e8c0: 80 09 00 24 lwz r0,36(r9) ffc0e8c4: 7c 0b 00 10 subfc r0,r11,r0 ffc0e8c8: 38 00 00 00 li r0,0 ffc0e8cc: 7c 00 01 14 adde r0,r0,r0 } alloc_begin = (uintptr_t) alloc_begin_ptr; block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { ffc0e8d0: 2f 80 00 00 cmpwi cr7,r0,0 return false; ffc0e8d4: 38 60 00 00 li r3,0 } alloc_begin = (uintptr_t) alloc_begin_ptr; block = _Heap_Block_of_alloc_area( alloc_begin, heap->page_size ); if ( !_Heap_Is_block_in_heap( heap, block ) ) { ffc0e8d8: 41 9e 01 ac beq- cr7,ffc0ea84 <_Heap_Free+0x208> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc0e8dc: 80 cb 00 04 lwz r6,4(r11) ffc0e8e0: 38 00 00 00 li r0,0 - 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; ffc0e8e4: 54 c8 00 3c rlwinm r8,r6,0,0,30 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc0e8e8: 7d 48 5a 14 add r10,r8,r11 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; ffc0e8ec: 7f 8a 28 40 cmplw cr7,r10,r5 ffc0e8f0: 41 9c 00 14 blt- cr7,ffc0e904 <_Heap_Free+0x88> <== NEVER TAKEN ffc0e8f4: 80 09 00 24 lwz r0,36(r9) ffc0e8f8: 7c 0a 00 10 subfc r0,r10,r0 ffc0e8fc: 38 00 00 00 li r0,0 ffc0e900: 7c 00 01 14 adde r0,r0,r0 _Heap_Protection_block_check( heap, block ); block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { ffc0e904: 2f 80 00 00 cmpwi cr7,r0,0 return false; ffc0e908: 38 60 00 00 li r3,0 _Heap_Protection_block_check( heap, block ); block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { ffc0e90c: 41 9e 01 78 beq- cr7,ffc0ea84 <_Heap_Free+0x208> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc0e910: 80 0a 00 04 lwz r0,4(r10) return false; } _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_prev_used( next_block ) ) { ffc0e914: 70 04 00 01 andi. r4,r0,1 ffc0e918: 41 82 01 6c beq- ffc0ea84 <_Heap_Free+0x208> 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 ffc0e91c: 80 69 00 24 lwz r3,36(r9) - 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; ffc0e920: 54 00 00 3c rlwinm r0,r0,0,0,30 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); ffc0e924: 38 80 00 00 li r4,0 ffc0e928: 7f 8a 18 00 cmpw cr7,r10,r3 ffc0e92c: 41 9e 00 18 beq- cr7,ffc0e944 <_Heap_Free+0xc8> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc0e930: 7c ea 02 14 add r7,r10,r0 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; ffc0e934: 80 e7 00 04 lwz r7,4(r7) return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) ffc0e938: 70 ff 00 01 andi. r31,r7,1 ffc0e93c: 7c 80 00 26 mfcr r4 ffc0e940: 54 84 1f fe rlwinm r4,r4,3,31,31 next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { ffc0e944: 70 c7 00 01 andi. r7,r6,1 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 ffc0e948: 54 84 06 3e clrlwi r4,r4,24 && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); if ( !_Heap_Is_prev_used( block ) ) { ffc0e94c: 40 82 00 94 bne- ffc0e9e0 <_Heap_Free+0x164> uintptr_t const prev_size = block->prev_size; ffc0e950: 80 cb 00 00 lwz r6,0(r11) 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; ffc0e954: 39 80 00 00 li r12,0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc0e958: 7c e6 58 50 subf r7,r6,r11 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; ffc0e95c: 7f 87 28 40 cmplw cr7,r7,r5 ffc0e960: 41 9c 00 10 blt- cr7,ffc0e970 <_Heap_Free+0xf4> <== NEVER TAKEN ffc0e964: 7d 87 18 10 subfc r12,r7,r3 ffc0e968: 39 80 00 00 li r12,0 ffc0e96c: 7d 8c 61 14 adde r12,r12,r12 Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { ffc0e970: 2f 8c 00 00 cmpwi cr7,r12,0 _HAssert( false ); return( false ); ffc0e974: 38 60 00 00 li r3,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 ) ) { ffc0e978: 41 9e 01 0c beq- cr7,ffc0ea84 <_Heap_Free+0x208> <== 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; ffc0e97c: 80 a7 00 04 lwz r5,4(r7) 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) ) { ffc0e980: 70 bf 00 01 andi. r31,r5,1 ffc0e984: 41 82 01 00 beq- ffc0ea84 <_Heap_Free+0x208> <== NEVER TAKEN _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ ffc0e988: 2f 84 00 00 cmpwi cr7,r4,0 ffc0e98c: 7c c8 32 14 add r6,r8,r6 ffc0e990: 41 9e 00 34 beq- cr7,ffc0e9c4 <_Heap_Free+0x148> return _Heap_Free_list_tail(heap)->prev; } RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; ffc0e994: 81 6a 00 08 lwz r11,8(r10) uintptr_t const size = block_size + prev_size + next_block_size; ffc0e998: 7c c6 02 14 add r6,r6,r0 Heap_Block *prev = block->prev; ffc0e99c: 81 4a 00 0c lwz r10,12(r10) prev->next = next; ffc0e9a0: 91 6a 00 08 stw r11,8(r10) next->prev = prev; ffc0e9a4: 91 4b 00 0c stw r10,12(r11) _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc0e9a8: 81 69 00 38 lwz r11,56(r9) ffc0e9ac: 38 0b ff ff addi r0,r11,-1 ffc0e9b0: 90 09 00 38 stw r0,56(r9) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc0e9b4: 60 c0 00 01 ori r0,r6,1 ffc0e9b8: 90 07 00 04 stw r0,4(r7) next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; ffc0e9bc: 7c c6 39 2e stwx r6,r6,r7 ffc0e9c0: 48 00 00 9c b ffc0ea5c <_Heap_Free+0x1e0> } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc0e9c4: 60 c0 00 01 ori r0,r6,1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; ffc0e9c8: 7c c8 59 2e stwx r6,r8,r11 next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc0e9cc: 90 07 00 04 stw r0,4(r7) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; ffc0e9d0: 80 0a 00 04 lwz r0,4(r10) ffc0e9d4: 54 00 00 3c rlwinm r0,r0,0,0,30 ffc0e9d8: 90 0a 00 04 stw r0,4(r10) ffc0e9dc: 48 00 00 80 b ffc0ea5c <_Heap_Free+0x1e0> next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ ffc0e9e0: 2f 84 00 00 cmpwi cr7,r4,0 ffc0e9e4: 41 9e 00 30 beq- cr7,ffc0ea14 <_Heap_Free+0x198> RTEMS_INLINE_ROUTINE void _Heap_Free_list_replace( Heap_Block *old_block, Heap_Block *new_block ) { Heap_Block *next = old_block->next; ffc0e9e8: 80 ca 00 08 lwz r6,8(r10) uintptr_t const size = block_size + next_block_size; ffc0e9ec: 7c e0 42 14 add r7,r0,r8 Heap_Block *prev = old_block->prev; ffc0e9f0: 81 4a 00 0c lwz r10,12(r10) _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc0e9f4: 60 e0 00 01 ori r0,r7,1 new_block->next = next; ffc0e9f8: 90 cb 00 08 stw r6,8(r11) new_block->prev = prev; ffc0e9fc: 91 4b 00 0c stw r10,12(r11) next->prev = new_block; prev->next = new_block; ffc0ea00: 91 6a 00 08 stw r11,8(r10) Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; ffc0ea04: 91 66 00 0c stw r11,12(r6) ffc0ea08: 90 0b 00 04 stw r0,4(r11) next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; ffc0ea0c: 7c e7 59 2e stwx r7,r7,r11 ffc0ea10: 48 00 00 4c b ffc0ea5c <_Heap_Free+0x1e0> } 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; ffc0ea14: 61 00 00 01 ori r0,r8,1 RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; ffc0ea18: 80 e9 00 08 lwz r7,8(r9) ffc0ea1c: 90 0b 00 04 stw r0,4(r11) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; ffc0ea20: 80 0a 00 04 lwz r0,4(r10) new_block->next = next; ffc0ea24: 90 eb 00 08 stw r7,8(r11) ffc0ea28: 54 00 00 3c rlwinm r0,r0,0,0,30 new_block->prev = block_before; ffc0ea2c: 91 2b 00 0c stw r9,12(r11) next_block->prev_size = block_size; ffc0ea30: 7d 08 59 2e stwx r8,r8,r11 block_before->next = new_block; next->prev = new_block; ffc0ea34: 91 67 00 0c stw r11,12(r7) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; ffc0ea38: 91 69 00 08 stw r11,8(r9) /* Statistics */ ++stats->free_blocks; ffc0ea3c: 81 69 00 38 lwz r11,56(r9) } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; ffc0ea40: 90 0a 00 04 stw r0,4(r10) next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; ffc0ea44: 38 0b 00 01 addi r0,r11,1 if ( stats->max_free_blocks < stats->free_blocks ) { ffc0ea48: 81 69 00 3c lwz r11,60(r9) 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; ffc0ea4c: 90 09 00 38 stw r0,56(r9) if ( stats->max_free_blocks < stats->free_blocks ) { ffc0ea50: 7f 8b 00 40 cmplw cr7,r11,r0 ffc0ea54: 40 9c 00 08 bge- cr7,ffc0ea5c <_Heap_Free+0x1e0> stats->max_free_blocks = stats->free_blocks; ffc0ea58: 90 09 00 3c stw r0,60(r9) } } /* Statistics */ --stats->used_blocks; ffc0ea5c: 81 69 00 40 lwz r11,64(r9) ++stats->frees; stats->free_size += block_size; return( true ); ffc0ea60: 38 60 00 01 li r3,1 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc0ea64: 38 0b ff ff addi r0,r11,-1 ++stats->frees; ffc0ea68: 81 69 00 50 lwz r11,80(r9) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc0ea6c: 90 09 00 40 stw r0,64(r9) ++stats->frees; ffc0ea70: 38 0b 00 01 addi r0,r11,1 ffc0ea74: 90 09 00 50 stw r0,80(r9) stats->free_size += block_size; ffc0ea78: 80 09 00 30 lwz r0,48(r9) ffc0ea7c: 7d 00 42 14 add r8,r0,r8 ffc0ea80: 91 09 00 30 stw r8,48(r9) return( true ); } ffc0ea84: 39 61 00 10 addi r11,r1,16 ffc0ea88: 4b ff 1a bc b ffc00544 <_restgpr_31_x> =============================================================================== ffc1c324 <_Heap_Size_of_alloc_area>: RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc1c324: 80 03 00 10 lwz r0,16(r3) bool _Heap_Size_of_alloc_area( Heap_Control *heap, void *alloc_begin_ptr, uintptr_t *alloc_size ) { ffc1c328: 7c 69 1b 78 mr r9,r3 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 ffc1c32c: 81 03 00 20 lwz r8,32(r3) RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc1c330: 7d 44 03 96 divwu r10,r4,r0 ffc1c334: 7d 4a 01 d6 mullw r10,r10,r0 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; ffc1c338: 38 00 00 00 li r0,0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc1c33c: 39 4a ff f8 addi r10,r10,-8 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; ffc1c340: 7f 8a 40 40 cmplw cr7,r10,r8 ffc1c344: 41 9c 00 14 blt- cr7,ffc1c358 <_Heap_Size_of_alloc_area+0x34> ffc1c348: 80 03 00 24 lwz r0,36(r3) ffc1c34c: 7c 0a 00 10 subfc r0,r10,r0 ffc1c350: 38 00 00 00 li r0,0 ffc1c354: 7c 00 01 14 adde r0,r0,r0 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 ) ) { ffc1c358: 2f 80 00 00 cmpwi cr7,r0,0 return false; ffc1c35c: 38 60 00 00 li r3,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 ) ) { ffc1c360: 4d 9e 00 20 beqlr cr7 - 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; ffc1c364: 81 6a 00 04 lwz r11,4(r10) 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; ffc1c368: 38 00 00 00 li r0,0 - 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; ffc1c36c: 55 6b 00 3c rlwinm r11,r11,0,0,30 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc1c370: 7d 6b 52 14 add r11,r11,r10 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; ffc1c374: 7f 8b 40 40 cmplw cr7,r11,r8 ffc1c378: 41 9c 00 14 blt- cr7,ffc1c38c <_Heap_Size_of_alloc_area+0x68><== NEVER TAKEN ffc1c37c: 80 09 00 24 lwz r0,36(r9) ffc1c380: 7c 0b 00 10 subfc r0,r11,r0 ffc1c384: 38 00 00 00 li r0,0 ffc1c388: 7c 00 01 14 adde r0,r0,r0 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( ffc1c38c: 2f 80 00 00 cmpwi cr7,r0,0 !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) ) { return false; ffc1c390: 38 60 00 00 li r3,0 } block_size = _Heap_Block_size( block ); next_block = _Heap_Block_at( block, block_size ); if ( ffc1c394: 4d 9e 00 20 beqlr cr7 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; ffc1c398: 80 0b 00 04 lwz r0,4(r11) !_Heap_Is_block_in_heap( heap, next_block ) || !_Heap_Is_prev_used( next_block ) ffc1c39c: 70 09 00 01 andi. r9,r0,1 ffc1c3a0: 4d 82 00 20 beqlr ) { return false; } *alloc_size = (uintptr_t) next_block + HEAP_ALLOC_BONUS - alloc_begin; ffc1c3a4: 20 84 00 04 subfic r4,r4,4 ffc1c3a8: 7d 64 5a 14 add r11,r4,r11 ffc1c3ac: 91 65 00 00 stw r11,0(r5) return true; ffc1c3b0: 38 60 00 01 li r3,1 } ffc1c3b4: 4e 80 00 20 blr =============================================================================== ffc09cc0 <_Heap_Walk>: 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; ffc09cc0: 2f 85 00 00 cmpwi cr7,r5,0 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { ffc09cc4: 94 21 ff 98 stwu r1,-104(r1) ffc09cc8: 7c 08 02 a6 mflr r0 ffc09ccc: bd c1 00 20 stmw r14,32(r1) ffc09cd0: 7c 7e 1b 78 mr r30,r3 ffc09cd4: 7c 9f 23 78 mr r31,r4 ffc09cd8: 90 01 00 6c stw r0,108(r1) uintptr_t const page_size = heap->page_size; ffc09cdc: 83 43 00 10 lwz r26,16(r3) uintptr_t const min_block_size = heap->min_block_size; ffc09ce0: 83 23 00 14 lwz r25,20(r3) Heap_Block *const first_block = heap->first_block; ffc09ce4: 83 03 00 20 lwz r24,32(r3) Heap_Block *const last_block = heap->last_block; ffc09ce8: 82 e3 00 24 lwz r23,36(r3) Heap_Block *block = first_block; Heap_Walk_printer printer = dump ? _Heap_Walk_print : _Heap_Walk_print_nothing; ffc09cec: 41 9e 00 10 beq- cr7,ffc09cfc <_Heap_Walk+0x3c> ffc09cf0: 3d 20 ff c1 lis r9,-63 ffc09cf4: 39 29 9c 10 addi r9,r9,-25584 ffc09cf8: 48 00 00 0c b ffc09d04 <_Heap_Walk+0x44> ffc09cfc: 3d 20 ff c1 lis r9,-63 ffc09d00: 39 29 9c 0c addi r9,r9,-25588 ffc09d04: 91 21 00 18 stw r9,24(r1) if ( !_System_state_Is_up( _System_state_Get() ) ) { ffc09d08: 3d 20 00 00 lis r9,0 return true; ffc09d0c: 38 60 00 01 li 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() ) ) { ffc09d10: 80 09 28 24 lwz r0,10276(r9) ffc09d14: 2f 80 00 03 cmpwi cr7,r0,3 ffc09d18: 40 be 04 bc bne+ cr7,ffc0a1d4 <_Heap_Walk+0x514> 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)( ffc09d1c: 80 1e 00 08 lwz r0,8(r30) ffc09d20: 3c a0 ff c2 lis r5,-62 ffc09d24: 81 1e 00 18 lwz r8,24(r30) ffc09d28: 7f e3 fb 78 mr r3,r31 ffc09d2c: 90 01 00 0c stw r0,12(r1) ffc09d30: 38 80 00 00 li r4,0 ffc09d34: 38 a5 84 d9 addi r5,r5,-31527 ffc09d38: 80 1e 00 0c lwz r0,12(r30) ffc09d3c: 7f 46 d3 78 mr r6,r26 ffc09d40: 81 3e 00 1c lwz r9,28(r30) ffc09d44: 7f 27 cb 78 mr r7,r25 ffc09d48: 90 01 00 10 stw r0,16(r1) ffc09d4c: 7f 0a c3 78 mr r10,r24 ffc09d50: 80 01 00 18 lwz r0,24(r1) ffc09d54: 92 e1 00 08 stw r23,8(r1) ffc09d58: 7c 09 03 a6 mtctr r0 ffc09d5c: 4c c6 31 82 crclr 4*cr1+eq ffc09d60: 4e 80 04 21 bctrl heap->area_begin, heap->area_end, first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { ffc09d64: 2f 9a 00 00 cmpwi cr7,r26,0 ffc09d68: 40 be 00 18 bne+ cr7,ffc09d80 <_Heap_Walk+0xc0> (*printer)( source, true, "page size is zero\n" ); ffc09d6c: 3c a0 ff c2 lis r5,-62 ffc09d70: 7f e3 fb 78 mr r3,r31 ffc09d74: 38 80 00 01 li r4,1 ffc09d78: 38 a5 85 6a addi r5,r5,-31382 ffc09d7c: 48 00 00 c0 b ffc09e3c <_Heap_Walk+0x17c> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { ffc09d80: 73 49 00 07 andi. r9,r26,7 ffc09d84: 41 a2 00 1c beq+ ffc09da0 <_Heap_Walk+0xe0> (*printer)( ffc09d88: 3c a0 ff c2 lis r5,-62 ffc09d8c: 7f e3 fb 78 mr r3,r31 ffc09d90: 38 80 00 01 li r4,1 ffc09d94: 38 a5 85 7d addi r5,r5,-31363 ffc09d98: 7f 46 d3 78 mr r6,r26 ffc09d9c: 48 00 04 54 b ffc0a1f0 <_Heap_Walk+0x530> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc09da0: 7c 19 d3 96 divwu r0,r25,r26 ffc09da4: 7c 00 d1 d6 mullw r0,r0,r26 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { ffc09da8: 7f 99 00 00 cmpw cr7,r25,r0 ffc09dac: 41 be 00 1c beq+ cr7,ffc09dc8 <_Heap_Walk+0x108> (*printer)( ffc09db0: 3c a0 ff c2 lis r5,-62 ffc09db4: 7f e3 fb 78 mr r3,r31 ffc09db8: 38 80 00 01 li r4,1 ffc09dbc: 38 a5 85 9b addi r5,r5,-31333 ffc09dc0: 7f 26 cb 78 mr r6,r25 ffc09dc4: 48 00 04 2c b ffc0a1f0 <_Heap_Walk+0x530> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc09dc8: 38 18 00 08 addi r0,r24,8 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc09dcc: 7d 20 d3 96 divwu r9,r0,r26 ffc09dd0: 7d 29 d1 d6 mullw r9,r9,r26 ); return false; } if ( ffc09dd4: 7f 80 48 00 cmpw cr7,r0,r9 ffc09dd8: 41 be 00 1c beq+ cr7,ffc09df4 <_Heap_Walk+0x134> !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( ffc09ddc: 3c a0 ff c2 lis r5,-62 ffc09de0: 7f e3 fb 78 mr r3,r31 ffc09de4: 38 80 00 01 li r4,1 ffc09de8: 38 a5 85 bf addi r5,r5,-31297 ffc09dec: 7f 06 c3 78 mr r6,r24 ffc09df0: 48 00 04 00 b ffc0a1f0 <_Heap_Walk+0x530> 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; ffc09df4: 80 18 00 04 lwz r0,4(r24) ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { ffc09df8: 70 09 00 01 andi. r9,r0,1 ffc09dfc: 40 a2 00 18 bne+ ffc09e14 <_Heap_Walk+0x154> (*printer)( ffc09e00: 3c a0 ff c2 lis r5,-62 ffc09e04: 7f e3 fb 78 mr r3,r31 ffc09e08: 38 80 00 01 li r4,1 ffc09e0c: 38 a5 85 f0 addi r5,r5,-31248 ffc09e10: 48 00 00 2c b ffc09e3c <_Heap_Walk+0x17c> - 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; ffc09e14: 83 b7 00 04 lwz r29,4(r23) ffc09e18: 57 bd 00 3c rlwinm r29,r29,0,0,30 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc09e1c: 7f b7 ea 14 add r29,r23,r29 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; ffc09e20: 80 1d 00 04 lwz r0,4(r29) ); return false; } if ( _Heap_Is_free( last_block ) ) { ffc09e24: 70 09 00 01 andi. r9,r0,1 ffc09e28: 40 a2 00 28 bne+ ffc09e50 <_Heap_Walk+0x190> (*printer)( ffc09e2c: 3c a0 ff c2 lis r5,-62 ffc09e30: 7f e3 fb 78 mr r3,r31 ffc09e34: 38 80 00 01 li r4,1 ffc09e38: 38 a5 86 1e addi r5,r5,-31202 ffc09e3c: 80 01 00 18 lwz r0,24(r1) ffc09e40: 7c 09 03 a6 mtctr r0 ffc09e44: 4c c6 31 82 crclr 4*cr1+eq ffc09e48: 4e 80 04 21 bctrl ffc09e4c: 48 00 00 ec b ffc09f38 <_Heap_Walk+0x278> ); return false; } if ( ffc09e50: 7f 9d c0 00 cmpw cr7,r29,r24 ffc09e54: 41 9e 00 18 beq- cr7,ffc09e6c <_Heap_Walk+0x1ac> _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( ffc09e58: 3c a0 ff c2 lis r5,-62 ffc09e5c: 7f e3 fb 78 mr r3,r31 ffc09e60: 38 80 00 01 li r4,1 ffc09e64: 38 a5 86 33 addi r5,r5,-31181 ffc09e68: 4b ff ff d4 b ffc09e3c <_Heap_Walk+0x17c> int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; ffc09e6c: 81 3e 00 10 lwz r9,16(r30) const Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); ffc09e70: 7f c0 f3 78 mr r0,r30 return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; ffc09e74: 80 de 00 08 lwz r6,8(r30) ffc09e78: 48 00 00 d0 b ffc09f48 <_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; ffc09e7c: 81 5e 00 20 lwz r10,32(r30) ffc09e80: 39 60 00 00 li r11,0 ffc09e84: 7f 8a 30 40 cmplw cr7,r10,r6 ffc09e88: 41 9d 00 14 bgt- cr7,ffc09e9c <_Heap_Walk+0x1dc> ffc09e8c: 81 7e 00 24 lwz r11,36(r30) ffc09e90: 7d 66 58 10 subfc r11,r6,r11 ffc09e94: 39 60 00 00 li r11,0 ffc09e98: 7d 6b 59 14 adde r11,r11,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 ) ) { ffc09e9c: 2f 8b 00 00 cmpwi cr7,r11,0 ffc09ea0: 40 be 00 18 bne+ cr7,ffc09eb8 <_Heap_Walk+0x1f8> (*printer)( ffc09ea4: 3c a0 ff c2 lis r5,-62 ffc09ea8: 7f e3 fb 78 mr r3,r31 ffc09eac: 38 80 00 01 li r4,1 ffc09eb0: 38 a5 86 62 addi r5,r5,-31134 ffc09eb4: 48 00 03 3c b ffc0a1f0 <_Heap_Walk+0x530> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc09eb8: 39 66 00 08 addi r11,r6,8 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc09ebc: 7d 4b 4b 96 divwu r10,r11,r9 ffc09ec0: 7d 4a 49 d6 mullw r10,r10,r9 ); return false; } if ( ffc09ec4: 7f 8b 50 00 cmpw cr7,r11,r10 ffc09ec8: 41 be 00 18 beq+ cr7,ffc09ee0 <_Heap_Walk+0x220> !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( ffc09ecc: 3c a0 ff c2 lis r5,-62 ffc09ed0: 7f e3 fb 78 mr r3,r31 ffc09ed4: 38 80 00 01 li r4,1 ffc09ed8: 38 a5 86 82 addi r5,r5,-31102 ffc09edc: 48 00 03 14 b ffc0a1f0 <_Heap_Walk+0x530> - 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; ffc09ee0: 81 66 00 04 lwz r11,4(r6) ffc09ee4: 55 6b 00 3c rlwinm r11,r11,0,0,30 block = next_block; } while ( block != first_block ); return true; } ffc09ee8: 7d 66 5a 14 add r11,r6,r11 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; ffc09eec: 81 6b 00 04 lwz r11,4(r11) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc09ef0: 71 6a 00 01 andi. r10,r11,1 ffc09ef4: 41 a2 00 18 beq+ ffc09f0c <_Heap_Walk+0x24c> (*printer)( ffc09ef8: 3c a0 ff c2 lis r5,-62 ffc09efc: 7f e3 fb 78 mr r3,r31 ffc09f00: 38 80 00 01 li r4,1 ffc09f04: 38 a5 86 b2 addi r5,r5,-31054 ffc09f08: 48 00 02 e8 b ffc0a1f0 <_Heap_Walk+0x530> ); return false; } if ( free_block->prev != prev_block ) { ffc09f0c: 80 e6 00 0c lwz r7,12(r6) ffc09f10: 7f 87 00 00 cmpw cr7,r7,r0 ffc09f14: 41 be 00 2c beq+ cr7,ffc09f40 <_Heap_Walk+0x280> (*printer)( ffc09f18: 3c a0 ff c2 lis r5,-62 ffc09f1c: 7f e3 fb 78 mr r3,r31 ffc09f20: 38 80 00 01 li r4,1 ffc09f24: 38 a5 86 ce addi r5,r5,-31026 ffc09f28: 80 01 00 18 lwz r0,24(r1) ffc09f2c: 7c 09 03 a6 mtctr r0 ffc09f30: 4c c6 31 82 crclr 4*cr1+eq ffc09f34: 4e 80 04 21 bctrl if ( !_System_state_Is_up( _System_state_Get() ) ) { return true; } if ( !_Heap_Walk_check_control( source, printer, heap ) ) { return false; ffc09f38: 38 60 00 00 li r3,0 ffc09f3c: 48 00 02 98 b ffc0a1d4 <_Heap_Walk+0x514> return false; } prev_block = free_block; free_block = free_block->next; ffc09f40: 7c c0 33 78 mr r0,r6 ffc09f44: 80 c6 00 08 lwz r6,8(r6) 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 ) { ffc09f48: 7f 86 f0 00 cmpw cr7,r6,r30 ffc09f4c: 40 9e ff 30 bne+ cr7,ffc09e7c <_Heap_Walk+0x1bc> ffc09f50: 48 00 00 0c b ffc09f5c <_Heap_Walk+0x29c> block->prev_size ); } block = next_block; } while ( block != first_block ); ffc09f54: 7f 7d db 78 mr r29,r27 ffc09f58: 48 00 00 30 b ffc09f88 <_Heap_Walk+0x2c8> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc09f5c: 3e 60 ff c2 lis r19,-62 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( ffc09f60: 3e 80 ff c2 lis r20,-62 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)( ffc09f64: 3e 40 ff c2 lis r18,-62 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc09f68: 3a 73 88 6e addi r19,r19,-30610 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( ffc09f6c: 3a 94 88 57 addi r20,r20,-30633 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)( ffc09f70: 3a 52 87 ba addi r18,r18,-30790 ffc09f74: 3e 20 ff c2 lis r17,-62 " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ffc09f78: 3e c0 ff c2 lis r22,-62 ffc09f7c: 3e 00 ff c2 lis r16,-62 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)( ffc09f80: 3d e0 ff c2 lis r15,-62 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc09f84: 3d c0 ff c2 lis r14,-62 block = next_block; } while ( block != first_block ); return true; } ffc09f88: 82 bd 00 04 lwz r21,4(r29) 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; ffc09f8c: 38 00 00 00 li r0,0 ffc09f90: 81 3e 00 20 lwz r9,32(r30) - 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; ffc09f94: 56 bc 00 3c rlwinm r28,r21,0,0,30 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc09f98: 7f 7c ea 14 add r27,r28,r29 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; ffc09f9c: 7f 89 d8 40 cmplw cr7,r9,r27 ffc09fa0: 41 9d 00 14 bgt- cr7,ffc09fb4 <_Heap_Walk+0x2f4> <== NEVER TAKEN ffc09fa4: 80 1e 00 24 lwz r0,36(r30) ffc09fa8: 7c 1b 00 10 subfc r0,r27,r0 ffc09fac: 38 00 00 00 li r0,0 ffc09fb0: 7c 00 01 14 adde r0,r0,r0 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 ) ) { ffc09fb4: 2f 80 00 00 cmpwi cr7,r0,0 ffc09fb8: 40 be 00 18 bne+ cr7,ffc09fd0 <_Heap_Walk+0x310> (*printer)( ffc09fbc: 3c a0 ff c2 lis r5,-62 ffc09fc0: 7f e3 fb 78 mr r3,r31 ffc09fc4: 38 80 00 01 li r4,1 ffc09fc8: 38 a5 87 00 addi r5,r5,-30976 ffc09fcc: 48 00 00 a8 b ffc0a074 <_Heap_Walk+0x3b4> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc09fd0: 7d 3c d3 96 divwu r9,r28,r26 ffc09fd4: 7d 29 d1 d6 mullw r9,r9,r26 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; ffc09fd8: 7f a0 ba 78 xor r0,r29,r23 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc09fdc: 7f 9c 48 00 cmpw cr7,r28,r9 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; ffc09fe0: 7c 00 00 34 cntlzw r0,r0 ffc09fe4: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc09fe8: 68 00 00 01 xori r0,r0,1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc09fec: 41 9e 00 28 beq- cr7,ffc0a014 <_Heap_Walk+0x354> ffc09ff0: 2f 80 00 00 cmpwi cr7,r0,0 ffc09ff4: 41 be 00 20 beq+ cr7,ffc0a014 <_Heap_Walk+0x354> (*printer)( ffc09ff8: 3c a0 ff c2 lis r5,-62 ffc09ffc: 7f e3 fb 78 mr r3,r31 ffc0a000: 38 80 00 01 li r4,1 ffc0a004: 38 a5 87 2d addi r5,r5,-30931 ffc0a008: 7f a6 eb 78 mr r6,r29 ffc0a00c: 7f 87 e3 78 mr r7,r28 ffc0a010: 4b ff ff 18 b ffc09f28 <_Heap_Walk+0x268> ); return false; } if ( block_size < min_block_size && is_not_last_block ) { ffc0a014: 7f 9c c8 40 cmplw cr7,r28,r25 ffc0a018: 40 9c 00 3c bge- cr7,ffc0a054 <_Heap_Walk+0x394> ffc0a01c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a020: 41 be 00 34 beq+ cr7,ffc0a054 <_Heap_Walk+0x394> <== NEVER TAKEN (*printer)( ffc0a024: 80 01 00 18 lwz r0,24(r1) ffc0a028: 3c a0 ff c2 lis r5,-62 ffc0a02c: 7f e3 fb 78 mr r3,r31 ffc0a030: 38 80 00 01 li r4,1 ffc0a034: 7c 09 03 a6 mtctr r0 ffc0a038: 38 a5 87 5b addi r5,r5,-30885 ffc0a03c: 7f a6 eb 78 mr r6,r29 ffc0a040: 7f 87 e3 78 mr r7,r28 ffc0a044: 7f 28 cb 78 mr r8,r25 ffc0a048: 4c c6 31 82 crclr 4*cr1+eq ffc0a04c: 4e 80 04 21 bctrl ffc0a050: 4b ff fe e8 b ffc09f38 <_Heap_Walk+0x278> ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { ffc0a054: 7f 9b e8 40 cmplw cr7,r27,r29 ffc0a058: 41 9d 00 28 bgt- cr7,ffc0a080 <_Heap_Walk+0x3c0> ffc0a05c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a060: 41 be 00 20 beq+ cr7,ffc0a080 <_Heap_Walk+0x3c0> (*printer)( ffc0a064: 3c a0 ff c2 lis r5,-62 ffc0a068: 7f e3 fb 78 mr r3,r31 ffc0a06c: 38 80 00 01 li r4,1 ffc0a070: 38 a5 87 86 addi r5,r5,-30842 ffc0a074: 7f a6 eb 78 mr r6,r29 ffc0a078: 7f 67 db 78 mr r7,r27 ffc0a07c: 4b ff fe ac b ffc09f28 <_Heap_Walk+0x268> 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; ffc0a080: 80 1b 00 04 lwz r0,4(r27) ffc0a084: 56 b5 07 fe clrlwi r21,r21,31 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { ffc0a088: 70 09 00 01 andi. r9,r0,1 ffc0a08c: 40 a2 00 ec bne+ ffc0a178 <_Heap_Walk+0x4b8> 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 ? ffc0a090: 81 1d 00 0c lwz r8,12(r29) 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)( ffc0a094: 39 2f 84 a6 addi r9,r15,-31578 ffc0a098: 80 1e 00 08 lwz r0,8(r30) return _Heap_Free_list_head(heap)->next; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_last( Heap_Control *heap ) { return _Heap_Free_list_tail(heap)->prev; ffc0a09c: 81 7e 00 0c lwz r11,12(r30) ffc0a0a0: 7f 88 00 00 cmpw cr7,r8,r0 ffc0a0a4: 41 9e 00 14 beq- cr7,ffc0a0b8 <_Heap_Walk+0x3f8> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0a0a8: 7f 88 f0 00 cmpw cr7,r8,r30 ffc0a0ac: 39 36 83 eb addi r9,r22,-31765 ffc0a0b0: 40 be 00 08 bne+ cr7,ffc0a0b8 <_Heap_Walk+0x3f8> ffc0a0b4: 39 2e 84 b6 addi r9,r14,-31562 block->next, block->next == last_free_block ? ffc0a0b8: 81 5d 00 08 lwz r10,8(r29) 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)( ffc0a0bc: 38 11 84 c0 addi r0,r17,-31552 ffc0a0c0: 7f 8a 58 00 cmpw cr7,r10,r11 ffc0a0c4: 41 9e 00 14 beq- cr7,ffc0a0d8 <_Heap_Walk+0x418> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ffc0a0c8: 7f 8a f0 00 cmpw cr7,r10,r30 ffc0a0cc: 38 16 83 eb addi r0,r22,-31765 ffc0a0d0: 40 be 00 08 bne+ cr7,ffc0a0d8 <_Heap_Walk+0x418> ffc0a0d4: 38 10 84 cf addi r0,r16,-31537 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)( ffc0a0d8: 90 01 00 08 stw r0,8(r1) ffc0a0dc: 7f e3 fb 78 mr r3,r31 ffc0a0e0: 38 80 00 00 li r4,0 ffc0a0e4: 80 01 00 18 lwz r0,24(r1) ffc0a0e8: 7e 45 93 78 mr r5,r18 ffc0a0ec: 7f a6 eb 78 mr r6,r29 ffc0a0f0: 7f 87 e3 78 mr r7,r28 ffc0a0f4: 7c 09 03 a6 mtctr r0 ffc0a0f8: 4c c6 31 82 crclr 4*cr1+eq ffc0a0fc: 4e 80 04 21 bctrl block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { ffc0a100: 81 1b 00 00 lwz r8,0(r27) ffc0a104: 7f 9c 40 00 cmpw cr7,r28,r8 ffc0a108: 41 be 00 34 beq+ cr7,ffc0a13c <_Heap_Walk+0x47c> (*printer)( ffc0a10c: 80 01 00 18 lwz r0,24(r1) ffc0a110: 3c a0 ff c2 lis r5,-62 ffc0a114: 7f e3 fb 78 mr r3,r31 ffc0a118: 38 80 00 01 li r4,1 ffc0a11c: 7c 09 03 a6 mtctr r0 ffc0a120: 38 a5 87 ef addi r5,r5,-30737 ffc0a124: 7f a6 eb 78 mr r6,r29 ffc0a128: 7f 87 e3 78 mr r7,r28 ffc0a12c: 7f 69 db 78 mr r9,r27 ffc0a130: 4c c6 31 82 crclr 4*cr1+eq ffc0a134: 4e 80 04 21 bctrl ffc0a138: 4b ff fe 00 b ffc09f38 <_Heap_Walk+0x278> ); return false; } if ( !prev_used ) { ffc0a13c: 2f 95 00 00 cmpwi cr7,r21,0 ffc0a140: 40 be 00 18 bne+ cr7,ffc0a158 <_Heap_Walk+0x498> (*printer)( ffc0a144: 3c a0 ff c2 lis r5,-62 ffc0a148: 7f e3 fb 78 mr r3,r31 ffc0a14c: 38 80 00 01 li r4,1 ffc0a150: 38 a5 88 28 addi r5,r5,-30680 ffc0a154: 48 00 00 98 b ffc0a1ec <_Heap_Walk+0x52c> return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; ffc0a158: 81 3e 00 08 lwz r9,8(r30) ffc0a15c: 48 00 00 10 b ffc0a16c <_Heap_Walk+0x4ac> { 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 ) { ffc0a160: 7f 89 e8 00 cmpw cr7,r9,r29 ffc0a164: 41 9e 00 64 beq- cr7,ffc0a1c8 <_Heap_Walk+0x508> return true; } free_block = free_block->next; ffc0a168: 81 29 00 08 lwz r9,8(r9) ) { 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 ) { ffc0a16c: 7f 89 f0 00 cmpw cr7,r9,r30 ffc0a170: 40 9e ff f0 bne+ cr7,ffc0a160 <_Heap_Walk+0x4a0> ffc0a174: 48 00 00 68 b ffc0a1dc <_Heap_Walk+0x51c> if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { ffc0a178: 2f 95 00 00 cmpwi cr7,r21,0 (*printer)( ffc0a17c: 7f e3 fb 78 mr r3,r31 ffc0a180: 38 80 00 00 li r4,0 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { ffc0a184: 41 9e 00 24 beq- cr7,ffc0a1a8 <_Heap_Walk+0x4e8> (*printer)( ffc0a188: 80 01 00 18 lwz r0,24(r1) ffc0a18c: 7e 85 a3 78 mr r5,r20 ffc0a190: 7f a6 eb 78 mr r6,r29 ffc0a194: 7f 87 e3 78 mr r7,r28 ffc0a198: 7c 09 03 a6 mtctr r0 ffc0a19c: 4c c6 31 82 crclr 4*cr1+eq ffc0a1a0: 4e 80 04 21 bctrl ffc0a1a4: 48 00 00 24 b ffc0a1c8 <_Heap_Walk+0x508> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0a1a8: 80 01 00 18 lwz r0,24(r1) ffc0a1ac: 7e 65 9b 78 mr r5,r19 ffc0a1b0: 7f a6 eb 78 mr r6,r29 ffc0a1b4: 81 1d 00 00 lwz r8,0(r29) ffc0a1b8: 7f 87 e3 78 mr r7,r28 ffc0a1bc: 7c 09 03 a6 mtctr r0 ffc0a1c0: 4c c6 31 82 crclr 4*cr1+eq ffc0a1c4: 4e 80 04 21 bctrl block->prev_size ); } block = next_block; } while ( block != first_block ); ffc0a1c8: 7f 9b c0 00 cmpw cr7,r27,r24 ffc0a1cc: 40 9e fd 88 bne+ cr7,ffc09f54 <_Heap_Walk+0x294> return true; ffc0a1d0: 38 60 00 01 li r3,1 } ffc0a1d4: 39 61 00 68 addi r11,r1,104 ffc0a1d8: 4b ff 69 24 b ffc00afc <_restgpr_14_x> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( ffc0a1dc: 3c a0 ff c2 lis r5,-62 ffc0a1e0: 7f e3 fb 78 mr r3,r31 ffc0a1e4: 38 80 00 01 li r4,1 ffc0a1e8: 38 a5 88 93 addi r5,r5,-30573 ffc0a1ec: 7f a6 eb 78 mr r6,r29 ffc0a1f0: 80 01 00 18 lwz r0,24(r1) ffc0a1f4: 7c 09 03 a6 mtctr r0 ffc0a1f8: 4c c6 31 82 crclr 4*cr1+eq ffc0a1fc: 4e 80 04 21 bctrl ffc0a200: 4b ff fd 38 b ffc09f38 <_Heap_Walk+0x278> =============================================================================== ffc09c10 <_Heap_Walk_print>: static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc09c10: 7c 08 02 a6 mflr r0 ffc09c14: 7c 2b 0b 78 mr r11,r1 ffc09c18: 94 21 ff 88 stwu r1,-120(r1) ffc09c1c: 90 01 00 7c stw r0,124(r1) ffc09c20: 4b ff 6e d5 bl ffc00af4 <_savegpr_31> ffc09c24: 7c 60 1b 78 mr r0,r3 ffc09c28: 90 c1 00 1c stw r6,28(r1) ffc09c2c: 90 e1 00 20 stw r7,32(r1) ffc09c30: 91 01 00 24 stw r8,36(r1) ffc09c34: 91 21 00 28 stw r9,40(r1) ffc09c38: 91 41 00 2c stw r10,44(r1) ffc09c3c: 40 86 00 24 bne- cr1,ffc09c60 <_Heap_Walk_print+0x50> <== ALWAYS TAKEN ffc09c40: d8 21 00 30 stfd f1,48(r1) <== NOT EXECUTED ffc09c44: d8 41 00 38 stfd f2,56(r1) <== NOT EXECUTED ffc09c48: d8 61 00 40 stfd f3,64(r1) <== NOT EXECUTED ffc09c4c: d8 81 00 48 stfd f4,72(r1) <== NOT EXECUTED ffc09c50: d8 a1 00 50 stfd f5,80(r1) <== NOT EXECUTED ffc09c54: d8 c1 00 58 stfd f6,88(r1) <== NOT EXECUTED ffc09c58: d8 e1 00 60 stfd f7,96(r1) <== NOT EXECUTED ffc09c5c: d9 01 00 68 stfd f8,104(r1) <== NOT EXECUTED va_list ap; if ( error ) { ffc09c60: 2f 84 00 00 cmpwi cr7,r4,0 { /* Do nothing */ } static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc09c64: 7c bf 2b 78 mr r31,r5 va_list ap; if ( error ) { ffc09c68: 41 be 00 10 beq+ cr7,ffc09c78 <_Heap_Walk_print+0x68> printk( "FAIL[%d]: ", source ); ffc09c6c: 3c 60 ff c2 lis r3,-62 ffc09c70: 38 63 84 90 addi r3,r3,-31600 ffc09c74: 48 00 00 0c b ffc09c80 <_Heap_Walk_print+0x70> } else { printk( "PASS[%d]: ", source ); ffc09c78: 3c 60 ff c2 lis r3,-62 ffc09c7c: 38 63 84 9b addi r3,r3,-31589 ffc09c80: 7c 04 03 78 mr r4,r0 ffc09c84: 4c c6 31 82 crclr 4*cr1+eq ffc09c88: 4b ff be 5d bl ffc05ae4 } va_start( ap, fmt ); ffc09c8c: 38 00 00 03 li r0,3 ffc09c90: 98 01 00 08 stb r0,8(r1) ffc09c94: 38 00 00 00 li r0,0 vprintk( fmt, ap ); ffc09c98: 7f e3 fb 78 mr r3,r31 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc09c9c: 98 01 00 09 stb r0,9(r1) ffc09ca0: 38 01 00 80 addi r0,r1,128 vprintk( fmt, ap ); ffc09ca4: 38 81 00 08 addi r4,r1,8 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc09ca8: 90 01 00 0c stw r0,12(r1) ffc09cac: 38 01 00 10 addi r0,r1,16 ffc09cb0: 90 01 00 10 stw r0,16(r1) vprintk( fmt, ap ); ffc09cb4: 4b ff db d1 bl ffc07884 va_end( ap ); } ffc09cb8: 39 61 00 78 addi r11,r1,120 ffc09cbc: 4b ff 6e 84 b ffc00b40 <_restgpr_31_x> =============================================================================== ffc09668 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc09668: 7c 2b 0b 78 mr r11,r1 ffc0966c: 94 21 ff f0 stwu r1,-16(r1) ffc09670: 7c 08 02 a6 mflr r0 ffc09674: 48 01 1c d9 bl ffc1b34c <_savegpr_31> _Internal_errors_What_happened.the_source = the_source; ffc09678: 3d 60 00 00 lis r11,0 ffc0967c: 39 2b 2d 50 addi r9,r11,11600 void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc09680: 90 01 00 14 stw r0,20(r1) ffc09684: 7c bf 2b 78 mr r31,r5 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; ffc09688: 98 89 00 04 stb r4,4(r9) _Internal_errors_What_happened.the_error = the_error; ffc0968c: 90 a9 00 08 stw r5,8(r9) bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; ffc09690: 90 6b 2d 50 stw r3,11600(r11) _Internal_errors_What_happened.is_internal = is_internal; _Internal_errors_What_happened.the_error = the_error; _User_extensions_Fatal( the_source, is_internal, the_error ); ffc09694: 48 00 21 bd bl ffc0b850 <_User_extensions_Fatal> RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; ffc09698: 38 00 00 05 li r0,5 ffc0969c: 3d 20 00 00 lis r9,0 _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); ffc096a0: 7f e3 fb 78 mr r3,r31 ffc096a4: 90 09 28 48 stw r0,10312(r9) ffc096a8: 4b ff a2 b9 bl ffc03960 <_BSP_Fatal_error> ffc096ac: 48 00 00 00 b ffc096ac <_Internal_error_Occurred+0x44><== NOT EXECUTED =============================================================================== ffc096c4 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc096c4: 94 21 ff f0 stwu r1,-16(r1) ffc096c8: 7c 08 02 a6 mflr r0 ffc096cc: 90 01 00 14 stw r0,20(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 ) ffc096d0: 80 03 00 18 lwz r0,24(r3) */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc096d4: bf c1 00 08 stmw r30,8(r1) ffc096d8: 7c 7f 1b 78 mr r31,r3 * 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 ) ffc096dc: 2f 80 00 00 cmpwi cr7,r0,0 return NULL; ffc096e0: 38 60 00 00 li r3,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 ) ffc096e4: 41 9e 00 70 beq- cr7,ffc09754 <_Objects_Allocate+0x90> <== 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 ); ffc096e8: 3b df 00 20 addi r30,r31,32 ffc096ec: 7f c3 f3 78 mr r3,r30 ffc096f0: 4b ff f5 b1 bl ffc08ca0 <_Chain_Get> if ( information->auto_extend ) { ffc096f4: 88 1f 00 12 lbz r0,18(r31) ffc096f8: 2f 80 00 00 cmpwi cr7,r0,0 ffc096fc: 41 9e 00 58 beq- cr7,ffc09754 <_Objects_Allocate+0x90> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { ffc09700: 2f 83 00 00 cmpwi cr7,r3,0 ffc09704: 40 be 00 1c bne+ cr7,ffc09720 <_Objects_Allocate+0x5c> _Objects_Extend_information( information ); ffc09708: 7f e3 fb 78 mr r3,r31 ffc0970c: 48 00 00 85 bl ffc09790 <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); ffc09710: 7f c3 f3 78 mr r3,r30 ffc09714: 4b ff f5 8d bl ffc08ca0 <_Chain_Get> } if ( the_object ) { ffc09718: 2c 03 00 00 cmpwi r3,0 ffc0971c: 41 a2 00 38 beq+ ffc09754 <_Objects_Allocate+0x90> uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - ffc09720: a1 23 00 0a lhz r9,10(r3) ffc09724: a0 1f 00 0a lhz r0,10(r31) ffc09728: 7c 00 48 50 subf r0,r0,r9 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; ffc0972c: a1 3f 00 14 lhz r9,20(r31) ffc09730: 7c 00 4b 96 divwu r0,r0,r9 information->inactive_per_block[ block ]--; ffc09734: 81 3f 00 30 lwz r9,48(r31) ffc09738: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0973c: 7d 69 00 2e lwzx r11,r9,r0 ffc09740: 39 6b ff ff addi r11,r11,-1 ffc09744: 7d 69 01 2e stwx r11,r9,r0 information->inactive--; ffc09748: a1 3f 00 2c lhz r9,44(r31) ffc0974c: 38 09 ff ff addi r0,r9,-1 ffc09750: b0 1f 00 2c sth r0,44(r31) ); } #endif return the_object; } ffc09754: 39 61 00 10 addi r11,r1,16 ffc09758: 4b ff 6d e8 b ffc00540 <_restgpr_30_x> =============================================================================== ffc09790 <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { ffc09790: 94 21 ff b8 stwu r1,-72(r1) ffc09794: 7c 08 02 a6 mflr r0 ffc09798: 90 01 00 4c stw r0,76(r1) minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc0979c: 81 63 00 34 lwz r11,52(r3) */ void _Objects_Extend_information( Objects_Information *information ) { ffc097a0: be a1 00 1c stmw r21,28(r1) ffc097a4: 7c 7f 1b 78 mr r31,r3 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc097a8: 2f 8b 00 00 cmpwi cr7,r11,0 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); ffc097ac: a3 83 00 0a lhz r28,10(r3) index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc097b0: 41 9e 00 58 beq- cr7,ffc09808 <_Objects_Extend_information+0x78> block_count = 0; else { block_count = information->maximum / information->allocation_size; ffc097b4: a1 43 00 14 lhz r10,20(r3) for ( ; block < block_count; block++ ) { ffc097b8: 39 20 00 00 li r9,0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; ffc097bc: a3 63 00 10 lhz r27,16(r3) * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc097c0: 3b a0 00 00 li r29,0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; ffc097c4: 7f 7b 53 96 divwu r27,r27,r10 ffc097c8: 2f 9b 00 00 cmpwi cr7,r27,0 * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc097cc: 38 1b 00 01 addi r0,r27,1 ffc097d0: 40 be 00 24 bne+ cr7,ffc097f4 <_Objects_Extend_information+0x64><== ALWAYS TAKEN ffc097d4: 38 00 00 01 li r0,1 <== NOT EXECUTED ffc097d8: 48 00 00 1c b ffc097f4 <_Objects_Extend_information+0x64><== NOT EXECUTED * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc097dc: 57 a8 10 3a rlwinm r8,r29,2,0,29 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { ffc097e0: 7d 0b 40 2e lwzx r8,r11,r8 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { ffc097e4: 7d 29 52 14 add r9,r9,r10 if ( information->object_blocks[ block ] == NULL ) { ffc097e8: 2f 88 00 00 cmpwi cr7,r8,0 ffc097ec: 41 9e 00 30 beq- cr7,ffc0981c <_Objects_Extend_information+0x8c> if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { ffc097f0: 3b bd 00 01 addi r29,r29,1 ffc097f4: 34 00 ff ff addic. r0,r0,-1 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc097f8: 7f c9 e2 14 add r30,r9,r28 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { ffc097fc: 40 82 ff e0 bne+ ffc097dc <_Objects_Extend_information+0x4c> /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; ffc09800: 3b 40 00 01 li r26,1 ffc09804: 48 00 00 1c b ffc09820 <_Objects_Extend_information+0x90> minimum_index = _Objects_Get_index( information->minimum_id ); ffc09808: 7f 9e e3 78 mr r30,r28 /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; ffc0980c: 3b 40 00 01 li r26,1 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc09810: 3b a0 00 00 li r29,0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; ffc09814: 3b 60 00 00 li r27,0 ffc09818: 48 00 00 08 b ffc09820 <_Objects_Extend_information+0x90> else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { do_extend = false; ffc0981c: 3b 40 00 00 li r26,0 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; ffc09820: a0 1f 00 14 lhz r0,20(r31) ffc09824: a2 ff 00 10 lhz r23,16(r31) ffc09828: 7e e0 ba 14 add r23,r0,r23 /* * We need to limit the number of objects to the maximum number * representable in the index portion of the object Id. In the * case of 16-bit Ids, this is only 256 object instances. */ if ( maximum > OBJECTS_ID_FINAL_INDEX ) { ffc0982c: 2b 97 ff ff cmplwi cr7,r23,65535 ffc09830: 41 9d 02 10 bgt- cr7,ffc09a40 <_Objects_Extend_information+0x2b0> /* * Allocate the name table, and the objects and if it fails either return or * generate a fatal error depending on auto-extending being active. */ block_size = information->allocation_size * information->size; ffc09834: 80 7f 00 18 lwz r3,24(r31) ffc09838: 7c 60 19 d6 mullw r3,r0,r3 if ( information->auto_extend ) { ffc0983c: 88 1f 00 12 lbz r0,18(r31) ffc09840: 2f 80 00 00 cmpwi cr7,r0,0 ffc09844: 41 9e 00 14 beq- cr7,ffc09858 <_Objects_Extend_information+0xc8> new_object_block = _Workspace_Allocate( block_size ); ffc09848: 48 00 25 05 bl ffc0bd4c <_Workspace_Allocate> if ( !new_object_block ) ffc0984c: 7c 78 1b 79 mr. r24,r3 ffc09850: 40 a2 00 10 bne+ ffc09860 <_Objects_Extend_information+0xd0> ffc09854: 48 00 01 ec b ffc09a40 <_Objects_Extend_information+0x2b0> return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); ffc09858: 48 00 25 55 bl ffc0bdac <_Workspace_Allocate_or_fatal_error> ffc0985c: 7c 78 1b 78 mr r24,r3 } /* * Do we need to grow the tables? */ if ( do_extend ) { ffc09860: 2f 9a 00 00 cmpwi cr7,r26,0 ffc09864: 41 9e 01 58 beq- cr7,ffc099bc <_Objects_Extend_information+0x22c> */ /* * Up the block count and maximum */ block_count++; ffc09868: 3b 5b 00 01 addi r26,r27,1 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ffc0986c: 1c 1a 00 03 mulli r0,r26,3 ((maximum + minimum_index) * sizeof(Objects_Control *)); ffc09870: 7c 77 e2 14 add r3,r23,r28 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ffc09874: 7c 63 02 14 add r3,r3,r0 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); ffc09878: 54 63 10 3a rlwinm r3,r3,2,0,29 ffc0987c: 48 00 24 d1 bl ffc0bd4c <_Workspace_Allocate> if ( !object_blocks ) { ffc09880: 7c 76 1b 79 mr. r22,r3 ffc09884: 40 a2 00 10 bne+ ffc09894 <_Objects_Extend_information+0x104> _Workspace_Free( new_object_block ); ffc09888: 7f 03 c3 78 mr r3,r24 ffc0988c: 48 00 24 f5 bl ffc0bd80 <_Workspace_Free> return; ffc09890: 48 00 01 b0 b ffc09a40 <_Objects_Extend_information+0x2b0> * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { ffc09894: a0 1f 00 10 lhz r0,16(r31) } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( ffc09898: 57 5a 10 3a rlwinm r26,r26,2,0,29 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); ffc0989c: 7f 36 d2 14 add r25,r22,r26 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { ffc098a0: 7f 80 e0 40 cmplw cr7,r0,r28 ffc098a4: 7f 59 d2 14 add r26,r25,r26 ffc098a8: 39 20 00 00 li r9,0 ffc098ac: 40 bd 00 50 ble+ cr7,ffc098fc <_Objects_Extend_information+0x16c> * separate parts as size of each block has changed. */ memcpy( object_blocks, information->object_blocks, block_count * sizeof(void*) ); ffc098b0: 57 75 10 3a rlwinm r21,r27,2,0,29 /* * Copy each section of the table over. This has to be performed as * separate parts as size of each block has changed. */ memcpy( object_blocks, ffc098b4: 80 9f 00 34 lwz r4,52(r31) ffc098b8: 7e a5 ab 78 mr r5,r21 ffc098bc: 48 00 80 35 bl ffc118f0 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, ffc098c0: 80 9f 00 30 lwz r4,48(r31) ffc098c4: 7e a5 ab 78 mr r5,r21 ffc098c8: 7f 23 cb 78 mr r3,r25 ffc098cc: 48 00 80 25 bl ffc118f0 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc098d0: a0 1f 00 10 lhz r0,16(r31) information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, ffc098d4: 80 9f 00 1c lwz r4,28(r31) ffc098d8: 7f 43 d3 78 mr r3,r26 information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc098dc: 7f 9c 02 14 add r28,r28,r0 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, ffc098e0: 57 85 10 3a rlwinm r5,r28,2,0,29 ffc098e4: 48 00 80 0d bl ffc118f0 ffc098e8: 48 00 00 30 b ffc09918 <_Objects_Extend_information+0x188> * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc098ec: 55 2a 10 3a rlwinm r10,r9,2,0,29 /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { local_table[ index ] = NULL; ffc098f0: 7d 6a d1 2e stwx r11,r10,r26 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { ffc098f4: 39 29 00 01 addi r9,r9,1 ffc098f8: 48 00 00 18 b ffc09910 <_Objects_Extend_information+0x180> ffc098fc: 2f 9c 00 00 cmpwi cr7,r28,0 local_table[ index ] = NULL; ffc09900: 39 60 00 00 li r11,0 ffc09904: 38 1c 00 01 addi r0,r28,1 ffc09908: 40 be 00 08 bne+ cr7,ffc09910 <_Objects_Extend_information+0x180><== ALWAYS TAKEN ffc0990c: 38 00 00 01 li r0,1 <== NOT EXECUTED } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { ffc09910: 34 00 ff ff addic. r0,r0,-1 ffc09914: 40 82 ff d8 bne+ ffc098ec <_Objects_Extend_information+0x15c> */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); ffc09918: a1 5f 00 14 lhz r10,20(r31) } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; ffc0991c: 38 00 00 00 li r0,0 ffc09920: 57 7b 10 3a rlwinm r27,r27,2,0,29 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; ffc09924: 7d 7e 52 14 add r11,r30,r10 } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; ffc09928: 7c 16 d9 2e stwx r0,r22,r27 ffc0992c: 7f 9e 58 40 cmplw cr7,r30,r11 inactive_per_block[block_count] = 0; ffc09930: 7c 19 d9 2e stwx r0,r25,r27 for ( index=index_base ; ffc09934: 39 20 00 00 li r9,0 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc09938: 57 c8 10 3a rlwinm r8,r30,2,0,29 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; ffc0993c: 38 e0 00 00 li r7,0 ffc09940: 38 0a 00 01 addi r0,r10,1 ffc09944: 41 9d 00 0c bgt- cr7,ffc09950 <_Objects_Extend_information+0x1c0><== NEVER TAKEN ffc09948: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0994c: 40 be 00 18 bne+ cr7,ffc09964 <_Objects_Extend_information+0x1d4><== ALWAYS TAKEN ffc09950: 38 00 00 01 li r0,1 <== NOT EXECUTED ffc09954: 48 00 00 10 b ffc09964 <_Objects_Extend_information+0x1d4><== NOT EXECUTED * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc09958: 7d 7a 42 14 add r11,r26,r8 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; ffc0995c: 7c eb 49 2e stwx r7,r11,r9 object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { ffc09960: 39 29 00 04 addi r9,r9,4 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; ffc09964: 34 00 ff ff addic. r0,r0,-1 ffc09968: 40 82 ff f0 bne+ ffc09958 <_Objects_Extend_information+0x1c8> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0996c: 7c 00 00 a6 mfmsr r0 ffc09970: 7d 30 42 a6 mfsprg r9,0 ffc09974: 7c 09 48 78 andc r9,r0,r9 ffc09978: 7d 20 01 24 mtmsr r9 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | ffc0997c: 81 3f 00 00 lwz r9,0(r31) old_tables = information->object_blocks; information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; ffc09980: 56 f7 04 3e clrlwi r23,r23,16 information->maximum_id = _Objects_Build_id( ffc09984: a1 7f 00 04 lhz r11,4(r31) ffc09988: 55 29 c0 0e rlwinm r9,r9,24,0,7 old_tables = information->object_blocks; information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; information->local_table = local_table; information->maximum = (Objects_Maximum) maximum; ffc0998c: b2 ff 00 10 sth r23,16(r31) (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc09990: 55 6b d8 08 rlwinm r11,r11,27,0,4 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | ffc09994: 65 29 00 01 oris r9,r9,1 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; ffc09998: 80 7f 00 34 lwz r3,52(r31) (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc0999c: 7d 29 5b 78 or r9,r9,r11 information->object_blocks = object_blocks; ffc099a0: 92 df 00 34 stw r22,52(r31) uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | ffc099a4: 7d 37 bb 78 or r23,r9,r23 information->inactive_per_block = inactive_per_block; ffc099a8: 93 3f 00 30 stw r25,48(r31) information->local_table = local_table; ffc099ac: 93 5f 00 1c stw r26,28(r31) information->maximum = (Objects_Maximum) maximum; information->maximum_id = _Objects_Build_id( ffc099b0: 92 ff 00 0c stw r23,12(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc099b4: 7c 00 01 24 mtmsr r0 information->maximum ); _ISR_Enable( level ); _Workspace_Free( old_tables ); ffc099b8: 48 00 23 c9 bl ffc0bd80 <_Workspace_Free> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; ffc099bc: 81 3f 00 34 lwz r9,52(r31) ffc099c0: 57 bd 10 3a rlwinm r29,r29,2,0,29 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc099c4: 3b 81 00 08 addi r28,r1,8 ffc099c8: a0 bf 00 14 lhz r5,20(r31) } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; ffc099cc: 7f 09 e9 2e stwx r24,r9,r29 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc099d0: 7f 83 e3 78 mr r3,r28 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc099d4: 3b 7f 00 20 addi r27,r31,32 information->object_blocks[ block ] = new_object_block; /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc099d8: 81 3f 00 34 lwz r9,52(r31) ffc099dc: 80 df 00 18 lwz r6,24(r31) ffc099e0: 7c 89 e8 2e lwzx r4,r9,r29 ffc099e4: 48 00 4b 1d bl ffc0e500 <_Chain_Initialize> /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { ffc099e8: 48 00 00 30 b ffc09a18 <_Objects_Extend_information+0x288> ffc099ec: 81 3f 00 00 lwz r9,0(r31) information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc099f0: 7f 63 db 78 mr r3,r27 */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { the_object->id = _Objects_Build_id( ffc099f4: a0 1f 00 04 lhz r0,4(r31) ffc099f8: 55 29 c0 0e rlwinm r9,r9,24,0,7 ffc099fc: 65 29 00 01 oris r9,r9,1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc09a00: 54 00 d8 08 rlwinm r0,r0,27,0,4 ffc09a04: 7d 20 03 78 or r0,r9,r0 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | ffc09a08: 7c 00 f3 78 or r0,r0,r30 ffc09a0c: 90 04 00 08 stw r0,8(r4) index ); _Chain_Append( &information->Inactive, &the_object->Node ); index++; ffc09a10: 3b de 00 01 addi r30,r30,1 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc09a14: 4b ff f2 35 bl ffc08c48 <_Chain_Append> /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { ffc09a18: 7f 83 e3 78 mr r3,r28 ffc09a1c: 4b ff f2 85 bl ffc08ca0 <_Chain_Get> ffc09a20: 7c 64 1b 79 mr. r4,r3 ffc09a24: 40 82 ff c8 bne+ ffc099ec <_Objects_Extend_information+0x25c> _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; ffc09a28: a0 1f 00 14 lhz r0,20(r31) ffc09a2c: 81 3f 00 30 lwz r9,48(r31) ffc09a30: 7c 09 e9 2e stwx r0,r9,r29 information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); ffc09a34: a1 3f 00 2c lhz r9,44(r31) ffc09a38: 7c 00 4a 14 add r0,r0,r9 index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = ffc09a3c: b0 1f 00 2c sth r0,44(r31) (Objects_Maximum)(information->inactive + information->allocation_size); } ffc09a40: 39 61 00 48 addi r11,r1,72 ffc09a44: 4b ff 6a d8 b ffc0051c <_restgpr_21_x> =============================================================================== ffc09afc <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc09afc: 94 21 ff e8 stwu r1,-24(r1) ffc09b00: 7c 08 02 a6 mflr r0 ffc09b04: bf a1 00 0c stmw r29,12(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc09b08: 7c 9d 23 79 mr. r29,r4 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc09b0c: 7c 7e 1b 78 mr r30,r3 ffc09b10: 90 01 00 1c stw r0,28(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) return NULL; ffc09b14: 3b e0 00 00 li r31,0 ) { Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc09b18: 41 82 00 50 beq- ffc09b68 <_Objects_Get_information+0x6c> /* * 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 ); ffc09b1c: 48 00 4f 71 bl ffc0ea8c <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) ffc09b20: 2c 03 00 00 cmpwi r3,0 ffc09b24: 41 82 00 44 beq- ffc09b68 <_Objects_Get_information+0x6c> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) ffc09b28: 7f 9d 18 40 cmplw cr7,r29,r3 ffc09b2c: 41 9d 00 3c bgt- cr7,ffc09b68 <_Objects_Get_information+0x6c> return NULL; if ( !_Objects_Information_table[ the_api ] ) ffc09b30: 3d 20 00 00 lis r9,0 ffc09b34: 57 de 10 3a rlwinm r30,r30,2,0,29 ffc09b38: 39 29 2c 60 addi r9,r9,11360 ffc09b3c: 7d 29 f0 2e lwzx r9,r9,r30 ffc09b40: 2f 89 00 00 cmpwi cr7,r9,0 ffc09b44: 41 9e 00 24 beq- cr7,ffc09b68 <_Objects_Get_information+0x6c><== NEVER TAKEN return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; ffc09b48: 57 bd 10 3a rlwinm r29,r29,2,0,29 ffc09b4c: 7f e9 e8 2e lwzx r31,r9,r29 if ( !info ) ffc09b50: 2f 9f 00 00 cmpwi cr7,r31,0 ffc09b54: 41 9e 00 14 beq- cr7,ffc09b68 <_Objects_Get_information+0x6c><== NEVER TAKEN * In a multprocessing configuration, we may access remote objects. * Thus we may have 0 local instances and still have a valid object * pointer. */ #if !defined(RTEMS_MULTIPROCESSING) if ( info->maximum == 0 ) ffc09b58: a0 1f 00 10 lhz r0,16(r31) ffc09b5c: 2f 80 00 00 cmpwi cr7,r0,0 ffc09b60: 40 be 00 08 bne+ cr7,ffc09b68 <_Objects_Get_information+0x6c> return NULL; ffc09b64: 3b e0 00 00 li r31,0 #endif return info; } ffc09b68: 39 61 00 18 addi r11,r1,24 ffc09b6c: 7f e3 fb 78 mr r3,r31 ffc09b70: 4b ff 69 cc b ffc0053c <_restgpr_29_x> =============================================================================== ffc0a5b0 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0a5b0: 94 21 ff e0 stwu r1,-32(r1) ffc0a5b4: 7c 08 02 a6 mflr r0 ffc0a5b8: bf c1 00 18 stmw r30,24(r1) ffc0a5bc: 7c 9e 23 78 mr r30,r4 /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; ffc0a5c0: 7c 64 1b 79 mr. r4,r3 */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0a5c4: 90 01 00 24 stw r0,36(r1) /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; ffc0a5c8: 40 82 00 10 bne- ffc0a5d8 <_Objects_Id_to_name+0x28> ffc0a5cc: 3d 20 00 00 lis r9,0 ffc0a5d0: 81 29 31 b0 lwz r9,12720(r9) ffc0a5d4: 80 89 00 08 lwz r4,8(r9) */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); ffc0a5d8: 54 89 47 7e rlwinm r9,r4,8,29,31 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) ffc0a5dc: 38 09 ff ff addi r0,r9,-1 ffc0a5e0: 2b 80 00 02 cmplwi cr7,r0,2 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; ffc0a5e4: 3b e0 00 03 li r31,3 ffc0a5e8: 41 9d 00 44 bgt- cr7,ffc0a62c <_Objects_Id_to_name+0x7c> ffc0a5ec: 48 00 00 4c b ffc0a638 <_Objects_Id_to_name+0x88> if ( !_Objects_Information_table[ the_api ] ) return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; ffc0a5f0: 54 80 3e 7a rlwinm r0,r4,7,25,29 ffc0a5f4: 7c 69 00 2e lwzx r3,r9,r0 if ( !information ) ffc0a5f8: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a5fc: 41 9e 00 30 beq- cr7,ffc0a62c <_Objects_Id_to_name+0x7c><== NEVER TAKEN return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) ffc0a600: 88 03 00 38 lbz r0,56(r3) ffc0a604: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a608: 40 be 00 24 bne+ cr7,ffc0a62c <_Objects_Id_to_name+0x7c><== NEVER TAKEN return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); ffc0a60c: 38 a1 00 08 addi r5,r1,8 ffc0a610: 4b ff ff 21 bl ffc0a530 <_Objects_Get> if ( !the_object ) ffc0a614: 2c 03 00 00 cmpwi r3,0 ffc0a618: 41 82 00 14 beq- ffc0a62c <_Objects_Id_to_name+0x7c> return OBJECTS_INVALID_ID; *name = the_object->name; ffc0a61c: 80 03 00 0c lwz r0,12(r3) _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; ffc0a620: 3b e0 00 00 li r31,0 the_object = _Objects_Get( information, tmpId, &ignored_location ); if ( !the_object ) return OBJECTS_INVALID_ID; *name = the_object->name; ffc0a624: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0a628: 48 00 0e 79 bl ffc0b4a0 <_Thread_Enable_dispatch> return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } ffc0a62c: 39 61 00 20 addi r11,r1,32 ffc0a630: 7f e3 fb 78 mr r3,r31 ffc0a634: 4b ff 64 b8 b ffc00aec <_restgpr_30_x> the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; if ( !_Objects_Information_table[ the_api ] ) ffc0a638: 3d 60 00 00 lis r11,0 ffc0a63c: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc0a640: 39 6b 2c c0 addi r11,r11,11456 ffc0a644: 7d 2b 48 2e lwzx r9,r11,r9 ffc0a648: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a64c: 40 9e ff a4 bne+ cr7,ffc0a5f0 <_Objects_Id_to_name+0x40> ffc0a650: 4b ff ff dc b ffc0a62c <_Objects_Id_to_name+0x7c> =============================================================================== ffc0a124 <_POSIX_Absolute_timeout_to_ticks>: */ POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks( const struct timespec *abstime, Watchdog_Interval *ticks_out ) { ffc0a124: 94 21 ff e0 stwu r1,-32(r1) ffc0a128: 7c 08 02 a6 mflr r0 ffc0a12c: 90 01 00 24 stw r0,36(r1) /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0a130: 38 00 00 00 li r0,0 */ POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks( const struct timespec *abstime, Watchdog_Interval *ticks_out ) { ffc0a134: bf c1 00 18 stmw r30,24(r1) ffc0a138: 7c 7e 1b 78 mr r30,r3 ffc0a13c: 7c 9f 23 78 mr r31,r4 /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0a140: 90 04 00 00 stw r0,0(r4) /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0a144: 48 00 46 4d bl ffc0e790 <_Timespec_Is_valid> return POSIX_ABSOLUTE_TIMEOUT_INVALID; ffc0a148: 38 00 00 00 li r0,0 *ticks_out = 0; /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0a14c: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a150: 41 be 00 50 beq+ cr7,ffc0a1a0 <_POSIX_Absolute_timeout_to_ticks+0x7c> return POSIX_ABSOLUTE_TIMEOUT_INVALID; /* * Is the absolute time in the past? */ _TOD_Get( ¤t_time ); ffc0a154: 38 61 00 10 addi r3,r1,16 ffc0a158: 48 00 20 31 bl ffc0c188 <_TOD_Get> if ( _Timespec_Less_than( abstime, ¤t_time ) ) ffc0a15c: 7f c3 f3 78 mr r3,r30 ffc0a160: 38 81 00 10 addi r4,r1,16 ffc0a164: 48 00 46 6d bl ffc0e7d0 <_Timespec_Less_than> return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST; ffc0a168: 38 00 00 01 li r0,1 /* * Is the absolute time in the past? */ _TOD_Get( ¤t_time ); if ( _Timespec_Less_than( abstime, ¤t_time ) ) ffc0a16c: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a170: 40 be 00 30 bne+ cr7,ffc0a1a0 <_POSIX_Absolute_timeout_to_ticks+0x7c> return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST; /* * How long until the requested absolute time? */ _Timespec_Subtract( ¤t_time, abstime, &difference ); ffc0a174: 38 61 00 10 addi r3,r1,16 ffc0a178: 7f c4 f3 78 mr r4,r30 ffc0a17c: 38 a1 00 08 addi r5,r1,8 ffc0a180: 48 00 46 8d bl ffc0e80c <_Timespec_Subtract> /* * Internally the SuperCore uses ticks, so convert to them. */ *ticks_out = _Timespec_To_ticks( &difference ); ffc0a184: 38 61 00 08 addi r3,r1,8 ffc0a188: 48 00 46 c5 bl ffc0e84c <_Timespec_To_ticks> /* * This is the case we were expecting and it took this long to * get here. */ return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE; ffc0a18c: 38 00 00 03 li r0,3 /* * If the difference was 0, then the future is now. It is so bright * we better wear shades. */ if ( !*ticks_out ) ffc0a190: 2f 83 00 00 cmpwi cr7,r3,0 _Timespec_Subtract( ¤t_time, abstime, &difference ); /* * Internally the SuperCore uses ticks, so convert to them. */ *ticks_out = _Timespec_To_ticks( &difference ); ffc0a194: 90 7f 00 00 stw r3,0(r31) /* * If the difference was 0, then the future is now. It is so bright * we better wear shades. */ if ( !*ticks_out ) ffc0a198: 40 9e 00 08 bne- cr7,ffc0a1a0 <_POSIX_Absolute_timeout_to_ticks+0x7c><== ALWAYS TAKEN return POSIX_ABSOLUTE_TIMEOUT_IS_NOW; ffc0a19c: 38 00 00 02 li r0,2 <== NOT EXECUTED /* * This is the case we were expecting and it took this long to * get here. */ return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE; } ffc0a1a0: 39 61 00 20 addi r11,r1,32 ffc0a1a4: 7c 03 03 78 mr r3,r0 ffc0a1a8: 4b ff 87 30 b ffc028d8 <_restgpr_30_x> =============================================================================== ffc10244 <_POSIX_Keys_Run_destructors>: */ void _POSIX_Keys_Run_destructors( Thread_Control *thread ) { ffc10244: 94 21 ff e0 stwu r1,-32(r1) ffc10248: 7c 08 02 a6 mflr r0 ffc1024c: 90 01 00 24 stw r0,36(r1) ffc10250: bf 41 00 08 stmw r26,8(r1) * * Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99. */ while ( !done ) { Objects_Maximum index = 0; Objects_Maximum max = _POSIX_Keys_Information.maximum; ffc10254: 3f c0 00 00 lis r30,0 if ( key != NULL && key->destructor != NULL ) { void *value = key->Values [ thread_api ][ thread_index ]; if ( value != NULL ) { key->Values [ thread_api ][ thread_index ] = NULL; ffc10258: 3b 80 00 00 li r28,0 void _POSIX_Keys_Run_destructors( Thread_Control *thread ) { Objects_Maximum thread_index = _Objects_Get_index( thread->Object.id ); ffc1025c: 83 63 00 08 lwz r27,8(r3) for ( index = 1 ; index <= max ; ++index ) { POSIX_Keys_Control *key = (POSIX_Keys_Control *) _POSIX_Keys_Information.local_table [ index ]; if ( key != NULL && key->destructor != NULL ) { void *value = key->Values [ thread_api ][ thread_index ]; ffc10260: 57 7d 13 ba rlwinm r29,r27,2,14,29 ffc10264: 57 7b 56 fa rlwinm r27,r27,10,27,29 ffc10268: 3b 7b 00 10 addi r27,r27,16 * * Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99. */ while ( !done ) { Objects_Maximum index = 0; Objects_Maximum max = _POSIX_Keys_Information.maximum; ffc1026c: 39 3e 30 24 addi r9,r30,12324 ffc10270: a3 49 00 10 lhz r26,16(r9) done = true; for ( index = 1 ; index <= max ; ++index ) { ffc10274: 3b e0 00 01 li r31,1 */ while ( !done ) { Objects_Maximum index = 0; Objects_Maximum max = _POSIX_Keys_Information.maximum; done = true; ffc10278: 38 00 00 01 li r0,1 for ( index = 1 ; index <= max ; ++index ) { ffc1027c: 48 00 00 58 b ffc102d4 <_POSIX_Keys_Run_destructors+0x90> POSIX_Keys_Control *key = (POSIX_Keys_Control *) _POSIX_Keys_Information.local_table [ index ]; ffc10280: 39 3e 30 24 addi r9,r30,12324 Objects_Maximum max = _POSIX_Keys_Information.maximum; done = true; for ( index = 1 ; index <= max ; ++index ) { POSIX_Keys_Control *key = (POSIX_Keys_Control *) ffc10284: 81 69 00 1c lwz r11,28(r9) ffc10288: 57 e9 10 3a rlwinm r9,r31,2,0,29 ffc1028c: 7d 2b 48 2e lwzx r9,r11,r9 _POSIX_Keys_Information.local_table [ index ]; if ( key != NULL && key->destructor != NULL ) { ffc10290: 2f 89 00 00 cmpwi cr7,r9,0 ffc10294: 41 9e 00 38 beq- cr7,ffc102cc <_POSIX_Keys_Run_destructors+0x88> ffc10298: 81 69 00 10 lwz r11,16(r9) ffc1029c: 2f 8b 00 00 cmpwi cr7,r11,0 ffc102a0: 41 9e 00 2c beq- cr7,ffc102cc <_POSIX_Keys_Run_destructors+0x88> void *value = key->Values [ thread_api ][ thread_index ]; ffc102a4: 7d 69 da 14 add r11,r9,r27 ffc102a8: 81 6b 00 04 lwz r11,4(r11) ffc102ac: 7c 6b e8 2e lwzx r3,r11,r29 if ( value != NULL ) { ffc102b0: 2f 83 00 00 cmpwi cr7,r3,0 ffc102b4: 41 9e 00 18 beq- cr7,ffc102cc <_POSIX_Keys_Run_destructors+0x88><== ALWAYS TAKEN key->Values [ thread_api ][ thread_index ] = NULL; ffc102b8: 7f 8b e9 2e stwx r28,r11,r29 <== NOT EXECUTED (*key->destructor)( value ); ffc102bc: 80 09 00 10 lwz r0,16(r9) <== NOT EXECUTED ffc102c0: 7c 09 03 a6 mtctr r0 <== NOT EXECUTED ffc102c4: 4e 80 04 21 bctrl <== NOT EXECUTED done = false; ffc102c8: 38 00 00 00 li r0,0 <== NOT EXECUTED Objects_Maximum index = 0; Objects_Maximum max = _POSIX_Keys_Information.maximum; done = true; for ( index = 1 ; index <= max ; ++index ) { ffc102cc: 3b ff 00 01 addi r31,r31,1 ffc102d0: 57 ff 04 3e clrlwi r31,r31,16 ffc102d4: 7f 9f d0 40 cmplw cr7,r31,r26 ffc102d8: 40 bd ff a8 ble- cr7,ffc10280 <_POSIX_Keys_Run_destructors+0x3c> * number of iterations. An infinite loop may happen if destructors set * thread specific data. This can be considered dubious. * * Reference: 17.1.1.2 P1003.1c/Draft 10, p. 163, line 99. */ while ( !done ) { ffc102dc: 2f 80 00 00 cmpwi cr7,r0,0 ffc102e0: 41 9e ff 8c beq+ cr7,ffc1026c <_POSIX_Keys_Run_destructors+0x28><== NEVER TAKEN done = false; } } } } } ffc102e4: 39 61 00 20 addi r11,r1,32 ffc102e8: 4b ff 02 48 b ffc00530 <_restgpr_26_x> =============================================================================== ffc0cea0 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { ffc0cea0: 94 21 ff c8 stwu r1,-56(r1) ffc0cea4: 7c 08 02 a6 mflr r0 ffc0cea8: bf 61 00 24 stmw r27,36(r1) ffc0ceac: 7c 7e 1b 78 mr r30,r3 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( ffc0ceb0: 3c 60 00 00 lis r3,0 ffc0ceb4: 7c 9d 23 78 mr r29,r4 ffc0ceb8: 90 01 00 3c stw r0,60(r1) ffc0cebc: 7c bc 2b 78 mr r28,r5 ffc0cec0: 38 63 36 18 addi r3,r3,13848 ffc0cec4: 91 01 00 18 stw r8,24(r1) ffc0cec8: 7f c4 f3 78 mr r4,r30 ffc0cecc: 38 a1 00 0c addi r5,r1,12 ffc0ced0: 7c df 33 78 mr r31,r6 ffc0ced4: 7c fb 3b 78 mr r27,r7 ffc0ced8: 48 00 35 ed bl ffc104c4 <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { ffc0cedc: 80 01 00 0c lwz r0,12(r1) ffc0cee0: 81 01 00 18 lwz r8,24(r1) ffc0cee4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cee8: 40 9e 00 d4 bne- cr7,ffc0cfbc <_POSIX_Message_queue_Receive_support+0x11c> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { ffc0ceec: 81 23 00 14 lwz r9,20(r3) ffc0cef0: 55 20 07 be clrlwi r0,r9,30 ffc0cef4: 2f 80 00 01 cmpwi cr7,r0,1 ffc0cef8: 40 be 00 0c bne+ cr7,ffc0cf04 <_POSIX_Message_queue_Receive_support+0x64> _Thread_Enable_dispatch(); ffc0cefc: 48 00 45 31 bl ffc1142c <_Thread_Enable_dispatch> ffc0cf00: 48 00 00 bc b ffc0cfbc <_POSIX_Message_queue_Receive_support+0x11c> rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; ffc0cf04: 80 63 00 10 lwz r3,16(r3) if ( msg_len < the_mq->Message_queue.maximum_message_size ) { ffc0cf08: 80 03 00 68 lwz r0,104(r3) ffc0cf0c: 7f 9c 00 40 cmplw cr7,r28,r0 ffc0cf10: 40 bc 00 14 bge+ cr7,ffc0cf24 <_POSIX_Message_queue_Receive_support+0x84> _Thread_Enable_dispatch(); ffc0cf14: 48 00 45 19 bl ffc1142c <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); ffc0cf18: 48 00 ad c1 bl ffc17cd8 <__errno> ffc0cf1c: 38 00 00 7a li r0,122 ffc0cf20: 48 00 00 a4 b ffc0cfc4 <_POSIX_Message_queue_Receive_support+0x124> length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0cf24: 2f 9b 00 00 cmpwi cr7,r27,0 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; ffc0cf28: 38 00 ff ff li r0,-1 ffc0cf2c: 90 01 00 08 stw r0,8(r1) /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0cf30: 38 00 00 00 li r0,0 ffc0cf34: 41 9e 00 10 beq- cr7,ffc0cf44 <_POSIX_Message_queue_Receive_support+0xa4> do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; ffc0cf38: 71 20 40 00 andi. r0,r9,16384 ffc0cf3c: 7c 00 00 26 mfcr r0 ffc0cf40: 54 00 1f fe rlwinm r0,r0,3,31,31 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0cf44: 38 63 00 1c addi r3,r3,28 ffc0cf48: 7f c4 f3 78 mr r4,r30 ffc0cf4c: 7f a5 eb 78 mr r5,r29 ffc0cf50: 38 c1 00 08 addi r6,r1,8 ffc0cf54: 7c 07 03 78 mr r7,r0 ffc0cf58: 48 00 23 c5 bl ffc0f31c <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); ffc0cf5c: 48 00 44 d1 bl ffc1142c <_Thread_Enable_dispatch> if (msg_prio) { ffc0cf60: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0cf64: 41 9e 00 20 beq- cr7,ffc0cf84 <_POSIX_Message_queue_Receive_support+0xe4><== NEVER TAKEN *msg_prio = _POSIX_Message_queue_Priority_from_core( _Thread_Executing->Wait.count ffc0cf68: 3d 20 00 00 lis r9,0 ffc0cf6c: 81 29 36 90 lwz r9,13968(r9) 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); ffc0cf70: 80 09 00 24 lwz r0,36(r9) ffc0cf74: 7c 09 fe 70 srawi r9,r0,31 ffc0cf78: 7d 20 02 78 xor r0,r9,r0 ffc0cf7c: 7c 09 00 50 subf r0,r9,r0 timeout ); _Thread_Enable_dispatch(); if (msg_prio) { *msg_prio = _POSIX_Message_queue_Priority_from_core( ffc0cf80: 90 1f 00 00 stw r0,0(r31) _Thread_Executing->Wait.count ); } if ( !_Thread_Executing->Wait.return_code ) ffc0cf84: 3f e0 00 00 lis r31,0 return length_out; ffc0cf88: 80 61 00 08 lwz r3,8(r1) *msg_prio = _POSIX_Message_queue_Priority_from_core( _Thread_Executing->Wait.count ); } if ( !_Thread_Executing->Wait.return_code ) ffc0cf8c: 3b ff 36 84 addi r31,r31,13956 ffc0cf90: 81 3f 00 0c lwz r9,12(r31) ffc0cf94: 80 09 00 34 lwz r0,52(r9) ffc0cf98: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cf9c: 41 be 00 30 beq+ cr7,ffc0cfcc <_POSIX_Message_queue_Receive_support+0x12c> return length_out; rtems_set_errno_and_return_minus_one( ffc0cfa0: 48 00 ad 39 bl ffc17cd8 <__errno> ffc0cfa4: 81 3f 00 0c lwz r9,12(r31) ffc0cfa8: 7c 7e 1b 78 mr r30,r3 ffc0cfac: 80 69 00 34 lwz r3,52(r9) ffc0cfb0: 48 00 02 a5 bl ffc0d254 <_POSIX_Message_queue_Translate_core_message_queue_return_code> ffc0cfb4: 90 7e 00 00 stw r3,0(r30) ffc0cfb8: 48 00 00 10 b ffc0cfc8 <_POSIX_Message_queue_Receive_support+0x128> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); ffc0cfbc: 48 00 ad 1d bl ffc17cd8 <__errno> ffc0cfc0: 38 00 00 09 li r0,9 ffc0cfc4: 90 03 00 00 stw r0,0(r3) ffc0cfc8: 38 60 ff ff li r3,-1 } ffc0cfcc: 39 61 00 38 addi r11,r1,56 ffc0cfd0: 4b ff 89 28 b ffc058f8 <_restgpr_27_x> =============================================================================== ffc0d4cc <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>: #include void _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( Thread_Control *the_thread ) { ffc0d4cc: 7c 08 02 a6 mflr r0 ffc0d4d0: 94 21 ff f8 stwu r1,-8(r1) ffc0d4d4: 90 01 00 0c stw r0,12(r1) POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0d4d8: 81 23 01 34 lwz r9,308(r3) if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc0d4dc: 80 09 00 d8 lwz r0,216(r9) ffc0d4e0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d4e4: 40 9e 00 3c bne- cr7,ffc0d520 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54><== NEVER TAKEN ffc0d4e8: 80 09 00 dc lwz r0,220(r9) ffc0d4ec: 2f 80 00 01 cmpwi cr7,r0,1 ffc0d4f0: 40 be 00 30 bne+ cr7,ffc0d520 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && ffc0d4f4: 80 09 00 e0 lwz r0,224(r9) ffc0d4f8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d4fc: 41 be 00 24 beq+ cr7,ffc0d520 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x54> * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc0d500: 3d 20 00 00 lis r9,0 ffc0d504: 81 69 28 14 lwz r11,10260(r9) thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); ffc0d508: 38 80 ff ff li r4,-1 ffc0d50c: 38 0b ff ff addi r0,r11,-1 ffc0d510: 90 09 28 14 stw r0,10260(r9) return _Thread_Dispatch_disable_level; ffc0d514: 80 09 28 14 lwz r0,10260(r9) ffc0d518: 48 00 07 3d bl ffc0dc54 <_POSIX_Thread_Exit> ffc0d51c: 48 00 00 08 b ffc0d524 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x58> } else _Thread_Enable_dispatch(); ffc0d520: 4b ff d4 19 bl ffc0a938 <_Thread_Enable_dispatch> } ffc0d524: 80 01 00 0c lwz r0,12(r1) ffc0d528: 38 21 00 08 addi r1,r1,8 ffc0d52c: 7c 08 03 a6 mtlr r0 ffc0d530: 4e 80 00 20 blr =============================================================================== ffc0e9bc <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { ffc0e9bc: 94 21 ff e0 stwu r1,-32(r1) ffc0e9c0: 7c 08 02 a6 mflr r0 ffc0e9c4: bf 61 00 0c stmw r27,12(r1) ffc0e9c8: 7c 7f 1b 78 mr r31,r3 ffc0e9cc: 7c 9e 23 78 mr r30,r4 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc0e9d0: 80 64 00 00 lwz r3,0(r4) int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { ffc0e9d4: 7c bd 2b 78 mr r29,r5 ffc0e9d8: 90 01 00 24 stw r0,36(r1) ffc0e9dc: 7c db 33 78 mr r27,r6 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc0e9e0: 4b ff ff b5 bl ffc0e994 <_POSIX_Priority_Is_valid> return EINVAL; ffc0e9e4: 3b 80 00 16 li r28,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 ) ) ffc0e9e8: 2f 83 00 00 cmpwi cr7,r3,0 ffc0e9ec: 41 be 00 c8 beq+ cr7,ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8><== NEVER TAKEN return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { ffc0e9f0: 2f 9f 00 00 cmpwi cr7,r31,0 ) { if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; ffc0e9f4: 38 00 00 00 li r0,0 ffc0e9f8: 90 1d 00 00 stw r0,0(r29) *budget_callout = NULL; ffc0e9fc: 90 1b 00 00 stw r0,0(r27) if ( policy == SCHED_OTHER ) { ffc0ea00: 40 be 00 10 bne+ cr7,ffc0ea10 <_POSIX_Thread_Translate_sched_param+0x54> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; ffc0ea04: 38 00 00 01 li r0,1 ffc0ea08: 90 1d 00 00 stw r0,0(r29) ffc0ea0c: 48 00 00 a4 b ffc0eab0 <_POSIX_Thread_Translate_sched_param+0xf4> return 0; } if ( policy == SCHED_FIFO ) { ffc0ea10: 2f 9f 00 01 cmpwi cr7,r31,1 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; ffc0ea14: 3b 80 00 00 li r28,0 if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { ffc0ea18: 41 9e 00 9c beq- cr7,ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { ffc0ea1c: 2f 9f 00 02 cmpwi cr7,r31,2 ffc0ea20: 40 be 00 0c bne+ cr7,ffc0ea2c <_POSIX_Thread_Translate_sched_param+0x70> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; ffc0ea24: 93 fd 00 00 stw r31,0(r29) return 0; ffc0ea28: 48 00 00 8c b ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8> } if ( policy == SCHED_SPORADIC ) { ffc0ea2c: 2f 9f 00 04 cmpwi cr7,r31,4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; ffc0ea30: 3b 80 00 16 li r28,22 if ( policy == SCHED_RR ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { ffc0ea34: 40 be 00 80 bne+ cr7,ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8> if ( (param->sched_ss_repl_period.tv_sec == 0) && ffc0ea38: 80 1e 00 08 lwz r0,8(r30) ffc0ea3c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ea40: 40 9e 00 10 bne- cr7,ffc0ea50 <_POSIX_Thread_Translate_sched_param+0x94> ffc0ea44: 80 1e 00 0c lwz r0,12(r30) ffc0ea48: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ea4c: 41 be 00 68 beq+ cr7,ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8> (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && ffc0ea50: 80 1e 00 10 lwz r0,16(r30) ffc0ea54: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ea58: 40 9e 00 14 bne- cr7,ffc0ea6c <_POSIX_Thread_Translate_sched_param+0xb0> ffc0ea5c: 80 1e 00 14 lwz r0,20(r30) (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; ffc0ea60: 3b 80 00 16 li r28,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) && ffc0ea64: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ea68: 41 be 00 4c beq+ cr7,ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8> (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < ffc0ea6c: 38 7e 00 08 addi r3,r30,8 ffc0ea70: 4b ff d9 d1 bl ffc0c440 <_Timespec_To_ticks> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; ffc0ea74: 3b 80 00 16 li r28,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 ) < ffc0ea78: 7c 7f 1b 78 mr r31,r3 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) ffc0ea7c: 38 7e 00 10 addi r3,r30,16 ffc0ea80: 4b ff d9 c1 bl ffc0c440 <_Timespec_To_ticks> 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 ) < ffc0ea84: 7f 9f 18 40 cmplw cr7,r31,r3 ffc0ea88: 41 bc 00 2c blt+ cr7,ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) ffc0ea8c: 80 7e 00 04 lwz r3,4(r30) ffc0ea90: 4b ff ff 05 bl ffc0e994 <_POSIX_Priority_Is_valid> ffc0ea94: 2f 83 00 00 cmpwi cr7,r3,0 ffc0ea98: 41 be 00 1c beq+ cr7,ffc0eab4 <_POSIX_Thread_Translate_sched_param+0xf8> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; ffc0ea9c: 38 00 00 03 li r0,3 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc0eaa0: 3d 20 ff c1 lis r9,-63 return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; ffc0eaa4: 90 1d 00 00 stw r0,0(r29) *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc0eaa8: 38 09 83 4c addi r0,r9,-31924 ffc0eaac: 90 1b 00 00 stw r0,0(r27) return 0; ffc0eab0: 3b 80 00 00 li r28,0 } return EINVAL; } ffc0eab4: 39 61 00 20 addi r11,r1,32 ffc0eab8: 7f 83 e3 78 mr r3,r28 ffc0eabc: 4b ff 20 a0 b ffc00b5c <_restgpr_27_x> =============================================================================== ffc0db88 <_POSIX_Threads_Delete_extension>: */ void _POSIX_Threads_Delete_extension( Thread_Control *executing __attribute__((unused)), Thread_Control *deleted ) { ffc0db88: 94 21 ff e8 stwu r1,-24(r1) ffc0db8c: 7c 08 02 a6 mflr r0 api = deleted->API_Extensions[ THREAD_API_POSIX ]; /* * Run the POSIX cancellation handlers */ _POSIX_Threads_cancel_run( deleted ); ffc0db90: 7c 83 23 78 mr r3,r4 */ void _POSIX_Threads_Delete_extension( Thread_Control *executing __attribute__((unused)), Thread_Control *deleted ) { ffc0db94: bf 81 00 08 stmw r28,8(r1) ffc0db98: 7c 9f 23 78 mr r31,r4 Thread_Control *the_thread; POSIX_API_Control *api; void **value_ptr; api = deleted->API_Extensions[ THREAD_API_POSIX ]; ffc0db9c: 83 c4 01 34 lwz r30,308(r4) */ void _POSIX_Threads_Delete_extension( Thread_Control *executing __attribute__((unused)), Thread_Control *deleted ) { ffc0dba0: 90 01 00 1c stw r0,28(r1) api = deleted->API_Extensions[ THREAD_API_POSIX ]; /* * Run the POSIX cancellation handlers */ _POSIX_Threads_cancel_run( deleted ); ffc0dba4: 48 00 26 29 bl ffc101cc <_POSIX_Threads_cancel_run> /* * Run all the key destructors */ _POSIX_Keys_Run_destructors( deleted ); ffc0dba8: 7f e3 fb 78 mr r3,r31 ffc0dbac: 48 00 26 99 bl ffc10244 <_POSIX_Keys_Run_destructors> /* * Wakeup all the tasks which joined with this one */ value_ptr = (void **) deleted->Wait.return_argument; while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) ) ffc0dbb0: 3b be 00 44 addi r29,r30,68 _POSIX_Keys_Run_destructors( deleted ); /* * Wakeup all the tasks which joined with this one */ value_ptr = (void **) deleted->Wait.return_argument; ffc0dbb4: 83 9f 00 28 lwz r28,40(r31) while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) ) ffc0dbb8: 48 00 00 0c b ffc0dbc4 <_POSIX_Threads_Delete_extension+0x3c> *(void **)the_thread->Wait.return_argument = value_ptr; ffc0dbbc: 81 23 00 28 lwz r9,40(r3) <== NOT EXECUTED ffc0dbc0: 93 89 00 00 stw r28,0(r9) <== NOT EXECUTED /* * Wakeup all the tasks which joined with this one */ value_ptr = (void **) deleted->Wait.return_argument; while ( (the_thread = _Thread_queue_Dequeue( &api->Join_List )) ) ffc0dbc4: 7f a3 eb 78 mr r3,r29 ffc0dbc8: 4b ff d2 a1 bl ffc0ae68 <_Thread_queue_Dequeue> ffc0dbcc: 2c 03 00 00 cmpwi r3,0 ffc0dbd0: 40 82 ff ec bne+ ffc0dbbc <_POSIX_Threads_Delete_extension+0x34><== NEVER TAKEN *(void **)the_thread->Wait.return_argument = value_ptr; if ( api->schedpolicy == SCHED_SPORADIC ) ffc0dbd4: 80 1e 00 84 lwz r0,132(r30) ffc0dbd8: 2f 80 00 04 cmpwi cr7,r0,4 ffc0dbdc: 40 be 00 0c bne+ cr7,ffc0dbe8 <_POSIX_Threads_Delete_extension+0x60> (void) _Watchdog_Remove( &api->Sporadic_timer ); ffc0dbe0: 38 7e 00 a8 addi r3,r30,168 ffc0dbe4: 4b ff df a9 bl ffc0bb8c <_Watchdog_Remove> deleted->API_Extensions[ THREAD_API_POSIX ] = NULL; ffc0dbe8: 38 00 00 00 li r0,0 ffc0dbec: 90 1f 01 34 stw r0,308(r31) _Workspace_Free( api ); ffc0dbf0: 7f c3 f3 78 mr r3,r30 ffc0dbf4: 4b ff e1 8d bl ffc0bd80 <_Workspace_Free> } ffc0dbf8: 39 61 00 18 addi r11,r1,24 ffc0dbfc: 4b ff 29 3c b ffc00538 <_restgpr_28_x> =============================================================================== ffc08034 <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc08034: 94 21 ff 98 stwu r1,-104(r1) ffc08038: 7c 08 02 a6 mflr r0 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; ffc0803c: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc08040: 90 01 00 6c stw r0,108(r1) 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; ffc08044: 39 29 20 44 addi r9,r9,8260 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc08048: bf a1 00 5c stmw r29,92(r1) 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; ffc0804c: 83 e9 00 34 lwz r31,52(r9) maximum = Configuration_POSIX_API.number_of_initialization_threads; ffc08050: 83 a9 00 30 lwz r29,48(r9) if ( !user_threads || maximum == 0 ) ffc08054: 2f 9f 00 00 cmpwi cr7,r31,0 ffc08058: 41 9e 00 68 beq- cr7,ffc080c0 <_POSIX_Threads_Initialize_user_threads_body+0x8c><== NEVER TAKEN ffc0805c: 2f 9d 00 00 cmpwi cr7,r29,0 ffc08060: 41 9e 00 60 beq- cr7,ffc080c0 <_POSIX_Threads_Initialize_user_threads_body+0x8c><== NEVER TAKEN ffc08064: 3b c0 00 00 li r30,0 for ( index=0 ; index < maximum ; index++ ) { /* * There is no way for these calls to fail in this situation. */ (void) pthread_attr_init( &attr ); ffc08068: 38 61 00 0c addi r3,r1,12 ffc0806c: 48 00 6a 55 bl ffc0eac0 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); ffc08070: 38 80 00 02 li r4,2 ffc08074: 38 61 00 0c addi r3,r1,12 ffc08078: 48 00 6a 89 bl ffc0eb00 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); ffc0807c: 80 9f 00 04 lwz r4,4(r31) ffc08080: 38 61 00 0c addi r3,r1,12 ffc08084: 48 00 6a b5 bl ffc0eb38 status = pthread_create( ffc08088: 80 bf 00 00 lwz r5,0(r31) ffc0808c: 38 61 00 08 addi r3,r1,8 ffc08090: 38 81 00 0c addi r4,r1,12 ffc08094: 38 c0 00 00 li r6,0 ffc08098: 4b ff fc 5d bl ffc07cf4 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) ffc0809c: 7c 65 1b 79 mr. r5,r3 ffc080a0: 41 a2 00 10 beq+ ffc080b0 <_POSIX_Threads_Initialize_user_threads_body+0x7c> _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); ffc080a4: 38 60 00 02 li r3,2 ffc080a8: 38 80 00 01 li r4,1 ffc080ac: 48 00 22 d5 bl ffc0a380 <_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++ ) { ffc080b0: 3b de 00 01 addi r30,r30,1 ffc080b4: 7f 9e e8 00 cmpw cr7,r30,r29 ffc080b8: 3b ff 00 08 addi r31,r31,8 ffc080bc: 40 9e ff ac bne+ cr7,ffc08068 <_POSIX_Threads_Initialize_user_threads_body+0x34><== NEVER TAKEN NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); } } ffc080c0: 39 61 00 68 addi r11,r1,104 ffc080c4: 4b ff 8a a0 b ffc00b64 <_restgpr_29_x> =============================================================================== ffc0dd24 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { ffc0dd24: 94 21 ff f0 stwu r1,-16(r1) ffc0dd28: 7c 08 02 a6 mflr r0 ffc0dd2c: 90 01 00 14 stw r0,20(r1) ffc0dd30: bf c1 00 08 stmw r30,8(r1) ffc0dd34: 7c 9e 23 78 mr r30,r4 Thread_Control *the_thread; POSIX_API_Control *api; the_thread = argument; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0dd38: 83 e4 01 34 lwz r31,308(r4) /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); ffc0dd3c: 38 7f 00 98 addi r3,r31,152 ffc0dd40: 48 00 10 a9 bl ffc0ede8 <_Timespec_To_ticks> RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); ffc0dd44: 3d 20 00 00 lis r9,0 ffc0dd48: 80 1f 00 88 lwz r0,136(r31) ffc0dd4c: 88 89 27 24 lbz r4,10020(r9) the_thread->cpu_time_budget = ticks; ffc0dd50: 90 7e 00 78 stw r3,120(r30) ffc0dd54: 7c 80 20 50 subf r4,r0,r4 */ #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 ) { ffc0dd58: 80 1e 00 1c lwz r0,28(r30) 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; ffc0dd5c: 90 9e 00 18 stw r4,24(r30) */ #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 ) { ffc0dd60: 2f 80 00 00 cmpwi cr7,r0,0 ffc0dd64: 40 9e 00 1c bne- cr7,ffc0dd80 <_POSIX_Threads_Sporadic_budget_TSR+0x5c><== NEVER TAKEN /* * If this would make them less important, then do not change it. */ if ( the_thread->current_priority > new_priority ) { ffc0dd68: 80 1e 00 14 lwz r0,20(r30) ffc0dd6c: 7f 80 20 40 cmplw cr7,r0,r4 ffc0dd70: 40 bd 00 10 ble+ cr7,ffc0dd80 <_POSIX_Threads_Sporadic_budget_TSR+0x5c> _Thread_Change_priority( the_thread, new_priority, true ); ffc0dd74: 7f c3 f3 78 mr r3,r30 ffc0dd78: 38 a0 00 01 li r5,1 ffc0dd7c: 4b ff c8 59 bl ffc0a5d4 <_Thread_Change_priority> #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); ffc0dd80: 38 7f 00 90 addi r3,r31,144 ffc0dd84: 48 00 10 65 bl ffc0ede8 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0dd88: 38 9f 00 a8 addi r4,r31,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0dd8c: 90 7f 00 b4 stw r3,180(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0dd90: 3c 60 00 00 lis r3,0 ffc0dd94: 38 63 2d 68 addi r3,r3,11624 ffc0dd98: 4b ff dc 9d bl ffc0ba34 <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } ffc0dd9c: 39 61 00 10 addi r11,r1,16 ffc0dda0: 4b ff 27 a0 b ffc00540 <_restgpr_30_x> =============================================================================== ffc0dda4 <_POSIX_Threads_Sporadic_budget_callout>: * _POSIX_Threads_Sporadic_budget_callout */ void _POSIX_Threads_Sporadic_budget_callout( Thread_Control *the_thread ) { ffc0dda4: 7c 08 02 a6 mflr r0 ffc0dda8: 94 21 ff f8 stwu r1,-8(r1) ffc0ddac: 3d 40 00 00 lis r10,0 ffc0ddb0: 90 01 00 0c stw r0,12(r1) /* * 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 */ ffc0ddb4: 38 00 ff ff li r0,-1 ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0ddb8: 81 63 01 34 lwz r11,308(r3) /* * 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 */ ffc0ddbc: 90 03 00 78 stw r0,120(r3) ffc0ddc0: 88 8a 27 24 lbz r4,10020(r10) ffc0ddc4: 80 0b 00 8c lwz r0,140(r11) ffc0ddc8: 7c 80 20 50 subf r4,r0,r4 */ #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 ) { ffc0ddcc: 80 03 00 1c lwz r0,28(r3) * 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; ffc0ddd0: 90 83 00 18 stw r4,24(r3) */ #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 ) { ffc0ddd4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ddd8: 40 9e 00 18 bne- cr7,ffc0ddf0 <_POSIX_Threads_Sporadic_budget_callout+0x4c><== 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 ) { ffc0dddc: 80 03 00 14 lwz r0,20(r3) ffc0dde0: 7f 80 20 40 cmplw cr7,r0,r4 ffc0dde4: 40 bc 00 0c bge+ cr7,ffc0ddf0 <_POSIX_Threads_Sporadic_budget_callout+0x4c><== NEVER TAKEN _Thread_Change_priority( the_thread, new_priority, true ); ffc0dde8: 38 a0 00 01 li r5,1 ffc0ddec: 4b ff c7 e9 bl ffc0a5d4 <_Thread_Change_priority> #if 0 printk( "lower priority\n" ); #endif } } } ffc0ddf0: 80 01 00 0c lwz r0,12(r1) ffc0ddf4: 38 21 00 08 addi r1,r1,8 ffc0ddf8: 7c 08 03 a6 mtlr r0 ffc0ddfc: 4e 80 00 20 blr =============================================================================== ffc07d80 <_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) { ffc07d80: 7c 08 02 a6 mflr r0 ffc07d84: 7c 2b 0b 78 mr r11,r1 ffc07d88: 94 21 ff f0 stwu r1,-16(r1) ffc07d8c: 90 01 00 14 stw r0,20(r1) ffc07d90: 48 01 42 a5 bl ffc1c034 <_savegpr_31> ffc07d94: 7c 9f 23 78 mr r31,r4 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; ffc07d98: 81 24 00 68 lwz r9,104(r4) ffc07d9c: 38 09 00 01 addi r0,r9,1 ffc07da0: 90 04 00 68 stw r0,104(r4) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc07da4: 80 04 00 54 lwz r0,84(r4) ffc07da8: 2f 80 00 00 cmpwi cr7,r0,0 ffc07dac: 40 9e 00 10 bne- cr7,ffc07dbc <_POSIX_Timer_TSR+0x3c> ffc07db0: 80 04 00 58 lwz r0,88(r4) ffc07db4: 2f 80 00 00 cmpwi cr7,r0,0 ffc07db8: 41 9e 00 38 beq- cr7,ffc07df0 <_POSIX_Timer_TSR+0x70> <== NEVER TAKEN ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( ffc07dbc: 80 9f 00 64 lwz r4,100(r31) ffc07dc0: 3c c0 ff c0 lis r6,-64 ffc07dc4: 80 bf 00 08 lwz r5,8(r31) ffc07dc8: 38 7f 00 10 addi r3,r31,16 ffc07dcc: 38 c6 7d 80 addi r6,r6,32128 ffc07dd0: 7f e7 fb 78 mr r7,r31 ffc07dd4: 48 00 68 f5 bl ffc0e6c8 <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) ffc07dd8: 2f 83 00 00 cmpwi cr7,r3,0 ffc07ddc: 41 be 00 30 beq+ cr7,ffc07e0c <_POSIX_Timer_TSR+0x8c> <== NEVER TAKEN return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); ffc07de0: 38 7f 00 6c addi r3,r31,108 ffc07de4: 48 00 19 49 bl ffc0972c <_TOD_Get> /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc07de8: 38 00 00 03 li r0,3 ffc07dec: 48 00 00 08 b ffc07df4 <_POSIX_Timer_TSR+0x74> } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; ffc07df0: 38 00 00 04 li r0,4 <== NOT EXECUTED ffc07df4: 98 1f 00 3c stb r0,60(r31) /* * 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 ) ) { ffc07df8: 80 7f 00 38 lwz r3,56(r31) ffc07dfc: 80 9f 00 44 lwz r4,68(r31) ffc07e00: 48 00 63 f1 bl ffc0e1f0 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; ffc07e04: 38 00 00 00 li r0,0 ffc07e08: 90 1f 00 68 stw r0,104(r31) } ffc07e0c: 39 61 00 10 addi r11,r1,16 ffc07e10: 4b ff 88 48 b ffc00658 <_restgpr_31_x> =============================================================================== ffc102ec <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc102ec: 94 21 ff 98 stwu r1,-104(r1) ffc102f0: 7c 08 02 a6 mflr r0 ffc102f4: 7c a6 2b 78 mr r6,r5 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, ffc102f8: 38 e0 00 01 li r7,1 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc102fc: bf 21 00 4c stmw r25,76(r1) 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, ffc10300: 38 a1 00 08 addi r5,r1,8 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc10304: 90 01 00 6c stw r0,108(r1) ffc10308: 7c 7f 1b 78 mr r31,r3 ffc1030c: 7c 9e 23 78 mr r30,r4 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, ffc10310: 48 00 00 b1 bl ffc103c0 <_POSIX_signals_Clear_signals> ffc10314: 2f 83 00 00 cmpwi cr7,r3,0 is_global, true ) ) return false; ffc10318: 38 00 00 00 li r0,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, ffc1031c: 41 9e 00 98 beq- cr7,ffc103b4 <_POSIX_signals_Check_signal+0xc8> #endif /* * Just to prevent sending a signal which is currently being ignored. */ if ( _POSIX_signals_Vectors[ signo ].sa_handler == SIG_IGN ) ffc10320: 3f 20 00 00 lis r25,0 ffc10324: 1f 5e 00 0c mulli r26,r30,12 ffc10328: 3b 39 31 c0 addi r25,r25,12736 ffc1032c: 7d 39 d2 14 add r9,r25,r26 ffc10330: 83 a9 00 08 lwz r29,8(r9) ffc10334: 2f 9d 00 01 cmpwi cr7,r29,1 ffc10338: 41 9e 00 7c beq- cr7,ffc103b4 <_POSIX_signals_Check_signal+0xc8><== NEVER TAKEN /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; ffc1033c: 80 09 00 04 lwz r0,4(r9) /* * 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, ffc10340: 3f 60 00 00 lis r27,0 return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; ffc10344: 83 9f 00 d0 lwz r28,208(r31) /* * 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, ffc10348: 39 3b 31 44 addi r9,r27,12612 ffc1034c: 80 89 00 0c lwz r4,12(r9) ffc10350: 38 61 00 14 addi r3,r1,20 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; ffc10354: 7c 00 e3 78 or r0,r0,r28 ffc10358: 90 1f 00 d0 stw r0,208(r31) /* * 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, ffc1035c: 38 84 00 20 addi r4,r4,32 ffc10360: 38 a0 00 28 li r5,40 ffc10364: 48 00 15 8d bl ffc118f0 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { ffc10368: 7c 19 d0 2e lwzx r0,r25,r26 case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( ffc1036c: 7f c3 f3 78 mr r3,r30 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { ffc10370: 2f 80 00 02 cmpwi cr7,r0,2 ffc10374: 40 be 00 18 bne+ cr7,ffc1038c <_POSIX_signals_Check_signal+0xa0> case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( ffc10378: 38 81 00 08 addi r4,r1,8 ffc1037c: 7f a9 03 a6 mtctr r29 ffc10380: 38 a0 00 00 li r5,0 ffc10384: 4e 80 04 21 bctrl signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; ffc10388: 48 00 00 0c b ffc10394 <_POSIX_signals_Check_signal+0xa8> default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); ffc1038c: 7f a9 03 a6 mtctr r29 ffc10390: 4e 80 04 21 bctrl } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, ffc10394: 3b 7b 31 44 addi r27,r27,12612 ffc10398: 80 7b 00 0c lwz r3,12(r27) ffc1039c: 38 81 00 14 addi r4,r1,20 ffc103a0: 38 a0 00 28 li r5,40 ffc103a4: 38 63 00 20 addi r3,r3,32 ffc103a8: 48 00 15 49 bl ffc118f0 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; ffc103ac: 93 9f 00 d0 stw r28,208(r31) return true; ffc103b0: 38 00 00 01 li r0,1 } ffc103b4: 39 61 00 68 addi r11,r1,104 ffc103b8: 7c 03 03 78 mr r3,r0 ffc103bc: 4b ff 01 70 b ffc0052c <_restgpr_25_x> =============================================================================== ffc10b30 <_POSIX_signals_Clear_process_signals>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc10b30: 7d 60 00 a6 mfmsr r11 ffc10b34: 7c 10 42 a6 mfsprg r0,0 ffc10b38: 7d 60 00 78 andc r0,r11,r0 ffc10b3c: 7c 00 01 24 mtmsr r0 mask = signo_to_mask( signo ); ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { ffc10b40: 3d 20 00 00 lis r9,0 ffc10b44: 1c 03 00 0c mulli r0,r3,12 ffc10b48: 39 29 31 c0 addi r9,r9,12736 ffc10b4c: 7d 29 00 2e lwzx r9,r9,r0 ffc10b50: 2f 89 00 02 cmpwi cr7,r9,2 ffc10b54: 40 be 00 20 bne+ cr7,ffc10b74 <_POSIX_signals_Clear_process_signals+0x44> if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) ffc10b58: 3d 20 00 00 lis r9,0 ffc10b5c: 39 29 33 b4 addi r9,r9,13236 ffc10b60: 7d 40 4a 14 add r10,r0,r9 ffc10b64: 7c 09 00 2e lwzx r0,r9,r0 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc10b68: 39 4a 00 04 addi r10,r10,4 ffc10b6c: 7f 80 50 00 cmpw cr7,r0,r10 ffc10b70: 40 be 00 20 bne+ cr7,ffc10b90 <_POSIX_signals_Clear_process_signals+0x60><== NEVER TAKEN clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; ffc10b74: 3d 20 00 00 lis r9,0 ffc10b78: 38 00 ff fe li r0,-2 ffc10b7c: 38 63 ff ff addi r3,r3,-1 ffc10b80: 5c 03 18 3e rotlw r3,r0,r3 ffc10b84: 80 09 28 50 lwz r0,10320(r9) ffc10b88: 7c 63 00 38 and r3,r3,r0 ffc10b8c: 90 69 28 50 stw r3,10320(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc10b90: 7d 60 01 24 mtmsr r11 } _ISR_Enable( level ); } ffc10b94: 4e 80 00 20 blr =============================================================================== ffc088b0 <_POSIX_signals_Get_lowest>: ffc088b0: 39 40 00 05 li r10,5 ffc088b4: 7d 49 03 a6 mtctr r10 sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc088b8: 39 20 00 1b li r9,27 ffc088bc: 38 00 00 01 li r0,1 #include #include #include #include int _POSIX_signals_Get_lowest( ffc088c0: 39 69 ff ff addi r11,r9,-1 ffc088c4: 7c 0b 58 30 slw r11,r0,r11 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { ffc088c8: 7d 6a 18 39 and. r10,r11,r3 ffc088cc: 40 82 00 34 bne- ffc08900 <_POSIX_signals_Get_lowest+0x50><== NEVER TAKEN sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc088d0: 39 29 00 01 addi r9,r9,1 ffc088d4: 42 00 ff ec bdnz+ ffc088c0 <_POSIX_signals_Get_lowest+0x10> ffc088d8: 39 60 00 1a li r11,26 ffc088dc: 7d 69 03 a6 mtctr r11 ffc088e0: 39 20 00 01 li r9,1 ffc088e4: 38 00 00 01 li r0,1 #include #include #include #include int _POSIX_signals_Get_lowest( ffc088e8: 39 69 ff ff addi r11,r9,-1 ffc088ec: 7c 0b 58 30 slw r11,r0,r11 #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { if ( set & signo_to_mask( signo ) ) { ffc088f0: 7d 6a 18 39 and. r10,r11,r3 ffc088f4: 40 82 00 0c bne- ffc08900 <_POSIX_signals_Get_lowest+0x50> */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { ffc088f8: 39 29 00 01 addi r9,r9,1 ffc088fc: 42 00 ff ec bdnz+ ffc088e8 <_POSIX_signals_Get_lowest+0x38> * a return 0. This routine will NOT be called unless a signal * is pending in the set passed in. */ found_it: return signo; } ffc08900: 7d 23 4b 78 mr r3,r9 ffc08904: 4e 80 00 20 blr =============================================================================== ffc1bf38 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1bf38: 94 21 ff f0 stwu r1,-16(r1) ffc1bf3c: 7c 08 02 a6 mflr r0 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc1bf40: 3c e0 10 00 lis r7,4096 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1bf44: 90 01 00 14 stw r0,20(r1) /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc1bf48: 60 e7 80 00 ori r7,r7,32768 ffc1bf4c: 39 64 ff ff addi r11,r4,-1 ffc1bf50: 80 03 00 10 lwz r0,16(r3) ffc1bf54: 39 40 00 01 li r10,1 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1bf58: bf c1 00 08 stmw r30,8(r1) ffc1bf5c: 7c a9 2b 78 mr r9,r5 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc1bf60: 7c 06 38 38 and r6,r0,r7 ffc1bf64: 7f 86 38 00 cmpw cr7,r6,r7 { POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc1bf68: 81 03 01 34 lwz r8,308(r3) bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1bf6c: 7c 7f 1b 78 mr r31,r3 ffc1bf70: 7d 4b 58 30 slw r11,r10,r11 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc1bf74: 40 be 00 60 bne+ cr7,ffc1bfd4 <_POSIX_signals_Unblock_thread+0x9c> if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { ffc1bf78: 80 03 00 30 lwz r0,48(r3) ffc1bf7c: 7d 6a 00 39 and. r10,r11,r0 ffc1bf80: 40 82 00 14 bne- ffc1bf94 <_POSIX_signals_Unblock_thread+0x5c> ffc1bf84: 80 08 00 d0 lwz r0,208(r8) /* * This should only be reached via pthread_kill(). */ return false; ffc1bf88: 3b c0 00 00 li r30,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) ) { ffc1bf8c: 7d 68 00 79 andc. r8,r11,r0 ffc1bf90: 41 82 00 cc beq- ffc1c05c <_POSIX_signals_Unblock_thread+0x124> the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc1bf94: 2f 89 00 00 cmpwi cr7,r9,0 if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; ffc1bf98: 81 7f 00 28 lwz r11,40(r31) */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { if ( (the_thread->Wait.option & mask) || (~api->signals_blocked & mask) ) { the_thread->Wait.return_code = EINTR; ffc1bf9c: 38 00 00 04 li r0,4 ffc1bfa0: 90 1f 00 34 stw r0,52(r31) the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc1bfa4: 40 be 00 18 bne+ cr7,ffc1bfbc <_POSIX_signals_Unblock_thread+0x84> the_info->si_signo = signo; the_info->si_code = SI_USER; ffc1bfa8: 38 00 00 01 li r0,1 the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; ffc1bfac: 90 8b 00 00 stw r4,0(r11) the_info->si_code = SI_USER; ffc1bfb0: 90 0b 00 04 stw r0,4(r11) the_info->si_value.sival_int = 0; ffc1bfb4: 91 2b 00 08 stw r9,8(r11) ffc1bfb8: 48 00 00 0c b ffc1bfc4 <_POSIX_signals_Unblock_thread+0x8c> } else { *the_info = *info; ffc1bfbc: 7c a9 64 aa lswi r5,r9,12 ffc1bfc0: 7c ab 65 aa stswi r5,r11,12 } _Thread_queue_Extract_with_proxy( the_thread ); ffc1bfc4: 7f e3 fb 78 mr r3,r31 ffc1bfc8: 4b fe f2 91 bl ffc0b258 <_Thread_queue_Extract_with_proxy> return true; ffc1bfcc: 3b c0 00 01 li r30,1 ffc1bfd0: 48 00 00 8c b ffc1c05c <_POSIX_signals_Unblock_thread+0x124> } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc1bfd4: 81 28 00 d0 lwz r9,208(r8) } else if ( the_thread->current_state == STATES_READY ) { if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; ffc1bfd8: 3b c0 00 00 li r30,0 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc1bfdc: 7d 68 48 79 andc. r8,r11,r9 ffc1bfe0: 41 82 00 7c beq- ffc1c05c <_POSIX_signals_Unblock_thread+0x124> * 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 ) ) { ffc1bfe4: 74 09 10 00 andis. r9,r0,4096 ffc1bfe8: 41 82 00 48 beq- ffc1c030 <_POSIX_signals_Unblock_thread+0xf8> the_thread->Wait.return_code = EINTR; ffc1bfec: 39 20 00 04 li r9,4 ffc1bff0: 91 23 00 34 stw r9,52(r3) /* * 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) ) ffc1bff4: 3d 20 00 03 lis r9,3 ffc1bff8: 61 29 be e0 ori r9,r9,48864 ffc1bffc: 7c 0a 48 39 and. r10,r0,r9 ffc1c000: 41 a2 00 0c beq+ ffc1c00c <_POSIX_signals_Unblock_thread+0xd4> _Thread_queue_Extract_with_proxy( the_thread ); ffc1c004: 4b fe f2 55 bl ffc0b258 <_Thread_queue_Extract_with_proxy> ffc1c008: 48 00 00 54 b ffc1c05c <_POSIX_signals_Unblock_thread+0x124> else if ( _States_Is_delaying(the_thread->current_state) ) { ffc1c00c: 70 0b 00 08 andi. r11,r0,8 ffc1c010: 41 a2 00 4c beq+ ffc1c05c <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN (void) _Watchdog_Remove( &the_thread->Timer ); ffc1c014: 38 63 00 48 addi r3,r3,72 ffc1c018: 4b fe fb 75 bl ffc0bb8c <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc1c01c: 3c 80 10 03 lis r4,4099 ffc1c020: 7f e3 fb 78 mr r3,r31 ffc1c024: 60 84 ff f8 ori r4,r4,65528 ffc1c028: 4b fe e6 c5 bl ffc0a6ec <_Thread_Clear_state> ffc1c02c: 48 00 00 30 b ffc1c05c <_POSIX_signals_Unblock_thread+0x124> _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { ffc1c030: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c034: 40 9e 00 28 bne- cr7,ffc1c05c <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc1c038: 3d 20 00 00 lis r9,0 ffc1c03c: 39 29 31 44 addi r9,r9,12612 ffc1c040: 80 09 00 08 lwz r0,8(r9) ffc1c044: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c048: 41 9e 00 14 beq- cr7,ffc1c05c <_POSIX_signals_Unblock_thread+0x124> ffc1c04c: 80 09 00 0c lwz r0,12(r9) ffc1c050: 7f 83 00 00 cmpw cr7,r3,r0 ffc1c054: 40 be 00 08 bne+ cr7,ffc1c05c <_POSIX_signals_Unblock_thread+0x124><== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc1c058: 99 49 00 18 stb r10,24(r9) } } return false; } ffc1c05c: 39 61 00 10 addi r11,r1,16 ffc1c060: 7f c3 f3 78 mr r3,r30 ffc1c064: 4b fe 44 dc b ffc00540 <_restgpr_30_x> =============================================================================== ffc0f778 <_RBTree_Extract_unprotected>: */ void _RBTree_Extract_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { ffc0f778: 94 21 ff e8 stwu r1,-24(r1) ffc0f77c: 7c 08 02 a6 mflr r0 ffc0f780: bf 81 00 08 stmw r28,8(r1) RBTree_Node *leaf, *target; RBTree_Color victim_color; RBTree_Direction dir; if (!the_node) return; ffc0f784: 7c 9e 23 79 mr. r30,r4 */ void _RBTree_Extract_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { ffc0f788: 7c 7f 1b 78 mr r31,r3 ffc0f78c: 90 01 00 1c stw r0,28(r1) RBTree_Node *leaf, *target; RBTree_Color victim_color; RBTree_Direction dir; if (!the_node) return; ffc0f790: 41 82 01 b4 beq- ffc0f944 <_RBTree_Extract_unprotected+0x1cc> /* check if min needs to be updated */ if (the_node == the_rbtree->first[RBT_LEFT]) { ffc0f794: 80 03 00 08 lwz r0,8(r3) ffc0f798: 7f 9e 00 00 cmpw cr7,r30,r0 ffc0f79c: 40 be 00 24 bne+ cr7,ffc0f7c0 <_RBTree_Extract_unprotected+0x48> if (the_node->child[RBT_RIGHT]) ffc0f7a0: 80 1e 00 08 lwz r0,8(r30) ffc0f7a4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f7a8: 40 be 00 14 bne+ cr7,ffc0f7bc <_RBTree_Extract_unprotected+0x44> the_rbtree->first[RBT_LEFT] = the_node->child[RBT_RIGHT]; else { the_rbtree->first[RBT_LEFT] = the_node->parent; ffc0f7ac: 81 3e 00 00 lwz r9,0(r30) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0f7b0: 7f 83 48 00 cmpw cr7,r3,r9 /* check if min needs to be updated */ if (the_node == the_rbtree->first[RBT_LEFT]) { if (the_node->child[RBT_RIGHT]) the_rbtree->first[RBT_LEFT] = the_node->child[RBT_RIGHT]; else { the_rbtree->first[RBT_LEFT] = the_node->parent; ffc0f7b4: 91 23 00 08 stw r9,8(r3) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0f7b8: 40 be 00 08 bne+ cr7,ffc0f7c0 <_RBTree_Extract_unprotected+0x48> the_rbtree->first[RBT_LEFT])) the_rbtree->first[RBT_LEFT] = NULL; ffc0f7bc: 90 1f 00 08 stw r0,8(r31) } } /* check if max needs to be updated: note, min can equal max (1 element) */ if (the_node == the_rbtree->first[RBT_RIGHT]) { ffc0f7c0: 80 1f 00 0c lwz r0,12(r31) ffc0f7c4: 83 9e 00 04 lwz r28,4(r30) ffc0f7c8: 7f 9e 00 00 cmpw cr7,r30,r0 ffc0f7cc: 40 be 00 20 bne+ cr7,ffc0f7ec <_RBTree_Extract_unprotected+0x74> if (the_node->child[RBT_LEFT]) ffc0f7d0: 2f 9c 00 00 cmpwi cr7,r28,0 ffc0f7d4: 40 be 00 14 bne+ cr7,ffc0f7e8 <_RBTree_Extract_unprotected+0x70> the_rbtree->first[RBT_RIGHT] = the_node->child[RBT_LEFT]; else { the_rbtree->first[RBT_RIGHT] = the_node->parent; ffc0f7d8: 80 1e 00 00 lwz r0,0(r30) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0f7dc: 7f 9f 00 00 cmpw cr7,r31,r0 /* check if max needs to be updated: note, min can equal max (1 element) */ if (the_node == the_rbtree->first[RBT_RIGHT]) { if (the_node->child[RBT_LEFT]) the_rbtree->first[RBT_RIGHT] = the_node->child[RBT_LEFT]; else { the_rbtree->first[RBT_RIGHT] = the_node->parent; ffc0f7e0: 90 1f 00 0c stw r0,12(r31) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0f7e4: 40 be 00 08 bne+ cr7,ffc0f7ec <_RBTree_Extract_unprotected+0x74> the_rbtree->first[RBT_RIGHT])) the_rbtree->first[RBT_RIGHT] = NULL; ffc0f7e8: 93 9f 00 0c stw r28,12(r31) * either max in node->child[RBT_LEFT] or min in node->child[RBT_RIGHT], * and replace the_node with the target node. This maintains the binary * search tree property, but may violate the red-black properties. */ if (the_node->child[RBT_LEFT] && the_node->child[RBT_RIGHT]) { ffc0f7ec: 2f 9c 00 00 cmpwi cr7,r28,0 ffc0f7f0: 80 1e 00 08 lwz r0,8(r30) ffc0f7f4: 7f 9d e3 78 mr r29,r28 ffc0f7f8: 41 9e 00 d0 beq- cr7,ffc0f8c8 <_RBTree_Extract_unprotected+0x150> ffc0f7fc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f800: 40 be 00 0c bne+ cr7,ffc0f80c <_RBTree_Extract_unprotected+0x94> ffc0f804: 48 00 00 d0 b ffc0f8d4 <_RBTree_Extract_unprotected+0x15c> target = the_node->child[RBT_LEFT]; /* find max in node->child[RBT_LEFT] */ while (target->child[RBT_RIGHT]) target = target->child[RBT_RIGHT]; ffc0f808: 7c 1d 03 78 mr r29,r0 ffc0f80c: 80 1d 00 08 lwz r0,8(r29) ffc0f810: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f814: 40 9e ff f4 bne+ cr7,ffc0f808 <_RBTree_Extract_unprotected+0x90> * target's position (target is the right child of target->parent) * when target vacates it. if there is no child, then target->parent * should become NULL. This may cause the coloring to be violated. * For now we store the color of the node being deleted in victim_color. */ leaf = target->child[RBT_LEFT]; ffc0f818: 83 9d 00 04 lwz r28,4(r29) if(leaf) { ffc0f81c: 2f 9c 00 00 cmpwi cr7,r28,0 ffc0f820: 41 9e 00 10 beq- cr7,ffc0f830 <_RBTree_Extract_unprotected+0xb8> leaf->parent = target->parent; ffc0f824: 80 1d 00 00 lwz r0,0(r29) ffc0f828: 90 1c 00 00 stw r0,0(r28) ffc0f82c: 48 00 00 0c b ffc0f838 <_RBTree_Extract_unprotected+0xc0> } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); ffc0f830: 7f a3 eb 78 mr r3,r29 ffc0f834: 4b ff fd 6d bl ffc0f5a0 <_RBTree_Extract_validate_unprotected> } victim_color = target->color; dir = target != target->parent->child[0]; ffc0f838: 81 7d 00 00 lwz r11,0(r29) leaf->parent = target->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); } victim_color = target->color; ffc0f83c: 81 3d 00 0c lwz r9,12(r29) dir = target != target->parent->child[0]; ffc0f840: 80 0b 00 04 lwz r0,4(r11) ffc0f844: 7f a0 02 78 xor r0,r29,r0 ffc0f848: 7c 00 00 34 cntlzw r0,r0 ffc0f84c: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0f850: 68 00 00 01 xori r0,r0,1 target->parent->child[dir] = leaf; ffc0f854: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0f858: 7d 6b 02 14 add r11,r11,r0 ffc0f85c: 93 8b 00 04 stw r28,4(r11) /* now replace the_node with target */ dir = the_node != the_node->parent->child[0]; ffc0f860: 81 7e 00 00 lwz r11,0(r30) ffc0f864: 80 0b 00 04 lwz r0,4(r11) ffc0f868: 7f c0 02 78 xor r0,r30,r0 ffc0f86c: 7c 00 00 34 cntlzw r0,r0 ffc0f870: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0f874: 68 00 00 01 xori r0,r0,1 the_node->parent->child[dir] = target; ffc0f878: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0f87c: 7d 6b 02 14 add r11,r11,r0 ffc0f880: 93 ab 00 04 stw r29,4(r11) /* set target's new children to the original node's children */ target->child[RBT_RIGHT] = the_node->child[RBT_RIGHT]; ffc0f884: 80 1e 00 08 lwz r0,8(r30) ffc0f888: 90 1d 00 08 stw r0,8(r29) if (the_node->child[RBT_RIGHT]) ffc0f88c: 81 7e 00 08 lwz r11,8(r30) ffc0f890: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0f894: 41 9e 00 08 beq- cr7,ffc0f89c <_RBTree_Extract_unprotected+0x124><== NEVER TAKEN the_node->child[RBT_RIGHT]->parent = target; ffc0f898: 93 ab 00 00 stw r29,0(r11) target->child[RBT_LEFT] = the_node->child[RBT_LEFT]; ffc0f89c: 80 1e 00 04 lwz r0,4(r30) ffc0f8a0: 90 1d 00 04 stw r0,4(r29) if (the_node->child[RBT_LEFT]) ffc0f8a4: 81 7e 00 04 lwz r11,4(r30) ffc0f8a8: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0f8ac: 41 9e 00 08 beq- cr7,ffc0f8b4 <_RBTree_Extract_unprotected+0x13c> the_node->child[RBT_LEFT]->parent = target; ffc0f8b0: 93 ab 00 00 stw r29,0(r11) /* finally, update the parent node and recolor. target has completely * replaced the_node, and target's child has moved up the tree if needed. * the_node is no longer part of the tree, although it has valid pointers * still. */ target->parent = the_node->parent; ffc0f8b4: 80 1e 00 00 lwz r0,0(r30) ffc0f8b8: 90 1d 00 00 stw r0,0(r29) target->color = the_node->color; ffc0f8bc: 80 1e 00 0c lwz r0,12(r30) ffc0f8c0: 90 1d 00 0c stw r0,12(r29) ffc0f8c4: 48 00 00 4c b ffc0f910 <_RBTree_Extract_unprotected+0x198> * violated. We will fix it later. * For now we store the color of the node being deleted in victim_color. */ leaf = the_node->child[RBT_LEFT] ? the_node->child[RBT_LEFT] : the_node->child[RBT_RIGHT]; if( leaf ) { ffc0f8c8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f8cc: 7c 1c 03 78 mr r28,r0 ffc0f8d0: 41 9e 00 10 beq- cr7,ffc0f8e0 <_RBTree_Extract_unprotected+0x168> leaf->parent = the_node->parent; ffc0f8d4: 80 1e 00 00 lwz r0,0(r30) ffc0f8d8: 90 1c 00 00 stw r0,0(r28) ffc0f8dc: 48 00 00 0c b ffc0f8e8 <_RBTree_Extract_unprotected+0x170> } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(the_node); ffc0f8e0: 7f c3 f3 78 mr r3,r30 ffc0f8e4: 4b ff fc bd bl ffc0f5a0 <_RBTree_Extract_validate_unprotected> } victim_color = the_node->color; /* remove the_node from the tree */ dir = the_node != the_node->parent->child[0]; ffc0f8e8: 81 7e 00 00 lwz r11,0(r30) leaf->parent = the_node->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(the_node); } victim_color = the_node->color; ffc0f8ec: 81 3e 00 0c lwz r9,12(r30) /* remove the_node from the tree */ dir = the_node != the_node->parent->child[0]; ffc0f8f0: 80 0b 00 04 lwz r0,4(r11) ffc0f8f4: 7f c0 02 78 xor r0,r30,r0 ffc0f8f8: 7c 00 00 34 cntlzw r0,r0 ffc0f8fc: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0f900: 68 00 00 01 xori r0,r0,1 the_node->parent->child[dir] = leaf; ffc0f904: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0f908: 7d 6b 02 14 add r11,r11,r0 ffc0f90c: 93 8b 00 04 stw r28,4(r11) /* fix coloring. leaf has moved up the tree. The color of the deleted * node is in victim_color. There are two cases: * 1. Deleted a red node, its child must be black. Nothing must be done. * 2. Deleted a black node, its child must be red. Paint child black. */ if (victim_color == RBT_BLACK) { /* eliminate case 1 */ ffc0f910: 2f 89 00 00 cmpwi cr7,r9,0 ffc0f914: 40 9e 00 10 bne- cr7,ffc0f924 <_RBTree_Extract_unprotected+0x1ac> if (leaf) { ffc0f918: 2f 9c 00 00 cmpwi cr7,r28,0 ffc0f91c: 41 9e 00 08 beq- cr7,ffc0f924 <_RBTree_Extract_unprotected+0x1ac> leaf->color = RBT_BLACK; /* case 2 */ ffc0f920: 91 3c 00 0c stw r9,12(r28) /* Wipe the_node */ _RBTree_Set_off_rbtree(the_node); /* set root to black, if it exists */ if (the_rbtree->root) the_rbtree->root->color = RBT_BLACK; ffc0f924: 81 3f 00 04 lwz r9,4(r31) */ RTEMS_INLINE_ROUTINE void _RBTree_Set_off_rbtree( RBTree_Node *node ) { node->parent = node->child[RBT_LEFT] = node->child[RBT_RIGHT] = NULL; ffc0f928: 38 00 00 00 li r0,0 ffc0f92c: 90 1e 00 08 stw r0,8(r30) ffc0f930: 2f 89 00 00 cmpwi cr7,r9,0 ffc0f934: 90 1e 00 04 stw r0,4(r30) ffc0f938: 90 1e 00 00 stw r0,0(r30) ffc0f93c: 41 9e 00 08 beq- cr7,ffc0f944 <_RBTree_Extract_unprotected+0x1cc> ffc0f940: 90 09 00 0c stw r0,12(r9) } ffc0f944: 39 61 00 18 addi r11,r1,24 ffc0f948: 4b ff 11 f4 b ffc00b3c <_restgpr_28_x> =============================================================================== ffc0f5a0 <_RBTree_Extract_validate_unprotected>: * of the extract operation. */ void _RBTree_Extract_validate_unprotected( RBTree_Node *the_node ) { ffc0f5a0: 94 21 ff e0 stwu r1,-32(r1) ffc0f5a4: 7c 08 02 a6 mflr r0 ffc0f5a8: 90 01 00 24 stw r0,36(r1) ffc0f5ac: bf 41 00 08 stmw r26,8(r1) ffc0f5b0: 7c 7e 1b 78 mr r30,r3 RBTree_Node *parent, *sibling; RBTree_Direction dir; parent = the_node->parent; ffc0f5b4: 83 e3 00 00 lwz r31,0(r3) if(!parent->parent) return; ffc0f5b8: 80 1f 00 00 lwz r0,0(r31) ffc0f5bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f5c0: 41 9e 01 b0 beq- cr7,ffc0f770 <_RBTree_Extract_validate_unprotected+0x1d0> sibling = _RBTree_Sibling(the_node); ffc0f5c4: 4b ff ff 29 bl ffc0f4ec <_RBTree_Sibling> * Now the_node has a black sibling and red parent. After rotation, * update sibling pointer. */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; sibling->color = RBT_BLACK; ffc0f5c8: 3b 40 00 00 li r26,0 } /* sibling is black, see if both of its children are also black. */ if (!_RBTree_Is_red(sibling->child[RBT_RIGHT]) && !_RBTree_Is_red(sibling->child[RBT_LEFT])) { sibling->color = RBT_RED; ffc0f5cc: 3b 60 00 01 li r27,1 if(!parent->parent) return; sibling = _RBTree_Sibling(the_node); /* continue to correct tree as long as the_node is black and not the root */ while (!_RBTree_Is_red(the_node) && parent->parent) { ffc0f5d0: 48 00 01 58 b ffc0f728 <_RBTree_Extract_validate_unprotected+0x188> */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0f5d4: 2f 83 00 00 cmpwi cr7,r3,0 ffc0f5d8: 41 9e 00 48 beq- cr7,ffc0f620 <_RBTree_Extract_validate_unprotected+0x80><== NEVER TAKEN ffc0f5dc: 80 03 00 0c lwz r0,12(r3) ffc0f5e0: 2f 80 00 01 cmpwi cr7,r0,1 ffc0f5e4: 40 be 00 3c bne+ cr7,ffc0f620 <_RBTree_Extract_validate_unprotected+0x80> * update sibling pointer. */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; sibling->color = RBT_BLACK; dir = the_node != parent->child[0]; ffc0f5e8: 83 bf 00 04 lwz r29,4(r31) * then rotate parent left, making the sibling be the_node's grandparent. * Now the_node has a black sibling and red parent. After rotation, * update sibling pointer. */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; ffc0f5ec: 90 1f 00 0c stw r0,12(r31) sibling->color = RBT_BLACK; dir = the_node != parent->child[0]; ffc0f5f0: 7f dd ea 78 xor r29,r30,r29 ffc0f5f4: 7f bd 00 34 cntlzw r29,r29 * Now the_node has a black sibling and red parent. After rotation, * update sibling pointer. */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; sibling->color = RBT_BLACK; ffc0f5f8: 93 43 00 0c stw r26,12(r3) dir = the_node != parent->child[0]; ffc0f5fc: 57 bd d9 7e rlwinm r29,r29,27,5,31 ffc0f600: 6b bd 00 01 xori r29,r29,1 _RBTree_Rotate(parent, dir); ffc0f604: 7f a4 eb 78 mr r4,r29 sibling = parent->child[!dir]; ffc0f608: 6b bd 00 01 xori r29,r29,1 ffc0f60c: 57 bd 10 3a rlwinm r29,r29,2,0,29 */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; sibling->color = RBT_BLACK; dir = the_node != parent->child[0]; _RBTree_Rotate(parent, dir); ffc0f610: 7f e3 fb 78 mr r3,r31 sibling = parent->child[!dir]; ffc0f614: 7f bf ea 14 add r29,r31,r29 */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; sibling->color = RBT_BLACK; dir = the_node != parent->child[0]; _RBTree_Rotate(parent, dir); ffc0f618: 4b ff ff 11 bl ffc0f528 <_RBTree_Rotate> sibling = parent->child[!dir]; ffc0f61c: 80 7d 00 04 lwz r3,4(r29) } /* sibling is black, see if both of its children are also black. */ if (!_RBTree_Is_red(sibling->child[RBT_RIGHT]) && ffc0f620: 81 23 00 08 lwz r9,8(r3) ffc0f624: 38 00 00 00 li r0,0 ffc0f628: 2f 89 00 00 cmpwi cr7,r9,0 ffc0f62c: 41 9e 00 14 beq- cr7,ffc0f640 <_RBTree_Extract_validate_unprotected+0xa0> * This function maintains the properties of the red-black tree. * * @note It does NOT disable interrupts to ensure the atomicity * of the extract operation. */ void _RBTree_Extract_validate_unprotected( ffc0f630: 80 09 00 0c lwz r0,12(r9) ffc0f634: 68 00 00 01 xori r0,r0,1 ffc0f638: 7c 00 00 34 cntlzw r0,r0 ffc0f63c: 54 00 d9 7e rlwinm r0,r0,27,5,31 _RBTree_Rotate(parent, dir); sibling = parent->child[!dir]; } /* sibling is black, see if both of its children are also black. */ if (!_RBTree_Is_red(sibling->child[RBT_RIGHT]) && ffc0f640: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f644: 40 9e 00 40 bne- cr7,ffc0f684 <_RBTree_Extract_validate_unprotected+0xe4> !_RBTree_Is_red(sibling->child[RBT_LEFT])) { ffc0f648: 81 23 00 04 lwz r9,4(r3) ffc0f64c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0f650: 41 9e 00 14 beq- cr7,ffc0f664 <_RBTree_Extract_validate_unprotected+0xc4> * This function maintains the properties of the red-black tree. * * @note It does NOT disable interrupts to ensure the atomicity * of the extract operation. */ void _RBTree_Extract_validate_unprotected( ffc0f654: 80 09 00 0c lwz r0,12(r9) ffc0f658: 68 00 00 01 xori r0,r0,1 ffc0f65c: 7c 00 00 34 cntlzw r0,r0 ffc0f660: 54 00 d9 7e rlwinm r0,r0,27,5,31 _RBTree_Rotate(parent, dir); sibling = parent->child[!dir]; } /* sibling is black, see if both of its children are also black. */ if (!_RBTree_Is_red(sibling->child[RBT_RIGHT]) && ffc0f664: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f668: 40 9e 00 1c bne- cr7,ffc0f684 <_RBTree_Extract_validate_unprotected+0xe4> !_RBTree_Is_red(sibling->child[RBT_LEFT])) { sibling->color = RBT_RED; ffc0f66c: 93 63 00 0c stw r27,12(r3) ffc0f670: 81 3f 00 0c lwz r9,12(r31) ffc0f674: 2f 89 00 01 cmpwi cr7,r9,1 ffc0f678: 40 be 00 e0 bne+ cr7,ffc0f758 <_RBTree_Extract_validate_unprotected+0x1b8> if (_RBTree_Is_red(parent)) { parent->color = RBT_BLACK; ffc0f67c: 90 1f 00 0c stw r0,12(r31) break; ffc0f680: 48 00 00 c0 b ffc0f740 <_RBTree_Extract_validate_unprotected+0x1a0> * cases, either the_node is to the left or the right of the parent. * In both cases, first check if one of sibling's children is black, * and if so rotate in the proper direction and update sibling pointer. * Then switch the sibling and parent colors, and rotate through parent. */ dir = the_node != parent->child[0]; ffc0f684: 83 bf 00 04 lwz r29,4(r31) ffc0f688: 38 00 00 00 li r0,0 ffc0f68c: 7f dd ea 78 xor r29,r30,r29 ffc0f690: 7f bd 00 34 cntlzw r29,r29 ffc0f694: 57 bd d9 7e rlwinm r29,r29,27,5,31 ffc0f698: 6b bd 00 01 xori r29,r29,1 if (!_RBTree_Is_red(sibling->child[!dir])) { ffc0f69c: 6b bc 00 01 xori r28,r29,1 ffc0f6a0: 57 89 10 3a rlwinm r9,r28,2,0,29 ffc0f6a4: 7d 23 4a 14 add r9,r3,r9 ffc0f6a8: 81 29 00 04 lwz r9,4(r9) ffc0f6ac: 2f 89 00 00 cmpwi cr7,r9,0 ffc0f6b0: 41 9e 00 14 beq- cr7,ffc0f6c4 <_RBTree_Extract_validate_unprotected+0x124> * This function maintains the properties of the red-black tree. * * @note It does NOT disable interrupts to ensure the atomicity * of the extract operation. */ void _RBTree_Extract_validate_unprotected( ffc0f6b4: 80 09 00 0c lwz r0,12(r9) ffc0f6b8: 68 00 00 01 xori r0,r0,1 ffc0f6bc: 7c 00 00 34 cntlzw r0,r0 ffc0f6c0: 54 00 d9 7e rlwinm r0,r0,27,5,31 * In both cases, first check if one of sibling's children is black, * and if so rotate in the proper direction and update sibling pointer. * Then switch the sibling and parent colors, and rotate through parent. */ dir = the_node != parent->child[0]; if (!_RBTree_Is_red(sibling->child[!dir])) { ffc0f6c4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f6c8: 40 be 00 30 bne+ cr7,ffc0f6f8 <_RBTree_Extract_validate_unprotected+0x158> sibling->color = RBT_RED; ffc0f6cc: 39 20 00 01 li r9,1 ffc0f6d0: 91 23 00 0c stw r9,12(r3) sibling->child[dir]->color = RBT_BLACK; ffc0f6d4: 57 a9 10 3a rlwinm r9,r29,2,0,29 ffc0f6d8: 7d 23 4a 14 add r9,r3,r9 ffc0f6dc: 81 29 00 04 lwz r9,4(r9) _RBTree_Rotate(sibling, !dir); ffc0f6e0: 6b a4 00 01 xori r4,r29,1 * Then switch the sibling and parent colors, and rotate through parent. */ dir = the_node != parent->child[0]; if (!_RBTree_Is_red(sibling->child[!dir])) { sibling->color = RBT_RED; sibling->child[dir]->color = RBT_BLACK; ffc0f6e4: 90 09 00 0c stw r0,12(r9) _RBTree_Rotate(sibling, !dir); ffc0f6e8: 4b ff fe 41 bl ffc0f528 <_RBTree_Rotate> sibling = parent->child[!dir]; ffc0f6ec: 57 89 10 3a rlwinm r9,r28,2,0,29 ffc0f6f0: 7d 3f 4a 14 add r9,r31,r9 ffc0f6f4: 80 69 00 04 lwz r3,4(r9) } sibling->color = parent->color; ffc0f6f8: 80 1f 00 0c lwz r0,12(r31) parent->color = RBT_BLACK; sibling->child[!dir]->color = RBT_BLACK; ffc0f6fc: 57 9c 10 3a rlwinm r28,r28,2,0,29 _RBTree_Rotate(parent, dir); ffc0f700: 7f a4 eb 78 mr r4,r29 sibling->color = RBT_RED; sibling->child[dir]->color = RBT_BLACK; _RBTree_Rotate(sibling, !dir); sibling = parent->child[!dir]; } sibling->color = parent->color; ffc0f704: 90 03 00 0c stw r0,12(r3) parent->color = RBT_BLACK; sibling->child[!dir]->color = RBT_BLACK; ffc0f708: 7c 63 e2 14 add r3,r3,r28 sibling->child[dir]->color = RBT_BLACK; _RBTree_Rotate(sibling, !dir); sibling = parent->child[!dir]; } sibling->color = parent->color; parent->color = RBT_BLACK; ffc0f70c: 38 00 00 00 li r0,0 sibling->child[!dir]->color = RBT_BLACK; ffc0f710: 81 23 00 04 lwz r9,4(r3) _RBTree_Rotate(parent, dir); ffc0f714: 7f e3 fb 78 mr r3,r31 sibling->child[dir]->color = RBT_BLACK; _RBTree_Rotate(sibling, !dir); sibling = parent->child[!dir]; } sibling->color = parent->color; parent->color = RBT_BLACK; ffc0f718: 90 1f 00 0c stw r0,12(r31) sibling->child[!dir]->color = RBT_BLACK; ffc0f71c: 90 09 00 0c stw r0,12(r9) _RBTree_Rotate(parent, dir); ffc0f720: 4b ff fe 09 bl ffc0f528 <_RBTree_Rotate> break; /* done */ ffc0f724: 48 00 00 1c b ffc0f740 <_RBTree_Extract_validate_unprotected+0x1a0> if(!parent->parent) return; sibling = _RBTree_Sibling(the_node); /* continue to correct tree as long as the_node is black and not the root */ while (!_RBTree_Is_red(the_node) && parent->parent) { ffc0f728: 80 1e 00 0c lwz r0,12(r30) ffc0f72c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0f730: 41 9e 00 10 beq- cr7,ffc0f740 <_RBTree_Extract_validate_unprotected+0x1a0> ffc0f734: 80 1f 00 00 lwz r0,0(r31) ffc0f738: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f73c: 40 9e fe 98 bne+ cr7,ffc0f5d4 <_RBTree_Extract_validate_unprotected+0x34> sibling->child[!dir]->color = RBT_BLACK; _RBTree_Rotate(parent, dir); break; /* done */ } } /* while */ if(!the_node->parent->parent) the_node->color = RBT_BLACK; ffc0f740: 81 3e 00 00 lwz r9,0(r30) ffc0f744: 80 09 00 00 lwz r0,0(r9) ffc0f748: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f74c: 40 be 00 24 bne+ cr7,ffc0f770 <_RBTree_Extract_validate_unprotected+0x1d0> ffc0f750: 90 1e 00 0c stw r0,12(r30) ffc0f754: 48 00 00 1c b ffc0f770 <_RBTree_Extract_validate_unprotected+0x1d0> if (_RBTree_Is_red(parent)) { parent->color = RBT_BLACK; break; } the_node = parent; /* done if parent is red */ parent = the_node->parent; ffc0f758: 83 bf 00 00 lwz r29,0(r31) sibling = _RBTree_Sibling(the_node); ffc0f75c: 7f e3 fb 78 mr r3,r31 ffc0f760: 7f fe fb 78 mr r30,r31 ffc0f764: 4b ff fd 89 bl ffc0f4ec <_RBTree_Sibling> if (_RBTree_Is_red(parent)) { parent->color = RBT_BLACK; break; } the_node = parent; /* done if parent is red */ parent = the_node->parent; ffc0f768: 7f bf eb 78 mr r31,r29 sibling = _RBTree_Sibling(the_node); ffc0f76c: 4b ff ff bc b ffc0f728 <_RBTree_Extract_validate_unprotected+0x188> _RBTree_Rotate(parent, dir); break; /* done */ } } /* while */ if(!the_node->parent->parent) the_node->color = RBT_BLACK; } ffc0f770: 39 61 00 20 addi r11,r1,32 ffc0f774: 4b ff 13 c0 b ffc00b34 <_restgpr_26_x> =============================================================================== ffc0b3d8 <_RBTree_Initialize>: void *starting_address, size_t number_nodes, size_t node_size, bool is_unique ) { ffc0b3d8: 94 21 ff e8 stwu r1,-24(r1) ffc0b3dc: 7c 08 02 a6 mflr r0 ffc0b3e0: bf 81 00 08 stmw r28,8(r1) size_t count; RBTree_Node *next; /* TODO: Error message? */ if (!the_rbtree) return; ffc0b3e4: 7c 7d 1b 79 mr. r29,r3 void *starting_address, size_t number_nodes, size_t node_size, bool is_unique ) { ffc0b3e8: 7c df 33 78 mr r31,r6 ffc0b3ec: 90 01 00 1c stw r0,28(r1) ffc0b3f0: 7c fe 3b 78 mr r30,r7 size_t count; RBTree_Node *next; /* TODO: Error message? */ if (!the_rbtree) return; ffc0b3f4: 41 82 00 44 beq- ffc0b438 <_RBTree_Initialize+0x60> <== NEVER TAKEN RBTree_Control *the_rbtree, RBTree_Compare_function compare_function, bool is_unique ) { the_rbtree->permanent_null = NULL; ffc0b3f8: 38 00 00 00 li r0,0 the_rbtree->root = NULL; the_rbtree->first[0] = NULL; the_rbtree->first[1] = NULL; the_rbtree->compare_function = compare_function; ffc0b3fc: 90 9d 00 10 stw r4,16(r29) /* could do sanity checks here */ _RBTree_Initialize_empty(the_rbtree, compare_function, is_unique); count = number_nodes; next = starting_address; ffc0b400: 7c bc 2b 78 mr r28,r5 RBTree_Control *the_rbtree, RBTree_Compare_function compare_function, bool is_unique ) { the_rbtree->permanent_null = NULL; ffc0b404: 90 1d 00 00 stw r0,0(r29) the_rbtree->root = NULL; ffc0b408: 90 1d 00 04 stw r0,4(r29) the_rbtree->first[0] = NULL; ffc0b40c: 90 1d 00 08 stw r0,8(r29) the_rbtree->first[1] = NULL; ffc0b410: 90 1d 00 0c stw r0,12(r29) the_rbtree->compare_function = compare_function; the_rbtree->is_unique = is_unique; ffc0b414: 99 1d 00 14 stb r8,20(r29) while ( count-- ) { ffc0b418: 48 00 00 18 b ffc0b430 <_RBTree_Initialize+0x58> _RBTree_Insert(the_rbtree, next); ffc0b41c: 7f 84 e3 78 mr r4,r28 ffc0b420: 7f a3 eb 78 mr r3,r29 ffc0b424: 4b ff ff a1 bl ffc0b3c4 <_RBTree_Insert> * node_size - size of node in bytes * * Output parameters: NONE */ void _RBTree_Initialize( ffc0b428: 7f 9c f2 14 add r28,r28,r30 ffc0b42c: 3b ff ff ff addi r31,r31,-1 /* could do sanity checks here */ _RBTree_Initialize_empty(the_rbtree, compare_function, is_unique); count = number_nodes; next = starting_address; while ( count-- ) { ffc0b430: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0b434: 40 9e ff e8 bne+ cr7,ffc0b41c <_RBTree_Initialize+0x44> _RBTree_Insert(the_rbtree, next); next = (RBTree_Node *) _Addresses_Add_offset( (void *) next, node_size ); } } ffc0b438: 39 61 00 18 addi r11,r1,24 ffc0b43c: 4b ff 65 48 b ffc01984 <_restgpr_28_x> =============================================================================== ffc0f4ec <_RBTree_Sibling>: */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( RBTree_Node *the_node ) { if(!the_node) return NULL; ffc0f4ec: 2c 03 00 00 cmpwi r3,0 ffc0f4f0: 38 00 00 00 li r0,0 ffc0f4f4: 41 82 00 2c beq- ffc0f520 <_RBTree_Sibling+0x34> if(!(the_node->parent)) return NULL; ffc0f4f8: 81 23 00 00 lwz r9,0(r3) ffc0f4fc: 2f 89 00 00 cmpwi cr7,r9,0 ffc0f500: 41 9e 00 20 beq- cr7,ffc0f520 <_RBTree_Sibling+0x34> <== NEVER TAKEN if(!(the_node->parent->parent)) return NULL; ffc0f504: 81 69 00 00 lwz r11,0(r9) ffc0f508: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0f50c: 41 9e 00 14 beq- cr7,ffc0f520 <_RBTree_Sibling+0x34> if(the_node == the_node->parent->child[RBT_LEFT]) ffc0f510: 80 09 00 04 lwz r0,4(r9) ffc0f514: 7f 83 00 00 cmpw cr7,r3,r0 ffc0f518: 40 be 00 08 bne+ cr7,ffc0f520 <_RBTree_Sibling+0x34> return the_node->parent->child[RBT_RIGHT]; ffc0f51c: 80 09 00 08 lwz r0,8(r9) else return the_node->parent->child[RBT_LEFT]; } ffc0f520: 7c 03 03 78 mr r3,r0 ffc0f524: 4e 80 00 20 blr =============================================================================== ffc0f9f8 <_RBTree_Validate_insert_unprotected>: * append operation. */ void _RBTree_Validate_insert_unprotected( RBTree_Node *the_node ) { ffc0f9f8: 94 21 ff e0 stwu r1,-32(r1) ffc0f9fc: 7c 08 02 a6 mflr r0 ffc0fa00: bf 61 00 0c stmw r27,12(r1) ffc0fa04: 7c 7e 1b 78 mr r30,r3 /* ensure node is on the same branch direction as parent */ if (dir != pdir) { _RBTree_Rotate(the_node->parent, pdir); the_node = the_node->child[pdir]; } the_node->parent->color = RBT_BLACK; ffc0fa08: 3b 80 00 00 li r28,0 * append operation. */ void _RBTree_Validate_insert_unprotected( RBTree_Node *the_node ) { ffc0fa0c: 90 01 00 24 stw r0,36(r1) if (dir != pdir) { _RBTree_Rotate(the_node->parent, pdir); the_node = the_node->child[pdir]; } the_node->parent->color = RBT_BLACK; g->color = RBT_RED; ffc0fa10: 3b 60 00 01 li r27,1 RBTree_Node *u,*g; /* note: the insert root case is handled already */ /* if the parent is black, nothing needs to be done * otherwise may need to loop a few times */ while (_RBTree_Is_red(_RBTree_Parent(the_node))) { ffc0fa14: 48 00 00 74 b ffc0fa88 <_RBTree_Validate_insert_unprotected+0x90> ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(!(the_node->parent->parent->parent)) return NULL; ffc0fa18: 80 1f 00 00 lwz r0,0(r31) ffc0fa1c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0fa20: 41 9e 00 90 beq- cr7,ffc0fab0 <_RBTree_Validate_insert_unprotected+0xb8><== NEVER TAKEN { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(the_node == the_node->parent->child[RBT_LEFT]) ffc0fa24: 81 3f 00 04 lwz r9,4(r31) ffc0fa28: 7f 83 48 00 cmpw cr7,r3,r9 ffc0fa2c: 40 be 00 08 bne+ cr7,ffc0fa34 <_RBTree_Validate_insert_unprotected+0x3c> return the_node->parent->child[RBT_RIGHT]; ffc0fa30: 81 3f 00 08 lwz r9,8(r31) */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0fa34: 2f 89 00 00 cmpwi cr7,r9,0 ffc0fa38: 41 9e 00 78 beq- cr7,ffc0fab0 <_RBTree_Validate_insert_unprotected+0xb8> ffc0fa3c: 80 09 00 0c lwz r0,12(r9) ffc0fa40: 2f 80 00 01 cmpwi cr7,r0,1 ffc0fa44: 40 be 00 6c bne+ cr7,ffc0fab0 <_RBTree_Validate_insert_unprotected+0xb8> u = _RBTree_Parent_sibling(the_node); g = the_node->parent->parent; /* if uncle is red, repaint uncle/parent black and grandparent red */ if(_RBTree_Is_red(u)) { the_node->parent->color = RBT_BLACK; ffc0fa48: 93 83 00 0c stw r28,12(r3) u->color = RBT_BLACK; g->color = RBT_RED; ffc0fa4c: 7f fe fb 78 mr r30,r31 g = the_node->parent->parent; /* if uncle is red, repaint uncle/parent black and grandparent red */ if(_RBTree_Is_red(u)) { the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; ffc0fa50: 93 89 00 0c stw r28,12(r9) g->color = RBT_RED; ffc0fa54: 90 1f 00 0c stw r0,12(r31) ffc0fa58: 48 00 00 30 b ffc0fa88 <_RBTree_Validate_insert_unprotected+0x90> RBTree_Direction dir = the_node != the_node->parent->child[0]; RBTree_Direction pdir = the_node->parent != g->child[0]; /* ensure node is on the same branch direction as parent */ if (dir != pdir) { _RBTree_Rotate(the_node->parent, pdir); ffc0fa5c: 7f a4 eb 78 mr r4,r29 ffc0fa60: 4b ff ff 21 bl ffc0f980 <_RBTree_Rotate> the_node = the_node->child[pdir]; ffc0fa64: 57 a0 10 3a rlwinm r0,r29,2,0,29 ffc0fa68: 7f de 02 14 add r30,r30,r0 ffc0fa6c: 83 de 00 04 lwz r30,4(r30) } the_node->parent->color = RBT_BLACK; ffc0fa70: 81 3e 00 00 lwz r9,0(r30) g->color = RBT_RED; /* now rotate grandparent in the other branch direction (toward uncle) */ _RBTree_Rotate(g, (1-pdir)); ffc0fa74: 7f e3 fb 78 mr r3,r31 ffc0fa78: 20 9d 00 01 subfic r4,r29,1 /* ensure node is on the same branch direction as parent */ if (dir != pdir) { _RBTree_Rotate(the_node->parent, pdir); the_node = the_node->child[pdir]; } the_node->parent->color = RBT_BLACK; ffc0fa7c: 93 89 00 0c stw r28,12(r9) g->color = RBT_RED; ffc0fa80: 93 7f 00 0c stw r27,12(r31) /* now rotate grandparent in the other branch direction (toward uncle) */ _RBTree_Rotate(g, (1-pdir)); ffc0fa84: 4b ff fe fd bl ffc0f980 <_RBTree_Rotate> ISR_Level level; _ISR_Disable( level ); return _RBTree_Insert_unprotected( tree, node ); _ISR_Enable( level ); } ffc0fa88: 80 7e 00 00 lwz r3,0(r30) */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Parent( RBTree_Node *the_node ) { if (!the_node->parent->parent) return NULL; ffc0fa8c: 83 e3 00 00 lwz r31,0(r3) ffc0fa90: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0fa94: 41 9e 00 14 beq- cr7,ffc0faa8 <_RBTree_Validate_insert_unprotected+0xb0> */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0fa98: 80 03 00 0c lwz r0,12(r3) ffc0fa9c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0faa0: 40 be 00 44 bne+ cr7,ffc0fae4 <_RBTree_Validate_insert_unprotected+0xec> ffc0faa4: 4b ff ff 74 b ffc0fa18 <_RBTree_Validate_insert_unprotected+0x20> /* now rotate grandparent in the other branch direction (toward uncle) */ _RBTree_Rotate(g, (1-pdir)); } } if(!the_node->parent->parent) the_node->color = RBT_BLACK; ffc0faa8: 93 fe 00 0c stw r31,12(r30) ffc0faac: 48 00 00 38 b ffc0fae4 <_RBTree_Validate_insert_unprotected+0xec> u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0fab0: 83 bf 00 04 lwz r29,4(r31) the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; ffc0fab4: 80 03 00 04 lwz r0,4(r3) RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0fab8: 7c 7d ea 78 xor r29,r3,r29 the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; ffc0fabc: 7f c0 02 78 xor r0,r30,r0 RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0fac0: 7f bd 00 34 cntlzw r29,r29 the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; ffc0fac4: 7c 00 00 34 cntlzw r0,r0 RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0fac8: 57 bd d9 7e rlwinm r29,r29,27,5,31 the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; ffc0facc: 54 00 d9 7e rlwinm r0,r0,27,5,31 RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0fad0: 6b bd 00 01 xori r29,r29,1 the_node->parent->color = RBT_BLACK; u->color = RBT_BLACK; g->color = RBT_RED; the_node = g; } else { /* if uncle is black */ RBTree_Direction dir = the_node != the_node->parent->child[0]; ffc0fad4: 68 00 00 01 xori r0,r0,1 RBTree_Direction pdir = the_node->parent != g->child[0]; /* ensure node is on the same branch direction as parent */ if (dir != pdir) { ffc0fad8: 7f 80 e8 00 cmpw cr7,r0,r29 ffc0fadc: 40 be ff 80 bne- cr7,ffc0fa5c <_RBTree_Validate_insert_unprotected+0x64> ffc0fae0: 4b ff ff 90 b ffc0fa70 <_RBTree_Validate_insert_unprotected+0x78> /* now rotate grandparent in the other branch direction (toward uncle) */ _RBTree_Rotate(g, (1-pdir)); } } if(!the_node->parent->parent) the_node->color = RBT_BLACK; } ffc0fae4: 39 61 00 20 addi r11,r1,32 ffc0fae8: 4b ff 10 50 b ffc00b38 <_restgpr_27_x> =============================================================================== ffc09324 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { ffc09324: 7c 2b 0b 78 mr r11,r1 ffc09328: 94 21 ff e0 stwu r1,-32(r1) ffc0932c: 7c 08 02 a6 mflr r0 ffc09330: 7c 64 1b 78 mr r4,r3 ffc09334: 3c 60 00 00 lis r3,0 ffc09338: 48 01 3a 1d bl ffc1cd54 <_savegpr_31> ffc0933c: 38 63 2c 98 addi r3,r3,11416 ffc09340: 90 01 00 24 stw r0,36(r1) ffc09344: 38 a1 00 08 addi r5,r1,8 ffc09348: 48 00 21 b9 bl ffc0b500 <_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 ) { ffc0934c: 80 01 00 08 lwz r0,8(r1) ffc09350: 7c 7f 1b 78 mr r31,r3 ffc09354: 2f 80 00 00 cmpwi cr7,r0,0 ffc09358: 40 9e 00 88 bne- cr7,ffc093e0 <_Rate_monotonic_Timeout+0xbc><== NEVER TAKEN case OBJECTS_LOCAL: the_thread = the_period->owner; ffc0935c: 80 63 00 40 lwz r3,64(r3) */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_period ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_PERIOD); ffc09360: 80 03 00 10 lwz r0,16(r3) if ( _States_Is_waiting_for_period( the_thread->current_state ) && ffc09364: 70 09 40 00 andi. r9,r0,16384 ffc09368: 41 82 00 24 beq- ffc0938c <_Rate_monotonic_Timeout+0x68> ffc0936c: 81 23 00 20 lwz r9,32(r3) ffc09370: 80 1f 00 08 lwz r0,8(r31) ffc09374: 7f 89 00 00 cmpw cr7,r9,r0 ffc09378: 40 be 00 14 bne+ cr7,ffc0938c <_Rate_monotonic_Timeout+0x68> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc0937c: 3c 80 10 03 lis r4,4099 ffc09380: 60 84 ff f8 ori r4,r4,65528 ffc09384: 48 00 2c 85 bl ffc0c008 <_Thread_Clear_state> ffc09388: 48 00 00 18 b ffc093a0 <_Rate_monotonic_Timeout+0x7c> _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 ) { ffc0938c: 80 1f 00 38 lwz r0,56(r31) ffc09390: 2f 80 00 01 cmpwi cr7,r0,1 ffc09394: 40 be 00 30 bne+ cr7,ffc093c4 <_Rate_monotonic_Timeout+0xa0> the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; ffc09398: 38 00 00 03 li r0,3 ffc0939c: 90 1f 00 38 stw r0,56(r31) _Rate_monotonic_Initiate_statistics( the_period ); ffc093a0: 7f e3 fb 78 mr r3,r31 ffc093a4: 4b ff f9 35 bl ffc08cd8 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc093a8: 80 1f 00 3c lwz r0,60(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc093ac: 3c 60 00 00 lis r3,0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc093b0: 90 1f 00 1c stw r0,28(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc093b4: 38 63 2e 68 addi r3,r3,11880 ffc093b8: 38 9f 00 10 addi r4,r31,16 ffc093bc: 48 00 40 91 bl ffc0d44c <_Watchdog_Insert> ffc093c0: 48 00 00 0c b ffc093cc <_Rate_monotonic_Timeout+0xa8> _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; ffc093c4: 38 00 00 04 li r0,4 ffc093c8: 90 1f 00 38 stw r0,56(r31) * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc093cc: 3d 20 00 00 lis r9,0 ffc093d0: 81 69 28 6c lwz r11,10348(r9) ffc093d4: 38 0b ff ff addi r0,r11,-1 ffc093d8: 90 09 28 6c stw r0,10348(r9) return _Thread_Dispatch_disable_level; ffc093dc: 80 09 28 6c lwz r0,10348(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc093e0: 39 61 00 20 addi r11,r1,32 ffc093e4: 4b ff 7e 28 b ffc0120c <_restgpr_31_x> =============================================================================== ffc0a8e4 <_Scheduler_EDF_Allocate>: #include void *_Scheduler_EDF_Allocate( Thread_Control *the_thread ) { ffc0a8e4: 7c 2b 0b 78 mr r11,r1 ffc0a8e8: 94 21 ff f0 stwu r1,-16(r1) ffc0a8ec: 7c 08 02 a6 mflr r0 ffc0a8f0: 48 01 24 29 bl ffc1cd18 <_savegpr_31> ffc0a8f4: 7c 7f 1b 78 mr r31,r3 void *sched; Scheduler_EDF_Per_thread *schinfo; sched = _Workspace_Allocate( sizeof(Scheduler_EDF_Per_thread) ); ffc0a8f8: 38 60 00 18 li r3,24 #include void *_Scheduler_EDF_Allocate( Thread_Control *the_thread ) { ffc0a8fc: 90 01 00 14 stw r0,20(r1) void *sched; Scheduler_EDF_Per_thread *schinfo; sched = _Workspace_Allocate( sizeof(Scheduler_EDF_Per_thread) ); ffc0a900: 48 00 1e 8d bl ffc0c78c <_Workspace_Allocate> if ( sched ) { ffc0a904: 2c 03 00 00 cmpwi r3,0 ffc0a908: 41 82 00 14 beq- ffc0a91c <_Scheduler_EDF_Allocate+0x38><== NEVER TAKEN the_thread->scheduler_info = sched; schinfo = (Scheduler_EDF_Per_thread *)(the_thread->scheduler_info); schinfo->thread = the_thread; schinfo->queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN; ffc0a90c: 38 00 00 02 li r0,2 Scheduler_EDF_Per_thread *schinfo; sched = _Workspace_Allocate( sizeof(Scheduler_EDF_Per_thread) ); if ( sched ) { the_thread->scheduler_info = sched; ffc0a910: 90 7f 00 8c stw r3,140(r31) schinfo = (Scheduler_EDF_Per_thread *)(the_thread->scheduler_info); schinfo->thread = the_thread; ffc0a914: 93 e3 00 00 stw r31,0(r3) schinfo->queue_state = SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN; ffc0a918: 90 03 00 14 stw r0,20(r3) } return sched; } ffc0a91c: 39 61 00 10 addi r11,r1,16 ffc0a920: 4b ff 62 28 b ffc00b48 <_restgpr_31_x> =============================================================================== ffc0a924 <_Scheduler_EDF_Block>: #include void _Scheduler_EDF_Block( Thread_Control *the_thread ) { ffc0a924: 94 21 ff f0 stwu r1,-16(r1) ffc0a928: 7c 08 02 a6 mflr r0 ffc0a92c: bf c1 00 08 stmw r30,8(r1) RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); ffc0a930: 3f c0 00 00 lis r30,0 ffc0a934: 3b de 31 c4 addi r30,r30,12740 ffc0a938: 90 01 00 14 stw r0,20(r1) ffc0a93c: 7c 7f 1b 78 mr r31,r3 _Scheduler_EDF_Extract( the_thread ); ffc0a940: 48 00 00 89 bl ffc0a9c8 <_Scheduler_EDF_Extract> /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) ffc0a944: 80 1e 00 10 lwz r0,16(r30) ffc0a948: 7f 9f 00 00 cmpw cr7,r31,r0 ffc0a94c: 40 be 00 08 bne+ cr7,ffc0a954 <_Scheduler_EDF_Block+0x30><== NEVER TAKEN _Scheduler_EDF_Schedule(); ffc0a950: 48 00 01 e1 bl ffc0ab30 <_Scheduler_EDF_Schedule> if ( _Thread_Is_executing( the_thread ) ) ffc0a954: 80 1e 00 0c lwz r0,12(r30) ffc0a958: 7f 9f 00 00 cmpw cr7,r31,r0 ffc0a95c: 40 be 00 0c bne+ cr7,ffc0a968 <_Scheduler_EDF_Block+0x44><== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc0a960: 38 00 00 01 li r0,1 ffc0a964: 98 1e 00 18 stb r0,24(r30) } ffc0a968: 39 61 00 10 addi r11,r1,16 ffc0a96c: 4b ff 61 d8 b ffc00b44 <_restgpr_30_x> =============================================================================== ffc0ab68 <_Scheduler_EDF_Unblock>: #include void _Scheduler_EDF_Unblock( Thread_Control *the_thread ) { ffc0ab68: 94 21 ff f0 stwu r1,-16(r1) ffc0ab6c: 7c 08 02 a6 mflr r0 ffc0ab70: bf c1 00 08 stmw r30,8(r1) * a context switch. * Pseudo-ISR case: * Even if the thread isn't preemptible, if the new heir is * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_lower_than( ffc0ab74: 3f c0 00 00 lis r30,0 #include void _Scheduler_EDF_Unblock( Thread_Control *the_thread ) { ffc0ab78: 7c 7f 1b 78 mr r31,r3 ffc0ab7c: 90 01 00 14 stw r0,20(r1) * a context switch. * Pseudo-ISR case: * Even if the thread isn't preemptible, if the new heir is * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_lower_than( ffc0ab80: 3b de 31 c4 addi r30,r30,12740 void _Scheduler_EDF_Unblock( Thread_Control *the_thread ) { _Scheduler_EDF_Enqueue(the_thread); ffc0ab84: 4b ff fe 0d bl ffc0a990 <_Scheduler_EDF_Enqueue> ffc0ab88: 3d 60 00 00 lis r11,0 * a context switch. * Pseudo-ISR case: * Even if the thread isn't preemptible, if the new heir is * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_lower_than( ffc0ab8c: 81 3e 00 10 lwz r9,16(r30) ffc0ab90: 80 0b 21 10 lwz r0,8464(r11) ffc0ab94: 80 69 00 14 lwz r3,20(r9) ffc0ab98: 80 9f 00 14 lwz r4,20(r31) ffc0ab9c: 7c 09 03 a6 mtctr r0 ffc0aba0: 4e 80 04 21 bctrl ffc0aba4: 2f 83 00 00 cmpwi cr7,r3,0 ffc0aba8: 40 bc 00 34 bge+ cr7,ffc0abdc <_Scheduler_EDF_Unblock+0x74> _Thread_Heir->current_priority, the_thread->current_priority )) { _Thread_Heir = the_thread; if ( _Thread_Executing->is_preemptible || ffc0abac: 81 3e 00 0c lwz r9,12(r30) * a pseudo-ISR system task, we need to do a context switch. */ if ( _Scheduler_Is_priority_lower_than( _Thread_Heir->current_priority, the_thread->current_priority )) { _Thread_Heir = the_thread; ffc0abb0: 93 fe 00 10 stw r31,16(r30) if ( _Thread_Executing->is_preemptible || ffc0abb4: 88 09 00 74 lbz r0,116(r9) ffc0abb8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0abbc: 40 9e 00 10 bne- cr7,ffc0abcc <_Scheduler_EDF_Unblock+0x64><== ALWAYS TAKEN ffc0abc0: 80 1f 00 14 lwz r0,20(r31) <== NOT EXECUTED ffc0abc4: 2f 80 00 00 cmpwi cr7,r0,0 <== NOT EXECUTED ffc0abc8: 40 9e 00 14 bne- cr7,ffc0abdc <_Scheduler_EDF_Unblock+0x74><== NOT EXECUTED the_thread->current_priority == 0 ) _Thread_Dispatch_necessary = true; ffc0abcc: 3d 20 00 00 lis r9,0 ffc0abd0: 38 00 00 01 li r0,1 ffc0abd4: 39 29 31 c4 addi r9,r9,12740 ffc0abd8: 98 09 00 18 stb r0,24(r9) } } ffc0abdc: 39 61 00 10 addi r11,r1,16 ffc0abe0: 4b ff 5f 64 b ffc00b44 <_restgpr_30_x> =============================================================================== ffc0abe4 <_Scheduler_EDF_Update>: #include void _Scheduler_EDF_Update( Thread_Control *the_thread ) { ffc0abe4: 94 21 ff e8 stwu r1,-24(r1) ffc0abe8: 7c 08 02 a6 mflr r0 ffc0abec: 90 01 00 1c stw r0,28(r1) ffc0abf0: bf a1 00 0c stmw r29,12(r1) ffc0abf4: 7c 7f 1b 78 mr r31,r3 Scheduler_EDF_Per_thread *sched_info = ffc0abf8: 83 c3 00 8c lwz r30,140(r3) (Scheduler_EDF_Per_thread*)the_thread->scheduler_info; RBTree_Node *the_node = &(sched_info->Node); if (sched_info->queue_state == SCHEDULER_EDF_QUEUE_STATE_NEVER_HAS_BEEN) { ffc0abfc: 80 1e 00 14 lwz r0,20(r30) ffc0ac00: 2f 80 00 02 cmpwi cr7,r0,2 ffc0ac04: 40 be 00 20 bne+ cr7,ffc0ac24 <_Scheduler_EDF_Update+0x40> /* Shifts the priority to the region of background tasks. */ the_thread->Start.initial_priority |= (SCHEDULER_EDF_PRIO_MSB); ffc0ac08: 80 03 00 b0 lwz r0,176(r3) ffc0ac0c: 64 00 80 00 oris r0,r0,32768 ffc0ac10: 90 03 00 b0 stw r0,176(r3) the_thread->real_priority = the_thread->Start.initial_priority; ffc0ac14: 90 03 00 18 stw r0,24(r3) the_thread->current_priority = the_thread->Start.initial_priority; ffc0ac18: 90 03 00 14 stw r0,20(r3) sched_info->queue_state = SCHEDULER_EDF_QUEUE_STATE_NOT_PRESENTLY; ffc0ac1c: 38 00 00 00 li r0,0 ffc0ac20: 90 1e 00 14 stw r0,20(r30) } if ( sched_info->queue_state == SCHEDULER_EDF_QUEUE_STATE_YES ) { ffc0ac24: 80 1e 00 14 lwz r0,20(r30) ffc0ac28: 2f 80 00 01 cmpwi cr7,r0,1 ffc0ac2c: 40 be 00 68 bne+ cr7,ffc0ac94 <_Scheduler_EDF_Update+0xb0><== ALWAYS TAKEN _RBTree_Extract(&_Scheduler_EDF_Ready_queue, the_node); ffc0ac30: 3f a0 00 00 lis r29,0 <== NOT EXECUTED Thread_Control *the_thread ) { Scheduler_EDF_Per_thread *sched_info = (Scheduler_EDF_Per_thread*)the_thread->scheduler_info; RBTree_Node *the_node = &(sched_info->Node); ffc0ac34: 3b de 00 04 addi r30,r30,4 <== NOT EXECUTED the_thread->current_priority = the_thread->Start.initial_priority; sched_info->queue_state = SCHEDULER_EDF_QUEUE_STATE_NOT_PRESENTLY; } if ( sched_info->queue_state == SCHEDULER_EDF_QUEUE_STATE_YES ) { _RBTree_Extract(&_Scheduler_EDF_Ready_queue, the_node); ffc0ac38: 3b bd 31 e8 addi r29,r29,12776 <== NOT EXECUTED ffc0ac3c: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc0ac40: 7f c4 f3 78 mr r4,r30 <== NOT EXECUTED ffc0ac44: 48 00 4d 09 bl ffc0f94c <_RBTree_Extract> <== NOT EXECUTED _RBTree_Insert(&_Scheduler_EDF_Ready_queue, the_node); ffc0ac48: 7f c4 f3 78 mr r4,r30 <== NOT EXECUTED ffc0ac4c: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc0ac50: 48 00 4f 85 bl ffc0fbd4 <_RBTree_Insert> <== NOT EXECUTED _Scheduler_EDF_Schedule(); ffc0ac54: 4b ff fe dd bl ffc0ab30 <_Scheduler_EDF_Schedule> <== NOT EXECUTED if ( _Thread_Executing != _Thread_Heir ) { ffc0ac58: 3d 60 00 00 lis r11,0 <== NOT EXECUTED ffc0ac5c: 39 4b 31 c4 addi r10,r11,12740 <== NOT EXECUTED ffc0ac60: 81 2a 00 0c lwz r9,12(r10) <== NOT EXECUTED ffc0ac64: 80 0a 00 10 lwz r0,16(r10) <== NOT EXECUTED ffc0ac68: 7f 89 00 00 cmpw cr7,r9,r0 <== NOT EXECUTED ffc0ac6c: 41 9e 00 28 beq- cr7,ffc0ac94 <_Scheduler_EDF_Update+0xb0><== NOT EXECUTED if ( _Thread_Executing->is_preemptible || ffc0ac70: 88 09 00 74 lbz r0,116(r9) <== NOT EXECUTED ffc0ac74: 2f 80 00 00 cmpwi cr7,r0,0 <== NOT EXECUTED ffc0ac78: 40 9e 00 10 bne- cr7,ffc0ac88 <_Scheduler_EDF_Update+0xa4><== NOT EXECUTED ffc0ac7c: 80 1f 00 14 lwz r0,20(r31) <== NOT EXECUTED ffc0ac80: 2f 80 00 00 cmpwi cr7,r0,0 <== NOT EXECUTED ffc0ac84: 40 9e 00 10 bne- cr7,ffc0ac94 <_Scheduler_EDF_Update+0xb0><== NOT EXECUTED the_thread->current_priority == 0 ) _Thread_Dispatch_necessary = true; ffc0ac88: 39 6b 31 c4 addi r11,r11,12740 <== NOT EXECUTED ffc0ac8c: 38 00 00 01 li r0,1 <== NOT EXECUTED ffc0ac90: 98 0b 00 18 stb r0,24(r11) <== NOT EXECUTED } } } ffc0ac94: 39 61 00 18 addi r11,r1,24 ffc0ac98: 4b ff 5e a8 b ffc00b40 <_restgpr_29_x> =============================================================================== ffc0ac9c <_Scheduler_EDF_Yield>: #include #include #include void _Scheduler_EDF_Yield(void) { ffc0ac9c: 94 21 ff e8 stwu r1,-24(r1) <== NOT EXECUTED ffc0aca0: 7c 08 02 a6 mflr r0 <== NOT EXECUTED Scheduler_EDF_Per_thread *first_info; RBTree_Node *first_node; ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0aca4: 3d 20 00 00 lis r9,0 <== NOT EXECUTED #include #include #include void _Scheduler_EDF_Yield(void) { ffc0aca8: 90 01 00 1c stw r0,28(r1) <== NOT EXECUTED ffc0acac: bf 81 00 08 stmw r28,8(r1) <== NOT EXECUTED Scheduler_EDF_Per_thread *first_info; RBTree_Node *first_node; ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0acb0: 83 e9 31 d0 lwz r31,12752(r9) <== NOT EXECUTED Scheduler_EDF_Per_thread *executing_info = ffc0acb4: 83 9f 00 8c lwz r28,140(r31) <== NOT EXECUTED static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0acb8: 7f a0 00 a6 mfmsr r29 <== NOT EXECUTED ffc0acbc: 7c 10 42 a6 mfsprg r0,0 <== NOT EXECUTED ffc0acc0: 7f a0 00 78 andc r0,r29,r0 <== NOT EXECUTED ffc0acc4: 7c 00 01 24 mtmsr r0 <== NOT EXECUTED RTEMS_INLINE_ROUTINE bool _RBTree_Has_only_one_node( const RBTree_Control *the_rbtree ) { if(!the_rbtree) return NULL; /* TODO: expected behavior? */ return (the_rbtree->root->child[RBT_LEFT] == NULL && the_rbtree->root->child[RBT_RIGHT] == NULL); ffc0acc8: 3d 20 00 00 lis r9,0 <== NOT EXECUTED ffc0accc: 81 29 31 ec lwz r9,12780(r9) <== NOT EXECUTED ffc0acd0: 38 00 00 00 li r0,0 <== NOT EXECUTED ffc0acd4: 81 69 00 04 lwz r11,4(r9) <== NOT EXECUTED ffc0acd8: 2f 8b 00 00 cmpwi cr7,r11,0 <== NOT EXECUTED ffc0acdc: 40 be 00 10 bne+ cr7,ffc0acec <_Scheduler_EDF_Yield+0x50><== NOT EXECUTED #include #include #include #include void _Scheduler_EDF_Yield(void) ffc0ace0: 80 09 00 08 lwz r0,8(r9) <== NOT EXECUTED ffc0ace4: 7c 00 00 34 cntlzw r0,r0 <== NOT EXECUTED ffc0ace8: 54 00 d9 7e rlwinm r0,r0,27,5,31 <== NOT EXECUTED (Scheduler_EDF_Per_thread *) executing->scheduler_info; RBTree_Node *executing_node = &(executing_info->Node); _ISR_Disable( level ); if ( !_RBTree_Has_only_one_node(&_Scheduler_EDF_Ready_queue) ) { ffc0acec: 2f 80 00 00 cmpwi cr7,r0,0 <== NOT EXECUTED ffc0acf0: 40 be 00 6c bne+ cr7,ffc0ad5c <_Scheduler_EDF_Yield+0xc0><== NOT EXECUTED /* * The RBTree has more than one node, enqueue behind the tasks * with the same priority in case there are such ones. */ _RBTree_Extract( &_Scheduler_EDF_Ready_queue, executing_node ); ffc0acf4: 3f c0 00 00 lis r30,0 <== NOT EXECUTED ISR_Level level; Thread_Control *executing = _Thread_Executing; Scheduler_EDF_Per_thread *executing_info = (Scheduler_EDF_Per_thread *) executing->scheduler_info; RBTree_Node *executing_node = &(executing_info->Node); ffc0acf8: 3b 9c 00 04 addi r28,r28,4 <== NOT EXECUTED if ( !_RBTree_Has_only_one_node(&_Scheduler_EDF_Ready_queue) ) { /* * The RBTree has more than one node, enqueue behind the tasks * with the same priority in case there are such ones. */ _RBTree_Extract( &_Scheduler_EDF_Ready_queue, executing_node ); ffc0acfc: 3b de 31 e8 addi r30,r30,12776 <== NOT EXECUTED ffc0ad00: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc0ad04: 7f 84 e3 78 mr r4,r28 <== NOT EXECUTED ffc0ad08: 48 00 4c 45 bl ffc0f94c <_RBTree_Extract> <== NOT EXECUTED _RBTree_Insert( &_Scheduler_EDF_Ready_queue, executing_node ); ffc0ad0c: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc0ad10: 7f 84 e3 78 mr r4,r28 <== NOT EXECUTED ffc0ad14: 48 00 4e c1 bl ffc0fbd4 <_RBTree_Insert> <== NOT EXECUTED static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0ad18: 7c 00 00 a6 mfmsr r0 <== NOT EXECUTED ffc0ad1c: 7f a0 01 24 mtmsr r29 <== NOT EXECUTED ffc0ad20: 7c 00 01 24 mtmsr r0 <== NOT EXECUTED ffc0ad24: 3f 80 00 00 lis r28,0 <== NOT EXECUTED ffc0ad28: 3b 9c 31 c4 addi r28,r28,12740 <== NOT EXECUTED _ISR_Flash( level ); if ( _Thread_Is_heir( executing ) ) { ffc0ad2c: 80 1c 00 10 lwz r0,16(r28) <== NOT EXECUTED ffc0ad30: 7f 9f 00 00 cmpw cr7,r31,r0 <== NOT EXECUTED ffc0ad34: 40 be 00 18 bne+ cr7,ffc0ad4c <_Scheduler_EDF_Yield+0xb0><== NOT EXECUTED first_node = _RBTree_Peek( &_Scheduler_EDF_Ready_queue, RBT_LEFT ); ffc0ad38: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc0ad3c: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc0ad40: 48 00 4e a9 bl ffc0fbe8 <_RBTree_Peek> <== NOT EXECUTED first_info = _RBTree_Container_of(first_node, Scheduler_EDF_Per_thread, Node); _Thread_Heir = first_info->thread; ffc0ad44: 80 03 ff fc lwz r0,-4(r3) <== NOT EXECUTED ffc0ad48: 90 1c 00 10 stw r0,16(r28) <== NOT EXECUTED } _Thread_Dispatch_necessary = true; ffc0ad4c: 3d 20 00 00 lis r9,0 <== NOT EXECUTED ffc0ad50: 38 00 00 01 li r0,1 <== NOT EXECUTED ffc0ad54: 39 29 31 c4 addi r9,r9,12740 <== NOT EXECUTED ffc0ad58: 48 00 00 1c b ffc0ad74 <_Scheduler_EDF_Yield+0xd8> <== NOT EXECUTED ffc0ad5c: 3d 20 00 00 lis r9,0 <== NOT EXECUTED ffc0ad60: 39 29 31 c4 addi r9,r9,12740 <== NOT EXECUTED } else if ( !_Thread_Is_heir( executing ) ) ffc0ad64: 80 09 00 10 lwz r0,16(r9) <== NOT EXECUTED ffc0ad68: 7f 9f 00 00 cmpw cr7,r31,r0 <== NOT EXECUTED ffc0ad6c: 41 9e 00 0c beq- cr7,ffc0ad78 <_Scheduler_EDF_Yield+0xdc><== NOT EXECUTED _Thread_Dispatch_necessary = true; ffc0ad70: 38 00 00 01 li r0,1 <== NOT EXECUTED ffc0ad74: 98 09 00 18 stb r0,24(r9) <== NOT EXECUTED return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0ad78: 7f a0 01 24 mtmsr r29 <== NOT EXECUTED _ISR_Enable( level ); } ffc0ad7c: 39 61 00 18 addi r11,r1,24 <== NOT EXECUTED ffc0ad80: 4b ff 5d bc b ffc00b3c <_restgpr_28_x> <== NOT EXECUTED =============================================================================== ffc09ff4 <_Scheduler_priority_Block>: ) { Scheduler_priority_Per_thread *sched_info; Chain_Control *ready; sched_info = (Scheduler_priority_Per_thread *) the_thread->scheduler_info; ffc09ff4: 81 63 00 8c lwz r11,140(r3) ready = sched_info->ready_chain; ffc09ff8: 81 2b 00 00 lwz r9,0(r11) if ( _Chain_Has_only_one_node( ready ) ) { ffc09ffc: 81 49 00 00 lwz r10,0(r9) ffc0a000: 80 09 00 08 lwz r0,8(r9) ffc0a004: 7f 8a 00 00 cmpw cr7,r10,r0 ffc0a008: 40 be 00 4c bne+ cr7,ffc0a054 <_Scheduler_priority_Block+0x60> 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 ); ffc0a00c: 38 09 00 04 addi r0,r9,4 head->next = tail; head->previous = NULL; tail->previous = head; ffc0a010: 91 29 00 08 stw r9,8(r9) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0a014: 90 09 00 00 stw r0,0(r9) head->previous = NULL; ffc0a018: 38 00 00 00 li r0,0 ffc0a01c: 90 09 00 04 stw r0,4(r9) RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; ffc0a020: 81 2b 00 04 lwz r9,4(r11) ffc0a024: 80 0b 00 14 lwz r0,20(r11) ffc0a028: 81 49 00 00 lwz r10,0(r9) ffc0a02c: 7d 40 00 38 and r0,r10,r0 if ( *the_priority_map->minor == 0 ) ffc0a030: 2f 80 00 00 cmpwi cr7,r0,0 RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; ffc0a034: 90 09 00 00 stw r0,0(r9) if ( *the_priority_map->minor == 0 ) ffc0a038: 40 9e 00 2c bne- cr7,ffc0a064 <_Scheduler_priority_Block+0x70> _Priority_Major_bit_map &= the_priority_map->block_major; ffc0a03c: 3d 20 00 00 lis r9,0 ffc0a040: 80 0b 00 10 lwz r0,16(r11) ffc0a044: 81 49 28 4c lwz r10,10316(r9) ffc0a048: 7d 40 00 38 and r0,r10,r0 ffc0a04c: 90 09 28 4c stw r0,10316(r9) ffc0a050: 48 00 00 14 b ffc0a064 <_Scheduler_priority_Block+0x70> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc0a054: 81 63 00 00 lwz r11,0(r3) previous = the_node->previous; ffc0a058: 81 23 00 04 lwz r9,4(r3) next->previous = previous; ffc0a05c: 91 2b 00 04 stw r9,4(r11) previous->next = next; ffc0a060: 91 69 00 00 stw r11,0(r9) RTEMS_INLINE_ROUTINE bool _Thread_Is_heir ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Heir ); ffc0a064: 3d 20 00 00 lis r9,0 { _Scheduler_priority_Ready_queue_extract( the_thread ); /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) ffc0a068: 80 09 31 54 lwz r0,12628(r9) ffc0a06c: 7f 83 00 00 cmpw cr7,r3,r0 ffc0a070: 40 be 00 60 bne+ cr7,ffc0a0d0 <_Scheduler_priority_Block+0xdc> 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 ); ffc0a074: 3d 40 00 00 lis r10,0 * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( (Chain_Control *) _Scheduler.information ffc0a078: 3d 20 00 00 lis r9,0 ffc0a07c: 80 0a 28 4c lwz r0,10316(r10) ffc0a080: 81 29 20 e0 lwz r9,8416(r9) ffc0a084: 7c 0b 00 34 cntlzw r11,r0 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0a088: 3d 00 00 00 lis r8,0 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 ); ffc0a08c: 90 0a 28 4c stw r0,10316(r10) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0a090: 39 08 31 80 addi r8,r8,12672 ffc0a094: 55 6a 10 3a rlwinm r10,r11,2,0,29 ffc0a098: 7c 08 50 2e lwzx r0,r8,r10 ffc0a09c: 7c 07 00 34 cntlzw r7,r0 ffc0a0a0: 7c 08 51 2e stwx r0,r8,r10 return (_Priority_Bits_index( major ) << 4) + ffc0a0a4: 55 60 20 36 rlwinm r0,r11,4,0,27 ffc0a0a8: 7c 00 3a 14 add r0,r0,r7 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) ffc0a0ac: 1c 00 00 0c mulli r0,r0,12 ffc0a0b0: 7d 69 02 14 add r11,r9,r0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0a0b4: 7c 09 00 2e lwzx r0,r9,r0 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc0a0b8: 39 2b 00 04 addi r9,r11,4 ffc0a0bc: 7f 80 48 00 cmpw cr7,r0,r9 ffc0a0c0: 40 be 00 08 bne+ cr7,ffc0a0c8 <_Scheduler_priority_Block+0xd4><== ALWAYS TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc0a0c4: 38 00 00 00 li r0,0 <== NOT EXECUTED * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0a0c8: 3d 20 00 00 lis r9,0 ffc0a0cc: 90 09 31 54 stw r0,12628(r9) RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc0a0d0: 3d 20 00 00 lis r9,0 ffc0a0d4: 39 29 31 44 addi r9,r9,12612 _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) ffc0a0d8: 80 09 00 0c lwz r0,12(r9) ffc0a0dc: 7f 83 00 00 cmpw cr7,r3,r0 ffc0a0e0: 4c be 00 20 bnelr+ cr7 _Thread_Dispatch_necessary = true; ffc0a0e4: 38 00 00 01 li r0,1 ffc0a0e8: 98 09 00 18 stb r0,24(r9) ffc0a0ec: 4e 80 00 20 blr =============================================================================== ffc0a2c0 <_Scheduler_priority_Schedule>: 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 ); ffc0a2c0: 3d 40 00 00 lis r10,0 * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( (Chain_Control *) _Scheduler.information ffc0a2c4: 3d 20 00 00 lis r9,0 ffc0a2c8: 80 0a 28 4c lwz r0,10316(r10) ffc0a2cc: 81 29 20 e0 lwz r9,8416(r9) ffc0a2d0: 7c 0b 00 34 cntlzw r11,r0 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0a2d4: 3d 00 00 00 lis r8,0 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 ); ffc0a2d8: 90 0a 28 4c stw r0,10316(r10) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0a2dc: 39 08 31 80 addi r8,r8,12672 ffc0a2e0: 55 6a 10 3a rlwinm r10,r11,2,0,29 ffc0a2e4: 7c 08 50 2e lwzx r0,r8,r10 ffc0a2e8: 7c 07 00 34 cntlzw r7,r0 ffc0a2ec: 7c 08 51 2e stwx r0,r8,r10 return (_Priority_Bits_index( major ) << 4) + ffc0a2f0: 55 60 20 36 rlwinm r0,r11,4,0,27 ffc0a2f4: 7c 00 3a 14 add r0,r0,r7 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) ffc0a2f8: 1c 00 00 0c mulli r0,r0,12 ffc0a2fc: 7d 69 02 14 add r11,r9,r0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0a300: 7c 09 00 2e lwzx r0,r9,r0 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc0a304: 39 2b 00 04 addi r9,r11,4 ffc0a308: 7f 80 48 00 cmpw cr7,r0,r9 ffc0a30c: 40 be 00 08 bne+ cr7,ffc0a314 <_Scheduler_priority_Schedule+0x54><== ALWAYS TAKEN return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc0a310: 38 00 00 00 li r0,0 <== NOT EXECUTED * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0a314: 3d 20 00 00 lis r9,0 ffc0a318: 90 09 31 54 stw r0,12628(r9) #include void _Scheduler_priority_Schedule(void) { _Scheduler_priority_Schedule_body(); } ffc0a31c: 4e 80 00 20 blr =============================================================================== ffc0a320 <_Scheduler_priority_Tick>: #include #include void _Scheduler_priority_Tick( void ) { ffc0a320: 7c 08 02 a6 mflr r0 ffc0a324: 7c 2b 0b 78 mr r11,r1 ffc0a328: 94 21 ff f0 stwu r1,-16(r1) Thread_Control *executing; executing = _Thread_Executing; ffc0a32c: 3d 20 00 00 lis r9,0 #include #include void _Scheduler_priority_Tick( void ) { ffc0a330: 90 01 00 14 stw r0,20(r1) ffc0a334: 48 01 10 19 bl ffc1b34c <_savegpr_31> Thread_Control *executing; executing = _Thread_Executing; ffc0a338: 83 e9 31 50 lwz r31,12624(r9) /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) ffc0a33c: 88 1f 00 74 lbz r0,116(r31) ffc0a340: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a344: 41 9e 00 88 beq- cr7,ffc0a3cc <_Scheduler_priority_Tick+0xac> return; if ( !_States_Is_ready( executing->current_state ) ) ffc0a348: 80 1f 00 10 lwz r0,16(r31) ffc0a34c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a350: 40 9e 00 7c bne- cr7,ffc0a3cc <_Scheduler_priority_Tick+0xac> /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { ffc0a354: 80 1f 00 7c lwz r0,124(r31) ffc0a358: 2b 80 00 01 cmplwi cr7,r0,1 ffc0a35c: 41 9c 00 70 blt- cr7,ffc0a3cc <_Scheduler_priority_Tick+0xac> ffc0a360: 2b 80 00 02 cmplwi cr7,r0,2 ffc0a364: 40 9d 00 10 ble- cr7,ffc0a374 <_Scheduler_priority_Tick+0x54> ffc0a368: 2f 80 00 03 cmpwi cr7,r0,3 ffc0a36c: 40 be 00 60 bne+ cr7,ffc0a3cc <_Scheduler_priority_Tick+0xac><== NEVER TAKEN ffc0a370: 48 00 00 38 b ffc0a3a8 <_Scheduler_priority_Tick+0x88> 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 ) { ffc0a374: 81 3f 00 78 lwz r9,120(r31) ffc0a378: 38 09 ff ff addi r0,r9,-1 ffc0a37c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a380: 90 1f 00 78 stw r0,120(r31) ffc0a384: 41 bd 00 48 bgt+ cr7,ffc0a3cc <_Scheduler_priority_Tick+0xac> * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield(); ffc0a388: 3d 20 00 00 lis r9,0 ffc0a38c: 80 09 20 ec lwz r0,8428(r9) ffc0a390: 7c 09 03 a6 mtctr r0 ffc0a394: 4e 80 04 21 bctrl * 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; ffc0a398: 3d 20 00 00 lis r9,0 ffc0a39c: 80 09 28 08 lwz r0,10248(r9) ffc0a3a0: 90 1f 00 78 stw r0,120(r31) ffc0a3a4: 48 00 00 28 b ffc0a3cc <_Scheduler_priority_Tick+0xac> } break; #if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: if ( --executing->cpu_time_budget == 0 ) ffc0a3a8: 81 3f 00 78 lwz r9,120(r31) ffc0a3ac: 38 09 ff ff addi r0,r9,-1 ffc0a3b0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a3b4: 90 1f 00 78 stw r0,120(r31) ffc0a3b8: 40 be 00 14 bne+ cr7,ffc0a3cc <_Scheduler_priority_Tick+0xac> (*executing->budget_callout)( executing ); ffc0a3bc: 80 1f 00 80 lwz r0,128(r31) ffc0a3c0: 7f e3 fb 78 mr r3,r31 ffc0a3c4: 7c 09 03 a6 mtctr r0 ffc0a3c8: 4e 80 04 21 bctrl break; #endif } } ffc0a3cc: 39 61 00 10 addi r11,r1,16 ffc0a3d0: 4b ff 61 74 b ffc00544 <_restgpr_31_x> =============================================================================== ffc08d48 <_TOD_Validate>: 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) || ffc08d48: 2c 03 00 00 cmpwi r3,0 { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / rtems_configuration_get_microseconds_per_tick(); ffc08d4c: 3d 20 00 00 lis r9,0 ffc08d50: 81 29 20 30 lwz r9,8240(r9) (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; ffc08d54: 38 00 00 00 li r0,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) || ffc08d58: 41 82 00 94 beq- ffc08dec <_TOD_Validate+0xa4> <== NEVER TAKEN ) { uint32_t days_in_month; uint32_t ticks_per_second; ticks_per_second = TOD_MICROSECONDS_PER_SECOND / ffc08d5c: 3d 60 00 0f lis r11,15 ffc08d60: 61 6b 42 40 ori r11,r11,16960 ffc08d64: 7d 2b 4b 96 divwu r9,r11,r9 rtems_configuration_get_microseconds_per_tick(); if ((!the_tod) || ffc08d68: 81 63 00 18 lwz r11,24(r3) ffc08d6c: 7f 8b 48 40 cmplw cr7,r11,r9 ffc08d70: 40 9c 00 7c bge- cr7,ffc08dec <_TOD_Validate+0xa4> (the_tod->ticks >= ticks_per_second) || ffc08d74: 81 23 00 14 lwz r9,20(r3) ffc08d78: 2b 89 00 3b cmplwi cr7,r9,59 ffc08d7c: 41 9d 00 70 bgt- cr7,ffc08dec <_TOD_Validate+0xa4> (the_tod->second >= TOD_SECONDS_PER_MINUTE) || ffc08d80: 81 23 00 10 lwz r9,16(r3) ffc08d84: 2b 89 00 3b cmplwi cr7,r9,59 ffc08d88: 41 9d 00 64 bgt- cr7,ffc08dec <_TOD_Validate+0xa4> (the_tod->minute >= TOD_MINUTES_PER_HOUR) || ffc08d8c: 81 23 00 0c lwz r9,12(r3) ffc08d90: 2b 89 00 17 cmplwi cr7,r9,23 ffc08d94: 41 9d 00 58 bgt- cr7,ffc08dec <_TOD_Validate+0xa4> (the_tod->hour >= TOD_HOURS_PER_DAY) || (the_tod->month == 0) || ffc08d98: 81 23 00 04 lwz r9,4(r3) 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) || ffc08d9c: 2f 89 00 00 cmpwi cr7,r9,0 ffc08da0: 41 9e 00 4c beq- cr7,ffc08dec <_TOD_Validate+0xa4> <== NEVER TAKEN (the_tod->month == 0) || ffc08da4: 2b 89 00 0c cmplwi cr7,r9,12 ffc08da8: 41 9d 00 44 bgt- cr7,ffc08dec <_TOD_Validate+0xa4> (the_tod->month > TOD_MONTHS_PER_YEAR) || (the_tod->year < TOD_BASE_YEAR) || ffc08dac: 81 43 00 00 lwz r10,0(r3) (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) || ffc08db0: 2b 8a 07 c3 cmplwi cr7,r10,1987 ffc08db4: 40 9d 00 38 ble- cr7,ffc08dec <_TOD_Validate+0xa4> (the_tod->year < TOD_BASE_YEAR) || (the_tod->day == 0) ) ffc08db8: 81 63 00 08 lwz r11,8(r3) (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) || ffc08dbc: 2f 8b 00 00 cmpwi cr7,r11,0 ffc08dc0: 41 9e 00 2c beq- cr7,ffc08dec <_TOD_Validate+0xa4> <== NEVER TAKEN (the_tod->day == 0) ) return false; if ( (the_tod->year % 4) == 0 ) ffc08dc4: 71 40 00 03 andi. r0,r10,3 ffc08dc8: 3d 40 ff c2 lis r10,-62 ffc08dcc: 39 4a fe 34 addi r10,r10,-460 ffc08dd0: 40 82 00 08 bne- ffc08dd8 <_TOD_Validate+0x90> days_in_month = _TOD_Days_per_month[ 1 ][ the_tod->month ]; ffc08dd4: 39 29 00 0d addi r9,r9,13 else days_in_month = _TOD_Days_per_month[ 0 ][ the_tod->month ]; ffc08dd8: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc08ddc: 7c 0a 48 2e lwzx r0,r10,r9 * false - if the the_tod is invalid * * NOTE: This routine only works for leap-years through 2099. */ bool _TOD_Validate( ffc08de0: 7c 0b 00 10 subfc r0,r11,r0 ffc08de4: 38 00 00 00 li r0,0 ffc08de8: 7c 00 01 14 adde r0,r0,r0 if ( the_tod->day > days_in_month ) return false; return true; } ffc08dec: 7c 03 03 78 mr r3,r0 ffc08df0: 4e 80 00 20 blr =============================================================================== ffc0a5d4 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { ffc0a5d4: 94 21 ff e0 stwu r1,-32(r1) ffc0a5d8: 7c 08 02 a6 mflr r0 ffc0a5dc: 90 01 00 24 stw r0,36(r1) ffc0a5e0: bf 81 00 10 stmw r28,16(r1) ffc0a5e4: 7c 7f 1b 78 mr r31,r3 ffc0a5e8: 7c be 2b 78 mr r30,r5 States_Control state, original_state; /* * Save original state */ original_state = the_thread->current_state; ffc0a5ec: 83 a3 00 10 lwz r29,16(r3) /* * 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 ); ffc0a5f0: 90 81 00 08 stw r4,8(r1) ffc0a5f4: 48 00 0e 8d bl ffc0b480 <_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 ) ffc0a5f8: 80 1f 00 14 lwz r0,20(r31) ffc0a5fc: 80 81 00 08 lwz r4,8(r1) ffc0a600: 7f 80 20 00 cmpw cr7,r0,r4 ffc0a604: 41 9e 00 0c beq- cr7,ffc0a610 <_Thread_Change_priority+0x3c> _Thread_Set_priority( the_thread, new_priority ); ffc0a608: 7f e3 fb 78 mr r3,r31 ffc0a60c: 48 00 0d e9 bl ffc0b3f4 <_Thread_Set_priority> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a610: 7f 80 00 a6 mfmsr r28 ffc0a614: 7c 10 42 a6 mfsprg r0,0 ffc0a618: 7f 80 00 78 andc r0,r28,r0 ffc0a61c: 7c 00 01 24 mtmsr r0 /* * 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; ffc0a620: 80 1f 00 10 lwz r0,16(r31) ffc0a624: 57 bd 07 7a rlwinm r29,r29,0,29,29 if ( state != STATES_TRANSIENT ) { ffc0a628: 2f 80 00 04 cmpwi cr7,r0,4 ffc0a62c: 41 9e 00 38 beq- cr7,ffc0a664 <_Thread_Change_priority+0x90> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) ffc0a630: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0a634: 40 9e 00 0c bne- cr7,ffc0a640 <_Thread_Change_priority+0x6c><== NEVER TAKEN RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); ffc0a638: 54 09 07 b8 rlwinm r9,r0,0,30,28 the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); ffc0a63c: 91 3f 00 10 stw r9,16(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a640: 7f 80 01 24 mtmsr r28 _ISR_Enable( level ); if ( _States_Is_waiting_on_thread_queue( state ) ) { ffc0a644: 3d 20 00 03 lis r9,3 ffc0a648: 61 29 be e0 ori r9,r9,48864 ffc0a64c: 7c 0b 48 39 and. r11,r0,r9 ffc0a650: 41 a2 00 94 beq+ ffc0a6e4 <_Thread_Change_priority+0x110> _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); ffc0a654: 80 7f 00 44 lwz r3,68(r31) ffc0a658: 7f e4 fb 78 mr r4,r31 ffc0a65c: 48 00 0c dd bl ffc0b338 <_Thread_queue_Requeue> ffc0a660: 48 00 00 84 b ffc0a6e4 <_Thread_Change_priority+0x110> } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { ffc0a664: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0a668: 40 9e 00 30 bne- cr7,ffc0a698 <_Thread_Change_priority+0xc4><== NEVER TAKEN * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); if ( prepend_it ) ffc0a66c: 2f 9e 00 00 cmpwi cr7,r30,0 * Interrupts are STILL disabled. * We now know the thread will be in the READY state when we remove * the TRANSIENT state. So we have to place it on the appropriate * Ready Queue with interrupts off. */ the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); ffc0a670: 93 bf 00 10 stw r29,16(r31) ffc0a674: 3d 20 00 00 lis r9,0 ffc0a678: 39 29 20 e0 addi r9,r9,8416 if ( prepend_it ) ffc0a67c: 41 9e 00 0c beq- cr7,ffc0a688 <_Thread_Change_priority+0xb4> */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue_first( the_thread ); ffc0a680: 80 09 00 28 lwz r0,40(r9) ffc0a684: 48 00 00 08 b ffc0a68c <_Thread_Change_priority+0xb8> */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue( the_thread ); ffc0a688: 80 09 00 24 lwz r0,36(r9) ffc0a68c: 7f e3 fb 78 mr r3,r31 ffc0a690: 7c 09 03 a6 mtctr r0 ffc0a694: 4e 80 04 21 bctrl static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0a698: 7c 00 00 a6 mfmsr r0 ffc0a69c: 7f 80 01 24 mtmsr r28 ffc0a6a0: 7c 00 01 24 mtmsr r0 * This kernel routine implements the scheduling decision logic for * the scheduler. It does NOT dispatch. */ RTEMS_INLINE_ROUTINE void _Scheduler_Schedule( void ) { _Scheduler.Operations.schedule(); ffc0a6a4: 3d 20 00 00 lis r9,0 ffc0a6a8: 80 09 20 e8 lwz r0,8424(r9) ffc0a6ac: 7c 09 03 a6 mtctr r0 ffc0a6b0: 4e 80 04 21 bctrl * is also the heir thread, and false otherwise. */ RTEMS_INLINE_ROUTINE bool _Thread_Is_executing_also_the_heir( void ) { return ( _Thread_Executing == _Thread_Heir ); ffc0a6b4: 3d 20 00 00 lis r9,0 ffc0a6b8: 39 29 31 44 addi r9,r9,12612 ffc0a6bc: 81 69 00 0c lwz r11,12(r9) * We altered the set of thread priorities. So let's figure out * who is the heir and if we need to switch to them. */ _Scheduler_Schedule(); if ( !_Thread_Is_executing_also_the_heir() && ffc0a6c0: 80 09 00 10 lwz r0,16(r9) ffc0a6c4: 7f 8b 00 00 cmpw cr7,r11,r0 ffc0a6c8: 41 9e 00 18 beq- cr7,ffc0a6e0 <_Thread_Change_priority+0x10c> ffc0a6cc: 88 0b 00 74 lbz r0,116(r11) ffc0a6d0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a6d4: 41 9e 00 0c beq- cr7,ffc0a6e0 <_Thread_Change_priority+0x10c> _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; ffc0a6d8: 38 00 00 01 li r0,1 ffc0a6dc: 98 09 00 18 stb r0,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a6e0: 7f 80 01 24 mtmsr r28 _ISR_Enable( level ); } ffc0a6e4: 39 61 00 20 addi r11,r1,32 ffc0a6e8: 4b ff 5e 50 b ffc00538 <_restgpr_28_x> =============================================================================== ffc0a904 <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0a904: 94 21 ff e8 stwu r1,-24(r1) ffc0a908: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0a90c: 38 81 00 08 addi r4,r1,8 void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0a910: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0a914: 48 00 01 d9 bl ffc0aaec <_Thread_Get> switch ( location ) { ffc0a918: 80 01 00 08 lwz r0,8(r1) ffc0a91c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a920: 40 9e 00 24 bne- cr7,ffc0a944 <_Thread_Delay_ended+0x40><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( ffc0a924: 3c 80 10 00 lis r4,4096 ffc0a928: 60 84 00 18 ori r4,r4,24 ffc0a92c: 4b ff fd c1 bl ffc0a6ec <_Thread_Clear_state> * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc0a930: 3d 20 00 00 lis r9,0 ffc0a934: 81 69 28 0c lwz r11,10252(r9) ffc0a938: 38 0b ff ff addi r0,r11,-1 ffc0a93c: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc0a940: 80 09 28 0c lwz r0,10252(r9) | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Thread_Unnest_dispatch(); break; } } ffc0a944: 80 01 00 1c lwz r0,28(r1) ffc0a948: 38 21 00 18 addi r1,r1,24 ffc0a94c: 7c 08 03 a6 mtlr r0 ffc0a950: 4e 80 00 20 blr =============================================================================== ffc0a954 <_Thread_Dispatch>: * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc0a954: 3d 20 00 00 lis r9,0 * INTERRUPT LATENCY: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { ffc0a958: 94 21 ff c8 stwu r1,-56(r1) ffc0a95c: 7c 08 02 a6 mflr r0 ffc0a960: 81 69 28 0c lwz r11,10252(r9) ffc0a964: 90 01 00 3c stw r0,60(r1) ffc0a968: 38 0b 00 01 addi r0,r11,1 ffc0a96c: 90 09 28 0c stw r0,10252(r9) ffc0a970: bf 21 00 1c stmw r25,28(r1) return _Thread_Dispatch_disable_level; ffc0a974: 80 09 28 0c lwz r0,10252(r9) #endif /* * Now determine if we need to perform a dispatch on the current CPU. */ executing = _Thread_Executing; ffc0a978: 3f 80 00 00 lis r28,0 ffc0a97c: 3b bc 31 44 addi r29,r28,12612 ffc0a980: 83 fd 00 0c lwz r31,12(r29) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a984: 7c 00 00 a6 mfmsr r0 ffc0a988: 7d 30 42 a6 mfsprg r9,0 ffc0a98c: 7c 09 48 78 andc r9,r0,r9 ffc0a990: 7d 20 01 24 mtmsr r9 _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_necessary = false; ffc0a994: 3b 20 00 00 li r25,0 #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; ffc0a998: 3f 40 00 00 lis r26,0 #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); _Timestamp_Subtract( ffc0a99c: 3b bd 00 1c addi r29,r29,28 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0a9a0: 3f 60 00 00 lis r27,0 /* * Now determine if we need to perform a dispatch on the current CPU. */ executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { ffc0a9a4: 48 00 00 d8 b ffc0aa7c <_Thread_Dispatch+0x128> heir = _Thread_Heir; ffc0a9a8: 83 c9 00 10 lwz r30,16(r9) _Thread_Dispatch_necessary = false; ffc0a9ac: 9b 29 00 18 stb r25,24(r9) /* * 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 ) ffc0a9b0: 7f 9e f8 00 cmpw cr7,r30,r31 _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_necessary = false; _Thread_Executing = heir; ffc0a9b4: 93 c9 00 0c stw r30,12(r9) /* * 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 ) ffc0a9b8: 41 9e 00 d4 beq- cr7,ffc0aa8c <_Thread_Dispatch+0x138> */ #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 ) ffc0a9bc: 81 3e 00 7c lwz r9,124(r30) ffc0a9c0: 2f 89 00 01 cmpwi cr7,r9,1 ffc0a9c4: 40 be 00 0c bne+ cr7,ffc0a9d0 <_Thread_Dispatch+0x7c> heir->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0a9c8: 81 3a 28 08 lwz r9,10248(r26) ffc0a9cc: 91 3e 00 78 stw r9,120(r30) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a9d0: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); ffc0a9d4: 38 61 00 10 addi r3,r1,16 ffc0a9d8: 48 00 3c 99 bl ffc0e670 <_TOD_Get_uptime> _Timestamp_Subtract( ffc0a9dc: 7f a3 eb 78 mr r3,r29 ffc0a9e0: 38 81 00 10 addi r4,r1,16 ffc0a9e4: 38 a1 00 08 addi r5,r1,8 ffc0a9e8: 48 00 0c d1 bl ffc0b6b8 <_Timespec_Subtract> &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); ffc0a9ec: 38 7f 00 84 addi r3,r31,132 ffc0a9f0: 38 81 00 08 addi r4,r1,8 ffc0a9f4: 48 00 0c 69 bl ffc0b65c <_Timespec_Add_to> #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0a9f8: 81 3b 28 20 lwz r9,10272(r27) &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; ffc0a9fc: 81 41 00 10 lwz r10,16(r1) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0aa00: 2f 89 00 00 cmpwi cr7,r9,0 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; ffc0aa04: 81 61 00 14 lwz r11,20(r1) ffc0aa08: 91 5d 00 00 stw r10,0(r29) ffc0aa0c: 91 7d 00 04 stw r11,4(r29) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0aa10: 41 9e 00 14 beq- cr7,ffc0aa24 <_Thread_Dispatch+0xd0> <== NEVER TAKEN executing->libc_reent = *_Thread_libc_reent; ffc0aa14: 80 09 00 00 lwz r0,0(r9) ffc0aa18: 90 1f 01 2c stw r0,300(r31) *_Thread_libc_reent = heir->libc_reent; ffc0aa1c: 80 1e 01 2c lwz r0,300(r30) ffc0aa20: 90 09 00 00 stw r0,0(r9) } _User_extensions_Thread_switch( executing, heir ); ffc0aa24: 7f e3 fb 78 mr r3,r31 ffc0aa28: 7f c4 f3 78 mr r4,r30 ffc0aa2c: 48 00 0f b5 bl ffc0b9e0 <_User_extensions_Thread_switch> * operations. */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH != TRUE ) if ( executing->fp_context != NULL ) ffc0aa30: 80 1f 01 28 lwz r0,296(r31) ffc0aa34: 2f 80 00 00 cmpwi cr7,r0,0 ffc0aa38: 41 9e 00 0c beq- cr7,ffc0aa44 <_Thread_Dispatch+0xf0> _Context_Save_fp( &executing->fp_context ); ffc0aa3c: 38 7f 01 28 addi r3,r31,296 ffc0aa40: 48 01 09 e1 bl ffc1b420 <_CPU_Context_save_fp> #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); ffc0aa44: 38 7f 00 c8 addi r3,r31,200 ffc0aa48: 38 9e 00 c8 addi r4,r30,200 ffc0aa4c: 48 01 0b 55 bl ffc1b5a0 <_CPU_Context_switch> _Context_Save_fp( &_Thread_Allocated_fp->fp_context ); _Context_Restore_fp( &executing->fp_context ); _Thread_Allocated_fp = executing; } #else if ( executing->fp_context != NULL ) ffc0aa50: 80 1f 01 28 lwz r0,296(r31) ffc0aa54: 2f 80 00 00 cmpwi cr7,r0,0 ffc0aa58: 41 9e 00 0c beq- cr7,ffc0aa64 <_Thread_Dispatch+0x110> _Context_Restore_fp( &executing->fp_context ); ffc0aa5c: 38 7f 01 28 addi r3,r31,296 ffc0aa60: 48 01 0a 81 bl ffc1b4e0 <_CPU_Context_restore_fp> #endif #endif executing = _Thread_Executing; ffc0aa64: 39 3c 31 44 addi r9,r28,12612 ffc0aa68: 83 e9 00 0c lwz r31,12(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0aa6c: 7c 00 00 a6 mfmsr r0 ffc0aa70: 7d 30 42 a6 mfsprg r9,0 ffc0aa74: 7c 09 48 78 andc r9,r0,r9 ffc0aa78: 7d 20 01 24 mtmsr r9 /* * Now determine if we need to perform a dispatch on the current CPU. */ executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { ffc0aa7c: 39 3c 31 44 addi r9,r28,12612 ffc0aa80: 89 69 00 18 lbz r11,24(r9) ffc0aa84: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0aa88: 40 9e ff 20 bne+ cr7,ffc0a9a8 <_Thread_Dispatch+0x54> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0aa8c: 7c 00 01 24 mtmsr r0 * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc0aa90: 3d 20 00 00 lis r9,0 ffc0aa94: 81 69 28 0c lwz r11,10252(r9) ffc0aa98: 38 0b ff ff addi r0,r11,-1 ffc0aa9c: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc0aaa0: 80 09 28 0c lwz r0,10252(r9) _ISR_Enable( level ); _Thread_Unnest_dispatch(); _API_extensions_Run_postswitch(); ffc0aaa4: 4b ff e0 15 bl ffc08ab8 <_API_extensions_Run_postswitch> } ffc0aaa8: 39 61 00 38 addi r11,r1,56 ffc0aaac: 4b ff 5a 80 b ffc0052c <_restgpr_25_x> =============================================================================== ffc1098c <_Thread_Handler>: * Input parameters: NONE * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc1098c: 94 21 ff f0 stwu r1,-16(r1) ffc10990: 7c 08 02 a6 mflr r0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static bool doneConstructors; bool doCons; #endif executing = _Thread_Executing; ffc10994: 3d 20 00 00 lis r9,0 * Input parameters: NONE * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc10998: 90 01 00 14 stw r0,20(r1) ffc1099c: bf c1 00 08 stmw r30,8(r1) #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static bool doneConstructors; bool doCons; #endif executing = _Thread_Executing; ffc109a0: 83 e9 31 50 lwz r31,12624(r9) /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; ffc109a4: 81 3f 00 ac lwz r9,172(r31) } static inline void _CPU_ISR_Set_level( uint32_t level ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc109a8: 38 00 00 00 li r0,0 ffc109ac: 7c 00 00 a6 mfmsr r0 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc109b0: 71 2b 00 01 andi. r11,r9,1 static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; __asm__ volatile ( ffc109b4: 7d 30 42 a6 mfsprg r9,0 ffc109b8: 40 82 00 0c bne- ffc109c4 <_Thread_Handler+0x38> msr |= ppc_interrupt_get_disable_mask(); ffc109bc: 7d 20 03 78 or r0,r9,r0 ffc109c0: 48 00 00 08 b ffc109c8 <_Thread_Handler+0x3c> } else { msr &= ~ppc_interrupt_get_disable_mask(); ffc109c4: 7c 00 48 78 andc r0,r0,r9 } _CPU_MSR_SET(msr); ffc109c8: 7c 00 01 24 mtmsr r0 doCons = !doneConstructors && _Objects_Get_API( executing->Object.id ) != OBJECTS_INTERNAL_API; if (doCons) doneConstructors = true; #else doCons = !doneConstructors; ffc109cc: 3d 20 00 00 lis r9,0 ffc109d0: 8b c9 29 f8 lbz r30,10744(r9) doneConstructors = true; ffc109d4: 38 00 00 01 li r0,1 /* * Take care that 'begin' extensions get to complete before * 'switch' extensions can run. This means must keep dispatch * disabled until all 'begin' extensions complete. */ _User_extensions_Thread_begin( executing ); ffc109d8: 7f e3 fb 78 mr r3,r31 && _Objects_Get_API( executing->Object.id ) != OBJECTS_INTERNAL_API; if (doCons) doneConstructors = true; #else doCons = !doneConstructors; doneConstructors = true; ffc109dc: 98 09 29 f8 stb r0,10744(r9) /* * 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 ); ffc109e0: 4b ff ad cd bl ffc0b7ac <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); ffc109e4: 4b ff a0 cd bl ffc0aab0 <_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 (doCons) /* && (volatile void *)_init) */ { ffc109e8: 2f 9e 00 00 cmpwi cr7,r30,0 ffc109ec: 40 be 00 08 bne+ cr7,ffc109f4 <_Thread_Handler+0x68> INIT_NAME (); ffc109f0: 48 00 bc 4d bl ffc1c63c <_init> _Thread_Enable_dispatch(); #endif } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { ffc109f4: 80 1f 00 94 lwz r0,148(r31) ffc109f8: 2f 80 00 00 cmpwi cr7,r0,0 ffc109fc: 40 be 00 10 bne+ cr7,ffc10a0c <_Thread_Handler+0x80> executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( ffc10a00: 80 1f 00 90 lwz r0,144(r31) ffc10a04: 80 7f 00 9c lwz r3,156(r31) ffc10a08: 48 00 00 14 b ffc10a1c <_Thread_Handler+0x90> executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { ffc10a0c: 2f 80 00 01 cmpwi cr7,r0,1 ffc10a10: 40 be 00 18 bne+ cr7,ffc10a28 <_Thread_Handler+0x9c> <== NEVER TAKEN executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( ffc10a14: 80 1f 00 90 lwz r0,144(r31) ffc10a18: 80 7f 00 98 lwz r3,152(r31) ffc10a1c: 7c 09 03 a6 mtctr r0 ffc10a20: 4e 80 04 21 bctrl executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = ffc10a24: 90 7f 00 28 stw r3,40(r31) * 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 ); ffc10a28: 7f e3 fb 78 mr r3,r31 ffc10a2c: 4b ff ad d5 bl ffc0b800 <_User_extensions_Thread_exitted> _Internal_error_Occurred( ffc10a30: 38 60 00 00 li r3,0 ffc10a34: 38 80 00 01 li r4,1 ffc10a38: 38 a0 00 05 li r5,5 ffc10a3c: 4b ff 8c 2d bl ffc09668 <_Internal_error_Occurred> =============================================================================== ffc0ab9c <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0ab9c: 94 21 ff d0 stwu r1,-48(r1) ffc0aba0: 7c 08 02 a6 mflr r0 ffc0aba4: be e1 00 0c stmw r23,12(r1) if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { ffc0aba8: 7c b7 2b 79 mr. r23,r5 Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0abac: 7d 3a 4b 78 mr r26,r9 ffc0abb0: 90 01 00 34 stw r0,52(r1) /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; ffc0abb4: 38 00 00 00 li r0,0 Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0abb8: 7c 7e 1b 78 mr r30,r3 ffc0abbc: 81 21 00 40 lwz r9,64(r1) ffc0abc0: 7c 9f 23 78 mr r31,r4 ffc0abc4: 7c dd 33 78 mr r29,r6 /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; ffc0abc8: 90 04 01 30 stw r0,304(r4) Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0abcc: 7c fc 3b 78 mr r28,r7 ffc0abd0: 7d 1b 43 78 mr r27,r8 ffc0abd4: 83 09 00 00 lwz r24,0(r9) ffc0abd8: 7d 59 53 78 mr r25,r10 /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; ffc0abdc: 90 04 01 34 stw r0,308(r4) extensions_area = NULL; the_thread->libc_reent = NULL; ffc0abe0: 90 04 01 2c stw r0,300(r4) if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { ffc0abe4: 40 a2 00 38 bne+ ffc0ac1c <_Thread_Initialize+0x80> actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); ffc0abe8: 7c 83 23 78 mr r3,r4 ffc0abec: 7c c4 33 78 mr r4,r6 ffc0abf0: 48 00 08 e5 bl ffc0b4d4 <_Thread_Stack_Allocate> if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ ffc0abf4: 38 00 00 00 li r0,0 stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); if ( !actual_stack_size || actual_stack_size < stack_size ) ffc0abf8: 2c 03 00 00 cmpwi r3,0 ffc0abfc: 41 82 01 b0 beq- ffc0adac <_Thread_Initialize+0x210> ffc0ac00: 7f 83 e8 40 cmplw cr7,r3,r29 return false; /* stack allocation failed */ ffc0ac04: 7e e0 bb 78 mr r0,r23 stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); if ( !actual_stack_size || actual_stack_size < stack_size ) ffc0ac08: 41 9c 01 a4 blt- cr7,ffc0adac <_Thread_Initialize+0x210><== NEVER TAKEN return false; /* stack allocation failed */ stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; ffc0ac0c: 38 00 00 01 li r0,1 if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; ffc0ac10: 82 ff 00 c4 lwz r23,196(r31) the_thread->Start.core_allocated_stack = true; ffc0ac14: 98 1f 00 b4 stb r0,180(r31) ffc0ac18: 48 00 00 0c b ffc0ac24 <_Thread_Initialize+0x88> } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; ffc0ac1c: 98 04 00 b4 stb r0,180(r4) ffc0ac20: 7c c3 33 78 mr r3,r6 /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { ffc0ac24: 2f 9c 00 00 cmpwi cr7,r28,0 Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; ffc0ac28: 92 ff 00 bc stw r23,188(r31) extensions_area = NULL; the_thread->libc_reent = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) fp_area = NULL; ffc0ac2c: 3a e0 00 00 li r23,0 the_stack->size = size; ffc0ac30: 90 7f 00 b8 stw r3,184(r31) /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { ffc0ac34: 41 be 00 14 beq+ cr7,ffc0ac48 <_Thread_Initialize+0xac> fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); ffc0ac38: 38 60 01 08 li r3,264 ffc0ac3c: 48 00 11 11 bl ffc0bd4c <_Workspace_Allocate> if ( !fp_area ) ffc0ac40: 7c 77 1b 79 mr. r23,r3 ffc0ac44: 41 82 01 24 beq- ffc0ad68 <_Thread_Initialize+0x1cc> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0ac48: 3d 20 00 00 lis r9,0 fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); if ( !fp_area ) goto failed; fp_area = _Context_Fp_start( fp_area, 0 ); } the_thread->fp_context = fp_area; ffc0ac4c: 92 ff 01 28 stw r23,296(r31) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0ac50: 38 00 00 00 li r0,0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0ac54: 80 69 28 2c lwz r3,10284(r9) * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; ffc0ac58: 3b a0 00 00 li r29,0 if ( !fp_area ) goto failed; fp_area = _Context_Fp_start( fp_area, 0 ); } the_thread->fp_context = fp_area; the_thread->Start.fp_context = fp_area; ffc0ac5c: 92 ff 00 c0 stw r23,192(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0ac60: 2f 83 00 00 cmpwi cr7,r3,0 ffc0ac64: 90 1f 00 50 stw r0,80(r31) the_watchdog->routine = routine; ffc0ac68: 90 1f 00 64 stw r0,100(r31) the_watchdog->id = id; ffc0ac6c: 90 1f 00 68 stw r0,104(r31) the_watchdog->user_data = user_data; ffc0ac70: 90 1f 00 6c stw r0,108(r31) ffc0ac74: 41 be 00 18 beq+ cr7,ffc0ac8c <_Thread_Initialize+0xf0> extensions_area = _Workspace_Allocate( ffc0ac78: 38 63 00 01 addi r3,r3,1 ffc0ac7c: 54 63 10 3a rlwinm r3,r3,2,0,29 ffc0ac80: 48 00 10 cd bl ffc0bd4c <_Workspace_Allocate> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) ffc0ac84: 7c 7d 1b 79 mr. r29,r3 ffc0ac88: 41 82 00 e4 beq- ffc0ad6c <_Thread_Initialize+0x1d0> * if they are linked to the thread. An extension user may * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { ffc0ac8c: 2f 9d 00 00 cmpwi cr7,r29,0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0ac90: 93 bf 01 38 stw r29,312(r31) * if they are linked to the thread. An extension user may * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { ffc0ac94: 41 9e 00 30 beq- cr7,ffc0acc4 <_Thread_Initialize+0x128> for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) ffc0ac98: 3d 20 00 00 lis r9,0 ffc0ac9c: 81 69 28 2c lwz r11,10284(r9) the_thread->extensions[i] = NULL; ffc0aca0: 38 00 00 00 li r0,0 * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) ffc0aca4: 39 20 00 00 li r9,0 ffc0aca8: 48 00 00 14 b ffc0acbc <_Thread_Initialize+0x120> the_thread->extensions[i] = NULL; ffc0acac: 81 1f 01 38 lwz r8,312(r31) ffc0acb0: 55 2a 10 3a rlwinm r10,r9,2,0,29 * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) ffc0acb4: 39 29 00 01 addi r9,r9,1 the_thread->extensions[i] = NULL; ffc0acb8: 7c 08 51 2e stwx r0,r8,r10 * create the extension long after tasks have been created * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) ffc0acbc: 7f 89 58 40 cmplw cr7,r9,r11 ffc0acc0: 40 9d ff ec ble+ cr7,ffc0acac <_Thread_Initialize+0x110> the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { ffc0acc4: 2f 99 00 02 cmpwi cr7,r25,2 * General initialization */ the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; ffc0acc8: 80 01 00 38 lwz r0,56(r1) /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; ffc0accc: 9b 5f 00 a0 stb r26,160(r31) the_thread->Start.budget_algorithm = budget_algorithm; ffc0acd0: 93 3f 00 a4 stw r25,164(r31) the_thread->Start.budget_callout = budget_callout; ffc0acd4: 90 1f 00 a8 stw r0,168(r31) switch ( budget_algorithm ) { ffc0acd8: 40 be 00 10 bne+ cr7,ffc0ace8 <_Thread_Initialize+0x14c> case THREAD_CPU_BUDGET_ALGORITHM_NONE: case THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE: break; #if defined(RTEMS_SCORE_THREAD_ENABLE_EXHAUST_TIMESLICE) case THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0acdc: 3d 20 00 00 lis r9,0 ffc0ace0: 80 09 28 08 lwz r0,10248(r9) ffc0ace4: 90 1f 00 78 stw r0,120(r31) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0ace8: 80 01 00 3c lwz r0,60(r1) */ RTEMS_INLINE_ROUTINE void* _Scheduler_Allocate( Thread_Control *the_thread ) { return _Scheduler.Operations.allocate( the_thread ); ffc0acec: 3d 20 00 00 lis r9,0 the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; ffc0acf0: 3b 80 00 00 li r28,0 the_thread->resource_count = 0; the_thread->real_priority = priority; ffc0acf4: 93 7f 00 18 stw r27,24(r31) ffc0acf8: 7f e3 fb 78 mr r3,r31 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0acfc: 90 1f 00 ac stw r0,172(r31) the_thread->current_state = STATES_DORMANT; ffc0ad00: 38 00 00 01 li r0,1 ffc0ad04: 90 1f 00 10 stw r0,16(r31) ffc0ad08: 80 09 20 f8 lwz r0,8440(r9) the_thread->Wait.queue = NULL; ffc0ad0c: 93 9f 00 44 stw r28,68(r31) ffc0ad10: 7c 09 03 a6 mtctr r0 the_thread->resource_count = 0; ffc0ad14: 93 9f 00 1c stw r28,28(r31) the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; ffc0ad18: 93 7f 00 b0 stw r27,176(r31) ffc0ad1c: 4e 80 04 21 bctrl sched =_Scheduler_Allocate( the_thread ); if ( !sched ) ffc0ad20: 7c 7a 1b 79 mr. r26,r3 ffc0ad24: 41 82 00 4c beq- ffc0ad70 <_Thread_Initialize+0x1d4> goto failed; _Thread_Set_priority( the_thread, priority ); ffc0ad28: 7f e3 fb 78 mr r3,r31 ffc0ad2c: 7f 64 db 78 mr r4,r27 ffc0ad30: 48 00 06 c5 bl ffc0b3f4 <_Thread_Set_priority> Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( ffc0ad34: a0 1f 00 0a lhz r0,10(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0ad38: 81 3e 00 1c lwz r9,28(r30) * enabled when we get here. We want to be able to run the * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); ffc0ad3c: 7f e3 fb 78 mr r3,r31 ffc0ad40: 54 00 10 3a rlwinm r0,r0,2,0,29 /* * Initialize the CPU usage statistics */ #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ _Timestamp_Set_to_zero( &the_thread->cpu_time_used ); ffc0ad44: 93 9f 00 84 stw r28,132(r31) ffc0ad48: 93 9f 00 88 stw r28,136(r31) ffc0ad4c: 7f e9 01 2e stwx r31,r9,r0 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc0ad50: 93 1f 00 0c stw r24,12(r31) * enabled when we get here. We want to be able to run the * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); ffc0ad54: 48 00 0b 5d bl ffc0b8b0 <_User_extensions_Thread_create> if ( extension_status ) return true; ffc0ad58: 38 00 00 01 li r0,1 * user extensions with dispatching enabled. The Allocator * Mutex provides sufficient protection to let the user extensions * run safely. */ extension_status = _User_extensions_Thread_create( the_thread ); if ( extension_status ) ffc0ad5c: 2f 83 00 00 cmpwi cr7,r3,0 ffc0ad60: 41 be 00 10 beq+ cr7,ffc0ad70 <_Thread_Initialize+0x1d4> ffc0ad64: 48 00 00 48 b ffc0adac <_Thread_Initialize+0x210> * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; ffc0ad68: 3b a0 00 00 li r29,0 size_t actual_stack_size = 0; void *stack = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) void *fp_area; #endif void *sched = NULL; ffc0ad6c: 3b 40 00 00 li r26,0 extension_status = _User_extensions_Thread_create( the_thread ); if ( extension_status ) return true; failed: _Workspace_Free( the_thread->libc_reent ); ffc0ad70: 80 7f 01 2c lwz r3,300(r31) ffc0ad74: 48 00 10 0d bl ffc0bd80 <_Workspace_Free> for ( i=0 ; i <= THREAD_API_LAST ; i++ ) _Workspace_Free( the_thread->API_Extensions[i] ); ffc0ad78: 80 7f 01 30 lwz r3,304(r31) ffc0ad7c: 48 00 10 05 bl ffc0bd80 <_Workspace_Free> ffc0ad80: 80 7f 01 34 lwz r3,308(r31) ffc0ad84: 48 00 0f fd bl ffc0bd80 <_Workspace_Free> _Workspace_Free( extensions_area ); ffc0ad88: 7f a3 eb 78 mr r3,r29 ffc0ad8c: 48 00 0f f5 bl ffc0bd80 <_Workspace_Free> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Workspace_Free( fp_area ); ffc0ad90: 7e e3 bb 78 mr r3,r23 ffc0ad94: 48 00 0f ed bl ffc0bd80 <_Workspace_Free> #endif _Workspace_Free( sched ); ffc0ad98: 7f 43 d3 78 mr r3,r26 ffc0ad9c: 48 00 0f e5 bl ffc0bd80 <_Workspace_Free> _Thread_Stack_Free( the_thread ); ffc0ada0: 7f e3 fb 78 mr r3,r31 ffc0ada4: 48 00 07 a5 bl ffc0b548 <_Thread_Stack_Free> return false; ffc0ada8: 38 00 00 00 li r0,0 } ffc0adac: 39 61 00 30 addi r11,r1,48 ffc0adb0: 7c 03 03 78 mr r3,r0 ffc0adb4: 4b ff 57 70 b ffc00524 <_restgpr_23_x> =============================================================================== ffc0bd70 <_Thread_Restart>: bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0bd70: 94 21 ff e8 stwu r1,-24(r1) ffc0bd74: 7c 08 02 a6 mflr r0 ffc0bd78: 90 01 00 1c stw r0,28(r1) _Thread_Restart_self(); return true; } return false; ffc0bd7c: 38 00 00 00 li r0,0 */ RTEMS_INLINE_ROUTINE bool _States_Is_dormant ( States_Control the_states ) { return (the_states & STATES_DORMANT); ffc0bd80: 81 23 00 10 lwz r9,16(r3) bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0bd84: bf c1 00 10 stmw r30,16(r1) ffc0bd88: 7c 7f 1b 78 mr r31,r3 if ( !_States_Is_dormant( the_thread->current_state ) ) { ffc0bd8c: 71 2b 00 01 andi. r11,r9,1 ffc0bd90: 40 a2 00 70 bne+ ffc0be00 <_Thread_Restart+0x90> _Thread_Set_transient( the_thread ); ffc0bd94: 90 81 00 08 stw r4,8(r1) RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc0bd98: 3f c0 00 00 lis r30,0 ffc0bd9c: 3b de 31 64 addi r30,r30,12644 ffc0bda0: 90 a1 00 0c stw r5,12(r1) ffc0bda4: 48 00 00 f5 bl ffc0be98 <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); ffc0bda8: 7f e3 fb 78 mr r3,r31 ffc0bdac: 80 81 00 08 lwz r4,8(r1) ffc0bdb0: 80 a1 00 0c lwz r5,12(r1) ffc0bdb4: 48 00 3a ad bl ffc0f860 <_Thread_Reset> _Thread_Load_environment( the_thread ); ffc0bdb8: 7f e3 fb 78 mr r3,r31 ffc0bdbc: 48 00 37 69 bl ffc0f524 <_Thread_Load_environment> _Thread_Ready( the_thread ); ffc0bdc0: 7f e3 fb 78 mr r3,r31 ffc0bdc4: 48 00 3a 55 bl ffc0f818 <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); ffc0bdc8: 7f e3 fb 78 mr r3,r31 ffc0bdcc: 48 00 05 cd bl ffc0c398 <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) ffc0bdd0: 81 3e 00 0c lwz r9,12(r30) _Thread_Restart_self(); return true; ffc0bdd4: 38 00 00 01 li r0,1 _Thread_Ready( the_thread ); _User_extensions_Thread_restart( the_thread ); if ( _Thread_Is_executing ( the_thread ) ) ffc0bdd8: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0bddc: 40 be 00 24 bne+ cr7,ffc0be00 <_Thread_Restart+0x90> */ RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void ) { #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( _Thread_Executing->fp_context != NULL ) ffc0bde0: 80 1f 01 28 lwz r0,296(r31) ffc0bde4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bde8: 41 9e 00 0c beq- cr7,ffc0bdf4 <_Thread_Restart+0x84> <== NEVER TAKEN _Context_Restore_fp( &_Thread_Executing->fp_context ); ffc0bdec: 38 7f 01 28 addi r3,r31,296 ffc0bdf0: 48 01 01 f1 bl ffc1bfe0 <_CPU_Context_restore_fp> #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); ffc0bdf4: 80 7e 00 0c lwz r3,12(r30) ffc0bdf8: 38 63 00 c8 addi r3,r3,200 ffc0bdfc: 48 01 03 a5 bl ffc1c1a0 <_CPU_Context_restore> return true; } return false; } ffc0be00: 39 61 00 18 addi r11,r1,24 ffc0be04: 7c 03 03 78 mr r3,r0 ffc0be08: 4b ff 4f ac b ffc00db4 <_restgpr_30_x> =============================================================================== ffc0b548 <_Thread_Stack_Free>: */ void _Thread_Stack_Free( Thread_Control *the_thread ) { ffc0b548: 7c 08 02 a6 mflr r0 ffc0b54c: 94 21 ff f8 stwu r1,-8(r1) ffc0b550: 90 01 00 0c stw r0,12(r1) #if defined(RTEMS_SCORE_THREAD_ENABLE_USER_PROVIDED_STACK_VIA_API) /* * If the API provided the stack space, then don't free it. */ if ( !the_thread->Start.core_allocated_stack ) ffc0b554: 88 03 00 b4 lbz r0,180(r3) ffc0b558: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b55c: 41 9e 00 28 beq- cr7,ffc0b584 <_Thread_Stack_Free+0x3c> <== NEVER TAKEN * Call ONLY the CPU table stack free hook, or the * the RTEMS workspace free. This is so the free * routine properly matches the allocation of the stack. */ if ( Configuration.stack_free_hook ) ffc0b560: 3d 20 00 00 lis r9,0 ffc0b564: 80 63 00 bc lwz r3,188(r3) ffc0b568: 80 09 20 28 lwz r0,8232(r9) ffc0b56c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b570: 41 9e 00 10 beq- cr7,ffc0b580 <_Thread_Stack_Free+0x38> (*Configuration.stack_free_hook)( the_thread->Start.Initial_stack.area ); ffc0b574: 7c 09 03 a6 mtctr r0 ffc0b578: 4e 80 04 21 bctrl ffc0b57c: 48 00 00 08 b ffc0b584 <_Thread_Stack_Free+0x3c> else _Workspace_Free( the_thread->Start.Initial_stack.area ); ffc0b580: 48 00 08 01 bl ffc0bd80 <_Workspace_Free> } ffc0b584: 80 01 00 0c lwz r0,12(r1) ffc0b588: 38 21 00 08 addi r1,r1,8 ffc0b58c: 7c 08 03 a6 mtlr r0 ffc0b590: 4e 80 00 20 blr =============================================================================== ffc0b338 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0b338: 94 21 ff d8 stwu r1,-40(r1) ffc0b33c: 7c 08 02 a6 mflr r0 ffc0b340: bf a1 00 1c stmw r29,28(r1) /* * Just in case the thread really wasn't blocked on a thread queue * when we get here. */ if ( !the_thread_queue ) ffc0b344: 7c 7f 1b 79 mr. r31,r3 void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0b348: 7c 9e 23 78 mr r30,r4 ffc0b34c: 90 01 00 2c stw r0,44(r1) /* * Just in case the thread really wasn't blocked on a thread queue * when we get here. */ if ( !the_thread_queue ) ffc0b350: 41 82 00 54 beq- ffc0b3a4 <_Thread_queue_Requeue+0x6c> <== 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 ) { ffc0b354: 80 1f 00 34 lwz r0,52(r31) ffc0b358: 2f 80 00 01 cmpwi cr7,r0,1 ffc0b35c: 40 be 00 48 bne+ cr7,ffc0b3a4 <_Thread_queue_Requeue+0x6c><== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0b360: 7f a0 00 a6 mfmsr r29 ffc0b364: 7d 30 42 a6 mfsprg r9,0 ffc0b368: 7f a9 48 78 andc r9,r29,r9 ffc0b36c: 7d 20 01 24 mtmsr r9 Thread_queue_Control *tq = the_thread_queue; ISR_Level level; ISR_Level level_ignored; _ISR_Disable( level ); if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { ffc0b370: 3d 60 00 03 lis r11,3 ffc0b374: 81 24 00 10 lwz r9,16(r4) ffc0b378: 61 6b be e0 ori r11,r11,48864 ffc0b37c: 7d 6a 48 39 and. r10,r11,r9 ffc0b380: 41 a2 00 20 beq+ ffc0b3a0 <_Thread_queue_Requeue+0x68> <== 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; ffc0b384: 90 1f 00 30 stw r0,48(r31) _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); ffc0b388: 38 a0 00 01 li r5,1 ffc0b38c: 48 00 38 bd bl ffc0ec48 <_Thread_queue_Extract_priority_helper> (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); ffc0b390: 7f e3 fb 78 mr r3,r31 ffc0b394: 7f c4 f3 78 mr r4,r30 ffc0b398: 38 a1 00 08 addi r5,r1,8 ffc0b39c: 4b ff fd 19 bl ffc0b0b4 <_Thread_queue_Enqueue_priority> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0b3a0: 7f a0 01 24 mtmsr r29 } _ISR_Enable( level ); } } ffc0b3a4: 39 61 00 28 addi r11,r1,40 ffc0b3a8: 4b ff 51 94 b ffc0053c <_restgpr_29_x> =============================================================================== ffc0b3ac <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0b3ac: 94 21 ff e8 stwu r1,-24(r1) ffc0b3b0: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0b3b4: 38 81 00 08 addi r4,r1,8 void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0b3b8: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0b3bc: 4b ff f7 31 bl ffc0aaec <_Thread_Get> switch ( location ) { ffc0b3c0: 80 01 00 08 lwz r0,8(r1) ffc0b3c4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b3c8: 40 9e 00 1c bne- cr7,ffc0b3e4 <_Thread_queue_Timeout+0x38><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_queue_Process_timeout( the_thread ); ffc0b3cc: 48 00 39 6d bl ffc0ed38 <_Thread_queue_Process_timeout> * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc0b3d0: 3d 20 00 00 lis r9,0 ffc0b3d4: 81 69 28 0c lwz r11,10252(r9) ffc0b3d8: 38 0b ff ff addi r0,r11,-1 ffc0b3dc: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc0b3e0: 80 09 28 0c lwz r0,10252(r9) _Thread_Unnest_dispatch(); break; } } ffc0b3e4: 80 01 00 1c lwz r0,28(r1) ffc0b3e8: 38 21 00 18 addi r1,r1,24 ffc0b3ec: 7c 08 03 a6 mtlr r0 ffc0b3f0: 4e 80 00 20 blr =============================================================================== ffc18edc <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc18edc: 94 21 ff 98 stwu r1,-104(r1) ffc18ee0: 7c 08 02 a6 mflr r0 ffc18ee4: be 21 00 2c stmw r17,44(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc18ee8: 3a 21 00 14 addi r17,r1,20 ffc18eec: 3a 81 00 18 addi r20,r1,24 ffc18ef0: 90 01 00 6c stw r0,108(r1) ffc18ef4: 3b 61 00 0c addi r27,r1,12 head->previous = NULL; ffc18ef8: 38 00 00 00 li r0,0 tail->previous = head; ffc18efc: 3b 81 00 08 addi r28,r1,8 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc18f00: 92 81 00 14 stw r20,20(r1) ffc18f04: 7c 7f 1b 78 mr r31,r3 head->previous = NULL; ffc18f08: 90 01 00 18 stw r0,24(r1) static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; ffc18f0c: 3e 40 00 00 lis r18,0 */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc18f10: 3b 43 00 30 addi r26,r3,48 tail->previous = head; ffc18f14: 92 21 00 1c stw r17,28(r1) static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); ffc18f18: 3e 60 00 00 lis r19,0 /* * 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 ); ffc18f1c: 3b a3 00 68 addi r29,r3,104 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc18f20: 93 61 00 08 stw r27,8(r1) * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; ffc18f24: 3a a0 00 00 li r21,0 * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; ffc18f28: 3a c0 00 00 li r22,0 head->previous = NULL; ffc18f2c: 90 01 00 0c stw r0,12(r1) _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; ffc18f30: 3a e0 00 01 li r23,1 static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); ffc18f34: 3b 03 00 08 addi r24,r3,8 tail->previous = head; ffc18f38: 93 81 00 10 stw r28,16(r1) static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); ffc18f3c: 3b 23 00 40 addi r25,r3,64 { /* * 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; ffc18f40: 92 3f 00 78 stw r17,120(r31) static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; ffc18f44: 80 12 29 14 lwz r0,10516(r18) */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc18f48: 7f 85 e3 78 mr r5,r28 Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; ffc18f4c: 80 9f 00 3c lwz r4,60(r31) watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc18f50: 7f 43 d3 78 mr r3,r26 /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; ffc18f54: 90 1f 00 3c stw r0,60(r31) _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc18f58: 7c 84 00 50 subf r4,r4,r0 ffc18f5c: 48 00 4b 79 bl ffc1dad4 <_Watchdog_Adjust_to_chain> static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); ffc18f60: 83 d3 28 f8 lwz r30,10488(r19) Watchdog_Interval last_snapshot = watchdogs->last_snapshot; ffc18f64: 80 bf 00 74 lwz r5,116(r31) /* * 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 ) { ffc18f68: 7f 9e 28 40 cmplw cr7,r30,r5 ffc18f6c: 40 bd 00 18 ble+ cr7,ffc18f84 <_Timer_server_Body+0xa8> /* * 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 ); ffc18f70: 7c 85 f0 50 subf r4,r5,r30 ffc18f74: 7f a3 eb 78 mr r3,r29 ffc18f78: 7f 85 e3 78 mr r5,r28 ffc18f7c: 48 00 4b 59 bl ffc1dad4 <_Watchdog_Adjust_to_chain> ffc18f80: 48 00 00 18 b ffc18f98 <_Timer_server_Body+0xbc> } else if ( snapshot < last_snapshot ) { ffc18f84: 40 bc 00 14 bge+ cr7,ffc18f98 <_Timer_server_Body+0xbc> /* * 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 ); ffc18f88: 7f a3 eb 78 mr r3,r29 ffc18f8c: 38 80 00 01 li r4,1 ffc18f90: 7c be 28 50 subf r5,r30,r5 ffc18f94: 48 00 4a 89 bl ffc1da1c <_Watchdog_Adjust> } watchdogs->last_snapshot = snapshot; ffc18f98: 93 df 00 74 stw r30,116(r31) } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); ffc18f9c: 80 7f 00 78 lwz r3,120(r31) ffc18fa0: 48 00 0b d9 bl ffc19b78 <_Chain_Get> if ( timer == NULL ) { ffc18fa4: 7c 7e 1b 79 mr. r30,r3 ffc18fa8: 41 82 00 2c beq- ffc18fd4 <_Timer_server_Body+0xf8> static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc18fac: 80 1e 00 38 lwz r0,56(r30) _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc18fb0: 7f 43 d3 78 mr r3,r26 static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc18fb4: 2f 80 00 01 cmpwi cr7,r0,1 ffc18fb8: 41 9e 00 10 beq- cr7,ffc18fc8 <_Timer_server_Body+0xec> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc18fbc: 2f 80 00 03 cmpwi cr7,r0,3 ffc18fc0: 40 9e ff dc bne+ cr7,ffc18f9c <_Timer_server_Body+0xc0> <== NEVER TAKEN _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc18fc4: 7f a3 eb 78 mr r3,r29 ffc18fc8: 38 9e 00 10 addi r4,r30,16 ffc18fcc: 48 00 4b b9 bl ffc1db84 <_Watchdog_Insert> ffc18fd0: 4b ff ff cc b ffc18f9c <_Timer_server_Body+0xc0> * of zero it will be processed in the next iteration of the timer server * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); ffc18fd4: 4b ff fe 1d bl ffc18df0 if ( _Chain_Is_empty( insert_chain ) ) { ffc18fd8: 80 01 00 14 lwz r0,20(r1) ffc18fdc: 7f 80 a0 00 cmpw cr7,r0,r20 ffc18fe0: 40 be 00 1c bne+ cr7,ffc18ffc <_Timer_server_Body+0x120><== NEVER TAKEN ts->insert_chain = NULL; ffc18fe4: 93 df 00 78 stw r30,120(r31) ffc18fe8: 7c 60 01 24 mtmsr r3 _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 ) ) { ffc18fec: 80 01 00 08 lwz r0,8(r1) ffc18ff0: 7f 80 d8 00 cmpw cr7,r0,r27 ffc18ff4: 40 be 00 10 bne+ cr7,ffc19004 <_Timer_server_Body+0x128> ffc18ff8: 48 00 00 50 b ffc19048 <_Timer_server_Body+0x16c> ffc18ffc: 7c 60 01 24 mtmsr r3 <== NOT EXECUTED ffc19000: 4b ff ff 44 b ffc18f44 <_Timer_server_Body+0x68> <== NOT EXECUTED /* * It is essential that interrupts are disable here since an interrupt * service routine may remove a watchdog from the chain. */ _ISR_Disable( level ); ffc19004: 4b ff fd ed bl ffc18df0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc19008: 81 21 00 08 lwz r9,8(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Get_unprotected( Chain_Control *the_chain ) { if ( !_Chain_Is_empty(the_chain)) ffc1900c: 7f 89 d8 00 cmpw cr7,r9,r27 ffc19010: 41 9e 00 30 beq- cr7,ffc19040 <_Timer_server_Body+0x164> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; ffc19014: 81 69 00 00 lwz r11,0(r9) head->next = new_first; new_first->previous = head; ffc19018: 93 8b 00 04 stw r28,4(r11) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; head->next = new_first; ffc1901c: 91 61 00 08 stw r11,8(r1) watchdog = (Watchdog_Control *) _Chain_Get_unprotected( &fire_chain ); if ( watchdog != NULL ) { watchdog->state = WATCHDOG_INACTIVE; ffc19020: 92 a9 00 08 stw r21,8(r9) ffc19024: 7c 60 01 24 mtmsr 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 ); ffc19028: 80 09 00 1c lwz r0,28(r9) ffc1902c: 80 69 00 20 lwz r3,32(r9) ffc19030: 80 89 00 24 lwz r4,36(r9) ffc19034: 7c 09 03 a6 mtctr r0 ffc19038: 4e 80 04 21 bctrl } ffc1903c: 4b ff ff c8 b ffc19004 <_Timer_server_Body+0x128> ffc19040: 7c 60 01 24 mtmsr r3 ffc19044: 4b ff fe fc b ffc18f40 <_Timer_server_Body+0x64> } else { ts->active = false; ffc19048: 9a df 00 7c stb r22,124(r31) /* * Block until there is something to do. */ _Thread_Disable_dispatch(); ffc1904c: 4b ff fd b9 bl ffc18e04 <_Thread_Disable_dispatch> _Thread_Set_state( ts->thread, STATES_DELAYING ); ffc19050: 80 7f 00 00 lwz r3,0(r31) ffc19054: 38 80 00 08 li r4,8 ffc19058: 48 00 42 dd bl ffc1d334 <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); ffc1905c: 7f e3 fb 78 mr r3,r31 ffc19060: 4b ff fd bd bl ffc18e1c <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); ffc19064: 7f e3 fb 78 mr r3,r31 ffc19068: 4b ff fe 15 bl ffc18e7c <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); ffc1906c: 48 00 38 b9 bl ffc1c924 <_Thread_Enable_dispatch> ts->active = true; ffc19070: 9a ff 00 7c stb r23,124(r31) static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); ffc19074: 7f 03 c3 78 mr r3,r24 ffc19078: 48 00 4c 65 bl ffc1dcdc <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); ffc1907c: 7f 23 cb 78 mr r3,r25 ffc19080: 48 00 4c 5d bl ffc1dcdc <_Watchdog_Remove> ffc19084: 4b ff fe bc b ffc18f40 <_Timer_server_Body+0x64> =============================================================================== ffc19088 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc19088: 94 21 ff f0 stwu r1,-16(r1) ffc1908c: 7c 08 02 a6 mflr r0 ffc19090: 90 01 00 14 stw r0,20(r1) if ( ts->insert_chain == NULL ) { ffc19094: 80 03 00 78 lwz r0,120(r3) static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc19098: bf c1 00 08 stmw r30,8(r1) ffc1909c: 7c 7f 1b 78 mr r31,r3 if ( ts->insert_chain == NULL ) { ffc190a0: 2f 80 00 00 cmpwi cr7,r0,0 static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc190a4: 7c 9e 23 78 mr r30,r4 if ( ts->insert_chain == NULL ) { ffc190a8: 40 be 01 00 bne+ cr7,ffc191a8 <_Timer_server_Schedule_operation_method+0x120> * 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(); ffc190ac: 4b ff fd 59 bl ffc18e04 <_Thread_Disable_dispatch> if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc190b0: 80 1e 00 38 lwz r0,56(r30) ffc190b4: 2f 80 00 01 cmpwi cr7,r0,1 ffc190b8: 40 be 00 6c bne+ cr7,ffc19124 <_Timer_server_Schedule_operation_method+0x9c> /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); ffc190bc: 4b ff fd 35 bl ffc18df0 snapshot = _Watchdog_Ticks_since_boot; ffc190c0: 3d 20 00 00 lis r9,0 ffc190c4: 80 09 29 14 lwz r0,10516(r9) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc190c8: 39 7f 00 34 addi r11,r31,52 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc190cc: 81 3f 00 30 lwz r9,48(r31) last_snapshot = ts->Interval_watchdogs.last_snapshot; ffc190d0: 81 5f 00 3c lwz r10,60(r31) if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { ffc190d4: 7f 89 58 00 cmpw cr7,r9,r11 ffc190d8: 41 9e 00 20 beq- cr7,ffc190f8 <_Timer_server_Schedule_operation_method+0x70> /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; ffc190dc: 81 09 00 10 lwz r8,16(r9) first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; ffc190e0: 7d 4a 00 50 subf r10,r10,r0 delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { delta_interval -= delta; } else { delta_interval = 0; ffc190e4: 39 60 00 00 li r11,0 * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { ffc190e8: 7f 88 50 40 cmplw cr7,r8,r10 ffc190ec: 40 9d 00 08 ble- cr7,ffc190f4 <_Timer_server_Schedule_operation_method+0x6c> delta_interval -= delta; ffc190f0: 7d 6a 40 50 subf r11,r10,r8 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; ffc190f4: 91 69 00 10 stw r11,16(r9) } ts->Interval_watchdogs.last_snapshot = snapshot; ffc190f8: 90 1f 00 3c stw r0,60(r31) ffc190fc: 7c 60 01 24 mtmsr r3 _ISR_Enable( level ); _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc19100: 38 7f 00 30 addi r3,r31,48 ffc19104: 38 9e 00 10 addi r4,r30,16 ffc19108: 48 00 4a 7d bl ffc1db84 <_Watchdog_Insert> if ( !ts->active ) { ffc1910c: 88 1f 00 7c lbz r0,124(r31) ffc19110: 2f 80 00 00 cmpwi cr7,r0,0 ffc19114: 40 be 00 8c bne+ cr7,ffc191a0 <_Timer_server_Schedule_operation_method+0x118> _Timer_server_Reset_interval_system_watchdog( ts ); ffc19118: 7f e3 fb 78 mr r3,r31 ffc1911c: 4b ff fd 01 bl ffc18e1c <_Timer_server_Reset_interval_system_watchdog> ffc19120: 48 00 00 80 b ffc191a0 <_Timer_server_Schedule_operation_method+0x118> } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc19124: 2f 80 00 03 cmpwi cr7,r0,3 ffc19128: 40 be 00 78 bne+ cr7,ffc191a0 <_Timer_server_Schedule_operation_method+0x118> /* * We have to advance the last known seconds value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); ffc1912c: 4b ff fc c5 bl ffc18df0 snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); ffc19130: 3d 20 00 00 lis r9,0 last_snapshot = ts->TOD_watchdogs.last_snapshot; ffc19134: 81 1f 00 74 lwz r8,116(r31) /* * 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(); ffc19138: 80 09 28 f8 lwz r0,10488(r9) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc1913c: 39 7f 00 6c addi r11,r31,108 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc19140: 81 3f 00 68 lwz r9,104(r31) last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { ffc19144: 7f 89 58 00 cmpw cr7,r9,r11 ffc19148: 41 9e 00 30 beq- cr7,ffc19178 <_Timer_server_Schedule_operation_method+0xf0> first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { ffc1914c: 7f 80 40 40 cmplw cr7,r0,r8 _ISR_Disable( level ); 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; ffc19150: 81 49 00 10 lwz r10,16(r9) } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; ffc19154: 7d 6a 42 14 add r11,r10,r8 delta_interval += delta; ffc19158: 7d 60 58 50 subf r11,r0,r11 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 ) { ffc1915c: 40 9d 00 18 ble- cr7,ffc19174 <_Timer_server_Schedule_operation_method+0xec> /* * We advanced in time. */ delta = snapshot - last_snapshot; ffc19160: 7d 08 00 50 subf r8,r8,r0 if (delta_interval > delta) { ffc19164: 7f 8a 40 40 cmplw cr7,r10,r8 delta_interval -= delta; } else { delta_interval = 0; ffc19168: 39 60 00 00 li r11,0 if ( snapshot > last_snapshot ) { /* * We advanced in time. */ delta = snapshot - last_snapshot; if (delta_interval > delta) { ffc1916c: 40 9d 00 08 ble- cr7,ffc19174 <_Timer_server_Schedule_operation_method+0xec><== NEVER TAKEN delta_interval -= delta; ffc19170: 7d 68 50 50 subf r11,r8,r10 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; ffc19174: 91 69 00 10 stw r11,16(r9) } ts->TOD_watchdogs.last_snapshot = snapshot; ffc19178: 90 1f 00 74 stw r0,116(r31) ffc1917c: 7c 60 01 24 mtmsr r3 _ISR_Enable( level ); _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc19180: 38 7f 00 68 addi r3,r31,104 ffc19184: 38 9e 00 10 addi r4,r30,16 ffc19188: 48 00 49 fd bl ffc1db84 <_Watchdog_Insert> if ( !ts->active ) { ffc1918c: 88 1f 00 7c lbz r0,124(r31) ffc19190: 2f 80 00 00 cmpwi cr7,r0,0 ffc19194: 40 be 00 0c bne+ cr7,ffc191a0 <_Timer_server_Schedule_operation_method+0x118> _Timer_server_Reset_tod_system_watchdog( ts ); ffc19198: 7f e3 fb 78 mr r3,r31 ffc1919c: 4b ff fc e1 bl ffc18e7c <_Timer_server_Reset_tod_system_watchdog> } } _Thread_Enable_dispatch(); ffc191a0: 48 00 37 85 bl ffc1c924 <_Thread_Enable_dispatch> ffc191a4: 48 00 00 0c b ffc191b0 <_Timer_server_Schedule_operation_method+0x128> * 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 ); ffc191a8: 80 63 00 78 lwz r3,120(r3) ffc191ac: 48 00 09 75 bl ffc19b20 <_Chain_Append> } } ffc191b0: 39 61 00 10 addi r11,r1,16 ffc191b4: 4b ff 4f e8 b ffc0e19c <_restgpr_30_x> =============================================================================== ffc0b6f8 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { ffc0b6f8: 94 21 ff e8 stwu r1,-24(r1) ffc0b6fc: 7c 08 02 a6 mflr r0 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; ffc0b700: 3d 20 00 00 lis r9,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0b704: 90 01 00 1c stw r0,28(r1) 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; ffc0b708: 39 29 20 04 addi r9,r9,8196 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0b70c: 3d 60 00 00 lis r11,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0b710: bf 81 00 08 stmw r28,8(r1) uint32_t i; uint32_t number_of_extensions; User_extensions_Table *initial_extensions; number_of_extensions = Configuration.number_of_initial_extensions; initial_extensions = Configuration.User_extension_table; ffc0b714: 83 a9 00 3c lwz r29,60(r9) 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; ffc0b718: 83 c9 00 38 lwz r30,56(r9) ffc0b71c: 39 2b 2d f4 addi r9,r11,11764 initial_extensions = Configuration.User_extension_table; _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { ffc0b720: 2f 9d 00 00 cmpwi cr7,r29,0 head->previous = NULL; tail->previous = head; ffc0b724: 91 29 00 08 stw r9,8(r9) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0b728: 38 09 00 04 addi r0,r9,4 ffc0b72c: 90 0b 2d f4 stw r0,11764(r11) head->previous = NULL; ffc0b730: 38 00 00 00 li r0,0 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0b734: 3d 60 00 00 lis r11,0 head->previous = NULL; ffc0b738: 90 09 00 04 stw r0,4(r9) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0b73c: 39 2b 2c d0 addi r9,r11,11472 ffc0b740: 39 49 00 04 addi r10,r9,4 ffc0b744: 91 4b 2c d0 stw r10,11472(r11) head->previous = NULL; ffc0b748: 90 09 00 04 stw r0,4(r9) tail->previous = head; ffc0b74c: 91 29 00 08 stw r9,8(r9) ffc0b750: 41 9e 00 54 beq- cr7,ffc0b7a4 <_User_extensions_Handler_initialization+0xac><== NEVER TAKEN extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ffc0b754: 1f 9e 00 34 mulli r28,r30,52 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) ffc0b758: 7f 83 e3 78 mr r3,r28 ffc0b75c: 48 00 06 51 bl ffc0bdac <_Workspace_Allocate_or_fatal_error> _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0b760: 7f 85 e3 78 mr r5,r28 ffc0b764: 38 80 00 00 li r4,0 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) ffc0b768: 7c 7f 1b 78 mr r31,r3 _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0b76c: 48 00 62 69 bl ffc119d4 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0b770: 3b 80 00 00 li r28,0 ffc0b774: 48 00 00 28 b ffc0b79c <_User_extensions_Handler_initialization+0xa4> #include #include #include #include void _User_extensions_Handler_initialization(void) ffc0b778: 57 83 28 34 rlwinm r3,r28,5,0,26 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; ffc0b77c: 38 9f 00 14 addi r4,r31,20 ffc0b780: 7c 7d 1a 14 add r3,r29,r3 ffc0b784: 7c a3 04 aa lswi r5,r3,32 ffc0b788: 7c a4 05 aa stswi r5,r4,32 _User_extensions_Add_set( extension ); ffc0b78c: 7f e3 fb 78 mr r3,r31 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0b790: 3b 9c 00 01 addi r28,r28,1 ffc0b794: 48 00 36 bd bl ffc0ee50 <_User_extensions_Add_set> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; ffc0b798: 3b ff 00 34 addi r31,r31,52 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0b79c: 7f 9c f0 00 cmpw cr7,r28,r30 ffc0b7a0: 40 9e ff d8 bne+ cr7,ffc0b778 <_User_extensions_Handler_initialization+0x80> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; } } } ffc0b7a4: 39 61 00 18 addi r11,r1,24 ffc0b7a8: 4b ff 4d 90 b ffc00538 <_restgpr_28_x> =============================================================================== ffc0d458 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { ffc0d458: 94 21 ff e8 stwu r1,-24(r1) ffc0d45c: 7c 08 02 a6 mflr r0 ffc0d460: 90 01 00 1c stw r0,28(r1) ffc0d464: bf 81 00 08 stmw r28,8(r1) ffc0d468: 7c 7f 1b 78 mr r31,r3 ffc0d46c: 7c be 2b 78 mr r30,r5 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0d470: 7c 00 00 a6 mfmsr r0 ffc0d474: 7d 30 42 a6 mfsprg r9,0 ffc0d478: 7c 09 48 78 andc r9,r0,r9 ffc0d47c: 7d 20 01 24 mtmsr r9 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0d480: 81 23 00 00 lwz r9,0(r3) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc0d484: 3b a3 00 04 addi r29,r3,4 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { ffc0d488: 7f 89 e8 00 cmpw cr7,r9,r29 ffc0d48c: 41 9e 00 78 beq- cr7,ffc0d504 <_Watchdog_Adjust+0xac> switch ( direction ) { ffc0d490: 2f 84 00 00 cmpwi cr7,r4,0 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; ffc0d494: 3b 80 00 01 li r28,1 * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { ffc0d498: 41 9e 00 64 beq- cr7,ffc0d4fc <_Watchdog_Adjust+0xa4> ffc0d49c: 2f 84 00 01 cmpwi cr7,r4,1 ffc0d4a0: 40 be 00 64 bne+ cr7,ffc0d504 <_Watchdog_Adjust+0xac> <== NEVER TAKEN case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; ffc0d4a4: 81 69 00 10 lwz r11,16(r9) ffc0d4a8: 7f cb 2a 14 add r30,r11,r5 ffc0d4ac: 48 00 00 18 b ffc0d4c4 <_Watchdog_Adjust+0x6c> */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc0d4b0: 81 3f 00 00 lwz r9,0(r31) break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { ffc0d4b4: 81 69 00 10 lwz r11,16(r9) ffc0d4b8: 7f 9e 58 40 cmplw cr7,r30,r11 ffc0d4bc: 40 bc 00 10 bge+ cr7,ffc0d4cc <_Watchdog_Adjust+0x74> _Watchdog_First( header )->delta_interval -= units; ffc0d4c0: 7f de 58 50 subf r30,r30,r11 ffc0d4c4: 93 c9 00 10 stw r30,16(r9) break; ffc0d4c8: 48 00 00 3c b ffc0d504 <_Watchdog_Adjust+0xac> } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; ffc0d4cc: 93 89 00 10 stw r28,16(r9) while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; ffc0d4d0: 7f cb f0 50 subf r30,r11,r30 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0d4d4: 7c 00 01 24 mtmsr r0 _Watchdog_First( header )->delta_interval = 1; _ISR_Enable( level ); _Watchdog_Tickle( header ); ffc0d4d8: 7f e3 fb 78 mr r3,r31 ffc0d4dc: 48 00 02 35 bl ffc0d710 <_Watchdog_Tickle> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0d4e0: 7c 00 00 a6 mfmsr r0 ffc0d4e4: 7d 30 42 a6 mfsprg r9,0 ffc0d4e8: 7c 09 48 78 andc r9,r0,r9 ffc0d4ec: 7d 20 01 24 mtmsr r9 _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) ffc0d4f0: 81 3f 00 00 lwz r9,0(r31) ffc0d4f4: 7f 89 e8 00 cmpw cr7,r9,r29 ffc0d4f8: 41 9e 00 0c beq- cr7,ffc0d504 <_Watchdog_Adjust+0xac> switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0d4fc: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0d500: 40 9e ff b0 bne+ cr7,ffc0d4b0 <_Watchdog_Adjust+0x58> <== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0d504: 7c 00 01 24 mtmsr r0 } } _ISR_Enable( level ); } ffc0d508: 39 61 00 18 addi r11,r1,24 ffc0d50c: 4b ff 3e 34 b ffc01340 <_restgpr_28_x> =============================================================================== ffc0bb8c <_Watchdog_Remove>: */ Watchdog_States _Watchdog_Remove( Watchdog_Control *the_watchdog ) { ffc0bb8c: 7c 69 1b 78 mr r9,r3 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0bb90: 7c 00 00 a6 mfmsr r0 ffc0bb94: 7d 70 42 a6 mfsprg r11,0 ffc0bb98: 7c 0b 58 78 andc r11,r0,r11 ffc0bb9c: 7d 60 01 24 mtmsr r11 ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; ffc0bba0: 80 63 00 08 lwz r3,8(r3) switch ( previous_state ) { ffc0bba4: 2f 83 00 01 cmpwi cr7,r3,1 ffc0bba8: 41 9e 00 18 beq- cr7,ffc0bbc0 <_Watchdog_Remove+0x34> ffc0bbac: 2b 83 00 01 cmplwi cr7,r3,1 ffc0bbb0: 41 9c 00 70 blt- cr7,ffc0bc20 <_Watchdog_Remove+0x94> ffc0bbb4: 2b 83 00 03 cmplwi cr7,r3,3 ffc0bbb8: 41 9d 00 68 bgt- cr7,ffc0bc20 <_Watchdog_Remove+0x94> <== NEVER TAKEN ffc0bbbc: 48 00 00 10 b ffc0bbcc <_Watchdog_Remove+0x40> /* * 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; ffc0bbc0: 39 60 00 00 li r11,0 ffc0bbc4: 91 69 00 08 stw r11,8(r9) break; ffc0bbc8: 48 00 00 58 b ffc0bc20 <_Watchdog_Remove+0x94> case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; ffc0bbcc: 39 60 00 00 li r11,0 ffc0bbd0: 91 69 00 08 stw r11,8(r9) } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } ffc0bbd4: 81 69 00 00 lwz r11,0(r9) case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) ffc0bbd8: 81 4b 00 00 lwz r10,0(r11) ffc0bbdc: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0bbe0: 41 9e 00 14 beq- cr7,ffc0bbf4 <_Watchdog_Remove+0x68> next_watchdog->delta_interval += the_watchdog->delta_interval; ffc0bbe4: 81 0b 00 10 lwz r8,16(r11) ffc0bbe8: 81 49 00 10 lwz r10,16(r9) ffc0bbec: 7d 48 52 14 add r10,r8,r10 ffc0bbf0: 91 4b 00 10 stw r10,16(r11) if ( _Watchdog_Sync_count ) ffc0bbf4: 3d 40 00 00 lis r10,0 ffc0bbf8: 81 4a 28 3c lwz r10,10300(r10) ffc0bbfc: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0bc00: 41 9e 00 14 beq- cr7,ffc0bc14 <_Watchdog_Remove+0x88> _Watchdog_Sync_level = _ISR_Nest_level; ffc0bc04: 3d 40 00 00 lis r10,0 ffc0bc08: 81 0a 31 4c lwz r8,12620(r10) ffc0bc0c: 3d 40 00 00 lis r10,0 ffc0bc10: 91 0a 28 34 stw r8,10292(r10) { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; ffc0bc14: 81 49 00 04 lwz r10,4(r9) next->previous = previous; ffc0bc18: 91 4b 00 04 stw r10,4(r11) previous->next = next; ffc0bc1c: 91 6a 00 00 stw r11,0(r10) _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0bc20: 3d 60 00 00 lis r11,0 ffc0bc24: 81 6b 28 40 lwz r11,10304(r11) ffc0bc28: 91 69 00 18 stw r11,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0bc2c: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); return( previous_state ); } ffc0bc30: 4e 80 00 20 blr =============================================================================== ffc08520 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc08520: 94 21 ff e0 stwu r1,-32(r1) ffc08524: 7c 08 02 a6 mflr r0 ffc08528: bf 61 00 0c stmw r27,12(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc0852c: 3f e0 00 00 lis r31,0 ffc08530: 3b ff 2c 70 addi r31,r31,11376 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc08534: 7c 7d 1b 78 mr r29,r3 ffc08538: 90 01 00 24 stw r0,36(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc0853c: 7f e3 fb 78 mr r3,r31 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc08540: 7c 9e 23 78 mr r30,r4 rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc08544: 48 00 12 01 bl ffc09744 if (fcntl (fildes, F_GETFD) < 0) { ffc08548: 7f a3 eb 78 mr r3,r29 ffc0854c: 38 80 00 01 li r4,1 ffc08550: 4c c6 31 82 crclr 4*cr1+eq ffc08554: 48 00 75 51 bl ffc0faa4 ffc08558: 2f 83 00 00 cmpwi cr7,r3,0 ffc0855c: 40 bc 00 18 bge+ cr7,ffc08574 pthread_mutex_unlock(&aio_request_queue.mutex); ffc08560: 7f e3 fb 78 mr r3,r31 ffc08564: 48 00 12 85 bl ffc097e8 rtems_set_errno_and_return_minus_one (EBADF); ffc08568: 48 00 ad d5 bl ffc1333c <__errno> ffc0856c: 38 00 00 09 li r0,9 ffc08570: 48 00 00 c8 b ffc08638 } /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { ffc08574: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08578: 40 be 00 a4 bne+ cr7,ffc0861c AIO_printf ("Cancel all requests\n"); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); ffc0857c: 38 7f 00 48 addi r3,r31,72 ffc08580: 7f a4 eb 78 mr r4,r29 ffc08584: 38 a0 00 00 li r5,0 ffc08588: 48 00 02 d1 bl ffc08858 if (r_chain == NULL) { ffc0858c: 7c 7e 1b 79 mr. r30,r3 ffc08590: 40 a2 00 58 bne+ ffc085e8 AIO_printf ("Request chain not on [WQ]\n"); if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { ffc08594: 81 3f 00 54 lwz r9,84(r31) ffc08598: 38 1f 00 58 addi r0,r31,88 ffc0859c: 7f 89 00 00 cmpw cr7,r9,r0 ffc085a0: 41 9e 00 f8 beq- cr7,ffc08698 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc085a4: 38 7f 00 54 addi r3,r31,84 ffc085a8: 7f a4 eb 78 mr r4,r29 ffc085ac: 38 a0 00 00 li r5,0 ffc085b0: 48 00 02 a9 bl ffc08858 if (r_chain == NULL) { ffc085b4: 7c 7e 1b 79 mr. r30,r3 ffc085b8: 41 82 00 e0 beq- ffc08698 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc085bc: 48 00 2d 89 bl ffc0b344 <_Chain_Extract> AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); pthread_mutex_destroy (&r_chain->mutex); ffc085c0: 3b be 00 1c addi r29,r30,28 } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc085c4: 7f c3 f3 78 mr r3,r30 ffc085c8: 48 00 06 59 bl ffc08c20 pthread_mutex_destroy (&r_chain->mutex); ffc085cc: 7f a3 eb 78 mr r3,r29 ffc085d0: 48 00 0e b1 bl ffc09480 pthread_cond_destroy (&r_chain->mutex); ffc085d4: 7f a3 eb 78 mr r3,r29 ffc085d8: 48 00 0a e1 bl ffc090b8 free (r_chain); ffc085dc: 7f c3 f3 78 mr r3,r30 ffc085e0: 4b ff cb 29 bl ffc05108 ffc085e4: 48 00 00 28 b ffc0860c return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc085e8: 3b be 00 1c addi r29,r30,28 ffc085ec: 7f a3 eb 78 mr r3,r29 ffc085f0: 48 00 11 55 bl ffc09744 ffc085f4: 7f c3 f3 78 mr r3,r30 ffc085f8: 48 00 2d 4d bl ffc0b344 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc085fc: 7f c3 f3 78 mr r3,r30 ffc08600: 48 00 06 21 bl ffc08c20 pthread_mutex_unlock (&r_chain->mutex); ffc08604: 7f a3 eb 78 mr r3,r29 ffc08608: 48 00 11 e1 bl ffc097e8 pthread_mutex_unlock (&aio_request_queue.mutex); ffc0860c: 7f e3 fb 78 mr r3,r31 ffc08610: 48 00 11 d9 bl ffc097e8 return AIO_CANCELED; ffc08614: 3b c0 00 00 li r30,0 ffc08618: 48 00 00 bc b ffc086d4 } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { ffc0861c: 83 9e 00 00 lwz r28,0(r30) ffc08620: 7f 9c e8 00 cmpw cr7,r28,r29 ffc08624: 41 be 00 20 beq+ cr7,ffc08644 pthread_mutex_unlock (&aio_request_queue.mutex); ffc08628: 7f e3 fb 78 mr r3,r31 ffc0862c: 48 00 11 bd bl ffc097e8 rtems_set_errno_and_return_minus_one (EINVAL); ffc08630: 48 00 ad 0d bl ffc1333c <__errno> ffc08634: 38 00 00 16 li r0,22 ffc08638: 90 03 00 00 stw r0,0(r3) ffc0863c: 3b c0 ff ff li r30,-1 ffc08640: 48 00 00 94 b ffc086d4 } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); ffc08644: 38 7f 00 48 addi r3,r31,72 ffc08648: 7f 84 e3 78 mr r4,r28 ffc0864c: 38 a0 00 00 li r5,0 ffc08650: 48 00 02 09 bl ffc08858 if (r_chain == NULL) { ffc08654: 7c 7b 1b 79 mr. r27,r3 ffc08658: 40 a2 00 50 bne+ ffc086a8 if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { ffc0865c: 81 3f 00 54 lwz r9,84(r31) ffc08660: 38 1f 00 58 addi r0,r31,88 ffc08664: 7f 89 00 00 cmpw cr7,r9,r0 ffc08668: 41 9e 00 30 beq- cr7,ffc08698 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc0866c: 38 7f 00 54 addi r3,r31,84 ffc08670: 7f 84 e3 78 mr r4,r28 ffc08674: 38 a0 00 00 li r5,0 ffc08678: 48 00 01 e1 bl ffc08858 if (r_chain == NULL) { ffc0867c: 2c 03 00 00 cmpwi r3,0 ffc08680: 41 a2 ff a8 beq- ffc08628 rtems_set_errno_and_return_minus_one (EINVAL); } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc08684: 7f c4 f3 78 mr r4,r30 ffc08688: 38 63 00 08 addi r3,r3,8 ffc0868c: 48 00 05 ed bl ffc08c78 ffc08690: 7c 7e 1b 78 mr r30,r3 ffc08694: 48 00 00 38 b ffc086cc pthread_mutex_unlock (&aio_request_queue.mutex); return result; } else { pthread_mutex_unlock (&aio_request_queue.mutex); ffc08698: 7f e3 fb 78 mr r3,r31 ffc0869c: 48 00 11 4d bl ffc097e8 return AIO_ALLDONE; ffc086a0: 3b c0 00 02 li r30,2 ffc086a4: 48 00 00 30 b ffc086d4 } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc086a8: 3b bb 00 1c addi r29,r27,28 ffc086ac: 7f a3 eb 78 mr r3,r29 ffc086b0: 48 00 10 95 bl ffc09744 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc086b4: 7f c4 f3 78 mr r4,r30 ffc086b8: 38 7b 00 08 addi r3,r27,8 ffc086bc: 48 00 05 bd bl ffc08c78 ffc086c0: 7c 7e 1b 78 mr r30,r3 pthread_mutex_unlock (&r_chain->mutex); ffc086c4: 7f a3 eb 78 mr r3,r29 ffc086c8: 48 00 11 21 bl ffc097e8 pthread_mutex_unlock (&aio_request_queue.mutex); ffc086cc: 7f e3 fb 78 mr r3,r31 ffc086d0: 48 00 11 19 bl ffc097e8 return result; } return AIO_ALLDONE; } ffc086d4: 39 61 00 20 addi r11,r1,32 ffc086d8: 7f c3 f3 78 mr r3,r30 ffc086dc: 4b ff 84 1c b ffc00af8 <_restgpr_27_x> =============================================================================== ffc086e8 : ) { rtems_aio_request *req; int mode; if (op != O_SYNC) ffc086e8: 2f 83 20 00 cmpwi cr7,r3,8192 int aio_fsync( int op, struct aiocb *aiocbp ) { ffc086ec: 94 21 ff f0 stwu r1,-16(r1) ffc086f0: 7c 08 02 a6 mflr r0 ffc086f4: bf c1 00 08 stmw r30,8(r1) ffc086f8: 7c 9f 23 78 mr r31,r4 rtems_aio_request *req; int mode; if (op != O_SYNC) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc086fc: 3b c0 00 16 li r30,22 int aio_fsync( int op, struct aiocb *aiocbp ) { ffc08700: 90 01 00 14 stw r0,20(r1) rtems_aio_request *req; int mode; if (op != O_SYNC) ffc08704: 40 9e 00 28 bne- cr7,ffc0872c rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc08708: 80 64 00 00 lwz r3,0(r4) ffc0870c: 38 80 00 03 li r4,3 ffc08710: 4c c6 31 82 crclr 4*cr1+eq ffc08714: 48 00 73 91 bl ffc0faa4 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc08718: 54 63 07 be clrlwi r3,r3,30 ffc0871c: 38 63 ff ff addi r3,r3,-1 ffc08720: 2b 83 00 01 cmplwi cr7,r3,1 ffc08724: 40 bd 00 24 ble+ cr7,ffc08748 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); ffc08728: 3b c0 00 09 li r30,9 ffc0872c: 38 00 ff ff li r0,-1 ffc08730: 93 df 00 34 stw r30,52(r31) ffc08734: 90 1f 00 38 stw r0,56(r31) ffc08738: 48 00 ac 05 bl ffc1333c <__errno> ffc0873c: 93 c3 00 00 stw r30,0(r3) ffc08740: 38 60 ff ff li r3,-1 ffc08744: 48 00 00 28 b ffc0876c req = malloc (sizeof (rtems_aio_request)); ffc08748: 38 60 00 18 li r3,24 ffc0874c: 4b ff d0 29 bl ffc05774 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc08750: 3b c0 00 0b li r30,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) ffc08754: 7c 69 1b 79 mr. r9,r3 ffc08758: 41 a2 ff d4 beq- ffc0872c <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc0875c: 38 00 00 03 li r0,3 req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; ffc08760: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc08764: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc08768: 48 00 05 8d bl ffc08cf4 } ffc0876c: 39 61 00 10 addi r11,r1,16 ffc08770: 4b ff 83 94 b ffc00b04 <_restgpr_30_x> =============================================================================== ffc08f00 : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc08f00: 94 21 ff f0 stwu r1,-16(r1) ffc08f04: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc08f08: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc08f0c: 90 01 00 14 stw r0,20(r1) ffc08f10: bf c1 00 08 stmw r30,8(r1) ffc08f14: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc08f18: 80 63 00 00 lwz r3,0(r3) ffc08f1c: 4c c6 31 82 crclr 4*cr1+eq ffc08f20: 48 00 6b 85 bl ffc0faa4 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc08f24: 70 63 00 03 andi. r3,r3,3 ffc08f28: 41 82 00 10 beq- ffc08f38 <== NEVER TAKEN ffc08f2c: 2f 83 00 02 cmpwi cr7,r3,2 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); ffc08f30: 3b c0 00 09 li r30,9 { rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc08f34: 40 9e 00 14 bne- cr7,ffc08f48 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc08f38: 80 1f 00 18 lwz r0,24(r31) ffc08f3c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f40: 41 be 00 24 beq+ cr7,ffc08f64 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc08f44: 3b c0 00 16 li r30,22 ffc08f48: 38 00 ff ff li r0,-1 ffc08f4c: 93 df 00 34 stw r30,52(r31) ffc08f50: 90 1f 00 38 stw r0,56(r31) ffc08f54: 48 00 a3 e9 bl ffc1333c <__errno> ffc08f58: 93 c3 00 00 stw r30,0(r3) ffc08f5c: 38 60 ff ff li r3,-1 ffc08f60: 48 00 00 34 b ffc08f94 if (aiocbp->aio_offset < 0) ffc08f64: 80 1f 00 08 lwz r0,8(r31) ffc08f68: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f6c: 41 bc ff d8 blt- cr7,ffc08f44 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc08f70: 38 60 00 18 li r3,24 ffc08f74: 4b ff c8 01 bl ffc05774 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc08f78: 3b c0 00 0b li r30,11 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) ffc08f7c: 7c 69 1b 79 mr. r9,r3 ffc08f80: 41 a2 ff c8 beq- ffc08f48 <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; ffc08f84: 38 00 00 01 li r0,1 req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; ffc08f88: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_READ; ffc08f8c: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc08f90: 4b ff fd 65 bl ffc08cf4 } ffc08f94: 39 61 00 10 addi r11,r1,16 ffc08f98: 4b ff 7b 6c b ffc00b04 <_restgpr_30_x> =============================================================================== ffc08fa4 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc08fa4: 94 21 ff f0 stwu r1,-16(r1) ffc08fa8: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc08fac: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc08fb0: 90 01 00 14 stw r0,20(r1) ffc08fb4: bf c1 00 08 stmw r30,8(r1) ffc08fb8: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; 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); ffc08fbc: 3b c0 00 09 li r30,9 aio_write (struct aiocb *aiocbp) { rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc08fc0: 80 63 00 00 lwz r3,0(r3) ffc08fc4: 4c c6 31 82 crclr 4*cr1+eq ffc08fc8: 48 00 6a dd bl ffc0faa4 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc08fcc: 54 63 07 be clrlwi r3,r3,30 ffc08fd0: 38 63 ff ff addi r3,r3,-1 ffc08fd4: 2b 83 00 01 cmplwi cr7,r3,1 ffc08fd8: 41 9d 00 14 bgt- cr7,ffc08fec rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc08fdc: 80 1f 00 18 lwz r0,24(r31) ffc08fe0: 2f 80 00 00 cmpwi cr7,r0,0 ffc08fe4: 41 be 00 24 beq+ cr7,ffc09008 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc08fe8: 3b c0 00 16 li r30,22 ffc08fec: 38 00 ff ff li r0,-1 ffc08ff0: 93 df 00 34 stw r30,52(r31) ffc08ff4: 90 1f 00 38 stw r0,56(r31) ffc08ff8: 48 00 a3 45 bl ffc1333c <__errno> ffc08ffc: 93 c3 00 00 stw r30,0(r3) ffc09000: 38 60 ff ff li r3,-1 ffc09004: 48 00 00 34 b ffc09038 if (aiocbp->aio_offset < 0) ffc09008: 80 1f 00 08 lwz r0,8(r31) ffc0900c: 2f 80 00 00 cmpwi cr7,r0,0 ffc09010: 41 bc ff d8 blt- cr7,ffc08fe8 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc09014: 38 60 00 18 li r3,24 ffc09018: 4b ff c7 5d bl ffc05774 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc0901c: 3b c0 00 0b li r30,11 if (aiocbp->aio_offset < 0) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); if (req == NULL) ffc09020: 7c 69 1b 79 mr. r9,r3 ffc09024: 41 a2 ff c8 beq- ffc08fec <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc09028: 38 00 00 02 li r0,2 req = malloc (sizeof (rtems_aio_request)); if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; ffc0902c: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc09030: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc09034: 4b ff fc c1 bl ffc08cf4 } ffc09038: 39 61 00 10 addi r11,r1,16 ffc0903c: 4b ff 7a c8 b ffc00b04 <_restgpr_30_x> =============================================================================== ffc079e8 : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { ffc079e8: 7c 08 02 a6 mflr r0 ffc079ec: 94 21 ff f8 stwu r1,-8(r1) ffc079f0: 90 01 00 0c stw r0,12(r1) ffc079f4: 7c 60 1b 78 mr r0,r3 if ( !tp ) ffc079f8: 7c 83 23 79 mr. r3,r4 ffc079fc: 41 82 00 44 beq- ffc07a40 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc07a00: 2f 80 00 01 cmpwi cr7,r0,1 ffc07a04: 40 be 00 0c bne+ cr7,ffc07a10 _TOD_Get(tp); ffc07a08: 48 00 21 b1 bl ffc09bb8 <_TOD_Get> ffc07a0c: 48 00 00 18 b ffc07a24 return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { ffc07a10: 2f 80 00 04 cmpwi cr7,r0,4 ffc07a14: 41 9e 00 0c beq- cr7,ffc07a20 <== NEVER TAKEN return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) { ffc07a18: 2f 80 00 02 cmpwi cr7,r0,2 ffc07a1c: 40 be 00 10 bne+ cr7,ffc07a2c _TOD_Get_uptime_as_timespec( tp ); ffc07a20: 48 00 22 19 bl ffc09c38 <_TOD_Get_uptime_as_timespec> return 0; ffc07a24: 38 60 00 00 li r3,0 ffc07a28: 48 00 00 28 b ffc07a50 } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) ffc07a2c: 2f 80 00 03 cmpwi cr7,r0,3 ffc07a30: 40 be 00 10 bne+ cr7,ffc07a40 rtems_set_errno_and_return_minus_one( ENOSYS ); ffc07a34: 48 00 9d c1 bl ffc117f4 <__errno> ffc07a38: 38 00 00 58 li r0,88 ffc07a3c: 48 00 00 0c b ffc07a48 #endif rtems_set_errno_and_return_minus_one( EINVAL ); ffc07a40: 48 00 9d b5 bl ffc117f4 <__errno> ffc07a44: 38 00 00 16 li r0,22 ffc07a48: 90 03 00 00 stw r0,0(r3) ffc07a4c: 38 60 ff ff li r3,-1 return 0; } ffc07a50: 80 01 00 0c lwz r0,12(r1) ffc07a54: 38 21 00 08 addi r1,r1,8 ffc07a58: 7c 08 03 a6 mtlr r0 ffc07a5c: 4e 80 00 20 blr =============================================================================== ffc07a60 : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { ffc07a60: 7c 08 02 a6 mflr r0 ffc07a64: 94 21 ff f8 stwu r1,-8(r1) ffc07a68: 90 01 00 0c stw r0,12(r1) ffc07a6c: 7c 60 1b 78 mr r0,r3 if ( !tp ) ffc07a70: 7c 83 23 79 mr. r3,r4 ffc07a74: 41 82 00 60 beq- ffc07ad4 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc07a78: 2f 80 00 01 cmpwi cr7,r0,1 ffc07a7c: 40 be 00 3c bne+ cr7,ffc07ab8 if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) ffc07a80: 81 23 00 00 lwz r9,0(r3) ffc07a84: 3c 00 21 da lis r0,8666 ffc07a88: 60 00 e4 ff ori r0,r0,58623 ffc07a8c: 7f 89 00 40 cmplw cr7,r9,r0 ffc07a90: 40 9d 00 44 ble- cr7,ffc07ad4 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc07a94: 3d 20 00 00 lis r9,0 ffc07a98: 81 69 28 78 lwz r11,10360(r9) ffc07a9c: 38 0b 00 01 addi r0,r11,1 ffc07aa0: 90 09 28 78 stw r0,10360(r9) return _Thread_Dispatch_disable_level; ffc07aa4: 80 09 28 78 lwz r0,10360(r9) rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); ffc07aa8: 48 00 22 01 bl ffc09ca8 <_TOD_Set> _Thread_Enable_dispatch(); ffc07aac: 48 00 3b 45 bl ffc0b5f0 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; ffc07ab0: 38 60 00 00 li r3,0 ffc07ab4: 48 00 00 30 b ffc07ae4 _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) ffc07ab8: 2f 80 00 02 cmpwi cr7,r0,2 ffc07abc: 41 9e 00 0c beq- cr7,ffc07ac8 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) ffc07ac0: 2f 80 00 03 cmpwi cr7,r0,3 ffc07ac4: 40 be 00 10 bne+ cr7,ffc07ad4 rtems_set_errno_and_return_minus_one( ENOSYS ); ffc07ac8: 48 00 9d 2d bl ffc117f4 <__errno> ffc07acc: 38 00 00 58 li r0,88 ffc07ad0: 48 00 00 0c b ffc07adc #endif else rtems_set_errno_and_return_minus_one( EINVAL ); ffc07ad4: 48 00 9d 21 bl ffc117f4 <__errno> ffc07ad8: 38 00 00 16 li r0,22 ffc07adc: 90 03 00 00 stw r0,0(r3) ffc07ae0: 38 60 ff ff li r3,-1 return 0; } ffc07ae4: 80 01 00 0c lwz r0,12(r1) ffc07ae8: 38 21 00 08 addi r1,r1,8 ffc07aec: 7c 08 03 a6 mtlr r0 ffc07af0: 4e 80 00 20 blr =============================================================================== ffc1bc98 : int killinfo( pid_t pid, int sig, const union sigval *value ) { ffc1bc98: 94 21 ff d8 stwu r1,-40(r1) ffc1bc9c: 7c 08 02 a6 mflr r0 ffc1bca0: bf 81 00 18 stmw r28,24(r1) ffc1bca4: 7c 7e 1b 78 mr r30,r3 ffc1bca8: 7c 9f 23 78 mr r31,r4 ffc1bcac: 90 01 00 2c stw r0,44(r1) ffc1bcb0: 7c bd 2b 78 mr r29,r5 POSIX_signals_Siginfo_node *psiginfo; /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) ffc1bcb4: 4b ff fb 4d bl ffc1b800 ffc1bcb8: 7f 9e 18 00 cmpw cr7,r30,r3 ffc1bcbc: 41 be 00 10 beq+ cr7,ffc1bccc rtems_set_errno_and_return_minus_one( ESRCH ); ffc1bcc0: 4b ff 4e f5 bl ffc10bb4 <__errno> ffc1bcc4: 38 00 00 03 li r0,3 ffc1bcc8: 48 00 00 14 b ffc1bcdc /* * Validate the signal passed. */ if ( !sig ) ffc1bccc: 2f 9f 00 00 cmpwi cr7,r31,0 ffc1bcd0: 40 be 00 18 bne+ cr7,ffc1bce8 rtems_set_errno_and_return_minus_one( EINVAL ); ffc1bcd4: 4b ff 4e e1 bl ffc10bb4 <__errno> ffc1bcd8: 38 00 00 16 li r0,22 ffc1bcdc: 90 03 00 00 stw r0,0(r3) ffc1bce0: 38 60 ff ff li r3,-1 ffc1bce4: 48 00 02 24 b ffc1bf08 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc1bce8: 3b df ff ff addi r30,r31,-1 if ( !is_valid_signo(sig) ) ffc1bcec: 2b 9e 00 1f cmplwi cr7,r30,31 ffc1bcf0: 41 bd ff e4 bgt- cr7,ffc1bcd4 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 ) ffc1bcf4: 1c 1f 00 0c mulli r0,r31,12 ffc1bcf8: 3d 20 00 00 lis r9,0 ffc1bcfc: 39 29 31 c0 addi r9,r9,12736 ffc1bd00: 7d 29 02 14 add r9,r9,r0 ffc1bd04: 80 09 00 08 lwz r0,8(r9) return 0; ffc1bd08: 38 60 00 00 li r3,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 ) ffc1bd0c: 2f 80 00 01 cmpwi cr7,r0,1 ffc1bd10: 41 9e 01 f8 beq- cr7,ffc1bf08 /* * 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 ) ) ffc1bd14: 2f 9f 00 08 cmpwi cr7,r31,8 ffc1bd18: 41 9e 00 14 beq- cr7,ffc1bd2c ffc1bd1c: 2f 9f 00 04 cmpwi cr7,r31,4 ffc1bd20: 41 9e 00 0c beq- cr7,ffc1bd2c ffc1bd24: 2f 9f 00 0b cmpwi cr7,r31,11 ffc1bd28: 40 be 00 14 bne+ cr7,ffc1bd3c return pthread_kill( pthread_self(), sig ); ffc1bd2c: 48 00 04 0d bl ffc1c138 ffc1bd30: 7f e4 fb 78 mr r4,r31 ffc1bd34: 48 00 03 35 bl ffc1c068 ffc1bd38: 48 00 01 d0 b ffc1bf08 * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { ffc1bd3c: 2f 9d 00 00 cmpwi cr7,r29,0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; ffc1bd40: 93 e1 00 08 stw r31,8(r1) static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); ffc1bd44: 38 00 00 01 li r0,1 ffc1bd48: 7c 1e f0 30 slw r30,r0,r30 siginfo->si_code = SI_USER; ffc1bd4c: 90 01 00 0c stw r0,12(r1) if ( !value ) { ffc1bd50: 40 be 00 0c bne+ cr7,ffc1bd5c siginfo->si_value.sival_int = 0; ffc1bd54: 93 a1 00 10 stw r29,16(r1) ffc1bd58: 48 00 00 0c b ffc1bd64 } else { siginfo->si_value = *value; ffc1bd5c: 80 1d 00 00 lwz r0,0(r29) ffc1bd60: 90 01 00 10 stw r0,16(r1) * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc1bd64: 3d 20 00 00 lis r9,0 ffc1bd68: 81 69 28 0c lwz r11,10252(r9) ffc1bd6c: 38 0b 00 01 addi r0,r11,1 ffc1bd70: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc1bd74: 80 09 28 0c lwz r0,10252(r9) /* * 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; ffc1bd78: 3d 20 00 00 lis r9,0 ffc1bd7c: 80 69 31 50 lwz r3,12624(r9) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { ffc1bd80: 81 23 01 34 lwz r9,308(r3) ffc1bd84: 80 09 00 d0 lwz r0,208(r9) ffc1bd88: 7f c5 00 79 andc. r5,r30,r0 ffc1bd8c: 40 82 00 fc bne- ffc1be88 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc1bd90: 3d 20 00 00 lis r9,0 ffc1bd94: 80 69 33 4c lwz r3,13132(r9) /* 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 ); ffc1bd98: 3d 20 00 00 lis r9,0 ffc1bd9c: 38 09 33 50 addi r0,r9,13136 ffc1bda0: 48 00 00 24 b ffc1bdc4 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc1bda4: 81 63 00 30 lwz r11,48(r3) for ( the_node = _Chain_First( the_chain ); !_Chain_Is_tail( the_chain, the_node ) ; the_node = the_node->next ) { the_thread = (Thread_Control *)the_node; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc1bda8: 81 23 01 34 lwz r9,308(r3) #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc1bdac: 7f ca 58 39 and. r10,r30,r11 ffc1bdb0: 40 82 00 d8 bne- ffc1be88 /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) ffc1bdb4: 81 29 00 d0 lwz r9,208(r9) ffc1bdb8: 7f cb 48 79 andc. r11,r30,r9 ffc1bdbc: 40 82 00 cc bne- ffc1be88 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 ) { ffc1bdc0: 80 63 00 00 lwz r3,0(r3) /* 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 ); ffc1bdc4: 7f 83 00 00 cmpw cr7,r3,r0 ffc1bdc8: 40 9e ff dc bne+ cr7,ffc1bda4 * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; ffc1bdcc: 3d 20 00 00 lis r9,0 ffc1bdd0: 89 29 27 24 lbz r9,10020(r9) ffc1bdd4: 3d 60 00 00 lis r11,0 ffc1bdd8: 39 6b 2c 64 addi r11,r11,11364 ffc1bddc: 38 09 00 01 addi r0,r9,1 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( ffc1bde0: 38 8b 00 08 addi r4,r11,8 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; ffc1bde4: 38 60 00 00 li r3,0 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 ] ) ffc1bde8: 85 2b 00 04 lwzu r9,4(r11) ffc1bdec: 2f 89 00 00 cmpwi cr7,r9,0 ffc1bdf0: 41 9e 00 88 beq- cr7,ffc1be78 <== NEVER TAKEN continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; ffc1bdf4: 81 29 00 04 lwz r9,4(r9) #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { ffc1bdf8: 39 00 00 01 li r8,1 */ if ( !the_info ) continue; #endif maximum = the_info->maximum; ffc1bdfc: a3 a9 00 10 lhz r29,16(r9) ffc1be00: 80 e9 00 1c lwz r7,28(r9) object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { ffc1be04: 48 00 00 6c b ffc1be70 the_thread = (Thread_Control *) object_table[ index ]; ffc1be08: 85 27 00 04 lwzu r9,4(r7) if ( !the_thread ) ffc1be0c: 2f 89 00 00 cmpwi cr7,r9,0 ffc1be10: 41 9e 00 5c beq- cr7,ffc1be6c /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) ffc1be14: 81 49 00 14 lwz r10,20(r9) ffc1be18: 7f 8a 00 40 cmplw cr7,r10,r0 ffc1be1c: 41 9d 00 50 bgt- cr7,ffc1be6c #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) ffc1be20: 80 c9 01 34 lwz r6,308(r9) ffc1be24: 80 c6 00 d0 lwz r6,208(r6) ffc1be28: 7f dc 30 79 andc. r28,r30,r6 ffc1be2c: 41 82 00 40 beq- ffc1be6c * * 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 ) { ffc1be30: 41 9c 00 34 blt- cr7,ffc1be64 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { ffc1be34: 2f 83 00 00 cmpwi cr7,r3,0 ffc1be38: 41 9e 00 34 beq- cr7,ffc1be6c <== NEVER TAKEN ffc1be3c: 80 a3 00 10 lwz r5,16(r3) ffc1be40: 2f 85 00 00 cmpwi cr7,r5,0 ffc1be44: 41 9e 00 28 beq- cr7,ffc1be6c <== NEVER TAKEN /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { ffc1be48: 80 c9 00 10 lwz r6,16(r9) ffc1be4c: 2f 86 00 00 cmpwi cr7,r6,0 ffc1be50: 41 9e 00 14 beq- cr7,ffc1be64 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { ffc1be54: 74 bc 10 00 andis. r28,r5,4096 ffc1be58: 40 82 00 14 bne- ffc1be6c DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { ffc1be5c: 74 c5 10 00 andis. r5,r6,4096 ffc1be60: 41 82 00 0c beq- ffc1be6c */ if ( interested && !_States_Is_ready( interested->current_state ) ) { /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { ffc1be64: 7d 40 53 78 mr r0,r10 ffc1be68: 7d 23 4b 78 mr r3,r9 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { ffc1be6c: 39 08 00 01 addi r8,r8,1 ffc1be70: 7f 88 e8 40 cmplw cr7,r8,r29 ffc1be74: 40 9d ff 94 ble+ cr7,ffc1be08 * + 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++) { ffc1be78: 7f 8b 20 00 cmpw cr7,r11,r4 ffc1be7c: 40 be ff 6c bne- cr7,ffc1bde8 } } } } if ( interested ) { ffc1be80: 2f 83 00 00 cmpwi cr7,r3,0 ffc1be84: 41 9e 00 18 beq- cr7,ffc1be9c /* * 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 ) ) { ffc1be88: 7f e4 fb 78 mr r4,r31 ffc1be8c: 38 a1 00 08 addi r5,r1,8 ffc1be90: 48 00 00 a9 bl ffc1bf38 <_POSIX_signals_Unblock_thread> ffc1be94: 2f 83 00 00 cmpwi cr7,r3,0 ffc1be98: 40 9e 00 68 bne- cr7,ffc1bf00 /* * 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 ); ffc1be9c: 7f c3 f3 78 mr r3,r30 ffc1bea0: 48 00 00 71 bl ffc1bf10 <_POSIX_signals_Set_process_signals> if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { ffc1bea4: 1f ff 00 0c mulli r31,r31,12 ffc1bea8: 3d 20 00 00 lis r9,0 ffc1beac: 39 29 31 c0 addi r9,r9,12736 ffc1beb0: 7c 09 f8 2e lwzx r0,r9,r31 ffc1beb4: 2f 80 00 02 cmpwi cr7,r0,2 ffc1beb8: 40 be 00 48 bne+ cr7,ffc1bf00 psiginfo = (POSIX_signals_Siginfo_node *) ffc1bebc: 3c 60 00 00 lis r3,0 ffc1bec0: 38 63 33 40 addi r3,r3,13120 ffc1bec4: 4b fe cd dd bl ffc08ca0 <_Chain_Get> _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { ffc1bec8: 7c 64 1b 79 mr. r4,r3 ffc1becc: 40 a2 00 14 bne+ ffc1bee0 _Thread_Enable_dispatch(); ffc1bed0: 4b fe eb e1 bl ffc0aab0 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc1bed4: 4b ff 4c e1 bl ffc10bb4 <__errno> ffc1bed8: 38 00 00 0b li r0,11 ffc1bedc: 4b ff fe 00 b ffc1bcdc } psiginfo->Info = *siginfo; ffc1bee0: 39 24 00 08 addi r9,r4,8 ffc1bee4: 39 61 00 08 addi r11,r1,8 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc1bee8: 3c 60 00 00 lis r3,0 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc1beec: 7c ab 64 aa lswi r5,r11,12 ffc1bef0: 7c a9 65 aa stswi r5,r9,12 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc1bef4: 38 63 33 b4 addi r3,r3,13236 ffc1bef8: 7c 63 fa 14 add r3,r3,r31 ffc1befc: 4b fe cd 4d bl ffc08c48 <_Chain_Append> } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); ffc1bf00: 4b fe eb b1 bl ffc0aab0 <_Thread_Enable_dispatch> return 0; ffc1bf04: 38 60 00 00 li r3,0 } ffc1bf08: 39 61 00 28 addi r11,r1,40 ffc1bf0c: 4b fe 46 2c b ffc00538 <_restgpr_28_x> =============================================================================== ffc0d59c : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0d59c: 2c 03 00 00 cmpwi r3,0 return EINVAL; ffc0d5a0: 38 00 00 16 li r0,22 int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0d5a4: 41 82 00 38 beq- ffc0d5dc ffc0d5a8: 81 23 00 00 lwz r9,0(r3) ffc0d5ac: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d5b0: 41 be 00 2c beq+ cr7,ffc0d5dc return EINVAL; switch ( policy ) { ffc0d5b4: 2b 84 00 04 cmplwi cr7,r4,4 ffc0d5b8: 41 9d 00 20 bgt- cr7,ffc0d5d8 ffc0d5bc: 38 00 00 01 li r0,1 ffc0d5c0: 7c 00 20 30 slw r0,r0,r4 ffc0d5c4: 70 09 00 17 andi. r9,r0,23 ffc0d5c8: 41 82 00 10 beq- ffc0d5d8 <== NEVER TAKEN case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; ffc0d5cc: 90 83 00 14 stw r4,20(r3) return 0; ffc0d5d0: 38 00 00 00 li r0,0 ffc0d5d4: 48 00 00 08 b ffc0d5dc default: return ENOTSUP; ffc0d5d8: 38 00 00 86 li r0,134 } } ffc0d5dc: 7c 03 03 78 mr r3,r0 ffc0d5e0: 4e 80 00 20 blr =============================================================================== ffc08038 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc08038: 94 21 ff d8 stwu r1,-40(r1) ffc0803c: 7c 08 02 a6 mflr r0 ffc08040: bf 81 00 18 stmw r28,24(r1) const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc08044: 7c 7c 1b 79 mr. r28,r3 int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc08048: 7c bf 2b 78 mr r31,r5 ffc0804c: 90 01 00 2c stw r0,44(r1) /* * Error check parameters */ if ( !barrier ) return EINVAL; ffc08050: 38 00 00 16 li r0,22 const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc08054: 41 82 00 a8 beq- ffc080fc return EINVAL; if ( count == 0 ) ffc08058: 2f 85 00 00 cmpwi cr7,r5,0 ffc0805c: 41 be 00 a0 beq+ cr7,ffc080fc return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc08060: 2f 84 00 00 cmpwi cr7,r4,0 ffc08064: 40 be 00 10 bne+ cr7,ffc08074 the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); ffc08068: 38 61 00 08 addi r3,r1,8 ffc0806c: 4b ff fe f1 bl ffc07f5c the_attr = &my_attr; ffc08070: 38 81 00 08 addi r4,r1,8 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc08074: 81 24 00 00 lwz r9,0(r4) return EINVAL; ffc08078: 38 00 00 16 li r0,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc0807c: 2f 89 00 00 cmpwi cr7,r9,0 ffc08080: 41 be 00 7c beq+ cr7,ffc080fc return EINVAL; switch ( the_attr->process_shared ) { ffc08084: 83 c4 00 04 lwz r30,4(r4) ffc08088: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0808c: 40 9e 00 70 bne- cr7,ffc080fc <== NEVER TAKEN * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08090: 3d 20 00 00 lis r9,0 } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; ffc08094: 93 c1 00 10 stw r30,16(r1) ffc08098: 81 69 28 34 lwz r11,10292(r9) the_attributes.maximum_count = count; ffc0809c: 93 e1 00 14 stw r31,20(r1) ffc080a0: 38 0b 00 01 addi r0,r11,1 ffc080a4: 90 09 28 34 stw r0,10292(r9) return _Thread_Dispatch_disable_level; ffc080a8: 80 09 28 34 lwz r0,10292(r9) * This function allocates a barrier control block from * the inactive chain of free barrier control blocks. */ RTEMS_INLINE_ROUTINE POSIX_Barrier_Control *_POSIX_Barrier_Allocate( void ) { return (POSIX_Barrier_Control *) ffc080ac: 3f a0 00 00 lis r29,0 ffc080b0: 3b bd 2f ac addi r29,r29,12204 ffc080b4: 7f a3 eb 78 mr r3,r29 ffc080b8: 48 00 23 ed bl ffc0a4a4 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { ffc080bc: 7c 7f 1b 79 mr. r31,r3 ffc080c0: 40 a2 00 10 bne+ ffc080d0 _Thread_Enable_dispatch(); ffc080c4: 48 00 37 cd bl ffc0b890 <_Thread_Enable_dispatch> return EAGAIN; ffc080c8: 38 00 00 0b li r0,11 ffc080cc: 48 00 00 30 b ffc080fc } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); ffc080d0: 38 7f 00 10 addi r3,r31,16 ffc080d4: 38 81 00 10 addi r4,r1,16 ffc080d8: 48 00 19 09 bl ffc099e0 <_CORE_barrier_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc080dc: 80 1f 00 08 lwz r0,8(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc080e0: 81 7d 00 1c lwz r11,28(r29) ffc080e4: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc080e8: 7f eb 49 2e stwx r31,r11,r9 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc080ec: 93 df 00 0c stw r30,12(r31) ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; ffc080f0: 90 1c 00 00 stw r0,0(r28) _Thread_Enable_dispatch(); ffc080f4: 48 00 37 9d bl ffc0b890 <_Thread_Enable_dispatch> return 0; ffc080f8: 38 00 00 00 li r0,0 } ffc080fc: 39 61 00 28 addi r11,r1,40 ffc08100: 7c 03 03 78 mr r3,r0 ffc08104: 4b ff 8d 38 b ffc00e3c <_restgpr_28_x> =============================================================================== ffc077c0 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc077c0: 94 21 ff f0 stwu r1,-16(r1) ffc077c4: 7c 08 02 a6 mflr r0 ffc077c8: bf c1 00 08 stmw r30,8(r1) /* * 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 ) ffc077cc: 7c 7e 1b 79 mr. r30,r3 void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc077d0: 7c 9f 23 78 mr r31,r4 ffc077d4: 90 01 00 14 stw r0,20(r1) /* * 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 ) ffc077d8: 41 82 00 4c beq- ffc07824 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc077dc: 3d 20 00 00 lis r9,0 ffc077e0: 81 69 28 0c lwz r11,10252(r9) ffc077e4: 38 0b 00 01 addi r0,r11,1 ffc077e8: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc077ec: 80 09 28 0c lwz r0,10252(r9) return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); ffc077f0: 38 60 00 10 li r3,16 ffc077f4: 48 00 4c 31 bl ffc0c424 <_Workspace_Allocate> if ( handler ) { ffc077f8: 7c 69 1b 79 mr. r9,r3 ffc077fc: 41 82 00 24 beq- ffc07820 <== NEVER TAKEN thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc07800: 3d 60 00 00 lis r11,0 ffc07804: 81 6b 31 10 lwz r11,12560(r11) handler_stack = &thread_support->Cancellation_Handlers; handler->routine = routine; handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); ffc07808: 7d 24 4b 78 mr r4,r9 handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); if ( handler ) { thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; ffc0780c: 80 6b 01 34 lwz r3,308(r11) handler->routine = routine; ffc07810: 93 c9 00 08 stw r30,8(r9) handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); ffc07814: 38 63 00 e4 addi r3,r3,228 thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; handler->routine = routine; handler->arg = arg; ffc07818: 93 e9 00 0c stw r31,12(r9) _Chain_Append( handler_stack, &handler->Node ); ffc0781c: 48 00 1a 4d bl ffc09268 <_Chain_Append> } _Thread_Enable_dispatch(); ffc07820: 48 00 38 b1 bl ffc0b0d0 <_Thread_Enable_dispatch> } ffc07824: 39 61 00 10 addi r11,r1,16 ffc07828: 48 00 ef 28 b ffc16750 <_restgpr_30_x> =============================================================================== ffc08998 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc08998: 94 21 ff e8 stwu r1,-24(r1) ffc0899c: 7c 08 02 a6 mflr r0 ffc089a0: bf 81 00 08 stmw r28,8(r1) POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; ffc089a4: 7c 9e 23 79 mr. r30,r4 int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc089a8: 7c 7c 1b 78 mr r28,r3 ffc089ac: 90 01 00 1c stw r0,28(r1) POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; ffc089b0: 40 a2 00 0c bne+ ffc089bc else the_attr = &_POSIX_Condition_variables_Default_attributes; ffc089b4: 3f c0 00 00 lis r30,0 ffc089b8: 3b de 27 88 addi r30,r30,10120 /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) ffc089bc: 80 1e 00 04 lwz r0,4(r30) return EINVAL; ffc089c0: 38 60 00 16 li r3,22 else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) ffc089c4: 2f 80 00 01 cmpwi cr7,r0,1 ffc089c8: 41 9e 00 90 beq- cr7,ffc08a58 <== NEVER TAKEN return EINVAL; if ( !the_attr->is_initialized ) ffc089cc: 80 1e 00 00 lwz r0,0(r30) ffc089d0: 2f 80 00 00 cmpwi cr7,r0,0 ffc089d4: 41 be 00 84 beq+ cr7,ffc08a58 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc089d8: 3d 20 00 00 lis r9,0 ffc089dc: 81 69 28 40 lwz r11,10304(r9) ffc089e0: 38 0b 00 01 addi r0,r11,1 ffc089e4: 90 09 28 40 stw r0,10304(r9) return _Thread_Dispatch_disable_level; ffc089e8: 80 09 28 40 lwz r0,10304(r9) */ RTEMS_INLINE_ROUTINE POSIX_Condition_variables_Control *_POSIX_Condition_variables_Allocate( void ) { return (POSIX_Condition_variables_Control *) ffc089ec: 3f a0 00 00 lis r29,0 ffc089f0: 3b bd 30 64 addi r29,r29,12388 ffc089f4: 7f a3 eb 78 mr r3,r29 ffc089f8: 48 00 2a 9d bl ffc0b494 <_Objects_Allocate> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { ffc089fc: 7c 7f 1b 79 mr. r31,r3 ffc08a00: 40 a2 00 10 bne+ ffc08a10 _Thread_Enable_dispatch(); ffc08a04: 48 00 3e 7d bl ffc0c880 <_Thread_Enable_dispatch> return ENOMEM; ffc08a08: 38 60 00 0c li r3,12 ffc08a0c: 48 00 00 4c b ffc08a58 } the_cond->process_shared = the_attr->process_shared; ffc08a10: 80 1e 00 04 lwz r0,4(r30) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; ffc08a14: 3b c0 00 00 li r30,0 ffc08a18: 93 df 00 14 stw r30,20(r31) _Thread_queue_Initialize( ffc08a1c: 3c a0 10 00 lis r5,4096 ffc08a20: 38 7f 00 18 addi r3,r31,24 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; ffc08a24: 90 1f 00 10 stw r0,16(r31) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( ffc08a28: 38 80 00 00 li r4,0 ffc08a2c: 60 a5 08 00 ori r5,r5,2048 ffc08a30: 38 c0 00 74 li r6,116 ffc08a34: 48 00 46 ed bl ffc0d120 <_Thread_queue_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc08a38: 80 1f 00 08 lwz r0,8(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc08a3c: 81 7d 00 1c lwz r11,28(r29) ffc08a40: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc08a44: 7f eb 49 2e stwx r31,r11,r9 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc08a48: 93 df 00 0c stw r30,12(r31) &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; ffc08a4c: 90 1c 00 00 stw r0,0(r28) _Thread_Enable_dispatch(); ffc08a50: 48 00 3e 31 bl ffc0c880 <_Thread_Enable_dispatch> return 0; ffc08a54: 38 60 00 00 li r3,0 } ffc08a58: 39 61 00 18 addi r11,r1,24 ffc08a5c: 4b ff 8c 50 b ffc016ac <_restgpr_28_x> =============================================================================== ffc087f0 : int pthread_condattr_destroy( pthread_condattr_t *attr ) { if ( !attr || attr->is_initialized == false ) ffc087f0: 2c 03 00 00 cmpwi r3,0 return EINVAL; ffc087f4: 38 00 00 16 li r0,22 int pthread_condattr_destroy( pthread_condattr_t *attr ) { if ( !attr || attr->is_initialized == false ) ffc087f8: 41 82 00 18 beq- ffc08810 ffc087fc: 81 23 00 00 lwz r9,0(r3) ffc08800: 2f 89 00 00 cmpwi cr7,r9,0 ffc08804: 41 be 00 0c beq+ cr7,ffc08810 <== NEVER TAKEN return EINVAL; attr->is_initialized = false; ffc08808: 38 00 00 00 li r0,0 ffc0880c: 90 03 00 00 stw r0,0(r3) return 0; } ffc08810: 7c 03 03 78 mr r3,r0 ffc08814: 4e 80 00 20 blr =============================================================================== ffc07cf4 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc07cf4: 94 21 ff 80 stwu r1,-128(r1) ffc07cf8: 7c 08 02 a6 mflr r0 ffc07cfc: be a1 00 54 stmw r21,84(r1) int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc07d00: 7c b8 2b 79 mr. r24,r5 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc07d04: 7c 7a 1b 78 mr r26,r3 ffc07d08: 90 01 00 84 stw r0,132(r1) ffc07d0c: 7c d9 33 78 mr r25,r6 struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) return EFAULT; ffc07d10: 3b c0 00 0e li r30,14 int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc07d14: 41 82 02 08 beq- ffc07f1c return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; ffc07d18: 2f 84 00 00 cmpwi cr7,r4,0 ffc07d1c: 7c 9f 23 78 mr r31,r4 ffc07d20: 40 be 00 0c bne+ cr7,ffc07d2c ffc07d24: 3f e0 ff c2 lis r31,-62 ffc07d28: 3b ff ef 60 addi r31,r31,-4256 if ( !the_attr->is_initialized ) ffc07d2c: 80 1f 00 00 lwz r0,0(r31) return EINVAL; ffc07d30: 3b c0 00 16 li r30,22 if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; if ( !the_attr->is_initialized ) ffc07d34: 2f 80 00 00 cmpwi cr7,r0,0 ffc07d38: 41 be 01 e4 beq+ cr7,ffc07f1c * 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) ) ffc07d3c: 80 1f 00 04 lwz r0,4(r31) ffc07d40: 2f 80 00 00 cmpwi cr7,r0,0 ffc07d44: 41 9e 00 18 beq- cr7,ffc07d5c ffc07d48: 3d 60 00 00 lis r11,0 ffc07d4c: 81 3f 00 08 lwz r9,8(r31) ffc07d50: 80 0b 27 28 lwz r0,10024(r11) ffc07d54: 7f 89 00 40 cmplw cr7,r9,r0 ffc07d58: 41 bc 01 c4 blt+ cr7,ffc07f1c * 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 ) { ffc07d5c: 80 1f 00 10 lwz r0,16(r31) ffc07d60: 2f 80 00 01 cmpwi cr7,r0,1 ffc07d64: 41 9e 00 14 beq- cr7,ffc07d78 ffc07d68: 2f 80 00 02 cmpwi cr7,r0,2 schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; break; default: return EINVAL; ffc07d6c: 3b c0 00 16 li r30,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 ) { ffc07d70: 40 be 01 ac bne+ cr7,ffc07f1c ffc07d74: 48 00 00 1c b ffc07d90 case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc07d78: 3d 20 00 00 lis r9,0 ffc07d7c: 81 29 31 10 lwz r9,12560(r9) ffc07d80: 80 69 01 34 lwz r3,308(r9) schedpolicy = api->schedpolicy; ffc07d84: 83 63 00 84 lwz r27,132(r3) schedparam = api->schedparam; ffc07d88: 38 63 00 88 addi r3,r3,136 ffc07d8c: 48 00 00 0c b ffc07d98 break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; ffc07d90: 83 7f 00 14 lwz r27,20(r31) schedparam = the_attr->schedparam; ffc07d94: 38 7f 00 18 addi r3,r31,24 ffc07d98: 38 81 00 20 addi r4,r1,32 ffc07d9c: 7c a3 e4 aa lswi r5,r3,28 ffc07da0: 7c a4 e5 aa stswi r5,r4,28 /* * 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; ffc07da4: 3b c0 00 86 li r30,134 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) ffc07da8: 80 1f 00 0c lwz r0,12(r31) ffc07dac: 2f 80 00 00 cmpwi cr7,r0,0 ffc07db0: 40 be 01 6c bne+ cr7,ffc07f1c return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc07db4: 80 61 00 20 lwz r3,32(r1) return EINVAL; ffc07db8: 3b c0 00 16 li r30,22 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc07dbc: 48 00 6b d9 bl ffc0e994 <_POSIX_Priority_Is_valid> ffc07dc0: 2f 83 00 00 cmpwi cr7,r3,0 ffc07dc4: 41 be 01 58 beq+ cr7,ffc07f1c <== NEVER TAKEN return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); ffc07dc8: 7c 24 0b 78 mr r4,r1 ffc07dcc: 86 e4 00 20 lwzu r23,32(r4) RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); ffc07dd0: 3d 20 00 00 lis r9,0 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( ffc07dd4: 7f 63 db 78 mr r3,r27 ffc07dd8: 8a c9 27 24 lbz r22,10020(r9) ffc07ddc: 38 a1 00 1c addi r5,r1,28 ffc07de0: 38 c1 00 18 addi r6,r1,24 ffc07de4: 48 00 6b d9 bl ffc0e9bc <_POSIX_Thread_Translate_sched_param> schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) ffc07de8: 7c 7e 1b 79 mr. r30,r3 ffc07dec: 40 a2 01 30 bne+ ffc07f1c #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); ffc07df0: 3e a0 00 00 lis r21,0 ffc07df4: 80 75 28 34 lwz r3,10292(r21) * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); ffc07df8: 3f a0 00 00 lis r29,0 ffc07dfc: 3b bd 2e 0c addi r29,r29,11788 ffc07e00: 48 00 1a 95 bl ffc09894 <_API_Mutex_Lock> ffc07e04: 7f a3 eb 78 mr r3,r29 ffc07e08: 48 00 25 d5 bl ffc0a3dc <_Objects_Allocate> * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { ffc07e0c: 7c 7c 1b 79 mr. r28,r3 ffc07e10: 40 a2 00 0c bne+ ffc07e1c _RTEMS_Unlock_allocator(); ffc07e14: 80 75 28 34 lwz r3,10292(r21) ffc07e18: 48 00 00 78 b ffc07e90 static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc07e1c: 3d 20 00 00 lis r9,0 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( ffc07e20: 80 1f 00 08 lwz r0,8(r31) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc07e24: 80 c9 27 28 lwz r6,10024(r9) /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( ffc07e28: 93 c1 00 48 stw r30,72(r1) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc07e2c: 54 c6 08 3c rlwinm r6,r6,1,0,30 /* * Initialize the core thread for this task. */ name.name_p = NULL; /* posix threads don't have a name by default */ status = _Thread_Initialize( ffc07e30: 7f 86 00 40 cmplw cr7,r6,r0 ffc07e34: 80 bf 00 04 lwz r5,4(r31) ffc07e38: 40 9c 00 08 bge- cr7,ffc07e40 ffc07e3c: 7c 06 03 78 mr r6,r0 ffc07e40: 80 01 00 18 lwz r0,24(r1) ffc07e44: 7f a3 eb 78 mr r3,r29 ffc07e48: 81 41 00 1c lwz r10,28(r1) ffc07e4c: 7f 84 e3 78 mr r4,r28 ffc07e50: 90 01 00 08 stw r0,8(r1) ffc07e54: 38 00 00 00 li r0,0 ffc07e58: 38 e0 00 01 li r7,1 ffc07e5c: 90 01 00 0c stw r0,12(r1) ffc07e60: 7d 17 b0 50 subf r8,r23,r22 ffc07e64: 38 01 00 48 addi r0,r1,72 ffc07e68: 39 20 00 01 li r9,1 ffc07e6c: 90 01 00 10 stw r0,16(r1) ffc07e70: 48 00 3a 45 bl ffc0b8b4 <_Thread_Initialize> budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { ffc07e74: 2f 83 00 00 cmpwi cr7,r3,0 ffc07e78: 40 9e 00 24 bne- cr7,ffc07e9c RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); ffc07e7c: 7f a3 eb 78 mr r3,r29 ffc07e80: 7f 84 e3 78 mr r4,r28 ffc07e84: 48 00 28 dd bl ffc0a760 <_Objects_Free> _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); ffc07e88: 3d 20 00 00 lis r9,0 ffc07e8c: 80 69 28 34 lwz r3,10292(r9) ffc07e90: 48 00 1a 89 bl ffc09918 <_API_Mutex_Unlock> return EAGAIN; ffc07e94: 3b c0 00 0b li r30,11 ffc07e98: 48 00 00 84 b ffc07f1c } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc07e9c: 83 bc 01 34 lwz r29,308(r28) api->Attributes = *the_attr; ffc07ea0: 38 a0 00 40 li r5,64 ffc07ea4: 7f e4 fb 78 mr r4,r31 ffc07ea8: 7f a3 eb 78 mr r3,r29 ffc07eac: 48 00 a1 a9 bl ffc12054 api->detachstate = the_attr->detachstate; ffc07eb0: 80 1f 00 3c lwz r0,60(r31) api->schedpolicy = schedpolicy; ffc07eb4: 93 7d 00 84 stw r27,132(r29) api->schedparam = schedparam; ffc07eb8: 38 9d 00 88 addi r4,r29,136 ffc07ebc: 38 61 00 20 addi r3,r1,32 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; ffc07ec0: 90 1d 00 40 stw r0,64(r29) api->schedpolicy = schedpolicy; api->schedparam = schedparam; ffc07ec4: 7c a3 e4 aa lswi r5,r3,28 ffc07ec8: 7c a4 e5 aa stswi r5,r4,28 /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc07ecc: 7f 83 e3 78 mr r3,r28 ffc07ed0: 38 80 00 01 li r4,1 ffc07ed4: 7f 05 c3 78 mr r5,r24 ffc07ed8: 7f 26 cb 78 mr r6,r25 ffc07edc: 38 e0 00 00 li r7,0 ffc07ee0: 48 00 44 39 bl ffc0c318 <_Thread_Start> _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { ffc07ee4: 2f 9b 00 04 cmpwi cr7,r27,4 ffc07ee8: 40 be 00 20 bne+ cr7,ffc07f08 _Watchdog_Insert_ticks( ffc07eec: 38 7d 00 90 addi r3,r29,144 ffc07ef0: 48 00 45 51 bl ffc0c440 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc07ef4: 38 9d 00 a8 addi r4,r29,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc07ef8: 90 7d 00 b4 stw r3,180(r29) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc07efc: 3c 60 00 00 lis r3,0 ffc07f00: 38 63 2d 28 addi r3,r3,11560 ffc07f04: 48 00 49 31 bl ffc0c834 <_Watchdog_Insert> } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc07f08: 80 1c 00 08 lwz r0,8(r28) _RTEMS_Unlock_allocator(); ffc07f0c: 3d 20 00 00 lis r9,0 ffc07f10: 80 69 28 34 lwz r3,10292(r9) } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc07f14: 90 1a 00 00 stw r0,0(r26) _RTEMS_Unlock_allocator(); ffc07f18: 48 00 1a 01 bl ffc09918 <_API_Mutex_Unlock> return 0; } ffc07f1c: 39 61 00 80 addi r11,r1,128 ffc07f20: 7f c3 f3 78 mr r3,r30 ffc07f24: 4b ff 8c 20 b ffc00b44 <_restgpr_21_x> =============================================================================== ffc1c068 : int pthread_kill( pthread_t thread, int sig ) { ffc1c068: 94 21 ff d8 stwu r1,-40(r1) ffc1c06c: 7c 08 02 a6 mflr r0 ffc1c070: bf 81 00 18 stmw r28,24(r1) POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) ffc1c074: 7c 9d 23 79 mr. r29,r4 int pthread_kill( pthread_t thread, int sig ) { ffc1c078: 90 01 00 2c stw r0,44(r1) POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) ffc1c07c: 41 82 00 10 beq- ffc1c08c static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc1c080: 3b 9d ff ff addi r28,r29,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc1c084: 2b 9c 00 1f cmplwi cr7,r28,31 ffc1c088: 40 bd 00 10 ble+ cr7,ffc1c098 rtems_set_errno_and_return_minus_one( EINVAL ); ffc1c08c: 4b ff 4b 29 bl ffc10bb4 <__errno> ffc1c090: 38 00 00 16 li r0,22 ffc1c094: 48 00 00 94 b ffc1c128 the_thread = _Thread_Get( thread, &location ); ffc1c098: 38 81 00 08 addi r4,r1,8 ffc1c09c: 4b fe ea 51 bl ffc0aaec <_Thread_Get> switch ( location ) { ffc1c0a0: 80 01 00 08 lwz r0,8(r1) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); the_thread = _Thread_Get( thread, &location ); ffc1c0a4: 7c 7e 1b 78 mr r30,r3 switch ( location ) { ffc1c0a8: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c0ac: 40 9e 00 74 bne- cr7,ffc1c120 <== NEVER TAKEN api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { ffc1c0b0: 1c 1d 00 0c mulli r0,r29,12 case OBJECTS_LOCAL: /* * If sig == 0 then just validate arguments */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc1c0b4: 81 23 01 34 lwz r9,308(r3) if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { ffc1c0b8: 3d 60 00 00 lis r11,0 ffc1c0bc: 39 6b 31 c0 addi r11,r11,12736 ffc1c0c0: 7d 6b 02 14 add r11,r11,r0 ffc1c0c4: 80 0b 00 08 lwz r0,8(r11) ffc1c0c8: 2f 80 00 01 cmpwi cr7,r0,1 ffc1c0cc: 41 9e 00 48 beq- cr7,ffc1c114 return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); ffc1c0d0: 80 09 00 d4 lwz r0,212(r9) static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); ffc1c0d4: 3b e0 00 01 li r31,1 ffc1c0d8: 7f fc e0 30 slw r28,r31,r28 ffc1c0dc: 7c 1c e3 78 or r28,r0,r28 ffc1c0e0: 93 89 00 d4 stw r28,212(r9) (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); ffc1c0e4: 7f a4 eb 78 mr r4,r29 ffc1c0e8: 38 a0 00 00 li r5,0 ffc1c0ec: 4b ff fe 4d bl ffc1bf38 <_POSIX_signals_Unblock_thread> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc1c0f0: 3d 20 00 00 lis r9,0 ffc1c0f4: 39 29 31 44 addi r9,r9,12612 ffc1c0f8: 80 09 00 08 lwz r0,8(r9) ffc1c0fc: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c100: 41 9e 00 14 beq- cr7,ffc1c114 ffc1c104: 80 09 00 0c lwz r0,12(r9) ffc1c108: 7f 9e 00 00 cmpw cr7,r30,r0 ffc1c10c: 40 be 00 08 bne+ cr7,ffc1c114 _Thread_Dispatch_necessary = true; ffc1c110: 9b e9 00 18 stb r31,24(r9) } _Thread_Enable_dispatch(); ffc1c114: 4b fe e9 9d bl ffc0aab0 <_Thread_Enable_dispatch> return 0; ffc1c118: 38 60 00 00 li r3,0 ffc1c11c: 48 00 00 14 b ffc1c130 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); ffc1c120: 4b ff 4a 95 bl ffc10bb4 <__errno> <== NOT EXECUTED ffc1c124: 38 00 00 03 li r0,3 <== NOT EXECUTED ffc1c128: 90 03 00 00 stw r0,0(r3) ffc1c12c: 38 60 ff ff li r3,-1 } ffc1c130: 39 61 00 28 addi r11,r1,40 ffc1c134: 4b fe 44 04 b ffc00538 <_restgpr_28_x> =============================================================================== ffc0a014 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0a014: 94 21 ff d8 stwu r1,-40(r1) ffc0a018: 7c 08 02 a6 mflr r0 ffc0a01c: bf a1 00 1c stmw r29,28(r1) ffc0a020: 7c 7d 1b 78 mr r29,r3 * * 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 ); ffc0a024: 7c 83 23 78 mr r3,r4 ffc0a028: 38 81 00 08 addi r4,r1,8 int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0a02c: 90 01 00 2c stw r0,44(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 ); ffc0a030: 48 00 00 f5 bl ffc0a124 <_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, ffc0a034: 68 7f 00 03 xori r31,r3,3 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); ffc0a038: 80 a1 00 08 lwz r5,8(r1) ffc0a03c: 7f ff 00 34 cntlzw r31,r31 ffc0a040: 57 ff d9 7e rlwinm r31,r31,27,5,31 * * 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 ); ffc0a044: 7c 7e 1b 78 mr r30,r3 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); ffc0a048: 7f e4 fb 78 mr r4,r31 ffc0a04c: 7f a3 eb 78 mr r3,r29 ffc0a050: 4b ff fe c1 bl ffc09f10 <_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) ) { ffc0a054: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0a058: 40 9e 00 30 bne- cr7,ffc0a088 ffc0a05c: 2f 83 00 10 cmpwi cr7,r3,16 ffc0a060: 40 be 00 28 bne+ cr7,ffc0a088 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) ffc0a064: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a068: 41 be 00 14 beq+ cr7,ffc0a07c <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0a06c: 3b de ff ff addi r30,r30,-1 ffc0a070: 2b 9e 00 01 cmplwi cr7,r30,1 ffc0a074: 41 bd 00 14 bgt+ cr7,ffc0a088 <== NEVER TAKEN ffc0a078: 48 00 00 0c b ffc0a084 * 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; ffc0a07c: 38 60 00 16 li r3,22 <== NOT EXECUTED ffc0a080: 48 00 00 08 b ffc0a088 <== NOT EXECUTED if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0a084: 38 60 00 74 li r3,116 } return lock_status; } ffc0a088: 39 61 00 28 addi r11,r1,40 ffc0a08c: 4b ff 88 48 b ffc028d4 <_restgpr_29_x> =============================================================================== ffc09b9c : int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { if ( !attr || !attr->is_initialized ) ffc09b9c: 2c 03 00 00 cmpwi r3,0 return EINVAL; ffc09ba0: 38 00 00 16 li r0,22 int pthread_mutexattr_setpshared( pthread_mutexattr_t *attr, int pshared ) { if ( !attr || !attr->is_initialized ) ffc09ba4: 41 82 00 20 beq- ffc09bc4 ffc09ba8: 81 23 00 00 lwz r9,0(r3) ffc09bac: 2f 89 00 00 cmpwi cr7,r9,0 ffc09bb0: 41 be 00 14 beq+ cr7,ffc09bc4 return EINVAL; switch ( pshared ) { ffc09bb4: 2b 84 00 01 cmplwi cr7,r4,1 ffc09bb8: 41 9d 00 0c bgt- cr7,ffc09bc4 <== NEVER TAKEN case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; ffc09bbc: 90 83 00 04 stw r4,4(r3) return 0; ffc09bc0: 38 00 00 00 li r0,0 default: return EINVAL; } } ffc09bc4: 7c 03 03 78 mr r3,r0 ffc09bc8: 4e 80 00 20 blr =============================================================================== ffc0739c : int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { if ( !attr || !attr->is_initialized ) ffc0739c: 2c 03 00 00 cmpwi r3,0 return EINVAL; ffc073a0: 38 00 00 16 li r0,22 int pthread_mutexattr_settype( pthread_mutexattr_t *attr, int type ) { if ( !attr || !attr->is_initialized ) ffc073a4: 41 82 00 20 beq- ffc073c4 ffc073a8: 81 23 00 00 lwz r9,0(r3) ffc073ac: 2f 89 00 00 cmpwi cr7,r9,0 ffc073b0: 41 be 00 14 beq+ cr7,ffc073c4 <== NEVER TAKEN return EINVAL; switch ( type ) { ffc073b4: 2b 84 00 03 cmplwi cr7,r4,3 ffc073b8: 41 9d 00 0c bgt- cr7,ffc073c4 case PTHREAD_MUTEX_NORMAL: case PTHREAD_MUTEX_RECURSIVE: case PTHREAD_MUTEX_ERRORCHECK: case PTHREAD_MUTEX_DEFAULT: attr->type = type; ffc073bc: 90 83 00 10 stw r4,16(r3) return 0; ffc073c0: 38 00 00 00 li r0,0 default: return EINVAL; } } ffc073c4: 7c 03 03 78 mr r3,r0 ffc073c8: 4e 80 00 20 blr =============================================================================== ffc08404 : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc08404: 94 21 ff e0 stwu r1,-32(r1) ffc08408: 7c 08 02 a6 mflr r0 ffc0840c: bf c1 00 18 stmw r30,24(r1) if ( !once_control || !init_routine ) ffc08410: 7c 7f 1b 79 mr. r31,r3 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc08414: 7c 9e 23 78 mr r30,r4 ffc08418: 90 01 00 24 stw r0,36(r1) if ( !once_control || !init_routine ) return EINVAL; ffc0841c: 38 00 00 16 li r0,22 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { if ( !once_control || !init_routine ) ffc08420: 41 82 00 60 beq- ffc08480 ffc08424: 2f 84 00 00 cmpwi cr7,r4,0 ffc08428: 41 9e 00 58 beq- cr7,ffc08480 return EINVAL; if ( !once_control->init_executed ) { ffc0842c: 81 3f 00 04 lwz r9,4(r31) once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; ffc08430: 38 00 00 00 li r0,0 ) { if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { ffc08434: 2f 89 00 00 cmpwi cr7,r9,0 ffc08438: 40 be 00 48 bne+ cr7,ffc08480 rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); ffc0843c: 38 60 01 00 li r3,256 ffc08440: 38 80 01 00 li r4,256 ffc08444: 38 a1 00 08 addi r5,r1,8 ffc08448: 48 00 0c bd bl ffc09104 if ( !once_control->init_executed ) { ffc0844c: 80 1f 00 04 lwz r0,4(r31) ffc08450: 2f 80 00 00 cmpwi cr7,r0,0 ffc08454: 40 be 00 18 bne+ cr7,ffc0846c <== NEVER TAKEN once_control->is_initialized = true; ffc08458: 38 00 00 01 li r0,1 once_control->init_executed = true; (*init_routine)(); ffc0845c: 7f c9 03 a6 mtctr r30 if ( !once_control->init_executed ) { rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); if ( !once_control->init_executed ) { once_control->is_initialized = true; ffc08460: 90 1f 00 00 stw r0,0(r31) once_control->init_executed = true; ffc08464: 90 1f 00 04 stw r0,4(r31) (*init_routine)(); ffc08468: 4e 80 04 21 bctrl } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); ffc0846c: 7c 25 0b 78 mr r5,r1 ffc08470: 84 65 00 08 lwzu r3,8(r5) ffc08474: 38 80 01 00 li r4,256 ffc08478: 48 00 0c 8d bl ffc09104 } return 0; ffc0847c: 38 00 00 00 li r0,0 } ffc08480: 39 61 00 20 addi r11,r1,32 ffc08484: 7c 03 03 78 mr r3,r0 ffc08488: 4b ff 86 e0 b ffc00b68 <_restgpr_30_x> =============================================================================== ffc08e04 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc08e04: 94 21 ff d8 stwu r1,-40(r1) ffc08e08: 7c 08 02 a6 mflr r0 ffc08e0c: bf 81 00 18 stmw r28,24(r1) const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc08e10: 7c 7c 1b 79 mr. r28,r3 int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc08e14: 90 01 00 2c stw r0,44(r1) /* * Error check parameters */ if ( !rwlock ) return EINVAL; ffc08e18: 38 00 00 16 li r0,22 const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc08e1c: 41 82 00 9c beq- ffc08eb8 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc08e20: 2f 84 00 00 cmpwi cr7,r4,0 ffc08e24: 40 be 00 10 bne+ cr7,ffc08e34 the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); ffc08e28: 38 61 00 0c addi r3,r1,12 ffc08e2c: 48 00 0a a1 bl ffc098cc the_attr = &default_attr; ffc08e30: 38 81 00 0c addi r4,r1,12 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc08e34: 81 24 00 00 lwz r9,0(r4) return EINVAL; ffc08e38: 38 00 00 16 li r0,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc08e3c: 2f 89 00 00 cmpwi cr7,r9,0 ffc08e40: 41 be 00 78 beq+ cr7,ffc08eb8 <== NEVER TAKEN return EINVAL; switch ( the_attr->process_shared ) { ffc08e44: 83 c4 00 04 lwz r30,4(r4) ffc08e48: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08e4c: 40 9e 00 6c bne- cr7,ffc08eb8 <== NEVER TAKEN * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08e50: 3d 20 00 00 lis r9,0 */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; ffc08e54: 93 c1 00 08 stw r30,8(r1) ffc08e58: 81 69 28 34 lwz r11,10292(r9) ffc08e5c: 38 0b 00 01 addi r0,r11,1 ffc08e60: 90 09 28 34 stw r0,10292(r9) return _Thread_Dispatch_disable_level; ffc08e64: 80 09 28 34 lwz r0,10292(r9) * This function allocates a RWLock control block from * the inactive chain of free RWLock control blocks. */ RTEMS_INLINE_ROUTINE POSIX_RWLock_Control *_POSIX_RWLock_Allocate( void ) { return (POSIX_RWLock_Control *) ffc08e68: 3f a0 00 00 lis r29,0 ffc08e6c: 3b bd 2d ec addi r29,r29,11756 ffc08e70: 7f a3 eb 78 mr r3,r29 ffc08e74: 48 00 2a a5 bl ffc0b918 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { ffc08e78: 7c 7f 1b 79 mr. r31,r3 ffc08e7c: 40 a2 00 10 bne+ ffc08e8c _Thread_Enable_dispatch(); ffc08e80: 48 00 3e 85 bl ffc0cd04 <_Thread_Enable_dispatch> return EAGAIN; ffc08e84: 38 00 00 0b li r0,11 ffc08e88: 48 00 00 30 b ffc08eb8 } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); ffc08e8c: 38 7f 00 10 addi r3,r31,16 ffc08e90: 38 81 00 08 addi r4,r1,8 ffc08e94: 48 00 21 01 bl ffc0af94 <_CORE_RWLock_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc08e98: 80 1f 00 08 lwz r0,8(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc08e9c: 81 7d 00 1c lwz r11,28(r29) ffc08ea0: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc08ea4: 7f eb 49 2e stwx r31,r11,r9 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc08ea8: 93 df 00 0c stw r30,12(r31) &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; ffc08eac: 90 1c 00 00 stw r0,0(r28) _Thread_Enable_dispatch(); ffc08eb0: 48 00 3e 55 bl ffc0cd04 <_Thread_Enable_dispatch> return 0; ffc08eb4: 38 00 00 00 li r0,0 } ffc08eb8: 39 61 00 28 addi r11,r1,40 ffc08ebc: 7c 03 03 78 mr r3,r0 ffc08ec0: 4b ff 8d 74 b ffc01c34 <_restgpr_28_x> =============================================================================== ffc08f3c : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc08f3c: 94 21 ff d8 stwu r1,-40(r1) ffc08f40: 7c 08 02 a6 mflr r0 ffc08f44: bf 81 00 18 stmw r28,24(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc08f48: 7c 7c 1b 79 mr. r28,r3 return EINVAL; ffc08f4c: 3b c0 00 16 li r30,22 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc08f50: 90 01 00 2c stw r0,44(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc08f54: 41 82 00 a4 beq- ffc08ff8 * * 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 ); ffc08f58: 7c 83 23 78 mr r3,r4 ffc08f5c: 38 81 00 08 addi r4,r1,8 ffc08f60: 48 00 6e d1 bl ffc0fe30 <_POSIX_Absolute_timeout_to_ticks> ffc08f64: 80 9c 00 00 lwz r4,0(r28) ffc08f68: 7c 7d 1b 78 mr r29,r3 ffc08f6c: 3c 60 00 00 lis r3,0 ffc08f70: 38 63 2d ec addi r3,r3,11756 ffc08f74: 38 a1 00 0c addi r5,r1,12 ffc08f78: 48 00 2e c1 bl ffc0be38 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc08f7c: 80 01 00 0c lwz r0,12(r1) ffc08f80: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f84: 40 9e 00 74 bne- cr7,ffc08ff8 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, ffc08f88: 6b bf 00 03 xori r31,r29,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( ffc08f8c: 80 9c 00 00 lwz r4,0(r28) ffc08f90: 7f ff 00 34 cntlzw r31,r31 ffc08f94: 80 c1 00 08 lwz r6,8(r1) ffc08f98: 57 ff d9 7e rlwinm r31,r31,27,5,31 ffc08f9c: 38 63 00 10 addi r3,r3,16 ffc08fa0: 7f e5 fb 78 mr r5,r31 ffc08fa4: 38 e0 00 00 li r7,0 ffc08fa8: 48 00 20 2d bl ffc0afd4 <_CORE_RWLock_Obtain_for_reading> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc08fac: 48 00 3d 59 bl ffc0cd04 <_Thread_Enable_dispatch> if ( !do_wait ) { ffc08fb0: 2f 9f 00 00 cmpwi cr7,r31,0 ffc08fb4: 40 9e 00 30 bne- cr7,ffc08fe4 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { ffc08fb8: 3d 20 00 00 lis r9,0 ffc08fbc: 81 29 31 30 lwz r9,12592(r9) ffc08fc0: 80 09 00 34 lwz r0,52(r9) ffc08fc4: 2f 80 00 02 cmpwi cr7,r0,2 ffc08fc8: 40 be 00 1c bne+ cr7,ffc08fe4 if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) ffc08fcc: 2f 9d 00 00 cmpwi cr7,r29,0 ffc08fd0: 41 be 00 28 beq+ cr7,ffc08ff8 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc08fd4: 3b bd ff ff addi r29,r29,-1 ffc08fd8: 2b 9d 00 01 cmplwi cr7,r29,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc08fdc: 3b c0 00 74 li r30,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 || ffc08fe0: 40 9d 00 18 ble- cr7,ffc08ff8 <== ALWAYS TAKEN return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( (CORE_RWLock_Status) _Thread_Executing->Wait.return_code ffc08fe4: 3d 20 00 00 lis r9,0 ffc08fe8: 81 29 31 30 lwz r9,12592(r9) status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc08fec: 80 69 00 34 lwz r3,52(r9) ffc08ff0: 48 00 00 dd bl ffc090cc <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc08ff4: 7c 7e 1b 78 mr r30,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc08ff8: 39 61 00 28 addi r11,r1,40 ffc08ffc: 7f c3 f3 78 mr r3,r30 ffc09000: 4b ff 8c 34 b ffc01c34 <_restgpr_28_x> =============================================================================== ffc09004 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc09004: 94 21 ff d8 stwu r1,-40(r1) ffc09008: 7c 08 02 a6 mflr r0 ffc0900c: bf 81 00 18 stmw r28,24(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc09010: 7c 7c 1b 79 mr. r28,r3 return EINVAL; ffc09014: 3b c0 00 16 li r30,22 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc09018: 90 01 00 2c stw r0,44(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc0901c: 41 82 00 a4 beq- ffc090c0 * * 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 ); ffc09020: 7c 83 23 78 mr r3,r4 ffc09024: 38 81 00 08 addi r4,r1,8 ffc09028: 48 00 6e 09 bl ffc0fe30 <_POSIX_Absolute_timeout_to_ticks> ffc0902c: 80 9c 00 00 lwz r4,0(r28) ffc09030: 7c 7d 1b 78 mr r29,r3 ffc09034: 3c 60 00 00 lis r3,0 ffc09038: 38 63 2d ec addi r3,r3,11756 ffc0903c: 38 a1 00 0c addi r5,r1,12 ffc09040: 48 00 2d f9 bl ffc0be38 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc09044: 80 01 00 0c lwz r0,12(r1) ffc09048: 2f 80 00 00 cmpwi cr7,r0,0 ffc0904c: 40 9e 00 74 bne- cr7,ffc090c0 (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, ffc09050: 6b bf 00 03 xori r31,r29,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( ffc09054: 80 9c 00 00 lwz r4,0(r28) ffc09058: 7f ff 00 34 cntlzw r31,r31 ffc0905c: 80 c1 00 08 lwz r6,8(r1) ffc09060: 57 ff d9 7e rlwinm r31,r31,27,5,31 ffc09064: 38 63 00 10 addi r3,r3,16 ffc09068: 7f e5 fb 78 mr r5,r31 ffc0906c: 38 e0 00 00 li r7,0 ffc09070: 48 00 20 39 bl ffc0b0a8 <_CORE_RWLock_Obtain_for_writing> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc09074: 48 00 3c 91 bl ffc0cd04 <_Thread_Enable_dispatch> if ( !do_wait && ffc09078: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0907c: 40 9e 00 30 bne- cr7,ffc090ac (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { ffc09080: 3d 20 00 00 lis r9,0 ffc09084: 81 29 31 30 lwz r9,12592(r9) ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && ffc09088: 80 09 00 34 lwz r0,52(r9) ffc0908c: 2f 80 00 02 cmpwi cr7,r0,2 ffc09090: 40 be 00 1c bne+ cr7,ffc090ac (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) ffc09094: 2f 9d 00 00 cmpwi cr7,r29,0 ffc09098: 41 be 00 28 beq+ cr7,ffc090c0 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0909c: 3b bd ff ff addi r29,r29,-1 ffc090a0: 2b 9d 00 01 cmplwi cr7,r29,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc090a4: 3b c0 00 74 li r30,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 || ffc090a8: 40 9d 00 18 ble- cr7,ffc090c0 <== 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 ffc090ac: 3d 20 00 00 lis r9,0 ffc090b0: 81 29 31 30 lwz r9,12592(r9) if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc090b4: 80 69 00 34 lwz r3,52(r9) ffc090b8: 48 00 00 15 bl ffc090cc <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc090bc: 7c 7e 1b 78 mr r30,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc090c0: 39 61 00 28 addi r11,r1,40 ffc090c4: 7f c3 f3 78 mr r3,r30 ffc090c8: 4b ff 8b 6c b ffc01c34 <_restgpr_28_x> =============================================================================== ffc098f0 : int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { if ( !attr ) ffc098f0: 2c 03 00 00 cmpwi r3,0 return EINVAL; ffc098f4: 38 00 00 16 li r0,22 int pthread_rwlockattr_setpshared( pthread_rwlockattr_t *attr, int pshared ) { if ( !attr ) ffc098f8: 41 82 00 20 beq- ffc09918 return EINVAL; if ( !attr->is_initialized ) ffc098fc: 81 23 00 00 lwz r9,0(r3) ffc09900: 2f 89 00 00 cmpwi cr7,r9,0 ffc09904: 41 be 00 14 beq+ cr7,ffc09918 return EINVAL; switch ( pshared ) { ffc09908: 2b 84 00 01 cmplwi cr7,r4,1 ffc0990c: 41 9d 00 0c bgt- cr7,ffc09918 <== NEVER TAKEN case PTHREAD_PROCESS_SHARED: case PTHREAD_PROCESS_PRIVATE: attr->process_shared = pshared; ffc09910: 90 83 00 04 stw r4,4(r3) return 0; ffc09914: 38 00 00 00 li r0,0 default: return EINVAL; } } ffc09918: 7c 03 03 78 mr r3,r0 ffc0991c: 4e 80 00 20 blr =============================================================================== ffc0a968 : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0a968: 94 21 ff d0 stwu r1,-48(r1) ffc0a96c: 7c 08 02 a6 mflr r0 ffc0a970: bf 61 00 1c stmw r27,28(r1) int rc; /* * Check all the parameters */ if ( !param ) ffc0a974: 7c bd 2b 79 mr. r29,r5 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0a978: 7c 7c 1b 78 mr r28,r3 ffc0a97c: 90 01 00 34 stw r0,52(r1) ffc0a980: 7c 9f 23 78 mr r31,r4 /* * Check all the parameters */ if ( !param ) return EINVAL; ffc0a984: 3b c0 00 16 li r30,22 int rc; /* * Check all the parameters */ if ( !param ) ffc0a988: 41 82 00 e8 beq- ffc0aa70 return EINVAL; rc = _POSIX_Thread_Translate_sched_param( ffc0a98c: 7c 83 23 78 mr r3,r4 ffc0a990: 38 a1 00 10 addi r5,r1,16 ffc0a994: 7f a4 eb 78 mr r4,r29 ffc0a998: 38 c1 00 0c addi r6,r1,12 ffc0a99c: 48 00 64 bd bl ffc10e58 <_POSIX_Thread_Translate_sched_param> policy, param, &budget_algorithm, &budget_callout ); if ( rc ) ffc0a9a0: 7c 7e 1b 79 mr. r30,r3 ffc0a9a4: 40 a2 00 cc bne+ ffc0aa70 return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); ffc0a9a8: 7f 83 e3 78 mr r3,r28 ffc0a9ac: 38 81 00 08 addi r4,r1,8 ffc0a9b0: 48 00 32 15 bl ffc0dbc4 <_Thread_Get> switch ( location ) { ffc0a9b4: 80 01 00 08 lwz r0,8(r1) return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); ffc0a9b8: 7c 7b 1b 78 mr r27,r3 switch ( location ) { ffc0a9bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a9c0: 40 9e 00 ac bne- cr7,ffc0aa6c case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0a9c4: 83 83 01 34 lwz r28,308(r3) if ( api->schedpolicy == SCHED_SPORADIC ) ffc0a9c8: 80 1c 00 84 lwz r0,132(r28) ffc0a9cc: 2f 80 00 04 cmpwi cr7,r0,4 ffc0a9d0: 40 be 00 0c bne+ cr7,ffc0a9dc (void) _Watchdog_Remove( &api->Sporadic_timer ); ffc0a9d4: 38 7c 00 a8 addi r3,r28,168 ffc0a9d8: 48 00 44 79 bl ffc0ee50 <_Watchdog_Remove> api->schedpolicy = policy; api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { ffc0a9dc: 2f 9f 00 00 cmpwi cr7,r31,0 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; ffc0a9e0: 93 fc 00 84 stw r31,132(r28) api->schedparam = *param; ffc0a9e4: 38 9c 00 88 addi r4,r28,136 the_thread->budget_algorithm = budget_algorithm; ffc0a9e8: 80 01 00 10 lwz r0,16(r1) if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; ffc0a9ec: 7c bd e4 aa lswi r5,r29,28 ffc0a9f0: 7c a4 e5 aa stswi r5,r4,28 the_thread->budget_algorithm = budget_algorithm; ffc0a9f4: 90 1b 00 7c stw r0,124(r27) the_thread->budget_callout = budget_callout; ffc0a9f8: 80 01 00 0c lwz r0,12(r1) ffc0a9fc: 90 1b 00 80 stw r0,128(r27) switch ( api->schedpolicy ) { ffc0aa00: 41 9c 00 64 blt- cr7,ffc0aa64 <== NEVER TAKEN ffc0aa04: 2f 9f 00 02 cmpwi cr7,r31,2 ffc0aa08: 40 9d 00 10 ble- cr7,ffc0aa18 ffc0aa0c: 2f 9f 00 04 cmpwi cr7,r31,4 ffc0aa10: 40 be 00 54 bne+ cr7,ffc0aa64 <== NEVER TAKEN ffc0aa14: 48 00 00 34 b ffc0aa48 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0aa18: 3d 20 00 00 lis r9,0 ffc0aa1c: 80 09 28 84 lwz r0,10372(r9) ffc0aa20: 3d 20 00 00 lis r9,0 ffc0aa24: 88 89 27 64 lbz r4,10084(r9) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0aa28: 7f 63 db 78 mr r3,r27 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0aa2c: 90 1b 00 78 stw r0,120(r27) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0aa30: 38 a0 00 01 li r5,1 ffc0aa34: 80 1c 00 88 lwz r0,136(r28) ffc0aa38: 7c 80 20 50 subf r4,r0,r4 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; the_thread->real_priority = ffc0aa3c: 90 9b 00 18 stw r4,24(r27) _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0aa40: 48 00 2c 6d bl ffc0d6ac <_Thread_Change_priority> the_thread, the_thread->real_priority, true ); break; ffc0aa44: 48 00 00 20 b ffc0aa64 case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; ffc0aa48: 80 1c 00 88 lwz r0,136(r28) _Watchdog_Remove( &api->Sporadic_timer ); ffc0aa4c: 38 7c 00 a8 addi r3,r28,168 true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; ffc0aa50: 90 1c 00 a4 stw r0,164(r28) _Watchdog_Remove( &api->Sporadic_timer ); ffc0aa54: 48 00 43 fd bl ffc0ee50 <_Watchdog_Remove> _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); ffc0aa58: 38 60 00 00 li r3,0 ffc0aa5c: 7f 64 db 78 mr r4,r27 ffc0aa60: 4b ff fd c1 bl ffc0a820 <_POSIX_Threads_Sporadic_budget_TSR> break; } _Thread_Enable_dispatch(); ffc0aa64: 48 00 31 25 bl ffc0db88 <_Thread_Enable_dispatch> return 0; ffc0aa68: 48 00 00 08 b ffc0aa70 #endif case OBJECTS_ERROR: break; } return ESRCH; ffc0aa6c: 3b c0 00 03 li r30,3 } ffc0aa70: 39 61 00 30 addi r11,r1,48 ffc0aa74: 7f c3 f3 78 mr r3,r30 ffc0aa78: 4b ff 7e 54 b ffc028cc <_restgpr_27_x> =============================================================================== ffc08020 : /* * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc08020: 7c 08 02 a6 mflr r0 ffc08024: 7c 2b 0b 78 mr r11,r1 ffc08028: 94 21 ff f0 stwu r1,-16(r1) * 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() ) ffc0802c: 3d 20 00 00 lis r9,0 ffc08030: 39 29 31 04 addi r9,r9,12548 /* * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc08034: 90 01 00 14 stw r0,20(r1) ffc08038: 48 00 e6 d1 bl ffc16708 <_savegpr_31> * 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() ) ffc0803c: 80 09 00 08 lwz r0,8(r9) ffc08040: 2f 80 00 00 cmpwi cr7,r0,0 ffc08044: 40 9e 00 5c bne- cr7,ffc080a0 <== NEVER TAKEN return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc08048: 81 29 00 0c lwz r9,12(r9) ffc0804c: 81 69 01 34 lwz r11,308(r9) * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08050: 3d 20 00 00 lis r9,0 ffc08054: 81 49 28 0c lwz r10,10252(r9) ffc08058: 38 0a 00 01 addi r0,r10,1 ffc0805c: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc08060: 80 09 28 0c lwz r0,10252(r9) _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc08064: 80 0b 00 d8 lwz r0,216(r11) */ void pthread_testcancel( void ) { POSIX_API_Control *thread_support; bool cancel = false; ffc08068: 3b e0 00 00 li r31,0 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc0806c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08070: 40 9e 00 14 bne- cr7,ffc08084 <== 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)); ffc08074: 80 0b 00 e0 lwz r0,224(r11) ffc08078: 7c 00 00 34 cntlzw r0,r0 ffc0807c: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc08080: 68 1f 00 01 xori r31,r0,1 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); ffc08084: 48 00 30 4d bl ffc0b0d0 <_Thread_Enable_dispatch> if ( cancel ) ffc08088: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0808c: 41 be 00 14 beq+ cr7,ffc080a0 _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); ffc08090: 3d 20 00 00 lis r9,0 ffc08094: 80 69 31 10 lwz r3,12560(r9) ffc08098: 38 80 ff ff li r4,-1 ffc0809c: 48 00 64 21 bl ffc0e4bc <_POSIX_Thread_Exit> } ffc080a0: 39 61 00 10 addi r11,r1,16 ffc080a4: 48 00 e6 b0 b ffc16754 <_restgpr_31_x> =============================================================================== ffc08cf4 : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc08cf4: 94 21 ff b0 stwu r1,-80(r1) ffc08cf8: 7c 08 02 a6 mflr r0 ffc08cfc: bf 61 00 3c stmw r27,60(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); ffc08d00: 3f e0 00 00 lis r31,0 ffc08d04: 3b ff 2c 70 addi r31,r31,11376 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc08d08: 7c 7d 1b 78 mr r29,r3 ffc08d0c: 90 01 00 54 stw r0,84(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); ffc08d10: 7f e3 fb 78 mr r3,r31 ffc08d14: 48 00 0a 31 bl ffc09744 if (result != 0) { ffc08d18: 7c 7e 1b 79 mr. r30,r3 ffc08d1c: 41 a2 00 10 beq+ ffc08d2c <== ALWAYS TAKEN free (req); ffc08d20: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc08d24: 4b ff c3 e5 bl ffc05108 <== NOT EXECUTED return result; ffc08d28: 48 00 01 cc b ffc08ef4 <== 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); ffc08d2c: 48 00 12 e5 bl ffc0a010 ffc08d30: 38 81 00 08 addi r4,r1,8 ffc08d34: 38 a1 00 10 addi r5,r1,16 ffc08d38: 48 00 0e 85 bl ffc09bbc ffc08d3c: 3b 9f 00 48 addi r28,r31,72 req->caller_thread = pthread_self (); ffc08d40: 48 00 12 d1 bl ffc0a010 req->priority = param.sched_priority - req->aiocbp->aio_reqprio; ffc08d44: 81 3d 00 14 lwz r9,20(r29) ffc08d48: 81 61 00 10 lwz r11,16(r1) ffc08d4c: 80 09 00 18 lwz r0,24(r9) /* _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 (); ffc08d50: 90 7d 00 10 stw r3,16(r29) 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); ffc08d54: 7f 83 e3 78 mr r3,r28 /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; ffc08d58: 7c 00 58 50 subf r0,r0,r11 ffc08d5c: 90 1d 00 0c stw r0,12(r29) req->policy = policy; ffc08d60: 80 01 00 08 lwz r0,8(r1) 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); ffc08d64: 80 89 00 00 lwz r4,0(r9) we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); req->caller_thread = pthread_self (); req->priority = param.sched_priority - req->aiocbp->aio_reqprio; req->policy = policy; ffc08d68: 90 1d 00 08 stw r0,8(r29) req->aiocbp->error_code = EINPROGRESS; ffc08d6c: 38 00 00 77 li r0,119 ffc08d70: 90 09 00 34 stw r0,52(r9) req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && ffc08d74: 80 1f 00 68 lwz r0,104(r31) 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; ffc08d78: 93 c9 00 38 stw r30,56(r9) if ((aio_request_queue.idle_threads == 0) && ffc08d7c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08d80: 40 9e 00 bc bne- cr7,ffc08e3c <== NEVER TAKEN ffc08d84: 80 1f 00 64 lwz r0,100(r31) ffc08d88: 2f 80 00 04 cmpwi cr7,r0,4 ffc08d8c: 41 bd 00 b0 bgt+ cr7,ffc08e3c 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); ffc08d90: 38 a0 00 01 li r5,1 ffc08d94: 4b ff fa c5 bl ffc08858 if (r_chain->new_fd == 1) { ffc08d98: 80 03 00 18 lwz r0,24(r3) 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); ffc08d9c: 7c 7c 1b 78 mr r28,r3 ffc08da0: 3b 63 00 08 addi r27,r3,8 if (r_chain->new_fd == 1) { ffc08da4: 2f 80 00 01 cmpwi cr7,r0,1 ffc08da8: 40 be 00 6c bne+ cr7,ffc08e14 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); ffc08dac: 7f a4 eb 78 mr r4,r29 ffc08db0: 7f 63 db 78 mr r3,r27 ffc08db4: 48 00 25 f9 bl ffc0b3ac <_Chain_Insert> rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; ffc08db8: 93 dc 00 18 stw r30,24(r28) pthread_mutex_init (&r_chain->mutex, NULL); ffc08dbc: 38 80 00 00 li r4,0 ffc08dc0: 38 7c 00 1c addi r3,r28,28 ffc08dc4: 48 00 08 29 bl ffc095ec pthread_cond_init (&r_chain->cond, NULL); ffc08dc8: 38 80 00 00 li r4,0 ffc08dcc: 38 7c 00 20 addi r3,r28,32 ffc08dd0: 48 00 03 d1 bl ffc091a0 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, ffc08dd4: 3c a0 ff c1 lis r5,-63 ffc08dd8: 38 61 00 0c addi r3,r1,12 ffc08ddc: 38 9f 00 08 addi r4,r31,8 ffc08de0: 38 a5 89 74 addi r5,r5,-30348 ffc08de4: 7f 86 e3 78 mr r6,r28 ffc08de8: 48 00 0b a1 bl ffc09988 rtems_aio_handle, (void *) r_chain); if (result != 0) { ffc08dec: 7c 7d 1b 79 mr. r29,r3 ffc08df0: 41 a2 00 14 beq+ ffc08e04 <== ALWAYS TAKEN pthread_mutex_unlock (&aio_request_queue.mutex); ffc08df4: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc08df8: 48 00 09 f1 bl ffc097e8 <== NOT EXECUTED return result; ffc08dfc: 7f be eb 78 mr r30,r29 <== NOT EXECUTED ffc08e00: 48 00 00 f4 b ffc08ef4 <== NOT EXECUTED } ++aio_request_queue.active_threads; ffc08e04: 81 3f 00 64 lwz r9,100(r31) ffc08e08: 38 09 00 01 addi r0,r9,1 ffc08e0c: 90 1f 00 64 stw r0,100(r31) ffc08e10: 48 00 00 d8 b ffc08ee8 } else { /* put request in the fd chain it belongs to */ pthread_mutex_lock (&r_chain->mutex); ffc08e14: 3b e3 00 1c addi r31,r3,28 ffc08e18: 7f e3 fb 78 mr r3,r31 ffc08e1c: 48 00 09 29 bl ffc09744 rtems_aio_insert_prio (&r_chain->perfd, req); ffc08e20: 7f 63 db 78 mr r3,r27 ffc08e24: 7f a4 eb 78 mr r4,r29 ffc08e28: 4b ff fd 8d bl ffc08bb4 pthread_cond_signal (&r_chain->cond); ffc08e2c: 38 7c 00 20 addi r3,r28,32 ffc08e30: 48 00 04 39 bl ffc09268 pthread_mutex_unlock (&r_chain->mutex); ffc08e34: 7f e3 fb 78 mr r3,r31 ffc08e38: 48 00 00 38 b ffc08e70 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, ffc08e3c: 38 a0 00 00 li r5,0 ffc08e40: 4b ff fa 19 bl ffc08858 req->aiocbp->aio_fildes, 0); if (r_chain != NULL) ffc08e44: 7c 7f 1b 79 mr. r31,r3 ffc08e48: 41 82 00 30 beq- ffc08e78 { pthread_mutex_lock (&r_chain->mutex); ffc08e4c: 3b 9f 00 1c addi r28,r31,28 ffc08e50: 7f 83 e3 78 mr r3,r28 ffc08e54: 48 00 08 f1 bl ffc09744 rtems_aio_insert_prio (&r_chain->perfd, req); ffc08e58: 38 7f 00 08 addi r3,r31,8 ffc08e5c: 7f a4 eb 78 mr r4,r29 ffc08e60: 4b ff fd 55 bl ffc08bb4 pthread_cond_signal (&r_chain->cond); ffc08e64: 38 7f 00 20 addi r3,r31,32 ffc08e68: 48 00 04 01 bl ffc09268 pthread_mutex_unlock (&r_chain->mutex); ffc08e6c: 7f 83 e3 78 mr r3,r28 ffc08e70: 48 00 09 79 bl ffc097e8 ffc08e74: 48 00 00 74 b ffc08ee8 } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); ffc08e78: 81 3d 00 14 lwz r9,20(r29) ffc08e7c: 38 7c 00 0c addi r3,r28,12 ffc08e80: 38 a0 00 01 li r5,1 ffc08e84: 80 89 00 00 lwz r4,0(r9) ffc08e88: 4b ff f9 d1 bl ffc08858 ffc08e8c: 7f a4 eb 78 mr r4,r29 if (r_chain->new_fd == 1) { ffc08e90: 80 03 00 18 lwz r0,24(r3) } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); ffc08e94: 7c 7c 1b 78 mr r28,r3 ffc08e98: 38 63 00 08 addi r3,r3,8 if (r_chain->new_fd == 1) { ffc08e9c: 2f 80 00 01 cmpwi cr7,r0,1 ffc08ea0: 40 be 00 28 bne+ cr7,ffc08ec8 ffc08ea4: 48 00 25 09 bl ffc0b3ac <_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; ffc08ea8: 93 fc 00 18 stw r31,24(r28) pthread_mutex_init (&r_chain->mutex, NULL); ffc08eac: 38 7c 00 1c addi r3,r28,28 ffc08eb0: 38 80 00 00 li r4,0 ffc08eb4: 48 00 07 39 bl ffc095ec pthread_cond_init (&r_chain->cond, NULL); ffc08eb8: 38 7c 00 20 addi r3,r28,32 ffc08ebc: 38 80 00 00 li r4,0 ffc08ec0: 48 00 02 e1 bl ffc091a0 ffc08ec4: 48 00 00 08 b ffc08ecc } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); ffc08ec8: 4b ff fc ed bl ffc08bb4 if (aio_request_queue.idle_threads > 0) ffc08ecc: 3c 60 00 00 lis r3,0 ffc08ed0: 38 63 2c 70 addi r3,r3,11376 ffc08ed4: 80 03 00 68 lwz r0,104(r3) ffc08ed8: 2f 80 00 00 cmpwi cr7,r0,0 ffc08edc: 40 9d 00 0c ble- cr7,ffc08ee8 <== ALWAYS TAKEN pthread_cond_signal (&aio_request_queue.new_req); ffc08ee0: 38 63 00 04 addi r3,r3,4 <== NOT EXECUTED ffc08ee4: 48 00 03 85 bl ffc09268 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); ffc08ee8: 3c 60 00 00 lis r3,0 ffc08eec: 38 63 2c 70 addi r3,r3,11376 ffc08ef0: 48 00 08 f9 bl ffc097e8 return 0; } ffc08ef4: 39 61 00 50 addi r11,r1,80 ffc08ef8: 7f c3 f3 78 mr r3,r30 ffc08efc: 4b ff 7b fc b ffc00af8 <_restgpr_27_x> =============================================================================== ffc08974 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc08974: 94 21 ff a0 stwu r1,-96(r1) ffc08978: 7c 08 02 a6 mflr r0 ffc0897c: be e1 00 3c stmw r23,60(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); ffc08980: 3f e0 00 00 lis r31,0 ffc08984: 3b ff 2c 70 addi r31,r31,11376 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc08988: 90 01 00 64 stw r0,100(r1) ffc0898c: 7c 7e 1b 78 mr r30,r3 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)) { ffc08990: 3b 3f 00 58 addi r25,r31,88 --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, ffc08994: 3b 5f 00 04 addi r26,r31,4 default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; ffc08998: 3b 60 ff ff li r27,-1 req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; req->aiocbp->error_code = 0; ffc0899c: 3b 80 00 00 li r28,0 /* 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); ffc089a0: 3b 1e 00 1c addi r24,r30,28 ffc089a4: 7f 03 c3 78 mr r3,r24 ffc089a8: 48 00 0d 9d bl ffc09744 if (result != 0) ffc089ac: 7c 77 1b 79 mr. r23,r3 ffc089b0: 40 82 01 f8 bne- ffc08ba8 <== NEVER TAKEN */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc089b4: 83 be 00 08 lwz r29,8(r30) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc089b8: 38 1e 00 0c addi r0,r30,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)) { ffc089bc: 7f 9d 00 00 cmpw cr7,r29,r0 ffc089c0: 41 9e 00 cc beq- cr7,ffc08a8c 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); ffc089c4: 48 00 16 4d bl ffc0a010 ffc089c8: 38 81 00 08 addi r4,r1,8 ffc089cc: 38 a1 00 14 addi r5,r1,20 ffc089d0: 48 00 11 ed bl ffc09bbc param.sched_priority = req->priority; ffc089d4: 80 1d 00 0c lwz r0,12(r29) ffc089d8: 90 01 00 14 stw r0,20(r1) pthread_setschedparam (pthread_self(), req->policy, ¶m); ffc089dc: 48 00 16 35 bl ffc0a010 ffc089e0: 38 a1 00 14 addi r5,r1,20 ffc089e4: 80 9d 00 08 lwz r4,8(r29) ffc089e8: 48 00 16 39 bl ffc0a020 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc089ec: 7f a3 eb 78 mr r3,r29 ffc089f0: 48 00 29 55 bl ffc0b344 <_Chain_Extract> rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); ffc089f4: 7f 03 c3 78 mr r3,r24 ffc089f8: 48 00 0d f1 bl ffc097e8 switch (req->aiocbp->aio_lio_opcode) { ffc089fc: 81 3d 00 14 lwz r9,20(r29) ffc08a00: 80 09 00 30 lwz r0,48(r9) ffc08a04: 2f 80 00 02 cmpwi cr7,r0,2 ffc08a08: 41 9e 00 30 beq- cr7,ffc08a38 ffc08a0c: 2f 80 00 03 cmpwi cr7,r0,3 ffc08a10: 41 9e 00 44 beq- cr7,ffc08a54 <== NEVER TAKEN ffc08a14: 2f 80 00 01 cmpwi cr7,r0,1 ffc08a18: 40 be 00 4c bne+ cr7,ffc08a64 <== NEVER TAKEN case LIO_READ: AIO_printf ("read\n"); result = pread (req->aiocbp->aio_fildes, ffc08a1c: 80 69 00 00 lwz r3,0(r9) ffc08a20: 80 89 00 10 lwz r4,16(r9) ffc08a24: 80 a9 00 14 lwz r5,20(r9) ffc08a28: 80 e9 00 08 lwz r7,8(r9) ffc08a2c: 81 09 00 0c lwz r8,12(r9) ffc08a30: 48 00 b8 41 bl ffc14270 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; ffc08a34: 48 00 00 28 b ffc08a5c case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, ffc08a38: 80 69 00 00 lwz r3,0(r9) ffc08a3c: 80 89 00 10 lwz r4,16(r9) ffc08a40: 80 a9 00 14 lwz r5,20(r9) ffc08a44: 80 e9 00 08 lwz r7,8(r9) ffc08a48: 81 09 00 0c lwz r8,12(r9) ffc08a4c: 48 00 b9 61 bl ffc143ac (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; ffc08a50: 48 00 00 0c b ffc08a5c case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); ffc08a54: 80 69 00 00 lwz r3,0(r9) <== NOT EXECUTED ffc08a58: 48 00 72 95 bl ffc0fcec <== NOT EXECUTED break; default: result = -1; } if (result == -1) { ffc08a5c: 2f 83 ff ff cmpwi cr7,r3,-1 ffc08a60: 40 be 00 1c bne+ cr7,ffc08a7c <== ALWAYS TAKEN req->aiocbp->return_value = -1; ffc08a64: 83 bd 00 14 lwz r29,20(r29) <== NOT EXECUTED ffc08a68: 93 7d 00 38 stw r27,56(r29) <== NOT EXECUTED req->aiocbp->error_code = errno; ffc08a6c: 48 00 a8 d1 bl ffc1333c <__errno> <== NOT EXECUTED ffc08a70: 80 03 00 00 lwz r0,0(r3) <== NOT EXECUTED ffc08a74: 90 1d 00 34 stw r0,52(r29) <== NOT EXECUTED ffc08a78: 4b ff ff 28 b ffc089a0 <== NOT EXECUTED } else { req->aiocbp->return_value = result; ffc08a7c: 81 3d 00 14 lwz r9,20(r29) ffc08a80: 90 69 00 38 stw r3,56(r9) req->aiocbp->error_code = 0; ffc08a84: 93 89 00 34 stw r28,52(r9) ffc08a88: 4b ff ff 18 b ffc089a0 struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); ffc08a8c: 7f 03 c3 78 mr r3,r24 ffc08a90: 48 00 0d 59 bl ffc097e8 pthread_mutex_lock (&aio_request_queue.mutex); ffc08a94: 7f e3 fb 78 mr r3,r31 ffc08a98: 48 00 0c ad bl ffc09744 if (rtems_chain_is_empty (chain)) ffc08a9c: 80 1e 00 08 lwz r0,8(r30) ffc08aa0: 7f 80 e8 00 cmpw cr7,r0,r29 ffc08aa4: 40 be 00 f8 bne+ cr7,ffc08b9c <== NEVER TAKEN { clock_gettime (CLOCK_REALTIME, &timeout); ffc08aa8: 38 81 00 0c addi r4,r1,12 ffc08aac: 38 60 00 01 li r3,1 ffc08ab0: 48 00 05 91 bl ffc09040 timeout.tv_sec += 3; ffc08ab4: 81 21 00 0c lwz r9,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc08ab8: 3b be 00 20 addi r29,r30,32 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; ffc08abc: 92 e1 00 10 stw r23,16(r1) pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; ffc08ac0: 38 09 00 03 addi r0,r9,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc08ac4: 7f a3 eb 78 mr r3,r29 pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; ffc08ac8: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc08acc: 7f e4 fb 78 mr r4,r31 ffc08ad0: 38 a1 00 0c addi r5,r1,12 ffc08ad4: 48 00 08 2d bl ffc09300 &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) { ffc08ad8: 2f 83 00 74 cmpwi cr7,r3,116 ffc08adc: 40 be 00 c0 bne+ cr7,ffc08b9c <== NEVER TAKEN ffc08ae0: 7f c3 f3 78 mr r3,r30 ffc08ae4: 48 00 28 61 bl ffc0b344 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); ffc08ae8: 7f 03 c3 78 mr r3,r24 ffc08aec: 48 00 09 95 bl ffc09480 pthread_cond_destroy (&r_chain->cond); ffc08af0: 7f a3 eb 78 mr r3,r29 ffc08af4: 48 00 05 c5 bl ffc090b8 free (r_chain); ffc08af8: 7f c3 f3 78 mr r3,r30 ffc08afc: 4b ff c6 0d bl ffc05108 /* 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)) { ffc08b00: 80 1f 00 54 lwz r0,84(r31) ffc08b04: 7f 80 c8 00 cmpw cr7,r0,r25 ffc08b08: 40 be 00 68 bne+ cr7,ffc08b70 AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; ffc08b0c: 81 3f 00 68 lwz r9,104(r31) --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); ffc08b10: 38 81 00 0c addi r4,r1,12 ffc08b14: 38 60 00 01 li r3,1 /* 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; ffc08b18: 38 09 00 01 addi r0,r9,1 --aio_request_queue.active_threads; ffc08b1c: 81 3f 00 64 lwz r9,100(r31) /* 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; ffc08b20: 90 1f 00 68 stw r0,104(r31) --aio_request_queue.active_threads; ffc08b24: 38 09 ff ff addi r0,r9,-1 ffc08b28: 90 1f 00 64 stw r0,100(r31) clock_gettime (CLOCK_REALTIME, &timeout); ffc08b2c: 48 00 05 15 bl ffc09040 timeout.tv_sec += 3; ffc08b30: 81 21 00 0c lwz r9,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc08b34: 7f 43 d3 78 mr r3,r26 ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; ffc08b38: 92 e1 00 10 stw r23,16(r1) 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; ffc08b3c: 38 09 00 03 addi r0,r9,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc08b40: 7f e4 fb 78 mr r4,r31 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; ffc08b44: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc08b48: 38 a1 00 0c addi r5,r1,12 ffc08b4c: 48 00 07 b5 bl ffc09300 &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { ffc08b50: 2f 83 00 74 cmpwi cr7,r3,116 ffc08b54: 40 be 00 1c bne+ cr7,ffc08b70 <== NEVER TAKEN AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; ffc08b58: 81 3f 00 68 lwz r9,104(r31) pthread_mutex_unlock (&aio_request_queue.mutex); ffc08b5c: 7f e3 fb 78 mr r3,r31 /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { AIO_printf ("Etimeout\n"); --aio_request_queue.idle_threads; ffc08b60: 38 09 ff ff addi r0,r9,-1 ffc08b64: 90 1f 00 68 stw r0,104(r31) pthread_mutex_unlock (&aio_request_queue.mutex); ffc08b68: 48 00 0c 81 bl ffc097e8 return NULL; ffc08b6c: 48 00 00 3c b ffc08ba8 } } /* 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; ffc08b70: 81 3f 00 68 lwz r9,104(r31) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc08b74: 83 df 00 54 lwz r30,84(r31) ffc08b78: 38 09 ff ff addi r0,r9,-1 ++aio_request_queue.active_threads; ffc08b7c: 81 3f 00 64 lwz r9,100(r31) } } /* 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; ffc08b80: 90 1f 00 68 stw r0,104(r31) ffc08b84: 7f c3 f3 78 mr r3,r30 ++aio_request_queue.active_threads; ffc08b88: 38 09 00 01 addi r0,r9,1 ffc08b8c: 90 1f 00 64 stw r0,100(r31) ffc08b90: 48 00 27 b5 bl ffc0b344 <_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); ffc08b94: 7f c3 f3 78 mr r3,r30 ffc08b98: 4b ff fd 85 bl ffc0891c } } /* 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); ffc08b9c: 7f e3 fb 78 mr r3,r31 ffc08ba0: 48 00 0c 49 bl ffc097e8 ffc08ba4: 4b ff fd fc b ffc089a0 } } AIO_printf ("Thread finished\n"); return NULL; } ffc08ba8: 39 61 00 60 addi r11,r1,96 ffc08bac: 38 60 00 00 li r3,0 ffc08bb0: 4b ff 7f 38 b ffc00ae8 <_restgpr_23_x> =============================================================================== ffc08774 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc08774: 94 21 ff f0 stwu r1,-16(r1) ffc08778: 7c 08 02 a6 mflr r0 ffc0877c: bf c1 00 08 stmw r30,8(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc08780: 3f e0 00 00 lis r31,0 ffc08784: 3b ff 2c 78 addi r31,r31,11384 ffc08788: 7f e3 fb 78 mr r3,r31 * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc0878c: 90 01 00 14 stw r0,20(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc08790: 48 00 11 89 bl ffc09918 if (result != 0) ffc08794: 7c 7e 1b 79 mr. r30,r3 ffc08798: 40 a2 00 b4 bne+ ffc0884c <== NEVER TAKEN return result; result = ffc0879c: 7f e3 fb 78 mr r3,r31 ffc087a0: 38 80 00 00 li r4,0 ffc087a4: 48 00 11 b5 bl ffc09958 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) ffc087a8: 2f 83 00 00 cmpwi cr7,r3,0 ffc087ac: 41 be 00 0c beq+ cr7,ffc087b8 <== ALWAYS TAKEN pthread_attr_destroy (&aio_request_queue.attr); ffc087b0: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc087b4: 48 00 11 3d bl ffc098f0 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc087b8: 3f e0 00 00 lis r31,0 ffc087bc: 3b ff 2c 70 addi r31,r31,11376 ffc087c0: 7f e3 fb 78 mr r3,r31 ffc087c4: 38 80 00 00 li r4,0 ffc087c8: 48 00 0e 25 bl ffc095ec if (result != 0) ffc087cc: 2f 83 00 00 cmpwi cr7,r3,0 ffc087d0: 41 be 00 0c beq+ cr7,ffc087dc <== ALWAYS TAKEN pthread_attr_destroy (&aio_request_queue.attr); ffc087d4: 38 7f 00 08 addi r3,r31,8 <== NOT EXECUTED ffc087d8: 48 00 11 19 bl ffc098f0 <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); ffc087dc: 3f e0 00 00 lis r31,0 ffc087e0: 3b ff 2c 74 addi r31,r31,11380 ffc087e4: 7f e3 fb 78 mr r3,r31 ffc087e8: 38 80 00 00 li r4,0 ffc087ec: 48 00 09 b5 bl ffc091a0 if (result != 0) { ffc087f0: 7c 7e 1b 79 mr. r30,r3 ffc087f4: 41 a2 00 14 beq+ ffc08808 <== ALWAYS TAKEN pthread_mutex_destroy (&aio_request_queue.mutex); ffc087f8: 38 7f ff fc addi r3,r31,-4 <== NOT EXECUTED ffc087fc: 48 00 0c 85 bl ffc09480 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); ffc08800: 38 7f 00 04 addi r3,r31,4 <== NOT EXECUTED ffc08804: 48 00 10 ed bl ffc098f0 <== NOT EXECUTED ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc08808: 3d 20 00 00 lis r9,0 ffc0880c: 39 29 2c 70 addi r9,r9,11376 ffc08810: 38 09 00 4c addi r0,r9,76 head->previous = NULL; tail->previous = head; ffc08814: 39 69 00 48 addi r11,r9,72 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc08818: 90 09 00 48 stw r0,72(r9) head->previous = NULL; ffc0881c: 38 00 00 00 li r0,0 tail->previous = head; ffc08820: 91 69 00 50 stw r11,80(r9) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc08824: 39 69 00 58 addi r11,r9,88 head->previous = NULL; ffc08828: 90 09 00 4c stw r0,76(r9) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0882c: 91 69 00 54 stw r11,84(r9) head->previous = NULL; tail->previous = head; ffc08830: 39 69 00 54 addi r11,r9,84 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; ffc08834: 90 09 00 58 stw r0,88(r9) } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; ffc08838: 90 09 00 64 stw r0,100(r9) aio_request_queue.idle_threads = 0; ffc0883c: 90 09 00 68 stw r0,104(r9) aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; ffc08840: 60 00 b0 0b ori r0,r0,45067 tail->previous = head; ffc08844: 91 69 00 5c stw r11,92(r9) ffc08848: 90 09 00 60 stw r0,96(r9) return result; } ffc0884c: 39 61 00 10 addi r11,r1,16 ffc08850: 7f c3 f3 78 mr r3,r30 ffc08854: 4b ff 82 b0 b ffc00b04 <_restgpr_30_x> =============================================================================== ffc08bb4 : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { ffc08bb4: 7c 08 02 a6 mflr r0 ffc08bb8: 94 21 ff f8 stwu r1,-8(r1) ffc08bbc: 7c 8b 23 78 mr r11,r4 ffc08bc0: 90 01 00 0c stw r0,12(r1) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc08bc4: 38 03 00 04 addi r0,r3,4 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc08bc8: 81 23 00 00 lwz r9,0(r3) rtems_chain_node *node; AIO_printf ("FD exists \n"); node = rtems_chain_first (chain); if (rtems_chain_is_empty (chain)) { ffc08bcc: 7f 89 00 00 cmpw cr7,r9,r0 ffc08bd0: 41 9e 00 3c beq- cr7,ffc08c0c <== 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; ffc08bd4: 81 49 00 14 lwz r10,20(r9) while (req->aiocbp->aio_reqprio > prio && ffc08bd8: 81 04 00 14 lwz r8,20(r4) 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; ffc08bdc: 81 4a 00 18 lwz r10,24(r10) while (req->aiocbp->aio_reqprio > prio && ffc08be0: 81 08 00 18 lwz r8,24(r8) ffc08be4: 48 00 00 10 b ffc08bf4 } } AIO_printf ("Thread finished\n"); return NULL; } ffc08be8: 81 29 00 00 lwz r9,0(r9) <== NOT EXECUTED int prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; while (req->aiocbp->aio_reqprio > prio && !rtems_chain_is_tail (chain, node)) { node = rtems_chain_next (node); prio = ((rtems_aio_request *) node)->aiocbp->aio_reqprio; ffc08bec: 81 49 00 14 lwz r10,20(r9) <== NOT EXECUTED ffc08bf0: 81 4a 00 18 lwz r10,24(r10) <== 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 && ffc08bf4: 7f 88 50 00 cmpw cr7,r8,r10 ffc08bf8: 40 9d 00 0c ble- cr7,ffc08c04 <== ALWAYS TAKEN ffc08bfc: 7f 89 00 00 cmpw cr7,r9,r0 <== NOT EXECUTED ffc08c00: 40 9e ff e8 bne+ cr7,ffc08be8 <== NOT EXECUTED RTEMS_INLINE_ROUTINE void rtems_chain_insert( rtems_chain_node *after_node, rtems_chain_node *the_node ) { _Chain_Insert( after_node, the_node ); ffc08c04: 80 69 00 04 lwz r3,4(r9) ffc08c08: 7d 64 5b 78 mr r4,r11 ffc08c0c: 48 00 27 a1 bl ffc0b3ac <_Chain_Insert> } rtems_chain_insert (node->previous, &req->next_prio); } } ffc08c10: 80 01 00 0c lwz r0,12(r1) ffc08c14: 38 21 00 08 addi r1,r1,8 ffc08c18: 7c 08 03 a6 mtlr r0 ffc08c1c: 4e 80 00 20 blr =============================================================================== ffc0891c : * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc0891c: 7c 08 02 a6 mflr r0 ffc08920: 94 21 ff f8 stwu r1,-8(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc08924: 3d 60 00 00 lis r11,0 ffc08928: 90 01 00 0c stw r0,12(r1) ffc0892c: 39 6b 2c 70 addi r11,r11,11376 ffc08930: 7c 64 1b 78 mr r4,r3 rtems_aio_request_chain *temp; rtems_chain_node *node; node = rtems_chain_first (&aio_request_queue.work_req); temp = (rtems_aio_request_chain *) node; ffc08934: 81 2b 00 48 lwz r9,72(r11) while (temp->fildes < r_chain->fildes && ffc08938: 39 6b 00 4c addi r11,r11,76 ffc0893c: 80 03 00 14 lwz r0,20(r3) ffc08940: 48 00 00 08 b ffc08948 } } AIO_printf ("Thread finished\n"); return NULL; } ffc08944: 81 29 00 00 lwz r9,0(r9) 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 && ffc08948: 81 49 00 14 lwz r10,20(r9) ffc0894c: 7f 8a 00 00 cmpw cr7,r10,r0 ffc08950: 40 9c 00 0c bge- cr7,ffc0895c ffc08954: 7f 89 58 00 cmpw cr7,r9,r11 ffc08958: 40 9e ff ec bne+ cr7,ffc08944 <== ALWAYS TAKEN ffc0895c: 80 69 00 04 lwz r3,4(r9) ffc08960: 48 00 2a 4d bl ffc0b3ac <_Chain_Insert> node = rtems_chain_next (node); temp = (rtems_aio_request_chain *) node; } rtems_chain_insert (rtems_chain_previous (node), &r_chain->next_fd); } ffc08964: 80 01 00 0c lwz r0,12(r1) ffc08968: 38 21 00 08 addi r1,r1,8 ffc0896c: 7c 08 03 a6 mtlr r0 ffc08970: 4e 80 00 20 blr =============================================================================== ffc08c78 : * 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) { ffc08c78: 7c 08 02 a6 mflr r0 ffc08c7c: 7c 2b 0b 78 mr r11,r1 ffc08c80: 94 21 ff f0 stwu r1,-16(r1) ffc08c84: 90 01 00 14 stw r0,20(r1) ffc08c88: 4b ff 7e 35 bl ffc00abc <_savegpr_31> RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc08c8c: 38 03 00 04 addi r0,r3,4 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc08c90: 83 e3 00 00 lwz r31,0(r3) if (rtems_chain_is_empty (chain)) return AIO_ALLDONE; ffc08c94: 38 60 00 02 li r3,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)) ffc08c98: 7f 9f 00 00 cmpw cr7,r31,r0 ffc08c9c: 40 be 00 0c bne+ cr7,ffc08ca8 ffc08ca0: 48 00 00 4c b ffc08cec } } AIO_printf ("Thread finished\n"); return NULL; } ffc08ca4: 83 ff 00 00 lwz r31,0(r31) <== 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) { ffc08ca8: 7f 9f 00 00 cmpw cr7,r31,r0 ffc08cac: 41 9e 00 3c beq- cr7,ffc08ce8 <== NEVER TAKEN ffc08cb0: 81 3f 00 14 lwz r9,20(r31) ffc08cb4: 7f 89 20 00 cmpw cr7,r9,r4 ffc08cb8: 40 9e ff ec bne+ cr7,ffc08ca4 <== NEVER TAKEN ffc08cbc: 7f e3 fb 78 mr r3,r31 ffc08cc0: 48 00 26 85 bl ffc0b344 <_Chain_Extract> if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; ffc08cc4: 81 3f 00 14 lwz r9,20(r31) ffc08cc8: 38 00 00 8c li r0,140 ffc08ccc: 90 09 00 34 stw r0,52(r9) current->aiocbp->return_value = -1; ffc08cd0: 38 00 ff ff li r0,-1 free (current); ffc08cd4: 7f e3 fb 78 mr r3,r31 return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; current->aiocbp->return_value = -1; ffc08cd8: 90 09 00 38 stw r0,56(r9) free (current); ffc08cdc: 4b ff c4 2d bl ffc05108 } return AIO_CANCELED; ffc08ce0: 38 60 00 00 li r3,0 ffc08ce4: 48 00 00 08 b ffc08cec node = rtems_chain_next (node); current = (rtems_aio_request *) node; } if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; ffc08ce8: 38 60 00 01 li r3,1 <== NOT EXECUTED current->aiocbp->return_value = -1; free (current); } return AIO_CANCELED; } ffc08cec: 39 61 00 10 addi r11,r1,16 ffc08cf0: 4b ff 7e 18 b ffc00b08 <_restgpr_31_x> =============================================================================== ffc0897c : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { ffc0897c: 94 21 ff d0 stwu r1,-48(r1) ffc08980: 7c 08 02 a6 mflr r0 ffc08984: bf 61 00 1c stmw r27,28(r1) ffc08988: 7c 7b 1b 78 mr r27,r3 ffc0898c: 7c 9c 23 78 mr r28,r4 ffc08990: 90 01 00 34 stw r0,52(r1) ffc08994: 7c bd 2b 78 mr r29,r5 ffc08998: 7c df 33 78 mr r31,r6 ffc0899c: 48 00 00 20 b ffc089bc while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( ffc089a0: 7f 83 e3 78 mr r3,r28 ffc089a4: 38 80 00 00 li r4,0 ffc089a8: 7f a5 eb 78 mr r5,r29 ffc089ac: 38 c1 00 08 addi r6,r1,8 ffc089b0: 4b ff f2 bd bl ffc07c6c ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( ffc089b4: 2c 03 00 00 cmpwi r3,0 ffc089b8: 40 82 00 18 bne- ffc089d0 <== ALWAYS TAKEN */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); ffc089bc: 7f 63 db 78 mr r3,r27 ffc089c0: 48 00 06 85 bl ffc09044 <_Chain_Get> sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ffc089c4: 7c 7e 1b 79 mr. r30,r3 ffc089c8: 41 82 ff d8 beq+ ffc089a0 ffc089cc: 38 60 00 00 li r3,0 } *node_ptr = node; return sc; } ffc089d0: 39 61 00 30 addi r11,r1,48 timeout, &out ); } *node_ptr = node; ffc089d4: 93 df 00 00 stw r30,0(r31) return sc; } ffc089d8: 48 00 d3 e0 b ffc15db8 <_restgpr_27_x> =============================================================================== ffc0ae48 : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { ffc0ae48: 94 21 ff e0 stwu r1,-32(r1) ffc0ae4c: 7c 08 02 a6 mflr r0 ffc0ae50: bf 61 00 0c stmw r27,12(r1) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0ae54: 7c 7b 1b 79 mr. r27,r3 #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { ffc0ae58: 90 01 00 24 stw r0,36(r1) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0ae5c: 41 82 00 5c beq- ffc0aeb8 <== NEVER TAKEN ffc0ae60: 3f e0 00 00 lis r31,0 ffc0ae64: 3b ff 30 80 addi r31,r31,12416 #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) ffc0ae68: 3b 9f 00 0c addi r28,r31,12 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; ffc0ae6c: 85 3f 00 04 lwzu r9,4(r31) if ( !information ) ffc0ae70: 3b c0 00 01 li r30,1 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; ffc0ae74: 83 a9 00 04 lwz r29,4(r9) if ( !information ) ffc0ae78: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0ae7c: 40 be 00 28 bne+ cr7,ffc0aea4 ffc0ae80: 48 00 00 30 b ffc0aeb0 continue; for ( i=1 ; i <= information->maximum ; i++ ) { the_thread = (Thread_Control *)information->local_table[ i ]; ffc0ae84: 81 3d 00 1c lwz r9,28(r29) ffc0ae88: 57 c0 10 3a rlwinm r0,r30,2,0,29 ffc0ae8c: 7c 69 00 2e lwzx r3,r9,r0 if ( !the_thread ) ffc0ae90: 2f 83 00 00 cmpwi cr7,r3,0 ffc0ae94: 41 9e 00 0c beq- cr7,ffc0aea0 continue; (*routine)(the_thread); ffc0ae98: 7f 69 03 a6 mtctr r27 ffc0ae9c: 4e 80 04 21 bctrl information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { ffc0aea0: 3b de 00 01 addi r30,r30,1 ffc0aea4: a0 1d 00 10 lhz r0,16(r29) ffc0aea8: 7f 9e 00 40 cmplw cr7,r30,r0 ffc0aeac: 40 9d ff d8 ble+ cr7,ffc0ae84 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { ffc0aeb0: 7f 9f e0 00 cmpw cr7,r31,r28 ffc0aeb4: 40 9e ff b8 bne+ cr7,ffc0ae6c (*routine)(the_thread); } } } ffc0aeb8: 39 61 00 20 addi r11,r1,32 ffc0aebc: 4b ff 64 80 b ffc0133c <_restgpr_27_x> =============================================================================== ffc16528 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc16528: 94 21 ff d0 stwu r1,-48(r1) ffc1652c: 7c 08 02 a6 mflr r0 ffc16530: bf 21 00 14 stmw r25,20(r1) register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc16534: 7c 7b 1b 79 mr. r27,r3 uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc16538: 7c bf 2b 78 mr r31,r5 ffc1653c: 90 01 00 34 stw r0,52(r1) ffc16540: 7c fa 3b 78 mr r26,r7 ffc16544: 7d 1d 43 78 mr r29,r8 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; ffc16548: 38 00 00 03 li r0,3 rtems_id *id ) { register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc1654c: 41 a2 00 d0 beq+ ffc1661c return RTEMS_INVALID_NAME; if ( !starting_address ) ffc16550: 2f 84 00 00 cmpwi cr7,r4,0 return RTEMS_INVALID_ADDRESS; ffc16554: 38 00 00 09 li r0,9 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !starting_address ) ffc16558: 41 9e 00 c4 beq- cr7,ffc1661c return RTEMS_INVALID_ADDRESS; if ( !id ) ffc1655c: 2f 88 00 00 cmpwi cr7,r8,0 ffc16560: 41 9e 00 bc beq- cr7,ffc1661c <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || ffc16564: 2f 85 00 00 cmpwi cr7,r5,0 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; ffc16568: 38 00 00 08 li r0,8 return RTEMS_INVALID_ADDRESS; if ( !id ) return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || ffc1656c: 41 be 00 b0 beq+ cr7,ffc1661c ffc16570: 2f 86 00 00 cmpwi cr7,r6,0 ffc16574: 41 be 00 a8 beq+ cr7,ffc1661c ffc16578: 7f 85 30 40 cmplw cr7,r5,r6 ffc1657c: 41 bc 00 a0 blt+ cr7,ffc1661c ffc16580: 70 c9 00 07 andi. r9,r6,7 ffc16584: 40 a2 00 98 bne+ ffc1661c !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) ffc16588: 70 99 00 07 andi. r25,r4,7 return RTEMS_INVALID_ADDRESS; ffc1658c: 38 00 00 09 li r0,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 ) ) ffc16590: 40 a2 00 8c bne+ ffc1661c * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc16594: 3d 20 00 00 lis r9,0 ffc16598: 81 69 28 e0 lwz r11,10464(r9) ffc1659c: 38 0b 00 01 addi r0,r11,1 ffc165a0: 90 09 28 e0 stw r0,10464(r9) return _Thread_Dispatch_disable_level; ffc165a4: 80 09 28 e0 lwz r0,10464(r9) * 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 ); ffc165a8: 3f 80 00 00 lis r28,0 ffc165ac: 90 81 00 08 stw r4,8(r1) ffc165b0: 3b 9c 6f 20 addi r28,r28,28448 ffc165b4: 7f 83 e3 78 mr r3,r28 ffc165b8: 90 c1 00 0c stw r6,12(r1) ffc165bc: 48 00 4f 3d bl ffc1b4f8 <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { ffc165c0: 7c 7e 1b 79 mr. r30,r3 ffc165c4: 80 81 00 08 lwz r4,8(r1) ffc165c8: 80 c1 00 0c lwz r6,12(r1) ffc165cc: 40 a2 00 10 bne+ ffc165dc _Thread_Enable_dispatch(); ffc165d0: 48 00 63 55 bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; ffc165d4: 38 00 00 05 li r0,5 ffc165d8: 48 00 00 44 b ffc1661c 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, ffc165dc: 7c bf 33 96 divwu r5,r31,r6 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; ffc165e0: 90 9e 00 10 stw r4,16(r30) the_partition->length = length; the_partition->buffer_size = buffer_size; ffc165e4: 90 de 00 18 stw r6,24(r30) return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; the_partition->length = length; ffc165e8: 93 fe 00 14 stw r31,20(r30) the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; ffc165ec: 93 5e 00 1c stw r26,28(r30) the_partition->number_of_used_blocks = 0; ffc165f0: 93 3e 00 20 stw r25,32(r30) _Chain_Initialize( &the_partition->Memory, starting_address, ffc165f4: 38 7e 00 24 addi r3,r30,36 ffc165f8: 48 00 35 c1 bl ffc19bb8 <_Chain_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc165fc: 80 1e 00 08 lwz r0,8(r30) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc16600: 81 7c 00 1c lwz r11,28(r28) ffc16604: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc16608: 7f cb 49 2e stwx r30,r11,r9 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc1660c: 93 7e 00 0c stw r27,12(r30) &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; ffc16610: 90 1d 00 00 stw r0,0(r29) name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); ffc16614: 48 00 63 11 bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc16618: 38 00 00 00 li r0,0 } ffc1661c: 39 61 00 30 addi r11,r1,48 ffc16620: 7c 03 03 78 mr r3,r0 ffc16624: 4b ff 7b 64 b ffc0e188 <_restgpr_25_x> =============================================================================== ffc16774 : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { ffc16774: 94 21 ff e0 stwu r1,-32(r1) ffc16778: 7c 08 02 a6 mflr r0 ffc1677c: 90 01 00 24 stw r0,36(r1) ffc16780: 7c 60 1b 78 mr r0,r3 RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get ( Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) ffc16784: 3c 60 00 00 lis r3,0 ffc16788: bf c1 00 18 stmw r30,24(r1) ffc1678c: 38 63 6f 20 addi r3,r3,28448 ffc16790: 7c 9f 23 78 mr r31,r4 ffc16794: 38 a1 00 08 addi r5,r1,8 ffc16798: 7c 04 03 78 mr r4,r0 ffc1679c: 48 00 52 bd bl ffc1ba58 <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc167a0: 80 01 00 08 lwz r0,8(r1) ffc167a4: 7c 7e 1b 78 mr r30,r3 ffc167a8: 2f 80 00 00 cmpwi cr7,r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc167ac: 38 60 00 04 li r3,4 { register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc167b0: 40 9e 00 58 bne- cr7,ffc16808 ) { void *starting; void *ending; starting = the_partition->starting_address; ffc167b4: 80 1e 00 10 lwz r0,16(r30) ending = _Addresses_Add_offset( starting, the_partition->length ); ffc167b8: 81 3e 00 14 lwz r9,20(r30) const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc167bc: 7f 9f 00 40 cmplw cr7,r31,r0 ffc167c0: 41 9c 00 50 blt- cr7,ffc16810 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); ffc167c4: 7d 20 4a 14 add r9,r0,r9 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc167c8: 7f 9f 48 40 cmplw cr7,r31,r9 ffc167cc: 41 9d 00 44 bgt- cr7,ffc16810 <== NEVER TAKEN offset = (uint32_t) _Addresses_Subtract( the_buffer, the_partition->starting_address ); return ((offset % the_partition->buffer_size) == 0); ffc167d0: 81 3e 00 18 lwz r9,24(r30) RTEMS_INLINE_ROUTINE int32_t _Addresses_Subtract ( const void *left, const void *right ) { return (int32_t) ((const char *) left - (const char *) right); ffc167d4: 7c 00 f8 50 subf r0,r0,r31 ffc167d8: 7d 60 4b 96 divwu r11,r0,r9 ffc167dc: 7d 2b 49 d6 mullw r9,r11,r9 starting = the_partition->starting_address; ending = _Addresses_Add_offset( starting, the_partition->length ); return ( _Addresses_Is_in_range( the_buffer, starting, ending ) && ffc167e0: 7f 80 48 00 cmpw cr7,r0,r9 ffc167e4: 40 9e 00 2c bne- cr7,ffc16810 RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); ffc167e8: 38 7e 00 24 addi r3,r30,36 ffc167ec: 7f e4 fb 78 mr r4,r31 ffc167f0: 48 00 33 31 bl ffc19b20 <_Chain_Append> case OBJECTS_LOCAL: if ( _Partition_Is_buffer_valid( buffer, the_partition ) ) { _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; ffc167f4: 81 3e 00 20 lwz r9,32(r30) ffc167f8: 38 09 ff ff addi r0,r9,-1 ffc167fc: 90 1e 00 20 stw r0,32(r30) _Thread_Enable_dispatch(); ffc16800: 48 00 61 25 bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc16804: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc16808: 39 61 00 20 addi r11,r1,32 ffc1680c: 4b ff 79 90 b ffc0e19c <_restgpr_30_x> _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); ffc16810: 48 00 61 15 bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; ffc16814: 38 60 00 09 li r3,9 ffc16818: 4b ff ff f0 b ffc16808 =============================================================================== ffc08e6c : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { ffc08e6c: 94 21 ff d8 stwu r1,-40(r1) ffc08e70: 7c 08 02 a6 mflr r0 ffc08e74: bf 81 00 18 stmw r28,24(r1) ffc08e78: 7c 7e 1b 78 mr r30,r3 RTEMS_INLINE_ROUTINE Rate_monotonic_Control *_Rate_monotonic_Get ( Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) ffc08e7c: 3c 60 00 00 lis r3,0 ffc08e80: 7c 9f 23 78 mr r31,r4 ffc08e84: 90 01 00 2c stw r0,44(r1) ffc08e88: 38 63 2c 98 addi r3,r3,11416 ffc08e8c: 7f c4 f3 78 mr r4,r30 ffc08e90: 38 a1 00 08 addi r5,r1,8 ffc08e94: 48 00 26 6d bl ffc0b500 <_Objects_Get> rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { ffc08e98: 80 01 00 08 lwz r0,8(r1) ffc08e9c: 7c 7d 1b 78 mr r29,r3 ffc08ea0: 2f 80 00 00 cmpwi cr7,r0,0 ffc08ea4: 40 9e 01 88 bne- cr7,ffc0902c case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { ffc08ea8: 3d 60 00 00 lis r11,0 ffc08eac: 81 23 00 40 lwz r9,64(r3) ffc08eb0: 80 0b 32 50 lwz r0,12880(r11) ffc08eb4: 7f 89 00 00 cmpw cr7,r9,r0 ffc08eb8: 41 9e 00 10 beq- cr7,ffc08ec8 _Thread_Enable_dispatch(); ffc08ebc: 48 00 35 11 bl ffc0c3cc <_Thread_Enable_dispatch> return RTEMS_NOT_OWNER_OF_RESOURCE; ffc08ec0: 3b c0 00 17 li r30,23 ffc08ec4: 48 00 01 6c b ffc09030 } if ( length == RTEMS_PERIOD_STATUS ) { ffc08ec8: 2f 9f 00 00 cmpwi cr7,r31,0 ffc08ecc: 40 9e 00 28 bne- cr7,ffc08ef4 switch ( the_period->state ) { ffc08ed0: 80 03 00 38 lwz r0,56(r3) ffc08ed4: 3b c0 00 00 li r30,0 ffc08ed8: 2b 80 00 04 cmplwi cr7,r0,4 ffc08edc: 41 9d 00 10 bgt- cr7,ffc08eec <== NEVER TAKEN case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc08ee0: 3d 20 ff c2 lis r9,-62 ffc08ee4: 39 29 f4 90 addi r9,r9,-2928 ffc08ee8: 7f c9 00 ae lbzx r30,r9,r0 case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); ffc08eec: 48 00 34 e1 bl ffc0c3cc <_Thread_Enable_dispatch> return( return_value ); ffc08ef0: 48 00 01 40 b ffc09030 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc08ef4: 7f 80 00 a6 mfmsr r28 ffc08ef8: 7c 10 42 a6 mfsprg r0,0 ffc08efc: 7f 80 00 78 andc r0,r28,r0 ffc08f00: 7c 00 01 24 mtmsr r0 } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { ffc08f04: 80 03 00 38 lwz r0,56(r3) ffc08f08: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f0c: 40 be 00 4c bne+ cr7,ffc08f58 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc08f10: 7f 80 01 24 mtmsr r28 _ISR_Enable( level ); the_period->next_length = length; ffc08f14: 93 e3 00 3c stw r31,60(r3) /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); ffc08f18: 4b ff fd c1 bl ffc08cd8 <_Rate_monotonic_Initiate_statistics> the_period->state = RATE_MONOTONIC_ACTIVE; ffc08f1c: 38 00 00 02 li r0,2 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc08f20: 3d 20 ff c1 lis r9,-63 ffc08f24: 90 1d 00 38 stw r0,56(r29) ffc08f28: 39 29 93 24 addi r9,r9,-27868 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc08f2c: 38 00 00 00 li r0,0 the_watchdog->routine = routine; ffc08f30: 91 3d 00 2c stw r9,44(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08f34: 3c 60 00 00 lis r3,0 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc08f38: 90 1d 00 18 stw r0,24(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08f3c: 38 63 2e 68 addi r3,r3,11880 ffc08f40: 38 9d 00 10 addi r4,r29,16 void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; ffc08f44: 93 dd 00 30 stw r30,48(r29) the_watchdog->user_data = user_data; ffc08f48: 90 1d 00 34 stw r0,52(r29) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc08f4c: 93 fd 00 1c stw r31,28(r29) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08f50: 48 00 44 fd bl ffc0d44c <_Watchdog_Insert> ffc08f54: 48 00 00 74 b ffc08fc8 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { ffc08f58: 2f 80 00 02 cmpwi cr7,r0,2 ffc08f5c: 40 be 00 78 bne+ cr7,ffc08fd4 /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); ffc08f60: 4b ff fe 09 bl ffc08d68 <_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; ffc08f64: 38 00 00 01 li r0,1 ffc08f68: 90 1d 00 38 stw r0,56(r29) the_period->next_length = length; ffc08f6c: 93 fd 00 3c stw r31,60(r29) ffc08f70: 7f 80 01 24 mtmsr r28 _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; ffc08f74: 3d 20 00 00 lis r9,0 ffc08f78: 80 1d 00 08 lwz r0,8(r29) ffc08f7c: 80 69 32 50 lwz r3,12880(r9) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc08f80: 38 80 40 00 li r4,16384 the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; the_period->next_length = length; _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; ffc08f84: 90 03 00 20 stw r0,32(r3) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc08f88: 48 00 3d b9 bl ffc0cd40 <_Thread_Set_state> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc08f8c: 7d 20 00 a6 mfmsr r9 ffc08f90: 7c 10 42 a6 mfsprg r0,0 ffc08f94: 7d 20 00 78 andc r0,r9,r0 ffc08f98: 7c 00 01 24 mtmsr r0 * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; the_period->state = RATE_MONOTONIC_ACTIVE; ffc08f9c: 39 60 00 02 li r11,2 /* * Did the watchdog timer expire while we were actually blocking * on it? */ _ISR_Disable( level ); local_state = the_period->state; ffc08fa0: 80 1d 00 38 lwz r0,56(r29) the_period->state = RATE_MONOTONIC_ACTIVE; ffc08fa4: 91 7d 00 38 stw r11,56(r29) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc08fa8: 7d 20 01 24 mtmsr r9 /* * 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 ) ffc08fac: 2f 80 00 03 cmpwi cr7,r0,3 ffc08fb0: 40 be 00 18 bne+ cr7,ffc08fc8 <== ALWAYS TAKEN _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc08fb4: 3d 20 00 00 lis r9,0 <== NOT EXECUTED ffc08fb8: 39 29 32 44 addi r9,r9,12868 <== NOT EXECUTED ffc08fbc: 80 69 00 0c lwz r3,12(r9) <== NOT EXECUTED ffc08fc0: 38 80 40 00 li r4,16384 <== NOT EXECUTED ffc08fc4: 48 00 30 45 bl ffc0c008 <_Thread_Clear_state> <== NOT EXECUTED _Thread_Enable_dispatch(); ffc08fc8: 48 00 34 05 bl ffc0c3cc <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc08fcc: 3b c0 00 00 li r30,0 ffc08fd0: 48 00 00 60 b ffc09030 } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc08fd4: 2f 80 00 04 cmpwi cr7,r0,4 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc08fd8: 3b c0 00 04 li r30,4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc08fdc: 40 be 00 54 bne+ cr7,ffc09030 <== NEVER TAKEN /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); ffc08fe0: 4b ff fd 89 bl ffc08d68 <_Rate_monotonic_Update_statistics> ffc08fe4: 7f 80 01 24 mtmsr r28 _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc08fe8: 38 00 00 02 li r0,2 the_period->next_length = length; ffc08fec: 93 fd 00 3c stw r31,60(r29) ffc08ff0: 3c 60 00 00 lis r3,0 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc08ff4: 90 1d 00 38 stw r0,56(r29) ffc08ff8: 38 63 2e 68 addi r3,r3,11880 ffc08ffc: 38 9d 00 10 addi r4,r29,16 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc09000: 93 fd 00 1c stw r31,28(r29) the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Scheduler_Release_job(the_period->owner, the_period->next_length); _Thread_Enable_dispatch(); return RTEMS_TIMEOUT; ffc09004: 3b c0 00 06 li r30,6 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc09008: 48 00 44 45 bl ffc0d44c <_Watchdog_Insert> ffc0900c: 3d 20 00 00 lis r9,0 ffc09010: 80 09 21 14 lwz r0,8468(r9) ffc09014: 80 7d 00 40 lwz r3,64(r29) ffc09018: 80 9d 00 3c lwz r4,60(r29) ffc0901c: 7c 09 03 a6 mtctr r0 ffc09020: 4e 80 04 21 bctrl the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Scheduler_Release_job(the_period->owner, the_period->next_length); _Thread_Enable_dispatch(); ffc09024: 48 00 33 a9 bl ffc0c3cc <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; ffc09028: 48 00 00 08 b ffc09030 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0902c: 3b c0 00 04 li r30,4 } ffc09030: 39 61 00 28 addi r11,r1,40 ffc09034: 7f c3 f3 78 mr r3,r30 ffc09038: 4b ff 81 c8 b ffc01200 <_restgpr_28_x> =============================================================================== ffc0903c : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0903c: 94 21 ff 70 stwu r1,-144(r1) ffc09040: 7c 08 02 a6 mflr r0 ffc09044: 90 01 00 94 stw r0,148(r1) rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) ffc09048: 7c 80 23 79 mr. r0,r4 */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0904c: bf 01 00 70 stmw r24,112(r1) ffc09050: 7c 7f 1b 78 mr r31,r3 rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) ffc09054: 90 01 00 68 stw r0,104(r1) ffc09058: 41 82 01 e4 beq- ffc0923c <== NEVER TAKEN return; (*print)( context, "Period information by period\n" ); ffc0905c: 3c 80 ff c2 lis r4,-62 ffc09060: 7c 09 03 a6 mtctr r0 ffc09064: 38 84 f4 95 addi r4,r4,-2923 /* * 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 ; ffc09068: 3f 00 00 00 lis r24,0 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0906c: 3f 20 ff c2 lis r25,-62 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, ffc09070: 3f 40 ff c2 lis r26,-62 char name[5]; if ( !print ) return; (*print)( context, "Period information by period\n" ); ffc09074: 4c c6 31 82 crclr 4*cr1+eq ffc09078: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); ffc0907c: 80 01 00 68 lwz r0,104(r1) ffc09080: 3c 80 ff c2 lis r4,-62 ffc09084: 7c 09 03 a6 mtctr r0 ffc09088: 38 84 f4 b3 addi r4,r4,-2893 ffc0908c: 7f e3 fb 78 mr r3,r31 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, ffc09090: 3f 60 ff c2 lis r27,-62 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc09094: 3f 80 ff c2 lis r28,-62 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc09098: 3b 39 f5 8f addi r25,r25,-2673 if ( !print ) return; (*print)( context, "Period information by period\n" ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); ffc0909c: 4c c6 31 82 crclr 4*cr1+eq ffc090a0: 4e 80 04 21 bctrl (*print)( context, "--- Wall times are in seconds ---\n" ); ffc090a4: 80 01 00 68 lwz r0,104(r1) ffc090a8: 3c 80 ff c2 lis r4,-62 ffc090ac: 7c 09 03 a6 mtctr r0 ffc090b0: 38 84 f4 d5 addi r4,r4,-2859 ffc090b4: 7f e3 fb 78 mr r3,r31 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, ffc090b8: 3b 5a f5 a6 addi r26,r26,-2650 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, ffc090bc: 3b 7b f5 c5 addi r27,r27,-2619 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc090c0: 3b 9c f4 42 addi r28,r28,-3006 return; (*print)( context, "Period information by period\n" ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); (*print)( context, "--- Wall times are in seconds ---\n" ); ffc090c4: 4c c6 31 82 crclr 4*cr1+eq ffc090c8: 4e 80 04 21 bctrl Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " ffc090cc: 80 01 00 68 lwz r0,104(r1) ffc090d0: 3c 80 ff c2 lis r4,-62 ffc090d4: 7c 09 03 a6 mtctr r0 ffc090d8: 38 84 f4 f8 addi r4,r4,-2824 ffc090dc: 7f e3 fb 78 mr r3,r31 ffc090e0: 4c c6 31 82 crclr 4*cr1+eq ffc090e4: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " ffc090e8: 80 01 00 68 lwz r0,104(r1) ffc090ec: 3c 80 ff c2 lis r4,-62 ffc090f0: 7f e3 fb 78 mr r3,r31 ffc090f4: 7c 09 03 a6 mtctr r0 ffc090f8: 38 84 f5 43 addi r4,r4,-2749 ffc090fc: 4c c6 31 82 crclr 4*cr1+eq ffc09100: 4e 80 04 21 bctrl /* * 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 ; ffc09104: 39 38 2c 98 addi r9,r24,11416 ffc09108: 83 c9 00 08 lwz r30,8(r9) ffc0910c: 48 00 01 20 b ffc0922c id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); ffc09110: 7f c3 f3 78 mr r3,r30 ffc09114: 38 81 00 30 addi r4,r1,48 ffc09118: 48 00 69 d1 bl ffc0fae8 if ( status != RTEMS_SUCCESSFUL ) ffc0911c: 2f 83 00 00 cmpwi cr7,r3,0 ffc09120: 40 be 01 08 bne+ cr7,ffc09228 #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 ); ffc09124: 38 81 00 18 addi r4,r1,24 ffc09128: 7f c3 f3 78 mr r3,r30 ffc0912c: 48 00 6a 89 bl ffc0fbb4 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); ffc09130: 80 61 00 18 lwz r3,24(r1) ffc09134: 38 80 00 05 li r4,5 ffc09138: 38 a1 00 08 addi r5,r1,8 ffc0913c: 48 00 02 ad bl ffc093e8 /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc09140: 80 01 00 68 lwz r0,104(r1) ffc09144: 7f 24 cb 78 mr r4,r25 ffc09148: 80 e1 00 30 lwz r7,48(r1) ffc0914c: 7f e3 fb 78 mr r3,r31 ffc09150: 81 01 00 34 lwz r8,52(r1) ffc09154: 7f c5 f3 78 mr r5,r30 ffc09158: 7c 09 03 a6 mtctr r0 ffc0915c: 38 c1 00 08 addi r6,r1,8 ffc09160: 4c c6 31 82 crclr 4*cr1+eq ffc09164: 4e 80 04 21 bctrl ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc09168: 80 81 00 30 lwz r4,48(r1) ffc0916c: 2f 84 00 00 cmpwi cr7,r4,0 ffc09170: 40 9e 00 20 bne- cr7,ffc09190 (*print)( context, "\n" ); ffc09174: 80 01 00 68 lwz r0,104(r1) ffc09178: 7f e3 fb 78 mr r3,r31 ffc0917c: 7f 84 e3 78 mr r4,r28 ffc09180: 7c 09 03 a6 mtctr r0 ffc09184: 4c c6 31 82 crclr 4*cr1+eq ffc09188: 4e 80 04 21 bctrl continue; ffc0918c: 48 00 00 9c b ffc09228 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 ); ffc09190: 38 61 00 48 addi r3,r1,72 ffc09194: 38 a1 00 10 addi r5,r1,16 ffc09198: 48 00 3e 3d bl ffc0cfd4 <_Timespec_Divide_by_integer> (*print)( context, ffc0919c: 80 01 00 68 lwz r0,104(r1) ffc091a0: 80 c1 00 3c lwz r6,60(r1) ffc091a4: 3b a0 03 e8 li r29,1000 ffc091a8: 81 01 00 44 lwz r8,68(r1) ffc091ac: 7c 09 03 a6 mtctr r0 ffc091b0: 81 41 00 14 lwz r10,20(r1) ffc091b4: 7c c6 eb d6 divw r6,r6,r29 ffc091b8: 80 e1 00 40 lwz r7,64(r1) ffc091bc: 81 21 00 10 lwz r9,16(r1) ffc091c0: 80 a1 00 38 lwz r5,56(r1) ffc091c4: 7d 08 eb d6 divw r8,r8,r29 ffc091c8: 7d 4a eb d6 divw r10,r10,r29 ffc091cc: 7f 44 d3 78 mr r4,r26 ffc091d0: 7f e3 fb 78 mr r3,r31 ffc091d4: 4c c6 31 82 crclr 4*cr1+eq ffc091d8: 4e 80 04 21 bctrl 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); ffc091dc: 80 81 00 30 lwz r4,48(r1) ffc091e0: 38 61 00 60 addi r3,r1,96 ffc091e4: 38 a1 00 10 addi r5,r1,16 ffc091e8: 48 00 3d ed bl ffc0cfd4 <_Timespec_Divide_by_integer> (*print)( context, ffc091ec: 80 c1 00 54 lwz r6,84(r1) ffc091f0: 81 01 00 5c lwz r8,92(r1) ffc091f4: 7f e3 fb 78 mr r3,r31 ffc091f8: 81 41 00 14 lwz r10,20(r1) ffc091fc: 7f 64 db 78 mr r4,r27 ffc09200: 80 01 00 68 lwz r0,104(r1) ffc09204: 7c c6 eb d6 divw r6,r6,r29 ffc09208: 80 a1 00 50 lwz r5,80(r1) ffc0920c: 80 e1 00 58 lwz r7,88(r1) ffc09210: 7c 09 03 a6 mtctr r0 ffc09214: 81 21 00 10 lwz r9,16(r1) ffc09218: 7d 08 eb d6 divw r8,r8,r29 ffc0921c: 7d 4a eb d6 divw r10,r10,r29 ffc09220: 4c c6 31 82 crclr 4*cr1+eq ffc09224: 4e 80 04 21 bctrl * 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++ ) { ffc09228: 3b de 00 01 addi r30,r30,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 ; id <= _Rate_monotonic_Information.maximum_id ; ffc0922c: 39 38 2c 98 addi r9,r24,11416 /* * 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 ; ffc09230: 80 09 00 0c lwz r0,12(r9) ffc09234: 7f 9e 00 40 cmplw cr7,r30,r0 ffc09238: 40 9d fe d8 ble+ cr7,ffc09110 the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } ffc0923c: 39 61 00 90 addi r11,r1,144 ffc09240: 4b ff 7f b0 b ffc011f0 <_restgpr_24_x> =============================================================================== ffc17c98 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc17c98: 7c 2b 0b 78 mr r11,r1 ffc17c9c: 94 21 ff e0 stwu r1,-32(r1) ffc17ca0: 7c 08 02 a6 mflr r0 ffc17ca4: 48 01 74 e9 bl ffc2f18c <_savegpr_31> register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) ffc17ca8: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc17cac: 90 01 00 24 stw r0,36(r1) Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; ffc17cb0: 38 00 00 0a li r0,10 register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) ffc17cb4: 41 a2 00 ac beq+ ffc17d60 return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); ffc17cb8: 38 81 00 08 addi r4,r1,8 ffc17cbc: 48 00 4c a5 bl ffc1c960 <_Thread_Get> switch ( location ) { ffc17cc0: 80 01 00 08 lwz r0,8(r1) ffc17cc4: 2f 80 00 00 cmpwi cr7,r0,0 ffc17cc8: 40 9e 00 94 bne- cr7,ffc17d5c case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; ffc17ccc: 81 23 01 30 lwz r9,304(r3) asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { ffc17cd0: 80 09 00 0c lwz r0,12(r9) ffc17cd4: 2f 80 00 00 cmpwi cr7,r0,0 ffc17cd8: 41 9e 00 78 beq- cr7,ffc17d50 if ( asr->is_enabled ) { ffc17cdc: 88 09 00 08 lbz r0,8(r9) ffc17ce0: 2f 80 00 00 cmpwi cr7,r0,0 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc17ce4: 7c 00 00 a6 mfmsr r0 ffc17ce8: 7d 70 42 a6 mfsprg r11,0 ffc17cec: 7c 0b 58 78 andc r11,r0,r11 ffc17cf0: 7d 60 01 24 mtmsr r11 ffc17cf4: 41 9e 00 40 beq- cr7,ffc17d34 ) { ISR_Level _level; _ISR_Disable( _level ); *signal_set |= signals; ffc17cf8: 81 69 00 14 lwz r11,20(r9) ffc17cfc: 7d 7f fb 78 or r31,r11,r31 ffc17d00: 93 e9 00 14 stw r31,20(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc17d04: 7c 00 01 24 mtmsr r0 _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc17d08: 3d 20 00 00 lis r9,0 ffc17d0c: 39 29 75 44 addi r9,r9,30020 ffc17d10: 80 09 00 08 lwz r0,8(r9) ffc17d14: 2f 80 00 00 cmpwi cr7,r0,0 ffc17d18: 41 9e 00 2c beq- cr7,ffc17d44 ffc17d1c: 80 09 00 0c lwz r0,12(r9) ffc17d20: 7f 83 00 00 cmpw cr7,r3,r0 ffc17d24: 40 be 00 20 bne+ cr7,ffc17d44 <== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc17d28: 38 00 00 01 li r0,1 ffc17d2c: 98 09 00 18 stb r0,24(r9) ffc17d30: 48 00 00 14 b ffc17d44 ffc17d34: 81 69 00 18 lwz r11,24(r9) ffc17d38: 7d 7f fb 78 or r31,r11,r31 ffc17d3c: 93 e9 00 18 stw r31,24(r9) ffc17d40: 7c 00 01 24 mtmsr r0 } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); ffc17d44: 48 00 4b e1 bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc17d48: 38 00 00 00 li r0,0 ffc17d4c: 48 00 00 14 b ffc17d60 } _Thread_Enable_dispatch(); ffc17d50: 48 00 4b d5 bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_NOT_DEFINED; ffc17d54: 38 00 00 0b li r0,11 ffc17d58: 48 00 00 08 b ffc17d60 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc17d5c: 38 00 00 04 li r0,4 } ffc17d60: 39 61 00 20 addi r11,r1,32 ffc17d64: 7c 03 03 78 mr r3,r0 ffc17d68: 4b ff 64 38 b ffc0e1a0 <_restgpr_31_x> =============================================================================== ffc105e4 : ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) ffc105e4: 2c 05 00 00 cmpwi r5,0 rtems_status_code rtems_task_mode( rtems_mode mode_set, rtems_mode mask, rtems_mode *previous_mode_set ) { ffc105e8: 7c 08 02 a6 mflr r0 ffc105ec: 94 21 ff f8 stwu r1,-8(r1) ffc105f0: 90 01 00 0c stw r0,12(r1) ffc105f4: 7c 60 1b 78 mr r0,r3 bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; ffc105f8: 38 60 00 09 li r3,9 ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) ffc105fc: 41 82 01 88 beq- ffc10784 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; ffc10600: 3d 20 00 00 lis r9,0 ffc10604: 81 69 31 50 lwz r11,12624(r9) api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc10608: 81 0b 00 7c lwz r8,124(r11) executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; ffc1060c: 89 4b 00 74 lbz r10,116(r11) if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc10610: 2f 88 00 00 cmpwi cr7,r8,0 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; ffc10614: 81 2b 01 30 lwz r9,304(r11) asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; ffc10618: 7d 4a 00 34 cntlzw r10,r10 ffc1061c: 55 4a d9 7e rlwinm r10,r10,27,5,31 ffc10620: 55 4a 40 2e rlwinm r10,r10,8,0,23 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc10624: 41 9e 00 08 beq- cr7,ffc1062c old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; ffc10628: 61 4a 02 00 ori r10,r10,512 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc1062c: 89 09 00 08 lbz r8,8(r9) ffc10630: 7d 08 00 34 cntlzw r8,r8 ffc10634: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc10638: 55 08 50 2a rlwinm r8,r8,10,0,21 ffc1063c: 7d 08 53 78 or r8,r8,r10 #ifndef ASM static inline uint32_t _CPU_ISR_Get_level( void ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc10640: 39 40 00 00 li r10,0 ffc10644: 7d 40 00 a6 mfmsr r10 if (msr & MSR_EE) return 0; ffc10648: 71 47 80 00 andi. r7,r10,32768 ffc1064c: 7c e0 00 26 mfcr r7 ffc10650: 54 e7 1f fe rlwinm r7,r7,3,31,31 old_mode |= _ISR_Get_level(); ffc10654: 7d 0a 3b 78 or r10,r8,r7 *previous_mode_set = old_mode; ffc10658: 91 45 00 00 stw r10,0(r5) /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc1065c: 70 8a 01 00 andi. r10,r4,256 ffc10660: 41 82 00 14 beq- ffc10674 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; ffc10664: 70 07 01 00 andi. r7,r0,256 ffc10668: 7d 40 00 26 mfcr r10 ffc1066c: 55 4a 1f fe rlwinm r10,r10,3,31,31 ffc10670: 99 4b 00 74 stb r10,116(r11) if ( mask & RTEMS_TIMESLICE_MASK ) { ffc10674: 70 8a 02 00 andi. r10,r4,512 ffc10678: 41 82 00 28 beq- ffc106a0 if ( _Modes_Is_timeslice(mode_set) ) { ffc1067c: 70 0a 02 00 andi. r10,r0,512 ffc10680: 41 82 00 1c beq- ffc1069c executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; ffc10684: 39 40 00 01 li r10,1 ffc10688: 91 4b 00 7c stw r10,124(r11) executing->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc1068c: 3d 40 00 00 lis r10,0 ffc10690: 81 4a 28 08 lwz r10,10248(r10) ffc10694: 91 4b 00 78 stw r10,120(r11) ffc10698: 48 00 00 08 b ffc106a0 } else executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; ffc1069c: 91 4b 00 7c stw r10,124(r11) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc106a0: 70 8b 00 01 andi. r11,r4,1 ffc106a4: 41 82 00 28 beq- ffc106cc } static inline void _CPU_ISR_Set_level( uint32_t level ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc106a8: 39 60 00 00 li r11,0 ffc106ac: 7d 60 00 a6 mfmsr r11 static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; __asm__ volatile ( ffc106b0: 7d 50 42 a6 mfsprg r10,0 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc106b4: 70 07 00 01 andi. r7,r0,1 ffc106b8: 40 82 00 0c bne- ffc106c4 msr |= ppc_interrupt_get_disable_mask(); ffc106bc: 7d 4b 5b 78 or r11,r10,r11 ffc106c0: 48 00 00 08 b ffc106c8 } else { msr &= ~ppc_interrupt_get_disable_mask(); ffc106c4: 7d 6b 50 78 andc r11,r11,r10 } _CPU_MSR_SET(msr); ffc106c8: 7d 60 01 24 mtmsr r11 * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { ffc106cc: 70 8a 04 00 andi. r10,r4,1024 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc106d0: 39 60 00 00 li r11,0 if ( mask & RTEMS_ASR_MASK ) { ffc106d4: 41 82 00 58 beq- ffc1072c * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( ffc106d8: 70 07 04 00 andi. r7,r0,1024 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 ) { ffc106dc: 89 49 00 08 lbz r10,8(r9) * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( ffc106e0: 7c 00 00 26 mfcr r0 ffc106e4: 54 00 1f fe rlwinm r0,r0,3,31,31 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 ) { ffc106e8: 7f 8a 00 00 cmpw cr7,r10,r0 ffc106ec: 41 9e 00 40 beq- cr7,ffc1072c asr->is_enabled = is_asr_enabled; ffc106f0: 98 09 00 08 stb r0,8(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc106f4: 7c 00 00 a6 mfmsr r0 ffc106f8: 7d 70 42 a6 mfsprg r11,0 ffc106fc: 7c 0b 58 78 andc r11,r0,r11 ffc10700: 7d 60 01 24 mtmsr r11 { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; ffc10704: 81 69 00 18 lwz r11,24(r9) information->signals_pending = information->signals_posted; ffc10708: 81 49 00 14 lwz r10,20(r9) information->signals_posted = _signals; ffc1070c: 91 69 00 14 stw r11,20(r9) rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; ffc10710: 91 49 00 18 stw r10,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc10714: 7c 00 01 24 mtmsr r0 _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { ffc10718: 80 09 00 14 lwz r0,20(r9) needs_asr_dispatching = true; ffc1071c: 39 60 00 01 li r11,1 if ( mask & RTEMS_ASR_MASK ) { is_asr_enabled = _Modes_Is_asr_disabled( mode_set ) ? false : true; if ( is_asr_enabled != asr->is_enabled ) { asr->is_enabled = is_asr_enabled; _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { ffc10720: 2f 80 00 00 cmpwi cr7,r0,0 ffc10724: 40 9e 00 08 bne- cr7,ffc1072c /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc10728: 39 60 00 00 li r11,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc1072c: 3d 20 00 00 lis r9,0 ffc10730: 80 09 28 48 lwz r0,10312(r9) if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; ffc10734: 38 60 00 00 li r3,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc10738: 2f 80 00 03 cmpwi cr7,r0,3 ffc1073c: 40 be 00 48 bne+ cr7,ffc10784 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || ffc10740: 2f 8b 00 00 cmpwi cr7,r11,0 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; ffc10744: 3d 40 00 00 lis r10,0 ffc10748: 39 4a 31 44 addi r10,r10,12612 ffc1074c: 81 2a 00 0c lwz r9,12(r10) if ( are_signals_pending || ffc10750: 40 9e 00 1c bne- cr7,ffc1076c ffc10754: 80 0a 00 10 lwz r0,16(r10) ffc10758: 7f 89 00 00 cmpw cr7,r9,r0 ffc1075c: 41 9e 00 28 beq- cr7,ffc10784 (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { ffc10760: 88 09 00 74 lbz r0,116(r9) ffc10764: 2f 80 00 00 cmpwi cr7,r0,0 ffc10768: 41 9e 00 1c beq- cr7,ffc10784 <== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc1076c: 3d 20 00 00 lis r9,0 ffc10770: 38 00 00 01 li r0,1 ffc10774: 39 29 31 44 addi r9,r9,12612 ffc10778: 98 09 00 18 stb r0,24(r9) if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); ffc1077c: 4b ff a1 d9 bl ffc0a954 <_Thread_Dispatch> } return RTEMS_SUCCESSFUL; ffc10780: 38 60 00 00 li r3,0 } ffc10784: 80 01 00 0c lwz r0,12(r1) ffc10788: 38 21 00 08 addi r1,r1,8 ffc1078c: 7c 08 03 a6 mtlr r0 ffc10790: 4e 80 00 20 blr =============================================================================== ffc0c740 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { ffc0c740: 94 21 ff e0 stwu r1,-32(r1) ffc0c744: 7c 08 02 a6 mflr r0 ffc0c748: bf c1 00 18 stmw r30,24(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0c74c: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { ffc0c750: 7c be 2b 78 mr r30,r5 ffc0c754: 90 01 00 24 stw r0,36(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0c758: 41 82 00 18 beq- ffc0c770 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 ) ); ffc0c75c: 3d 20 00 00 lis r9,0 ffc0c760: 89 29 27 44 lbz r9,10052(r9) !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; ffc0c764: 38 00 00 13 li r0,19 ) { register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0c768: 7f 9f 48 40 cmplw cr7,r31,r9 ffc0c76c: 41 bd 00 6c bgt+ cr7,ffc0c7d8 !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) ffc0c770: 2f 9e 00 00 cmpwi cr7,r30,0 return RTEMS_INVALID_ADDRESS; ffc0c774: 38 00 00 09 li r0,9 if ( new_priority != RTEMS_CURRENT_PRIORITY && !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; if ( !old_priority ) ffc0c778: 41 9e 00 60 beq- cr7,ffc0c7d8 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); ffc0c77c: 38 81 00 08 addi r4,r1,8 ffc0c780: 48 00 27 f9 bl ffc0ef78 <_Thread_Get> switch ( location ) { ffc0c784: 80 01 00 08 lwz r0,8(r1) ffc0c788: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c78c: 40 9e 00 48 bne- cr7,ffc0c7d4 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; if ( new_priority != RTEMS_CURRENT_PRIORITY ) { ffc0c790: 2f 9f 00 00 cmpwi cr7,r31,0 the_thread = _Thread_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; ffc0c794: 80 03 00 14 lwz r0,20(r3) ffc0c798: 90 1e 00 00 stw r0,0(r30) if ( new_priority != RTEMS_CURRENT_PRIORITY ) { ffc0c79c: 41 9e 00 2c beq- cr7,ffc0c7c8 the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || ffc0c7a0: 80 03 00 1c lwz r0,28(r3) 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; ffc0c7a4: 93 e3 00 18 stw r31,24(r3) if ( the_thread->resource_count == 0 || ffc0c7a8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c7ac: 41 9e 00 10 beq- cr7,ffc0c7bc ffc0c7b0: 80 03 00 14 lwz r0,20(r3) ffc0c7b4: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0c7b8: 40 9d 00 10 ble- cr7,ffc0c7c8 <== ALWAYS TAKEN the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); ffc0c7bc: 7f e4 fb 78 mr r4,r31 ffc0c7c0: 38 a0 00 00 li r5,0 ffc0c7c4: 48 00 22 9d bl ffc0ea60 <_Thread_Change_priority> } _Thread_Enable_dispatch(); ffc0c7c8: 48 00 27 75 bl ffc0ef3c <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0c7cc: 38 00 00 00 li r0,0 ffc0c7d0: 48 00 00 08 b ffc0c7d8 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0c7d4: 38 00 00 04 li r0,4 } ffc0c7d8: 39 61 00 20 addi r11,r1,32 ffc0c7dc: 7c 03 03 78 mr r3,r0 ffc0c7e0: 4b ff 49 4c b ffc0112c <_restgpr_30_x> =============================================================================== ffc18768 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { ffc18768: 94 21 ff e8 stwu r1,-24(r1) ffc1876c: 7c 08 02 a6 mflr r0 ffc18770: 7c 64 1b 78 mr r4,r3 RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Get ( Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) ffc18774: 3c 60 00 00 lis r3,0 ffc18778: 90 01 00 1c stw r0,28(r1) ffc1877c: 38 63 79 9c addi r3,r3,31132 ffc18780: 38 a1 00 08 addi r5,r1,8 ffc18784: 48 00 32 d5 bl ffc1ba58 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc18788: 80 01 00 08 lwz r0,8(r1) ffc1878c: 2f 80 00 00 cmpwi cr7,r0,0 ffc18790: 40 9e 00 24 bne- cr7,ffc187b4 case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) ffc18794: 80 03 00 38 lwz r0,56(r3) ffc18798: 2f 80 00 04 cmpwi cr7,r0,4 ffc1879c: 41 9e 00 0c beq- cr7,ffc187a8 <== NEVER TAKEN (void) _Watchdog_Remove( &the_timer->Ticker ); ffc187a0: 38 63 00 10 addi r3,r3,16 ffc187a4: 48 00 55 39 bl ffc1dcdc <_Watchdog_Remove> _Thread_Enable_dispatch(); ffc187a8: 48 00 41 7d bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc187ac: 38 60 00 00 li r3,0 ffc187b0: 48 00 00 08 b ffc187b8 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc187b4: 38 60 00 04 li r3,4 } ffc187b8: 80 01 00 1c lwz r0,28(r1) ffc187bc: 38 21 00 18 addi r1,r1,24 ffc187c0: 7c 08 03 a6 mtlr r0 ffc187c4: 4e 80 00 20 blr =============================================================================== ffc18cec : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc18cec: 94 21 ff c8 stwu r1,-56(r1) Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; ffc18cf0: 3d 20 00 00 lis r9,0 rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc18cf4: 7c 08 02 a6 mflr r0 ffc18cf8: bf 01 00 18 stmw r24,24(r1) ffc18cfc: 7c 7f 1b 78 mr r31,r3 ffc18d00: 7c 9c 23 78 mr r28,r4 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; ffc18d04: 83 a9 29 34 lwz r29,10548(r9) rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc18d08: 7c be 2b 78 mr r30,r5 ffc18d0c: 90 01 00 3c stw r0,60(r1) ffc18d10: 7c da 33 78 mr r26,r6 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) ffc18d14: 2f 9d 00 00 cmpwi cr7,r29,0 return RTEMS_INCORRECT_STATE; ffc18d18: 3b 20 00 0e li r25,14 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) ffc18d1c: 41 9e 00 c8 beq- cr7,ffc18de4 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) ffc18d20: 3d 20 00 00 lis r9,0 ffc18d24: 88 09 28 e4 lbz r0,10468(r9) return RTEMS_NOT_DEFINED; ffc18d28: 3b 20 00 0b li r25,11 Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) ffc18d2c: 2f 80 00 00 cmpwi cr7,r0,0 ffc18d30: 41 be 00 b4 beq+ cr7,ffc18de4 <== NEVER TAKEN return RTEMS_NOT_DEFINED; if ( !routine ) ffc18d34: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc18d38: 3b 20 00 09 li r25,9 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) ffc18d3c: 41 9e 00 a8 beq- cr7,ffc18de4 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc18d40: 7c 83 23 78 mr r3,r4 ffc18d44: 4b ff cc 29 bl ffc1596c <_TOD_Validate> return RTEMS_INVALID_CLOCK; ffc18d48: 3b 20 00 14 li r25,20 return RTEMS_NOT_DEFINED; if ( !routine ) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc18d4c: 2f 83 00 00 cmpwi cr7,r3,0 ffc18d50: 41 be 00 94 beq+ cr7,ffc18de4 return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc18d54: 7f 83 e3 78 mr r3,r28 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc18d58: 3f 60 00 00 lis r27,0 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc18d5c: 4b ff cb 85 bl ffc158e0 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) ffc18d60: 80 1b 28 f8 lwz r0,10488(r27) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc18d64: 7c 7c 1b 78 mr r28,r3 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc18d68: 7f 83 00 40 cmplw cr7,r3,r0 ffc18d6c: 40 bd 00 78 ble+ cr7,ffc18de4 ffc18d70: 3c 60 00 00 lis r3,0 ffc18d74: 38 63 79 9c addi r3,r3,31132 ffc18d78: 7f e4 fb 78 mr r4,r31 ffc18d7c: 38 a1 00 08 addi r5,r1,8 ffc18d80: 48 00 2c d9 bl ffc1ba58 <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc18d84: 83 01 00 08 lwz r24,8(r1) ffc18d88: 7c 79 1b 78 mr r25,r3 ffc18d8c: 2f 98 00 00 cmpwi cr7,r24,0 ffc18d90: 40 9e 00 50 bne- cr7,ffc18de0 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); ffc18d94: 38 63 00 10 addi r3,r3,16 ffc18d98: 48 00 4f 45 bl ffc1dcdc <_Watchdog_Remove> the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; ffc18d9c: 38 00 00 03 li r0,3 ffc18da0: 90 19 00 38 stw r0,56(r25) _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 ); ffc18da4: 7f 24 cb 78 mr r4,r25 ffc18da8: 7f a3 eb 78 mr r3,r29 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(); ffc18dac: 80 1b 28 f8 lwz r0,10488(r27) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc18db0: 93 19 00 18 stw r24,24(r25) ffc18db4: 7f 80 e0 50 subf r28,r0,r28 (*timer_server->schedule_operation)( timer_server, the_timer ); ffc18db8: 80 1d 00 04 lwz r0,4(r29) the_watchdog->routine = routine; ffc18dbc: 93 d9 00 2c stw r30,44(r25) ffc18dc0: 7c 09 03 a6 mtctr r0 the_watchdog->id = id; ffc18dc4: 93 f9 00 30 stw r31,48(r25) the_watchdog->user_data = user_data; ffc18dc8: 93 59 00 34 stw r26,52(r25) 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(); ffc18dcc: 93 99 00 1c stw r28,28(r25) (*timer_server->schedule_operation)( timer_server, the_timer ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; ffc18dd0: 3b 20 00 00 li r25,0 (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(); (*timer_server->schedule_operation)( timer_server, the_timer ); ffc18dd4: 4e 80 04 21 bctrl _Thread_Enable_dispatch(); ffc18dd8: 48 00 3b 4d bl ffc1c924 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc18ddc: 48 00 00 08 b ffc18de4 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc18de0: 3b 20 00 04 li r25,4 } ffc18de4: 39 61 00 38 addi r11,r1,56 ffc18de8: 7f 23 cb 78 mr r3,r25 ffc18dec: 4b ff 53 98 b ffc0e184 <_restgpr_24_x> =============================================================================== ffc0849c : int sched_get_priority_max( int policy ) { switch ( policy ) { ffc0849c: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_max( int policy ) { ffc084a0: 94 21 ff f8 stwu r1,-8(r1) ffc084a4: 7c 08 02 a6 mflr r0 ffc084a8: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc084ac: 41 9d 00 14 bgt- cr7,ffc084c0 ffc084b0: 38 00 00 01 li r0,1 ffc084b4: 7c 03 18 30 slw r3,r0,r3 ffc084b8: 70 60 00 17 andi. r0,r3,23 ffc084bc: 40 82 00 18 bne- ffc084d4 <== ALWAYS TAKEN case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc084c0: 48 00 8f 69 bl ffc11428 <__errno> ffc084c4: 38 00 00 16 li r0,22 ffc084c8: 90 03 00 00 stw r0,0(r3) ffc084cc: 38 60 ff ff li r3,-1 ffc084d0: 48 00 00 10 b ffc084e0 } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; ffc084d4: 3d 20 00 00 lis r9,0 ffc084d8: 88 69 27 24 lbz r3,10020(r9) ffc084dc: 38 63 ff ff addi r3,r3,-1 } ffc084e0: 80 01 00 0c lwz r0,12(r1) ffc084e4: 38 21 00 08 addi r1,r1,8 ffc084e8: 7c 08 03 a6 mtlr r0 ffc084ec: 4e 80 00 20 blr =============================================================================== ffc084f0 : int sched_get_priority_min( int policy ) { switch ( policy ) { ffc084f0: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_min( int policy ) { ffc084f4: 94 21 ff f8 stwu r1,-8(r1) ffc084f8: 7c 08 02 a6 mflr r0 ffc084fc: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc08500: 41 9d 00 18 bgt- cr7,ffc08518 ffc08504: 38 00 00 01 li r0,1 ffc08508: 7c 00 18 30 slw r0,r0,r3 ffc0850c: 70 09 00 17 andi. r9,r0,23 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; ffc08510: 38 60 00 01 li r3,1 int sched_get_priority_min( int policy ) { switch ( policy ) { ffc08514: 40 82 00 14 bne- ffc08528 <== ALWAYS TAKEN case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc08518: 48 00 8f 11 bl ffc11428 <__errno> ffc0851c: 38 00 00 16 li r0,22 ffc08520: 90 03 00 00 stw r0,0(r3) ffc08524: 38 60 ff ff li r3,-1 } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } ffc08528: 80 01 00 0c lwz r0,12(r1) ffc0852c: 38 21 00 08 addi r1,r1,8 ffc08530: 7c 08 03 a6 mtlr r0 ffc08534: 4e 80 00 20 blr =============================================================================== ffc08538 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc08538: 7c 2b 0b 78 mr r11,r1 ffc0853c: 94 21 ff e8 stwu r1,-24(r1) ffc08540: 7c 08 02 a6 mflr r0 ffc08544: 48 01 47 75 bl ffc1ccb8 <_savegpr_31> /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc08548: 7c 7f 1b 79 mr. r31,r3 int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc0854c: 90 01 00 1c stw r0,28(r1) /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc08550: 41 a2 00 24 beq+ ffc08574 <== NEVER TAKEN ffc08554: 90 81 00 08 stw r4,8(r1) ffc08558: 4b ff c7 c9 bl ffc04d20 ffc0855c: 7f 9f 18 00 cmpw cr7,r31,r3 ffc08560: 80 81 00 08 lwz r4,8(r1) ffc08564: 41 be 00 10 beq+ cr7,ffc08574 rtems_set_errno_and_return_minus_one( ESRCH ); ffc08568: 48 00 8e c1 bl ffc11428 <__errno> ffc0856c: 38 00 00 03 li r0,3 ffc08570: 48 00 00 14 b ffc08584 if ( !interval ) ffc08574: 2f 84 00 00 cmpwi cr7,r4,0 ffc08578: 40 be 00 18 bne+ cr7,ffc08590 rtems_set_errno_and_return_minus_one( EINVAL ); ffc0857c: 48 00 8e ad bl ffc11428 <__errno> ffc08580: 38 00 00 16 li r0,22 ffc08584: 90 03 00 00 stw r0,0(r3) ffc08588: 38 60 ff ff li r3,-1 ffc0858c: 48 00 00 14 b ffc085a0 _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); ffc08590: 3d 20 00 00 lis r9,0 ffc08594: 80 69 28 0c lwz r3,10252(r9) ffc08598: 48 00 3e 39 bl ffc0c3d0 <_Timespec_From_ticks> return 0; ffc0859c: 38 60 00 00 li r3,0 } ffc085a0: 39 61 00 18 addi r11,r1,24 ffc085a4: 4b ff 85 c8 b ffc00b6c <_restgpr_31_x> =============================================================================== ffc0b06c : * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc0b06c: 3d 20 00 00 lis r9,0 int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { ffc0b070: 94 21 ff b8 stwu r1,-72(r1) ffc0b074: 7c 08 02 a6 mflr r0 ffc0b078: 81 69 28 08 lwz r11,10248(r9) ffc0b07c: 90 01 00 4c stw r0,76(r1) ffc0b080: 38 0b 00 01 addi r0,r11,1 ffc0b084: 90 09 28 08 stw r0,10248(r9) ffc0b088: bf 61 00 34 stmw r27,52(r1) ffc0b08c: 7c 7f 1b 78 mr r31,r3 ffc0b090: 7c 9e 23 78 mr r30,r4 ffc0b094: 90 a1 00 28 stw r5,40(r1) ffc0b098: 90 c1 00 2c stw r6,44(r1) return _Thread_Dispatch_disable_level; ffc0b09c: 80 09 28 08 lwz r0,10248(r9) POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0b0a0: 70 9c 02 00 andi. r28,r4,512 /* unsigned int value */ ) { va_list arg; mode_t mode; unsigned int value = 0; ffc0b0a4: 3b a0 00 00 li r29,0 POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0b0a8: 41 a2 00 20 beq+ ffc0b0c8 va_start(arg, oflag); ffc0b0ac: 38 01 00 50 addi r0,r1,80 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0b0b0: 83 a1 00 2c lwz r29,44(r1) Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0b0b4: 90 01 00 18 stw r0,24(r1) ffc0b0b8: 39 21 00 20 addi r9,r1,32 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0b0bc: 38 00 00 04 li r0,4 Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0b0c0: 91 21 00 1c stw r9,28(r1) mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0b0c4: 98 01 00 14 stb r0,20(r1) va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); ffc0b0c8: 7f e3 fb 78 mr r3,r31 ffc0b0cc: 38 81 00 10 addi r4,r1,16 ffc0b0d0: 48 00 6b f9 bl ffc11cc8 <_POSIX_Semaphore_Name_to_id> * 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 ) { ffc0b0d4: 7c 7b 1b 79 mr. r27,r3 ffc0b0d8: 41 82 00 24 beq- ffc0b0fc /* * 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) ) ) { ffc0b0dc: 2f 9b 00 02 cmpwi cr7,r27,2 ffc0b0e0: 40 9e 00 0c bne- cr7,ffc0b0ec <== NEVER TAKEN ffc0b0e4: 2f 9c 00 00 cmpwi cr7,r28,0 ffc0b0e8: 40 9e 00 68 bne- cr7,ffc0b150 _Thread_Enable_dispatch(); ffc0b0ec: 48 00 33 a9 bl ffc0e494 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); ffc0b0f0: 48 00 9d 99 bl ffc14e88 <__errno> ffc0b0f4: 93 63 00 00 stw r27,0(r3) ffc0b0f8: 48 00 00 20 b ffc0b118 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { ffc0b0fc: 73 de 0a 00 andi. r30,r30,2560 ffc0b100: 2f 9e 0a 00 cmpwi cr7,r30,2560 ffc0b104: 40 be 00 1c bne+ cr7,ffc0b120 _Thread_Enable_dispatch(); ffc0b108: 48 00 33 8d bl ffc0e494 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); ffc0b10c: 48 00 9d 7d bl ffc14e88 <__errno> ffc0b110: 38 00 00 11 li r0,17 ffc0b114: 90 03 00 00 stw r0,0(r3) ffc0b118: 38 60 ff ff li r3,-1 ffc0b11c: 48 00 00 64 b ffc0b180 ffc0b120: 80 81 00 10 lwz r4,16(r1) ffc0b124: 3c 60 00 00 lis r3,0 ffc0b128: 38 a1 00 08 addi r5,r1,8 ffc0b12c: 38 63 30 ac addi r3,r3,12460 ffc0b130: 48 00 23 fd bl ffc0d52c <_Objects_Get> } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; ffc0b134: 81 23 00 18 lwz r9,24(r3) 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 ); ffc0b138: 90 61 00 0c stw r3,12(r1) the_semaphore->open_count += 1; ffc0b13c: 38 09 00 01 addi r0,r9,1 ffc0b140: 90 03 00 18 stw r0,24(r3) _Thread_Enable_dispatch(); ffc0b144: 48 00 33 51 bl ffc0e494 <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); ffc0b148: 48 00 33 4d bl ffc0e494 <_Thread_Enable_dispatch> goto return_id; ffc0b14c: 48 00 00 2c b ffc0b178 /* * 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( ffc0b150: 7f e3 fb 78 mr r3,r31 ffc0b154: 38 80 00 00 li r4,0 ffc0b158: 7f a5 eb 78 mr r5,r29 ffc0b15c: 38 c1 00 0c addi r6,r1,12 ffc0b160: 48 00 69 f1 bl ffc11b50 <_POSIX_Semaphore_Create_support> ffc0b164: 7c 7f 1b 78 mr r31,r3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); ffc0b168: 48 00 33 2d bl ffc0e494 <_Thread_Enable_dispatch> if ( status == -1 ) ffc0b16c: 2f 9f ff ff cmpwi cr7,r31,-1 return SEM_FAILED; ffc0b170: 38 60 ff ff li r3,-1 * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); if ( status == -1 ) ffc0b174: 41 9e 00 0c beq- cr7,ffc0b180 the_semaphore->Semaphore_id = the_semaphore->Object.id; id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; ffc0b178: 80 61 00 0c lwz r3,12(r1) ffc0b17c: 38 63 00 08 addi r3,r3,8 } ffc0b180: 39 61 00 48 addi r11,r1,72 ffc0b184: 4b ff 8b c0 b ffc03d44 <_restgpr_27_x> =============================================================================== ffc082fc : struct sigaction *oact ) { ISR_Level level; if ( oact ) ffc082fc: 7c a9 2b 79 mr. r9,r5 int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { ffc08300: 94 21 ff e8 stwu r1,-24(r1) ffc08304: 7c 08 02 a6 mflr r0 ffc08308: bf 81 00 08 stmw r28,8(r1) ffc0830c: 7c 7f 1b 78 mr r31,r3 ffc08310: 7c 9e 23 78 mr r30,r4 ffc08314: 90 01 00 1c stw r0,28(r1) ISR_Level level; if ( oact ) ffc08318: 41 82 00 1c beq- ffc08334 *oact = _POSIX_signals_Vectors[ sig ]; ffc0831c: 1c 03 00 0c mulli r0,r3,12 ffc08320: 3d 60 00 00 lis r11,0 ffc08324: 39 6b 32 00 addi r11,r11,12800 ffc08328: 7d 6b 02 14 add r11,r11,r0 ffc0832c: 7c ab 64 aa lswi r5,r11,12 ffc08330: 7c a9 65 aa stswi r5,r9,12 if ( !sig ) ffc08334: 2f 9f 00 00 cmpwi cr7,r31,0 ffc08338: 41 9e 00 18 beq- cr7,ffc08350 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc0833c: 38 1f ff ff addi r0,r31,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc08340: 2b 80 00 1f cmplwi cr7,r0,31 ffc08344: 41 9d 00 0c bgt- cr7,ffc08350 * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) ffc08348: 2f 9f 00 09 cmpwi cr7,r31,9 ffc0834c: 40 be 00 18 bne+ cr7,ffc08364 rtems_set_errno_and_return_minus_one( EINVAL ); ffc08350: 48 00 94 a5 bl ffc117f4 <__errno> ffc08354: 38 00 00 16 li r0,22 ffc08358: 90 03 00 00 stw r0,0(r3) ffc0835c: 38 60 ff ff li r3,-1 ffc08360: 48 00 00 74 b ffc083d4 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc08364: 2f 9e 00 00 cmpwi cr7,r30,0 * 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; ffc08368: 38 60 00 00 li r3,0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc0836c: 41 9e 00 68 beq- cr7,ffc083d4 <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc08370: 7f a0 00 a6 mfmsr r29 ffc08374: 7c 10 42 a6 mfsprg r0,0 ffc08378: 7f a0 00 78 andc r0,r29,r0 ffc0837c: 7c 00 01 24 mtmsr r0 * Unless the user is installing the default signal actions, then * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { ffc08380: 80 1e 00 08 lwz r0,8(r30) ffc08384: 3f 80 00 00 lis r28,0 ffc08388: 3b 9c 32 00 addi r28,r28,12800 ffc0838c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08390: 40 be 00 24 bne+ cr7,ffc083b4 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; ffc08394: 1f ff 00 0c mulli r31,r31,12 ffc08398: 3d 60 ff c2 lis r11,-62 ffc0839c: 38 0b b1 c4 addi r0,r11,-20028 ffc083a0: 7d 3c fa 14 add r9,r28,r31 ffc083a4: 7f e0 fa 14 add r31,r0,r31 ffc083a8: 7c bf 64 aa lswi r5,r31,12 ffc083ac: 7c a9 65 aa stswi r5,r9,12 ffc083b0: 48 00 00 1c b ffc083cc } else { _POSIX_signals_Clear_process_signals( sig ); ffc083b4: 7f e3 fb 78 mr r3,r31 _POSIX_signals_Vectors[ sig ] = *act; ffc083b8: 1f ff 00 0c mulli r31,r31,12 _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); ffc083bc: 48 00 62 c1 bl ffc0e67c <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; ffc083c0: 7f fc fa 14 add r31,r28,r31 ffc083c4: 7c be 64 aa lswi r5,r30,12 ffc083c8: 7c bf 65 aa stswi r5,r31,12 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc083cc: 7f a0 01 24 mtmsr r29 * 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; ffc083d0: 38 60 00 00 li r3,0 } ffc083d4: 39 61 00 18 addi r11,r1,24 ffc083d8: 4b ff 85 44 b ffc0091c <_restgpr_28_x> =============================================================================== ffc08908 : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc08908: 94 21 ff d0 stwu r1,-48(r1) ffc0890c: 7c 08 02 a6 mflr r0 ffc08910: bf 61 00 1c stmw r27,28(r1) ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc08914: 7c 7d 1b 79 mr. r29,r3 int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc08918: 7c 9f 23 78 mr r31,r4 ffc0891c: 90 01 00 34 stw r0,52(r1) ffc08920: 7c be 2b 78 mr r30,r5 ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc08924: 41 82 00 2c beq- ffc08950 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { ffc08928: 2f 85 00 00 cmpwi cr7,r5,0 ffc0892c: 41 9e 00 30 beq- cr7,ffc0895c if ( !_Timespec_Is_valid( timeout ) ) ffc08930: 7c a3 2b 78 mr r3,r5 ffc08934: 48 00 3e b1 bl ffc0c7e4 <_Timespec_Is_valid> ffc08938: 2f 83 00 00 cmpwi cr7,r3,0 ffc0893c: 41 9e 00 14 beq- cr7,ffc08950 rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); ffc08940: 7f c3 f3 78 mr r3,r30 ffc08944: 48 00 3f 21 bl ffc0c864 <_Timespec_To_ticks> if ( !interval ) ffc08948: 7c 64 1b 79 mr. r4,r3 ffc0894c: 40 a2 00 14 bne+ ffc08960 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); ffc08950: 48 00 96 05 bl ffc11f54 <__errno> ffc08954: 38 00 00 16 li r0,22 ffc08958: 48 00 01 80 b ffc08ad8 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; ffc0895c: 38 80 00 00 li r4,0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc08960: 2f 9f 00 00 cmpwi cr7,r31,0 ffc08964: 40 be 00 08 bne+ cr7,ffc0896c ffc08968: 3b e1 00 08 addi r31,r1,8 the_thread = _Thread_Executing; ffc0896c: 3d 20 00 00 lis r9,0 ffc08970: 81 29 31 90 lwz r9,12688(r9) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc08974: 83 69 01 34 lwz r27,308(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc08978: 7f 80 00 a6 mfmsr r28 ffc0897c: 7c 10 42 a6 mfsprg r0,0 ffc08980: 7f 80 00 78 andc r0,r28,r0 ffc08984: 7c 00 01 24 mtmsr r0 */ /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { ffc08988: 80 1d 00 00 lwz r0,0(r29) ffc0898c: 80 7b 00 d4 lwz r3,212(r27) ffc08990: 7c 0b 18 39 and. r11,r0,r3 ffc08994: 41 a2 00 40 beq+ ffc089d4 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); ffc08998: 4b ff ff 19 bl ffc088b0 <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( ffc0899c: 7f e5 fb 78 mr r5,r31 /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); ffc089a0: 90 7f 00 00 stw r3,0(r31) ffc089a4: 7c 64 1b 78 mr r4,r3 _POSIX_signals_Clear_signals( ffc089a8: 38 c0 00 00 li r6,0 ffc089ac: 7f 63 db 78 mr r3,r27 ffc089b0: 38 e0 00 00 li r7,0 ffc089b4: 48 00 65 65 bl ffc0ef18 <_POSIX_signals_Clear_signals> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc089b8: 7f 80 01 24 mtmsr r28 false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc089bc: 38 00 00 01 li r0,1 the_info->si_value.sival_int = 0; return the_info->si_signo; ffc089c0: 83 df 00 00 lwz r30,0(r31) false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc089c4: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc089c8: 38 00 00 00 li r0,0 ffc089cc: 90 1f 00 08 stw r0,8(r31) return the_info->si_signo; ffc089d0: 48 00 01 10 b ffc08ae0 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { ffc089d4: 3d 60 00 00 lis r11,0 ffc089d8: 80 6b 28 bc lwz r3,10428(r11) ffc089dc: 7c 0b 18 39 and. r11,r0,r3 ffc089e0: 41 a2 00 40 beq+ ffc08a20 signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc089e4: 4b ff fe cd bl ffc088b0 <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc089e8: 7f e5 fb 78 mr r5,r31 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc089ec: 7c 7e 1b 78 mr r30,r3 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc089f0: 7f c4 f3 78 mr r4,r30 ffc089f4: 7f 63 db 78 mr r3,r27 ffc089f8: 38 c0 00 01 li r6,1 ffc089fc: 38 e0 00 00 li r7,0 ffc08a00: 48 00 65 19 bl ffc0ef18 <_POSIX_signals_Clear_signals> ffc08a04: 7f 80 01 24 mtmsr r28 _ISR_Enable( level ); the_info->si_signo = signo; the_info->si_code = SI_USER; ffc08a08: 38 00 00 01 li r0,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; ffc08a0c: 93 df 00 00 stw r30,0(r31) the_info->si_code = SI_USER; ffc08a10: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc08a14: 38 00 00 00 li r0,0 ffc08a18: 90 1f 00 08 stw r0,8(r31) return signo; ffc08a1c: 48 00 00 c4 b ffc08ae0 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08a20: 3d 60 00 00 lis r11,0 ffc08a24: 81 4b 28 78 lwz r10,10360(r11) } the_info->si_signo = -1; ffc08a28: 38 00 ff ff li r0,-1 ffc08a2c: 90 1f 00 00 stw r0,0(r31) ffc08a30: 38 0a 00 01 addi r0,r10,1 ffc08a34: 90 0b 28 78 stw r0,10360(r11) return _Thread_Dispatch_disable_level; ffc08a38: 80 0b 28 78 lwz r0,10360(r11) _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; ffc08a3c: 38 00 00 04 li r0,4 ffc08a40: 90 09 00 34 stw r0,52(r9) } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc08a44: 3d 60 00 00 lis r11,0 ffc08a48: 39 6b 33 8c addi r11,r11,13196 the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; ffc08a4c: 80 1d 00 00 lwz r0,0(r29) } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc08a50: 91 69 00 44 stw r11,68(r9) the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; ffc08a54: 90 09 00 30 stw r0,48(r9) 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; ffc08a58: 38 00 00 01 li r0,1 the_thread->Wait.return_argument = the_info; ffc08a5c: 93 e9 00 28 stw r31,40(r9) ffc08a60: 90 0b 00 30 stw r0,48(r11) ffc08a64: 7f 80 01 24 mtmsr r28 _Thread_queue_Enter_critical_section( &_POSIX_signals_Wait_queue ); _ISR_Enable( level ); _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); ffc08a68: 3c 60 00 00 lis r3,0 ffc08a6c: 3c a0 ff c1 lis r5,-63 ffc08a70: 38 63 33 8c addi r3,r3,13196 ffc08a74: 38 a5 c4 d8 addi r5,r5,-15144 ffc08a78: 48 00 36 b5 bl ffc0c12c <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); ffc08a7c: 48 00 31 61 bl ffc0bbdc <_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 ); ffc08a80: 80 9f 00 00 lwz r4,0(r31) ffc08a84: 7f 63 db 78 mr r3,r27 ffc08a88: 7f e5 fb 78 mr r5,r31 ffc08a8c: 38 c0 00 00 li r6,0 ffc08a90: 38 e0 00 00 li r7,0 ffc08a94: 48 00 64 85 bl ffc0ef18 <_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) ffc08a98: 3d 20 00 00 lis r9,0 ffc08a9c: 81 29 31 90 lwz r9,12688(r9) ffc08aa0: 80 09 00 34 lwz r0,52(r9) ffc08aa4: 2f 80 00 04 cmpwi cr7,r0,4 ffc08aa8: 40 9e 00 20 bne- cr7,ffc08ac8 || !(*set & signo_to_mask( the_info->si_signo )) ) { ffc08aac: 83 df 00 00 lwz r30,0(r31) ffc08ab0: 39 20 00 01 li r9,1 ffc08ab4: 38 1e ff ff addi r0,r30,-1 ffc08ab8: 7d 29 00 30 slw r9,r9,r0 ffc08abc: 80 1d 00 00 lwz r0,0(r29) ffc08ac0: 7d 2b 00 39 and. r11,r9,r0 ffc08ac4: 40 a2 00 1c bne+ ffc08ae0 errno = _Thread_Executing->Wait.return_code; ffc08ac8: 48 00 94 8d bl ffc11f54 <__errno> ffc08acc: 3d 20 00 00 lis r9,0 ffc08ad0: 81 29 31 90 lwz r9,12688(r9) ffc08ad4: 80 09 00 34 lwz r0,52(r9) ffc08ad8: 90 03 00 00 stw r0,0(r3) return -1; ffc08adc: 3b c0 ff ff li r30,-1 } return the_info->si_signo; } ffc08ae0: 39 61 00 30 addi r11,r1,48 ffc08ae4: 7f c3 f3 78 mr r3,r30 ffc08ae8: 4b ff 82 30 b ffc00d18 <_restgpr_27_x> =============================================================================== ffc0ab3c : int sigwait( const sigset_t *set, int *sig ) { ffc0ab3c: 7c 2b 0b 78 mr r11,r1 ffc0ab40: 94 21 ff f0 stwu r1,-16(r1) ffc0ab44: 7c 08 02 a6 mflr r0 int status; status = sigtimedwait( set, NULL, NULL ); ffc0ab48: 38 a0 00 00 li r5,0 int sigwait( const sigset_t *set, int *sig ) { ffc0ab4c: 4b ff 7c 65 bl ffc027b0 <_savegpr_31> ffc0ab50: 7c 9f 23 78 mr r31,r4 int status; status = sigtimedwait( set, NULL, NULL ); ffc0ab54: 38 80 00 00 li r4,0 int sigwait( const sigset_t *set, int *sig ) { ffc0ab58: 90 01 00 14 stw r0,20(r1) int status; status = sigtimedwait( set, NULL, NULL ); ffc0ab5c: 4b ff fd d9 bl ffc0a934 if ( status != -1 ) { ffc0ab60: 2f 83 ff ff cmpwi cr7,r3,-1 ffc0ab64: 41 9e 00 18 beq- cr7,ffc0ab7c if ( sig ) ffc0ab68: 2f 9f 00 00 cmpwi cr7,r31,0 *sig = status; return 0; ffc0ab6c: 38 00 00 00 li r0,0 int status; status = sigtimedwait( set, NULL, NULL ); if ( status != -1 ) { if ( sig ) ffc0ab70: 41 9e 00 14 beq- cr7,ffc0ab84 <== NEVER TAKEN *sig = status; ffc0ab74: 90 7f 00 00 stw r3,0(r31) ffc0ab78: 48 00 00 0c b ffc0ab84 return 0; } return errno; ffc0ab7c: 48 00 91 3d bl ffc13cb8 <__errno> ffc0ab80: 80 03 00 00 lwz r0,0(r3) } ffc0ab84: 39 61 00 10 addi r11,r1,16 ffc0ab88: 7c 03 03 78 mr r3,r0 ffc0ab8c: 4b ff 7c 70 b ffc027fc <_restgpr_31_x> =============================================================================== ffc07ac0 : timer_t *timerid ) { POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc07ac0: 2f 83 00 01 cmpwi cr7,r3,1 int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { ffc07ac4: 94 21 ff f0 stwu r1,-16(r1) ffc07ac8: 7c 08 02 a6 mflr r0 ffc07acc: bf c1 00 08 stmw r30,8(r1) ffc07ad0: 7c 9f 23 78 mr r31,r4 ffc07ad4: 7c be 2b 78 mr r30,r5 ffc07ad8: 90 01 00 14 stw r0,20(r1) POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc07adc: 40 9e 00 3c bne- cr7,ffc07b18 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) ffc07ae0: 2f 85 00 00 cmpwi cr7,r5,0 ffc07ae4: 41 9e 00 34 beq- cr7,ffc07b18 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { ffc07ae8: 2f 84 00 00 cmpwi cr7,r4,0 ffc07aec: 41 9e 00 38 beq- cr7,ffc07b24 /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && ffc07af0: 81 24 00 00 lwz r9,0(r4) ffc07af4: 38 09 ff ff addi r0,r9,-1 ffc07af8: 2b 80 00 01 cmplwi cr7,r0,1 ffc07afc: 41 9d 00 1c bgt- cr7,ffc07b18 <== NEVER TAKEN ( 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 ) ffc07b00: 81 24 00 04 lwz r9,4(r4) ffc07b04: 2f 89 00 00 cmpwi cr7,r9,0 ffc07b08: 41 9e 00 10 beq- cr7,ffc07b18 <== NEVER TAKEN static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc07b0c: 39 29 ff ff addi r9,r9,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) ffc07b10: 2b 89 00 1f cmplwi cr7,r9,31 ffc07b14: 40 bd 00 10 ble+ cr7,ffc07b24 <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); ffc07b18: 48 00 99 89 bl ffc114a0 <__errno> ffc07b1c: 38 00 00 16 li r0,22 ffc07b20: 48 00 00 38 b ffc07b58 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc07b24: 3d 20 00 00 lis r9,0 ffc07b28: 81 69 28 54 lwz r11,10324(r9) ffc07b2c: 38 0b 00 01 addi r0,r11,1 ffc07b30: 90 09 28 54 stw r0,10324(r9) return _Thread_Dispatch_disable_level; ffc07b34: 80 09 28 54 lwz r0,10324(r9) * 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 ); ffc07b38: 3c 60 00 00 lis r3,0 ffc07b3c: 38 63 2f 2c addi r3,r3,12076 ffc07b40: 48 00 21 71 bl ffc09cb0 <_Objects_Allocate> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { ffc07b44: 2c 03 00 00 cmpwi r3,0 ffc07b48: 40 a2 00 1c bne+ ffc07b64 _Thread_Enable_dispatch(); ffc07b4c: 48 00 35 51 bl ffc0b09c <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc07b50: 48 00 99 51 bl ffc114a0 <__errno> ffc07b54: 38 00 00 0b li r0,11 ffc07b58: 90 03 00 00 stw r0,0(r3) ffc07b5c: 38 60 ff ff li r3,-1 ffc07b60: 48 00 00 88 b ffc07be8 } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ffc07b64: 38 00 00 02 li r0,2 ffc07b68: 98 03 00 3c stb r0,60(r3) ptimer->thread_id = _Thread_Executing->Object.id; ffc07b6c: 3d 20 00 00 lis r9,0 if ( evp != NULL ) { ffc07b70: 2f 9f 00 00 cmpwi cr7,r31,0 } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; ffc07b74: 81 29 31 70 lwz r9,12656(r9) ffc07b78: 80 09 00 08 lwz r0,8(r9) ffc07b7c: 90 03 00 38 stw r0,56(r3) if ( evp != NULL ) { ffc07b80: 41 9e 00 1c beq- cr7,ffc07b9c ptimer->inf.sigev_notify = evp->sigev_notify; ffc07b84: 80 1f 00 00 lwz r0,0(r31) ffc07b88: 90 03 00 40 stw r0,64(r3) ptimer->inf.sigev_signo = evp->sigev_signo; ffc07b8c: 80 1f 00 04 lwz r0,4(r31) ffc07b90: 90 03 00 44 stw r0,68(r3) ptimer->inf.sigev_value = evp->sigev_value; ffc07b94: 80 1f 00 08 lwz r0,8(r31) ffc07b98: 90 03 00 48 stw r0,72(r3) uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc07b9c: 81 23 00 08 lwz r9,8(r3) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc07ba0: 3d 60 00 00 lis r11,0 ffc07ba4: 81 4b 2f 48 lwz r10,12104(r11) } ptimer->overrun = 0; ffc07ba8: 38 00 00 00 li r0,0 ffc07bac: 55 2b 13 ba rlwinm r11,r9,2,14,29 ffc07bb0: 90 03 00 68 stw r0,104(r3) ptimer->timer_data.it_value.tv_sec = 0; ffc07bb4: 90 03 00 5c stw r0,92(r3) ptimer->timer_data.it_value.tv_nsec = 0; ffc07bb8: 90 03 00 60 stw r0,96(r3) ptimer->timer_data.it_interval.tv_sec = 0; ffc07bbc: 90 03 00 54 stw r0,84(r3) ptimer->timer_data.it_interval.tv_nsec = 0; ffc07bc0: 90 03 00 58 stw r0,88(r3) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc07bc4: 90 03 00 18 stw r0,24(r3) the_watchdog->routine = routine; ffc07bc8: 90 03 00 2c stw r0,44(r3) the_watchdog->id = id; ffc07bcc: 90 03 00 30 stw r0,48(r3) the_watchdog->user_data = user_data; ffc07bd0: 90 03 00 34 stw r0,52(r3) ffc07bd4: 7c 6a 59 2e stwx r3,r10,r11 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc07bd8: 90 03 00 0c stw r0,12(r3) _Watchdog_Initialize( &ptimer->Timer, NULL, 0, NULL ); _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; ffc07bdc: 91 3e 00 00 stw r9,0(r30) _Thread_Enable_dispatch(); ffc07be0: 48 00 34 bd bl ffc0b09c <_Thread_Enable_dispatch> return 0; ffc07be4: 38 60 00 00 li r3,0 } ffc07be8: 39 61 00 10 addi r11,r1,16 ffc07bec: 4b ff 8a 68 b ffc00654 <_restgpr_30_x> =============================================================================== ffc07bf0 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { ffc07bf0: 94 21 ff c8 stwu r1,-56(r1) ffc07bf4: 7c 08 02 a6 mflr r0 ffc07bf8: bf 81 00 28 stmw r28,40(r1) Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) ffc07bfc: 7c bd 2b 79 mr. r29,r5 timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { ffc07c00: 7c 7f 1b 78 mr r31,r3 ffc07c04: 90 01 00 3c stw r0,60(r1) ffc07c08: 7c 9c 23 78 mr r28,r4 ffc07c0c: 7c de 33 78 mr r30,r6 Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) ffc07c10: 41 82 01 58 beq- ffc07d68 <== 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) ) ) { ffc07c14: 38 7d 00 08 addi r3,r29,8 ffc07c18: 48 00 40 c9 bl ffc0bce0 <_Timespec_Is_valid> ffc07c1c: 2f 83 00 00 cmpwi cr7,r3,0 ffc07c20: 41 9e 01 48 beq- cr7,ffc07d68 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { ffc07c24: 7f a3 eb 78 mr r3,r29 ffc07c28: 48 00 40 b9 bl ffc0bce0 <_Timespec_Is_valid> ffc07c2c: 2f 83 00 00 cmpwi cr7,r3,0 ffc07c30: 41 9e 01 38 beq- cr7,ffc07d68 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { ffc07c34: 2f 9c 00 04 cmpwi cr7,r28,4 ffc07c38: 41 9e 00 0c beq- cr7,ffc07c44 ffc07c3c: 2f 9c 00 00 cmpwi cr7,r28,0 ffc07c40: 40 9e 01 28 bne- cr7,ffc07d68 } normalize = *value; /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { ffc07c44: 2f 9c 00 04 cmpwi cr7,r28,4 if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc07c48: 39 21 00 14 addi r9,r1,20 ffc07c4c: 7c bd 84 aa lswi r5,r29,16 ffc07c50: 7c a9 85 aa stswi r5,r9,16 /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { ffc07c54: 40 be 00 30 bne+ cr7,ffc07c84 struct timespec now; _TOD_Get( &now ); ffc07c58: 38 61 00 0c addi r3,r1,12 ffc07c5c: 48 00 1a d1 bl ffc0972c <_TOD_Get> /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) ffc07c60: 38 61 00 0c addi r3,r1,12 ffc07c64: 38 81 00 1c addi r4,r1,28 ffc07c68: 48 00 40 3d bl ffc0bca4 <_Timespec_Greater_than> ffc07c6c: 2f 83 00 00 cmpwi cr7,r3,0 ffc07c70: 40 9e 00 f8 bne- cr7,ffc07d68 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); ffc07c74: 38 81 00 1c addi r4,r1,28 ffc07c78: 38 61 00 0c addi r3,r1,12 ffc07c7c: 7c 85 23 78 mr r5,r4 ffc07c80: 48 00 40 a1 bl ffc0bd20 <_Timespec_Subtract> RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get ( timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) ffc07c84: 3c 60 00 00 lis r3,0 ffc07c88: 7f e4 fb 78 mr r4,r31 ffc07c8c: 38 63 2f 2c addi r3,r3,12076 ffc07c90: 38 a1 00 08 addi r5,r1,8 ffc07c94: 48 00 25 3d bl ffc0a1d0 <_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 ) { ffc07c98: 80 01 00 08 lwz r0,8(r1) ffc07c9c: 7c 7f 1b 78 mr r31,r3 ffc07ca0: 2f 80 00 00 cmpwi cr7,r0,0 ffc07ca4: 40 9e 00 c4 bne- cr7,ffc07d68 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 ) { ffc07ca8: 80 01 00 1c lwz r0,28(r1) ffc07cac: 2f 80 00 00 cmpwi cr7,r0,0 ffc07cb0: 40 9e 00 44 bne- cr7,ffc07cf4 ffc07cb4: 80 01 00 20 lwz r0,32(r1) ffc07cb8: 2f 80 00 00 cmpwi cr7,r0,0 ffc07cbc: 40 be 00 38 bne+ cr7,ffc07cf4 /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); ffc07cc0: 38 63 00 10 addi r3,r3,16 ffc07cc4: 48 00 45 99 bl ffc0c25c <_Watchdog_Remove> /* The old data of the timer are returned */ if ( ovalue ) ffc07cc8: 2f 9e 00 00 cmpwi cr7,r30,0 ffc07ccc: 39 3f 00 54 addi r9,r31,84 ffc07cd0: 41 9e 00 0c beq- cr7,ffc07cdc *ovalue = ptimer->timer_data; ffc07cd4: 7c a9 84 aa lswi r5,r9,16 ffc07cd8: 7c be 85 aa stswi r5,r30,16 /* The new data are set */ ptimer->timer_data = normalize; ffc07cdc: 39 61 00 14 addi r11,r1,20 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; ffc07ce0: 38 00 00 04 li r0,4 (void) _Watchdog_Remove( &ptimer->Timer ); /* The old data of the timer are returned */ if ( ovalue ) *ovalue = ptimer->timer_data; /* The new data are set */ ptimer->timer_data = normalize; ffc07ce4: 7c ab 84 aa lswi r5,r11,16 ffc07ce8: 7c a9 85 aa stswi r5,r9,16 /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; ffc07cec: 98 1f 00 3c stb r0,60(r31) ffc07cf0: 48 00 00 6c b ffc07d5c _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); ffc07cf4: 7f a3 eb 78 mr r3,r29 ffc07cf8: 48 00 40 69 bl ffc0bd60 <_Timespec_To_ticks> ffc07cfc: 90 7f 00 64 stw r3,100(r31) initial_period = _Timespec_To_ticks( &normalize.it_value ); ffc07d00: 38 61 00 1c addi r3,r1,28 ffc07d04: 48 00 40 5d bl ffc0bd60 <_Timespec_To_ticks> activated = _POSIX_Timer_Insert_helper( ffc07d08: 80 bf 00 08 lwz r5,8(r31) ffc07d0c: 3c c0 ff c0 lis r6,-64 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 ); ffc07d10: 7c 64 1b 78 mr r4,r3 activated = _POSIX_Timer_Insert_helper( ffc07d14: 38 c6 7d 80 addi r6,r6,32128 ffc07d18: 38 7f 00 10 addi r3,r31,16 ffc07d1c: 7f e7 fb 78 mr r7,r31 ffc07d20: 48 00 69 a9 bl ffc0e6c8 <_POSIX_Timer_Insert_helper> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { ffc07d24: 2f 83 00 00 cmpwi cr7,r3,0 ffc07d28: 41 9e 00 34 beq- cr7,ffc07d5c /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) ffc07d2c: 2f 9e 00 00 cmpwi cr7,r30,0 ffc07d30: 39 3f 00 54 addi r9,r31,84 ffc07d34: 41 9e 00 0c beq- cr7,ffc07d40 *ovalue = ptimer->timer_data; ffc07d38: 7c a9 84 aa lswi r5,r9,16 ffc07d3c: 7c be 85 aa stswi r5,r30,16 ptimer->timer_data = normalize; ffc07d40: 39 61 00 14 addi r11,r1,20 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc07d44: 38 00 00 03 li r0,3 * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) *ovalue = ptimer->timer_data; ptimer->timer_data = normalize; ffc07d48: 7c ab 84 aa lswi r5,r11,16 ffc07d4c: 7c a9 85 aa stswi r5,r9,16 /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; _TOD_Get( &ptimer->time ); ffc07d50: 38 7f 00 6c addi r3,r31,108 if ( ovalue ) *ovalue = ptimer->timer_data; ptimer->timer_data = normalize; /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc07d54: 98 1f 00 3c stb r0,60(r31) _TOD_Get( &ptimer->time ); ffc07d58: 48 00 19 d5 bl ffc0972c <_TOD_Get> _Thread_Enable_dispatch(); ffc07d5c: 48 00 33 41 bl ffc0b09c <_Thread_Enable_dispatch> return 0; ffc07d60: 38 60 00 00 li r3,0 ffc07d64: 48 00 00 14 b ffc07d78 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); ffc07d68: 48 00 97 39 bl ffc114a0 <__errno> ffc07d6c: 38 00 00 16 li r0,22 ffc07d70: 90 03 00 00 stw r0,0(r3) ffc07d74: 38 60 ff ff li r3,-1 } ffc07d78: 39 61 00 38 addi r11,r1,56 ffc07d7c: 4b ff 88 d0 b ffc0064c <_restgpr_28_x> =============================================================================== ffc079c0 : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc079c0: 94 21 ff d8 stwu r1,-40(r1) ffc079c4: 7c 08 02 a6 mflr r0 ffc079c8: bf a1 00 1c stmw r29,28(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc079cc: 3f a0 00 00 lis r29,0 ffc079d0: 3b bd 35 74 addi r29,r29,13684 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc079d4: 90 01 00 2c stw r0,44(r1) ffc079d8: 7c 7e 1b 78 mr r30,r3 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc079dc: 80 1d 00 1c lwz r0,28(r29) ffc079e0: 2f 80 00 00 cmpwi cr7,r0,0 ffc079e4: 40 be 00 24 bne+ cr7,ffc07a08 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc079e8: 3d 20 ff c0 lis r9,-64 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc079ec: 90 1d 00 08 stw r0,8(r29) the_watchdog->routine = routine; ffc079f0: 39 29 79 78 addi r9,r9,31096 ffc079f4: 91 3d 00 1c stw r9,28(r29) useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc079f8: 3b e0 00 00 li r31,0 the_watchdog->id = id; ffc079fc: 90 1d 00 20 stw r0,32(r29) the_watchdog->user_data = user_data; ffc07a00: 90 1d 00 24 stw r0,36(r29) ffc07a04: 48 00 00 58 b ffc07a5c if ( !the_timer->routine ) { _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); ffc07a08: 7f a3 eb 78 mr r3,r29 ffc07a0c: 48 00 43 91 bl ffc0bd9c <_Watchdog_Remove> useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc07a10: 3b e0 00 00 li r31,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) ) { ffc07a14: 38 63 ff fe addi r3,r3,-2 ffc07a18: 2b 83 00 01 cmplwi cr7,r3,1 ffc07a1c: 41 bd 00 40 bgt+ cr7,ffc07a5c <== 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); ffc07a20: 80 1d 00 0c lwz r0,12(r29) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc07a24: 38 81 00 08 addi r4,r1,8 * 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); ffc07a28: 80 7d 00 14 lwz r3,20(r29) ffc07a2c: 7c 63 02 14 add r3,r3,r0 ffc07a30: 80 1d 00 18 lwz r0,24(r29) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc07a34: 7c 60 18 50 subf r3,r0,r3 ffc07a38: 48 00 3d 41 bl ffc0b778 <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; ffc07a3c: 81 21 00 08 lwz r9,8(r1) ffc07a40: 3c 00 00 0f lis r0,15 remaining += tp.tv_nsec / 1000; ffc07a44: 83 e1 00 0c lwz r31,12(r1) ticks = the_timer->initial; ticks -= (the_timer->stop_time - the_timer->start_time); /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; ffc07a48: 60 00 42 40 ori r0,r0,16960 ffc07a4c: 7c 00 49 d6 mullw r0,r0,r9 remaining += tp.tv_nsec / 1000; ffc07a50: 39 20 03 e8 li r9,1000 ffc07a54: 7f ff 4b d6 divw r31,r31,r9 ffc07a58: 7f ff 02 14 add r31,r31,r0 /* * 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 ) { ffc07a5c: 2f 9e 00 00 cmpwi cr7,r30,0 ffc07a60: 41 be 00 4c beq+ cr7,ffc07aac Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; ffc07a64: 3c 00 00 0f lis r0,15 ffc07a68: 60 00 42 40 ori r0,r0,16960 ffc07a6c: 7d 3e 03 96 divwu r9,r30,r0 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc07a70: 7c 09 01 d6 mullw r0,r9,r0 * 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; ffc07a74: 91 21 00 08 stw r9,8(r1) tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); ffc07a78: 38 61 00 08 addi r3,r1,8 */ if ( useconds ) { Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc07a7c: 7f c0 f0 50 subf r30,r0,r30 ffc07a80: 1f de 03 e8 mulli r30,r30,1000 ffc07a84: 93 c1 00 0c stw r30,12(r1) ticks = _Timespec_To_ticks( &tp ); ffc07a88: 48 00 3d 61 bl ffc0b7e8 <_Timespec_To_ticks> if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); ffc07a8c: 38 61 00 08 addi r3,r1,8 ffc07a90: 48 00 3d 59 bl ffc0b7e8 <_Timespec_To_ticks> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc07a94: 3c 80 00 00 lis r4,0 ffc07a98: 38 84 35 74 addi r4,r4,13684 ffc07a9c: 90 64 00 0c stw r3,12(r4) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc07aa0: 3c 60 00 00 lis r3,0 ffc07aa4: 38 63 2d a8 addi r3,r3,11688 ffc07aa8: 48 00 41 9d bl ffc0bc44 <_Watchdog_Insert> } return remaining; } ffc07aac: 39 61 00 28 addi r11,r1,40 ffc07ab0: 7f e3 fb 78 mr r3,r31 ffc07ab4: 4b ff 8a e8 b ffc0059c <_restgpr_29_x>