=============================================================================== ffc09f30 <_API_extensions_Run_postdriver>: /* * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc09f30: 94 21 ff f0 stwu r1,-16(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc09f34: 3d 20 00 00 lis r9,0 ffc09f38: 7c 08 02 a6 mflr r0 ffc09f3c: 93 c1 00 08 stw r30,8(r1) ffc09f40: 3b c9 2e 00 addi r30,r9,11776 Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09f44: 3b de 00 04 addi r30,r30,4 /* * _API_extensions_Run_postdriver */ void _API_extensions_Run_postdriver( void ) { ffc09f48: 93 e1 00 0c stw r31,12(r1) ffc09f4c: 83 e9 2e 00 lwz r31,11776(r9) ffc09f50: 90 01 00 14 stw r0,20(r1) Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09f54: 7f 9f f0 00 cmpw cr7,r31,r30 ffc09f58: 41 9e 00 1c beq- cr7,ffc09f74 <_API_extensions_Run_postdriver+0x44><== NEVER TAKEN * Currently all APIs configure this hook so it is always non-NULL. */ #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); ffc09f5c: 80 1f 00 08 lwz r0,8(r31) ffc09f60: 7c 09 03 a6 mtctr r0 ffc09f64: 4e 80 04 21 bctrl Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { ffc09f68: 83 ff 00 00 lwz r31,0(r31) void _API_extensions_Run_postdriver( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09f6c: 7f 9f f0 00 cmpw cr7,r31,r30 ffc09f70: 40 9e ff ec bne+ cr7,ffc09f5c <_API_extensions_Run_postdriver+0x2c> #if defined(FUNCTIONALITY_NOT_CURRENTLY_USED_BY_ANY_API) if ( the_extension->postdriver_hook ) #endif (*the_extension->postdriver_hook)(); } } ffc09f74: 80 01 00 14 lwz r0,20(r1) ffc09f78: 83 c1 00 08 lwz r30,8(r1) ffc09f7c: 7c 08 03 a6 mtlr r0 ffc09f80: 83 e1 00 0c lwz r31,12(r1) ffc09f84: 38 21 00 10 addi r1,r1,16 ffc09f88: 4e 80 00 20 blr =============================================================================== ffc09f8c <_API_extensions_Run_postswitch>: /* * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc09f8c: 94 21 ff e8 stwu r1,-24(r1) ffc09f90: 3d 20 00 00 lis r9,0 ffc09f94: 7c 08 02 a6 mflr r0 ffc09f98: 93 c1 00 10 stw r30,16(r1) ffc09f9c: 3b c9 2e 00 addi r30,r9,11776 Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09fa0: 3b de 00 04 addi r30,r30,4 /* * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc09fa4: 93 e1 00 14 stw r31,20(r1) ffc09fa8: 83 e9 2e 00 lwz r31,11776(r9) ffc09fac: 90 01 00 1c stw r0,28(r1) Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09fb0: 7f 9f f0 00 cmpw cr7,r31,r30 /* * _API_extensions_Run_postswitch */ void _API_extensions_Run_postswitch( void ) { ffc09fb4: 93 a1 00 0c stw r29,12(r1) Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09fb8: 41 9e 00 28 beq- cr7,ffc09fe0 <_API_extensions_Run_postswitch+0x54><== NEVER TAKEN ffc09fbc: 3f a0 00 00 lis r29,0 ffc09fc0: 3b bd 31 44 addi r29,r29,12612 !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); ffc09fc4: 80 1f 00 0c lwz r0,12(r31) ffc09fc8: 80 7d 00 0c lwz r3,12(r29) ffc09fcc: 7c 09 03 a6 mtctr r0 ffc09fd0: 4e 80 04 21 bctrl Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); !_Chain_Is_tail( &_API_extensions_List, the_node ) ; the_node = the_node->next ) { ffc09fd4: 83 ff 00 00 lwz r31,0(r31) void _API_extensions_Run_postswitch( void ) { Chain_Node *the_node; API_extensions_Control *the_extension; for ( the_node = _Chain_First( &_API_extensions_List ); ffc09fd8: 7f 9f f0 00 cmpw cr7,r31,r30 ffc09fdc: 40 9e ff e8 bne+ cr7,ffc09fc4 <_API_extensions_Run_postswitch+0x38> the_extension = (API_extensions_Control *) the_node; (*the_extension->postswitch_hook)( _Thread_Executing ); } } ffc09fe0: 80 01 00 1c lwz r0,28(r1) ffc09fe4: 83 a1 00 0c lwz r29,12(r1) ffc09fe8: 7c 08 03 a6 mtlr r0 ffc09fec: 83 c1 00 10 lwz r30,16(r1) ffc09ff0: 83 e1 00 14 lwz r31,20(r1) ffc09ff4: 38 21 00 18 addi r1,r1,24 ffc09ff8: 4e 80 00 20 blr =============================================================================== ffc0c924 <_CORE_RWLock_Release>: */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0c924: 94 21 ff f0 stwu r1,-16(r1) ffc0c928: 7c 08 02 a6 mflr r0 ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0c92c: 3d 20 00 00 lis r9,0 */ CORE_RWLock_Status _CORE_RWLock_Release( CORE_RWLock_Control *the_rwlock ) { ffc0c930: 90 01 00 14 stw r0,20(r1) ffc0c934: 93 e1 00 0c stw r31,12(r1) ffc0c938: 7c 7f 1b 78 mr r31,r3 ISR_Level level; Thread_Control *executing = _Thread_Executing; ffc0c93c: 81 29 31 30 lwz r9,12592(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0c940: 7d 60 00 a6 mfmsr r11 ffc0c944: 7c 10 42 a6 mfsprg r0,0 ffc0c948: 7d 60 00 78 andc r0,r11,r0 ffc0c94c: 7c 00 01 24 mtmsr r0 * 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){ ffc0c950: 80 03 00 44 lwz r0,68(r3) ffc0c954: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c958: 41 9e 00 cc beq- cr7,ffc0ca24 <_CORE_RWLock_Release+0x100> _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; return CORE_RWLOCK_SUCCESSFUL; } if ( the_rwlock->current_state == CORE_RWLOCK_LOCKED_FOR_READING ) { ffc0c95c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0c960: 41 9e 00 94 beq- cr7,ffc0c9f4 <_CORE_RWLock_Release+0xd0> return CORE_RWLOCK_SUCCESSFUL; } } /* CORE_RWLOCK_LOCKED_FOR_WRITING or READING with readers */ executing->Wait.return_code = CORE_RWLOCK_SUCCESSFUL; ffc0c964: 38 00 00 00 li r0,0 ffc0c968: 90 09 00 34 stw r0,52(r9) /* * Implicitly transition to "unlocked" and find another thread interested * in obtaining this rwlock. */ the_rwlock->current_state = CORE_RWLOCK_UNLOCKED; ffc0c96c: 90 1f 00 44 stw r0,68(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0c970: 7d 60 01 24 mtmsr r11 _ISR_Enable( level ); next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); ffc0c974: 7f e3 fb 78 mr r3,r31 ffc0c978: 48 00 23 a5 bl ffc0ed1c <_Thread_queue_Dequeue> if ( next ) { ffc0c97c: 2c 03 00 00 cmpwi r3,0 ffc0c980: 41 82 00 5c beq- ffc0c9dc <_CORE_RWLock_Release+0xb8> if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { ffc0c984: 80 03 00 30 lwz r0,48(r3) ffc0c988: 2f 80 00 01 cmpwi cr7,r0,1 ffc0c98c: 41 9e 00 bc beq- cr7,ffc0ca48 <_CORE_RWLock_Release+0x124> } /* * Must be CORE_RWLOCK_THREAD_WAITING_FOR_READING */ the_rwlock->number_of_readers += 1; ffc0c990: 81 3f 00 48 lwz r9,72(r31) ffc0c994: 38 09 00 01 addi r0,r9,1 ffc0c998: 90 1f 00 48 stw r0,72(r31) the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_READING; ffc0c99c: 38 00 00 01 li r0,1 ffc0c9a0: 90 1f 00 44 stw r0,68(r31) ffc0c9a4: 48 00 00 20 b ffc0c9c4 <_CORE_RWLock_Release+0xa0> /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); if ( !next || ffc0c9a8: 80 09 00 30 lwz r0,48(r9) ffc0c9ac: 2f 80 00 01 cmpwi cr7,r0,1 ffc0c9b0: 41 9e 00 2c beq- cr7,ffc0c9dc <_CORE_RWLock_Release+0xb8><== NEVER TAKEN next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; ffc0c9b4: 81 3f 00 48 lwz r9,72(r31) ffc0c9b8: 38 09 00 01 addi r0,r9,1 ffc0c9bc: 90 1f 00 48 stw r0,72(r31) _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); ffc0c9c0: 48 00 27 fd bl ffc0f1bc <_Thread_queue_Extract> /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); ffc0c9c4: 7f e3 fb 78 mr r3,r31 ffc0c9c8: 48 00 29 7d bl ffc0f344 <_Thread_queue_First> if ( !next || ffc0c9cc: 7c 69 1b 79 mr. r9,r3 next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) return CORE_RWLOCK_SUCCESSFUL; the_rwlock->number_of_readers += 1; _Thread_queue_Extract( &the_rwlock->Wait_queue, next ); ffc0c9d0: 7f e3 fb 78 mr r3,r31 ffc0c9d4: 7d 24 4b 78 mr r4,r9 /* * Now see if more readers can be let go. */ while ( 1 ) { next = _Thread_queue_First( &the_rwlock->Wait_queue ); if ( !next || ffc0c9d8: 40 82 ff d0 bne+ ffc0c9a8 <_CORE_RWLock_Release+0x84> } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0c9dc: 80 01 00 14 lwz r0,20(r1) ffc0c9e0: 38 60 00 00 li r3,0 ffc0c9e4: 83 e1 00 0c lwz r31,12(r1) ffc0c9e8: 38 21 00 10 addi r1,r1,16 ffc0c9ec: 7c 08 03 a6 mtlr r0 ffc0c9f0: 4e 80 00 20 blr _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; ffc0c9f4: 81 43 00 48 lwz r10,72(r3) ffc0c9f8: 38 0a ff ff addi r0,r10,-1 if ( the_rwlock->number_of_readers != 0 ) { ffc0c9fc: 2f 80 00 00 cmpwi cr7,r0,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; ffc0ca00: 90 03 00 48 stw r0,72(r3) if ( the_rwlock->number_of_readers != 0 ) { ffc0ca04: 41 9e ff 60 beq+ cr7,ffc0c964 <_CORE_RWLock_Release+0x40> ffc0ca08: 7d 60 01 24 mtmsr r11 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0ca0c: 80 01 00 14 lwz r0,20(r1) ffc0ca10: 38 60 00 00 li r3,0 ffc0ca14: 83 e1 00 0c lwz r31,12(r1) ffc0ca18: 38 21 00 10 addi r1,r1,16 ffc0ca1c: 7c 08 03 a6 mtlr r0 ffc0ca20: 4e 80 00 20 blr ffc0ca24: 7d 60 01 24 mtmsr r11 */ _ISR_Disable( level ); if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; ffc0ca28: 38 00 00 02 li r0,2 } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0ca2c: 83 e1 00 0c lwz r31,12(r1) */ _ISR_Disable( level ); if ( the_rwlock->current_state == CORE_RWLOCK_UNLOCKED){ _ISR_Enable( level ); executing->Wait.return_code = CORE_RWLOCK_UNAVAILABLE; ffc0ca30: 90 09 00 34 stw r0,52(r9) } /* indentation is to match _ISR_Disable at top */ return CORE_RWLOCK_SUCCESSFUL; } ffc0ca34: 38 60 00 00 li r3,0 ffc0ca38: 80 01 00 14 lwz r0,20(r1) ffc0ca3c: 38 21 00 10 addi r1,r1,16 ffc0ca40: 7c 08 03 a6 mtlr r0 ffc0ca44: 4e 80 00 20 blr next = _Thread_queue_Dequeue( &the_rwlock->Wait_queue ); if ( next ) { if ( next->Wait.option == CORE_RWLOCK_THREAD_WAITING_FOR_WRITE ) { the_rwlock->current_state = CORE_RWLOCK_LOCKED_FOR_WRITING; ffc0ca48: 38 00 00 02 li r0,2 ffc0ca4c: 90 1f 00 44 stw r0,68(r31) return CORE_RWLOCK_SUCCESSFUL; ffc0ca50: 4b ff ff 8c b ffc0c9dc <_CORE_RWLock_Release+0xb8> =============================================================================== ffc0ca54 <_CORE_RWLock_Timeout>: void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0ca54: 94 21 ff e8 stwu r1,-24(r1) ffc0ca58: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0ca5c: 38 81 00 08 addi r4,r1,8 void _CORE_RWLock_Timeout( Objects_Id id, void *ignored ) { ffc0ca60: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0ca64: 48 00 1e b5 bl ffc0e918 <_Thread_Get> switch ( location ) { ffc0ca68: 80 01 00 08 lwz r0,8(r1) ffc0ca6c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ca70: 40 9e 00 1c bne- cr7,ffc0ca8c <_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 ); ffc0ca74: 48 00 2a 11 bl ffc0f484 <_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--; ffc0ca78: 3d 20 00 00 lis r9,0 ffc0ca7c: 81 69 28 34 lwz r11,10292(r9) ffc0ca80: 38 0b ff ff addi r0,r11,-1 ffc0ca84: 90 09 28 34 stw r0,10292(r9) return _Thread_Dispatch_disable_level; ffc0ca88: 80 09 28 34 lwz r0,10292(r9) _Thread_Unnest_dispatch(); break; } } ffc0ca8c: 80 01 00 1c lwz r0,28(r1) ffc0ca90: 38 21 00 18 addi r1,r1,24 ffc0ca94: 7c 08 03 a6 mtlr r0 ffc0ca98: 4e 80 00 20 blr =============================================================================== ffc14f38 <_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 ) { ffc14f38: 94 21 ff e0 stwu r1,-32(r1) ffc14f3c: 7c 08 02 a6 mflr r0 ffc14f40: 90 01 00 24 stw r0,36(r1) /* * 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)) { ffc14f44: 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; the_message_queue->number_of_pending_messages = 0; ffc14f48: 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 ) { ffc14f4c: 93 81 00 10 stw r28,16(r1) /* * 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)) { ffc14f50: 7c dc 33 78 mr r28,r6 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 ) { ffc14f54: 93 a1 00 14 stw r29,20(r1) ffc14f58: 7c 9d 23 78 mr r29,r4 ffc14f5c: 93 e1 00 1c stw r31,28(r1) ffc14f60: 7c 7f 1b 78 mr r31,r3 ffc14f64: 93 c1 00 18 stw r30,24(r1) size_t message_buffering_required = 0; size_t allocated_message_size; the_message_queue->maximum_pending_messages = maximum_pending_messages; ffc14f68: 90 a3 00 44 stw r5,68(r3) the_message_queue->number_of_pending_messages = 0; ffc14f6c: 90 03 00 48 stw r0,72(r3) the_message_queue->maximum_message_size = maximum_message_size; ffc14f70: 90 c3 00 4c stw r6,76(r3) CORE_message_queue_Control *the_message_queue, CORE_message_queue_Notify_Handler the_handler, void *the_argument ) { the_message_queue->notify_handler = the_handler; ffc14f74: 90 03 00 60 stw r0,96(r3) the_message_queue->notify_argument = the_argument; ffc14f78: 90 03 00 64 stw r0,100(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)) { ffc14f7c: 41 82 00 3c beq- ffc14fb8 <_CORE_message_queue_Initialize+0x80> allocated_message_size += sizeof(uint32_t); ffc14f80: 3b 86 00 04 addi r28,r6,4 allocated_message_size &= ~(sizeof(uint32_t) - 1); ffc14f84: 57 9c 00 3a rlwinm r28,r28,0,0,29 } if (allocated_message_size < maximum_message_size) ffc14f88: 7f 86 e0 40 cmplw cr7,r6,r28 return false; ffc14f8c: 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) ffc14f90: 40 9d 00 28 ble- cr7,ffc14fb8 <_CORE_message_queue_Initialize+0x80><== ALWAYS TAKEN STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } ffc14f94: 80 01 00 24 lwz r0,36(r1) ffc14f98: 7f c3 f3 78 mr r3,r30 ffc14f9c: 83 81 00 10 lwz r28,16(r1) ffc14fa0: 7c 08 03 a6 mtlr r0 ffc14fa4: 83 a1 00 14 lwz r29,20(r1) ffc14fa8: 83 c1 00 18 lwz r30,24(r1) ffc14fac: 83 e1 00 1c lwz r31,28(r1) ffc14fb0: 38 21 00 20 addi r1,r1,32 ffc14fb4: 4e 80 00 20 blr /* * Calculate how much total memory is required for message buffering and * check for overflow on the multiplication. */ if ( !size_t_mult32_with_overflow( ffc14fb8: 3b 9c 00 14 addi r28,r28,20 size_t a, size_t b, size_t *c ) { long long x = (long long)a*b; ffc14fbc: 7d 45 e0 16 mulhwu r10,r5,r28 ffc14fc0: 7d 65 e1 d6 mullw r11,r5,r28 if ( x > SIZE_MAX ) ffc14fc4: 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; ffc14fc8: 3b c0 00 00 li r30,0 size_t *c ) { long long x = (long long)a*b; if ( x > SIZE_MAX ) ffc14fcc: 41 bd ff c8 bgt- cr7,ffc14f94 <_CORE_message_queue_Initialize+0x5c> /* * Attempt to allocate the message memory */ the_message_queue->message_buffers = (CORE_message_queue_Buffer *) _Workspace_Allocate( message_buffering_required ); ffc14fd0: 7d 63 5b 78 mr r3,r11 ffc14fd4: 90 a1 00 08 stw r5,8(r1) ffc14fd8: 48 00 3d dd bl ffc18db4 <_Workspace_Allocate> if (the_message_queue->message_buffers == 0) ffc14fdc: 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 *) ffc14fe0: 90 7f 00 5c stw r3,92(r31) _Workspace_Allocate( message_buffering_required ); ffc14fe4: 7c 64 1b 78 mr r4,r3 if (the_message_queue->message_buffers == 0) ffc14fe8: 80 a1 00 08 lwz r5,8(r1) ffc14fec: 41 be ff a8 beq- cr7,ffc14f94 <_CORE_message_queue_Initialize+0x5c> /* * Initialize the pool of inactive messages, pending messages, * and set of waiting threads. */ _Chain_Initialize ( ffc14ff0: 38 7f 00 68 addi r3,r31,104 ffc14ff4: 7f 86 e3 78 mr r6,r28 ffc14ff8: 48 00 6d fd bl ffc1bdf4 <_Chain_Initialize> allocated_message_size + sizeof( CORE_message_queue_Buffer_control ) ); _Chain_Initialize_empty( &the_message_queue->Pending_messages ); _Thread_queue_Initialize( ffc14ffc: 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 ); ffc15000: 38 1f 00 50 addi r0,r31,80 head->next = tail; head->previous = NULL; ffc15004: 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 ); ffc15008: 39 3f 00 54 addi r9,r31,84 ffc1500c: 68 84 00 01 xori r4,r4,1 head->next = tail; head->previous = NULL; tail->previous = head; ffc15010: 90 1f 00 58 stw r0,88(r31) ffc15014: 7c 84 00 34 cntlzw r4,r4 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc15018: 91 3f 00 50 stw r9,80(r31) ffc1501c: 7f e3 fb 78 mr r3,r31 ffc15020: 54 84 d9 7e rlwinm r4,r4,27,5,31 ffc15024: 38 a0 00 80 li r5,128 ffc15028: 38 c0 00 06 li r6,6 ffc1502c: 48 00 2f f1 bl ffc1801c <_Thread_queue_Initialize> STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; } ffc15030: 80 01 00 24 lwz r0,36(r1) THREAD_QUEUE_DISCIPLINE_PRIORITY : THREAD_QUEUE_DISCIPLINE_FIFO, STATES_WAITING_FOR_MESSAGE, CORE_MESSAGE_QUEUE_STATUS_TIMEOUT ); return true; ffc15034: 3b c0 00 01 li r30,1 } ffc15038: 83 81 00 10 lwz r28,16(r1) ffc1503c: 7c 08 03 a6 mtlr r0 ffc15040: 7f c3 f3 78 mr r3,r30 ffc15044: 83 a1 00 14 lwz r29,20(r1) ffc15048: 83 c1 00 18 lwz r30,24(r1) ffc1504c: 83 e1 00 1c lwz r31,28(r1) ffc15050: 38 21 00 20 addi r1,r1,32 ffc15054: 4e 80 00 20 blr =============================================================================== ffc0a680 <_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 ) { ffc0a680: 94 21 ff f0 stwu r1,-16(r1) ffc0a684: 7c 08 02 a6 mflr r0 ffc0a688: 93 e1 00 0c stw r31,12(r1) ffc0a68c: 7c 7f 1b 78 mr r31,r3 ffc0a690: 90 01 00 14 stw r0,20(r1) ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { ffc0a694: 48 00 21 c1 bl ffc0c854 <_Thread_queue_Dequeue> ffc0a698: 2f 83 00 00 cmpwi cr7,r3,0 { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc0a69c: 38 60 00 00 li r3,0 if ( (the_thread = _Thread_queue_Dequeue(&the_semaphore->Wait_queue)) ) { ffc0a6a0: 41 9e 00 18 beq- cr7,ffc0a6b8 <_CORE_semaphore_Surrender+0x38> status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } ffc0a6a4: 80 01 00 14 lwz r0,20(r1) ffc0a6a8: 83 e1 00 0c lwz r31,12(r1) ffc0a6ac: 38 21 00 10 addi r1,r1,16 ffc0a6b0: 7c 08 03 a6 mtlr r0 ffc0a6b4: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a6b8: 7c 00 00 a6 mfmsr r0 ffc0a6bc: 7d 30 42 a6 mfsprg r9,0 ffc0a6c0: 7c 09 48 78 andc r9,r0,r9 ffc0a6c4: 7d 20 01 24 mtmsr r9 (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) ffc0a6c8: 81 3f 00 48 lwz r9,72(r31) the_semaphore->count += 1; else status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; ffc0a6cc: 38 60 00 04 li r3,4 (*api_semaphore_mp_support) ( the_thread, id ); #endif } else { _ISR_Disable( level ); if ( the_semaphore->count < the_semaphore->Attributes.maximum_count ) ffc0a6d0: 81 7f 00 40 lwz r11,64(r31) ffc0a6d4: 7f 89 58 40 cmplw cr7,r9,r11 ffc0a6d8: 40 9c 00 10 bge- cr7,ffc0a6e8 <_CORE_semaphore_Surrender+0x68><== NEVER TAKEN the_semaphore->count += 1; ffc0a6dc: 39 29 00 01 addi r9,r9,1 ffc0a6e0: 91 3f 00 48 stw r9,72(r31) { Thread_Control *the_thread; ISR_Level level; CORE_semaphore_Status status; status = CORE_SEMAPHORE_STATUS_SUCCESSFUL; ffc0a6e4: 38 60 00 00 li r3,0 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a6e8: 7c 00 01 24 mtmsr r0 status = CORE_SEMAPHORE_MAXIMUM_COUNT_EXCEEDED; _ISR_Enable( level ); } return status; } ffc0a6ec: 80 01 00 14 lwz r0,20(r1) ffc0a6f0: 83 e1 00 0c lwz r31,12(r1) ffc0a6f4: 38 21 00 10 addi r1,r1,16 ffc0a6f8: 7c 08 03 a6 mtlr r0 ffc0a6fc: 4e 80 00 20 blr =============================================================================== ffc10c4c <_Chain_Initialize>: Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10c4c: 2c 05 00 00 cmpwi r5,0 Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; ffc10c50: 38 00 00 00 li r0,0 size_t node_size ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); ffc10c54: 39 43 00 04 addi r10,r3,4 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; ffc10c58: 90 03 00 04 stw r0,4(r3) ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; ffc10c5c: 7c 69 1b 78 mr r9,r3 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10c60: 41 82 00 38 beq- ffc10c98 <_Chain_Initialize+0x4c> <== NEVER TAKEN ffc10c64: 39 05 ff ff addi r8,r5,-1 ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; ffc10c68: 7c a9 03 a6 mtctr r5 Chain_Node *next = starting_address; ffc10c6c: 7c 89 23 78 mr r9,r4 ) { size_t count = number_nodes; Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *current = head; ffc10c70: 7c 6b 1b 78 mr r11,r3 ffc10c74: 48 00 00 0c b ffc10c80 <_Chain_Initialize+0x34> Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10c78: 7d 2b 4b 78 mr r11,r9 current->next = next; next->previous = current; current = next; next = (Chain_Node *) ffc10c7c: 7c 09 03 78 mr r9,r0 Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { current->next = next; ffc10c80: 91 2b 00 00 stw r9,0(r11) * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( ffc10c84: 7c 09 32 14 add r0,r9,r6 head->previous = NULL; while ( count-- ) { current->next = next; next->previous = current; ffc10c88: 91 69 00 04 stw r11,4(r9) Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10c8c: 42 00 ff ec bdnz+ ffc10c78 <_Chain_Initialize+0x2c> * node_size - size of node in bytes * * Output parameters: NONE */ void _Chain_Initialize( ffc10c90: 7c c6 41 d6 mullw r6,r6,r8 Chain_Node *current = head; Chain_Node *next = starting_address; head->previous = NULL; while ( count-- ) { ffc10c94: 7d 24 32 14 add r9,r4,r6 current = next; next = (Chain_Node *) _Addresses_Add_offset( (void *) next, node_size ); } current->next = tail; ffc10c98: 91 49 00 00 stw r10,0(r9) tail->previous = current; ffc10c9c: 91 23 00 08 stw r9,8(r3) } ffc10ca0: 4e 80 00 20 blr =============================================================================== ffc08e6c <_Event_Surrender>: */ void _Event_Surrender( Thread_Control *the_thread ) { ffc08e6c: 94 21 ff f0 stwu r1,-16(r1) ffc08e70: 7c 08 02 a6 mflr r0 ffc08e74: 90 01 00 14 stw r0,20(r1) ffc08e78: 93 e1 00 0c stw r31,12(r1) ffc08e7c: 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 ]; ffc08e80: 81 63 01 30 lwz r11,304(r3) option_set = (rtems_option) the_thread->Wait.option; ffc08e84: 80 c3 00 30 lwz r6,48(r3) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc08e88: 7d 40 00 a6 mfmsr r10 ffc08e8c: 7c 10 42 a6 mfsprg r0,0 ffc08e90: 7d 40 00 78 andc r0,r10,r0 ffc08e94: 7c 00 01 24 mtmsr r0 _ISR_Disable( level ); pending_events = api->pending_events; ffc08e98: 81 2b 00 00 lwz r9,0(r11) event_condition = (rtems_event_set) the_thread->Wait.count; ffc08e9c: 80 03 00 24 lwz r0,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 ) ) { ffc08ea0: 7c 08 48 39 and. r8,r0,r9 ffc08ea4: 41 82 00 e4 beq- ffc08f88 <_Event_Surrender+0x11c> /* * 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() && ffc08ea8: 3c e0 00 00 lis r7,0 ffc08eac: 38 e7 31 44 addi r7,r7,12612 ffc08eb0: 80 a7 00 08 lwz r5,8(r7) ffc08eb4: 2f 85 00 00 cmpwi cr7,r5,0 ffc08eb8: 41 9e 00 10 beq- cr7,ffc08ec8 <_Event_Surrender+0x5c> ffc08ebc: 80 e7 00 0c lwz r7,12(r7) ffc08ec0: 7f 83 38 00 cmpw cr7,r3,r7 ffc08ec4: 41 9e 00 78 beq- cr7,ffc08f3c <_Event_Surrender+0xd0> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_for_event ( States_Control the_states ) { return (the_states & STATES_WAITING_FOR_EVENT); ffc08ec8: 80 ff 00 10 lwz r7,16(r31) } /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { ffc08ecc: 70 e5 01 00 andi. r5,r7,256 ffc08ed0: 41 82 00 b8 beq- ffc08f88 <_Event_Surrender+0x11c> if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { ffc08ed4: 7f 80 40 00 cmpw cr7,r0,r8 ffc08ed8: 41 9e 00 0c beq- cr7,ffc08ee4 <_Event_Surrender+0x78> ffc08edc: 70 c0 00 02 andi. r0,r6,2 ffc08ee0: 41 82 00 a8 beq- ffc08f88 <_Event_Surrender+0x11c> <== NEVER TAKEN api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc08ee4: 80 ff 00 28 lwz r7,40(r31) 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) ); ffc08ee8: 7d 29 40 78 andc r9,r9,r8 * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { api->pending_events = _Event_sets_Clear( pending_events, seized_events ); the_thread->Wait.count = 0; ffc08eec: 38 00 00 00 li r0,0 /* * Otherwise, this is a normal send to another thread */ if ( _States_Is_waiting_for_event( the_thread->current_state ) ) { if ( seized_events == event_condition || _Options_Is_any( option_set ) ) { api->pending_events = _Event_sets_Clear( pending_events, seized_events ); ffc08ef0: 91 2b 00 00 stw r9,0(r11) the_thread->Wait.count = 0; ffc08ef4: 90 1f 00 24 stw r0,36(r31) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc08ef8: 91 07 00 00 stw r8,0(r7) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc08efc: 7c 00 00 a6 mfmsr r0 ffc08f00: 7d 40 01 24 mtmsr r10 ffc08f04: 7c 00 01 24 mtmsr r0 _ISR_Flash( level ); if ( !_Watchdog_Is_active( &the_thread->Timer ) ) { ffc08f08: 80 1f 00 50 lwz r0,80(r31) ffc08f0c: 2f 80 00 02 cmpwi cr7,r0,2 ffc08f10: 41 9e 00 90 beq- cr7,ffc08fa0 <_Event_Surrender+0x134> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc08f14: 7d 40 01 24 mtmsr r10 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc08f18: 3c 80 10 03 lis r4,4099 ffc08f1c: 7f e3 fb 78 mr r3,r31 ffc08f20: 60 84 ff f8 ori r4,r4,65528 ffc08f24: 48 00 30 71 bl ffc0bf94 <_Thread_Clear_state> } return; } } _ISR_Enable( level ); } ffc08f28: 80 01 00 14 lwz r0,20(r1) ffc08f2c: 83 e1 00 0c lwz r31,12(r1) ffc08f30: 38 21 00 10 addi r1,r1,16 ffc08f34: 7c 08 03 a6 mtlr r0 ffc08f38: 4e 80 00 20 blr * 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) || ffc08f3c: 3c e0 00 00 lis r7,0 ffc08f40: 80 a7 28 54 lwz r5,10324(r7) /* * 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 ) && ffc08f44: 2f 85 00 02 cmpwi cr7,r5,2 ffc08f48: 41 9e 00 10 beq- cr7,ffc08f58 <_Event_Surrender+0xec> <== NEVER TAKEN ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { ffc08f4c: 80 a7 28 54 lwz r5,10324(r7) * 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) || ffc08f50: 2f 85 00 01 cmpwi cr7,r5,1 ffc08f54: 40 9e ff 74 bne+ cr7,ffc08ec8 <_Event_Surrender+0x5c> (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { ffc08f58: 7f 80 40 00 cmpw cr7,r0,r8 ffc08f5c: 41 9e 00 0c beq- cr7,ffc08f68 <_Event_Surrender+0xfc> ffc08f60: 70 c0 00 02 andi. r0,r6,2 ffc08f64: 41 82 00 24 beq- ffc08f88 <_Event_Surrender+0x11c> <== NEVER TAKEN api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc08f68: 80 df 00 28 lwz r6,40(r31) _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; ffc08f6c: 38 00 00 00 li r0,0 ffc08f70: 7d 29 40 78 andc r9,r9,r8 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) && ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); ffc08f74: 91 2b 00 00 stw r9,0(r11) the_thread->Wait.count = 0; ffc08f78: 90 1f 00 24 stw r0,36(r31) *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; ffc08f7c: 38 00 00 03 li r0,3 ((_Event_Sync_state == THREAD_BLOCKING_OPERATION_TIMEOUT) || (_Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED)) ) { if ( seized_events == event_condition || _Options_Is_any(option_set) ) { api->pending_events = _Event_sets_Clear( pending_events,seized_events ); the_thread->Wait.count = 0; *(rtems_event_set *)the_thread->Wait.return_argument = seized_events; ffc08f80: 91 06 00 00 stw r8,0(r6) _Event_Sync_state = THREAD_BLOCKING_OPERATION_SATISFIED; ffc08f84: 90 07 28 54 stw r0,10324(r7) ffc08f88: 7d 40 01 24 mtmsr r10 } return; } } _ISR_Enable( level ); } ffc08f8c: 80 01 00 14 lwz r0,20(r1) ffc08f90: 83 e1 00 0c lwz r31,12(r1) ffc08f94: 38 21 00 10 addi r1,r1,16 ffc08f98: 7c 08 03 a6 mtlr r0 ffc08f9c: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE void _Watchdog_Deactivate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_REMOVE_IT; ffc08fa0: 38 00 00 03 li r0,3 ffc08fa4: 90 1f 00 50 stw r0,80(r31) ffc08fa8: 7d 40 01 24 mtmsr r10 _ISR_Enable( level ); _Thread_Unblock( the_thread ); } else { _Watchdog_Deactivate( &the_thread->Timer ); _ISR_Enable( level ); (void) _Watchdog_Remove( &the_thread->Timer ); ffc08fac: 38 7f 00 48 addi r3,r31,72 ffc08fb0: 48 00 49 41 bl ffc0d8f0 <_Watchdog_Remove> ffc08fb4: 3c 80 10 03 lis r4,4099 ffc08fb8: 7f e3 fb 78 mr r3,r31 ffc08fbc: 60 84 ff f8 ori r4,r4,65528 ffc08fc0: 48 00 2f d5 bl ffc0bf94 <_Thread_Clear_state> ffc08fc4: 4b ff ff c8 b ffc08f8c <_Event_Surrender+0x120> =============================================================================== ffc08fc8 <_Event_Timeout>: void _Event_Timeout( Objects_Id id, void *ignored ) { ffc08fc8: 94 21 ff e8 stwu r1,-24(r1) ffc08fcc: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc08fd0: 38 81 00 08 addi r4,r1,8 void _Event_Timeout( Objects_Id id, void *ignored ) { ffc08fd4: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; ISR_Level level; the_thread = _Thread_Get( id, &location ); ffc08fd8: 48 00 34 79 bl ffc0c450 <_Thread_Get> switch ( location ) { ffc08fdc: 80 01 00 08 lwz r0,8(r1) ffc08fe0: 2f 80 00 00 cmpwi cr7,r0,0 ffc08fe4: 40 9e 00 54 bne- cr7,ffc09038 <_Event_Timeout+0x70> <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc08fe8: 7d 20 00 a6 mfmsr r9 ffc08fec: 7d 70 42 a6 mfsprg r11,0 ffc08ff0: 7d 2b 58 78 andc r11,r9,r11 ffc08ff4: 7d 60 01 24 mtmsr r11 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc08ff8: 3d 60 00 00 lis r11,0 return; } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { ffc08ffc: 81 6b 31 50 lwz r11,12624(r11) _ISR_Enable( level ); return; } #endif the_thread->Wait.count = 0; ffc09000: 90 03 00 24 stw r0,36(r3) if ( _Thread_Is_executing( the_thread ) ) { ffc09004: 7f 83 58 00 cmpw cr7,r3,r11 ffc09008: 41 9e 00 40 beq- cr7,ffc09048 <_Event_Timeout+0x80> if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; } the_thread->Wait.return_code = RTEMS_TIMEOUT; ffc0900c: 38 00 00 06 li r0,6 ffc09010: 90 03 00 34 stw r0,52(r3) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc09014: 7d 20 01 24 mtmsr r9 RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc09018: 3c 80 10 03 lis r4,4099 ffc0901c: 60 84 ff f8 ori r4,r4,65528 ffc09020: 48 00 2f 75 bl ffc0bf94 <_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--; ffc09024: 3d 20 00 00 lis r9,0 ffc09028: 81 69 28 0c lwz r11,10252(r9) ffc0902c: 38 0b ff ff addi r0,r11,-1 ffc09030: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc09034: 80 09 28 0c lwz r0,10252(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc09038: 80 01 00 1c lwz r0,28(r1) ffc0903c: 38 21 00 18 addi r1,r1,24 ffc09040: 7c 08 03 a6 mtlr r0 ffc09044: 4e 80 00 20 blr } #endif the_thread->Wait.count = 0; if ( _Thread_Is_executing( the_thread ) ) { if ( _Event_Sync_state == THREAD_BLOCKING_OPERATION_NOTHING_HAPPENED ) ffc09048: 3d 60 00 00 lis r11,0 ffc0904c: 80 0b 28 54 lwz r0,10324(r11) ffc09050: 2f 80 00 01 cmpwi cr7,r0,1 ffc09054: 40 9e ff b8 bne+ cr7,ffc0900c <_Event_Timeout+0x44> _Event_Sync_state = THREAD_BLOCKING_OPERATION_TIMEOUT; ffc09058: 38 00 00 02 li r0,2 ffc0905c: 90 0b 28 54 stw r0,10324(r11) ffc09060: 4b ff ff ac b ffc0900c <_Event_Timeout+0x44> =============================================================================== ffc10e98 <_Heap_Allocate_aligned_with_boundary>: Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc10e98: 94 21 ff e0 stwu r1,-32(r1) ffc10e9c: 7c 08 02 a6 mflr r0 ffc10ea0: 7d 80 00 26 mfcr r12 ffc10ea4: 7c 89 23 78 mr r9,r4 ffc10ea8: 90 01 00 24 stw r0,36(r1) Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE ffc10eac: 38 04 00 04 addi r0,r4,4 Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { ffc10eb0: 7f 84 00 40 cmplw cr7,r4,r0 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc10eb4: 93 a1 00 14 stw r29,20(r1) ffc10eb8: 7c 7d 1b 78 mr r29,r3 Heap_Statistics *const stats = &heap->stats; uintptr_t const block_size_floor = alloc_size + HEAP_BLOCK_HEADER_SIZE - HEAP_ALLOC_BONUS; uintptr_t const page_size = heap->page_size; ffc10ebc: 80 e3 00 10 lwz r7,16(r3) uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { /* Integer overflow occured */ return NULL; ffc10ec0: 38 60 00 00 li r3,0 Heap_Control *heap, uintptr_t alloc_size, uintptr_t alignment, uintptr_t boundary ) { ffc10ec4: 93 61 00 0c stw r27,12(r1) ffc10ec8: 93 81 00 10 stw r28,16(r1) ffc10ecc: 93 c1 00 18 stw r30,24(r1) ffc10ed0: 93 e1 00 1c stw r31,28(r1) ffc10ed4: 91 81 00 08 stw r12,8(r1) Heap_Block *block = NULL; uintptr_t alloc_begin = 0; uint32_t search_count = 0; bool search_again = false; if ( block_size_floor < alloc_size ) { ffc10ed8: 41 9d 00 7c bgt- cr7,ffc10f54 <_Heap_Allocate_aligned_with_boundary+0xbc> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { ffc10edc: 2e 06 00 00 cmpwi cr4,r6,0 ffc10ee0: 40 92 01 b8 bne- cr4,ffc11098 <_Heap_Allocate_aligned_with_boundary+0x200> return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; ffc10ee4: 80 9d 00 08 lwz r4,8(r29) do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { ffc10ee8: 7f 9d 20 00 cmpw cr7,r29,r4 ffc10eec: 41 9e 01 c4 beq- cr7,ffc110b0 <_Heap_Allocate_aligned_with_boundary+0x218> * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { if ( alignment == 0 ) { ffc10ef0: 2c 05 00 00 cmpwi r5,0 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { ffc10ef4: 3b c0 00 00 li r30,0 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size ffc10ef8: 3b 67 00 07 addi r27,r7,7 + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; ffc10efc: 23 89 00 04 subfic r28,r9,4 ffc10f00: 48 00 00 24 b ffc10f24 <_Heap_Allocate_aligned_with_boundary+0x8c> * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { if ( alignment == 0 ) { ffc10f04: 40 82 00 7c bne- ffc10f80 <_Heap_Allocate_aligned_with_boundary+0xe8> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc10f08: 3b e4 00 08 addi r31,r4,8 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { ffc10f0c: 2f 9f 00 00 cmpwi cr7,r31,0 ); } } /* Statistics */ ++search_count; ffc10f10: 3b de 00 01 addi r30,r30,1 if ( alloc_begin != 0 ) { ffc10f14: 40 9e 01 3c bne- cr7,ffc11050 <_Heap_Allocate_aligned_with_boundary+0x1b8> break; } block = block->next; ffc10f18: 80 84 00 08 lwz r4,8(r4) do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { ffc10f1c: 7f 9d 20 00 cmpw cr7,r29,r4 ffc10f20: 41 9e 00 20 beq- cr7,ffc10f40 <_Heap_Allocate_aligned_with_boundary+0xa8> /* * The HEAP_PREV_BLOCK_USED flag is always set in the block size_and_flag * field. Thus the value is about one unit larger than the real block * size. The greater than operator takes this into account. */ if ( block->size_and_flag > block_size_floor ) { ffc10f24: 81 64 00 04 lwz r11,4(r4) ffc10f28: 7f 80 58 40 cmplw cr7,r0,r11 ffc10f2c: 41 bc ff d8 blt- cr7,ffc10f04 <_Heap_Allocate_aligned_with_boundary+0x6c> if ( alloc_begin != 0 ) { break; } block = block->next; ffc10f30: 80 84 00 08 lwz r4,8(r4) ); } } /* Statistics */ ++search_count; ffc10f34: 3b de 00 01 addi r30,r30,1 do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { ffc10f38: 7f 9d 20 00 cmpw cr7,r29,r4 ffc10f3c: 40 9e ff e8 bne+ cr7,ffc10f24 <_Heap_Allocate_aligned_with_boundary+0x8c> ffc10f40: 3b e0 00 00 li r31,0 boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { ffc10f44: 80 1d 00 44 lwz r0,68(r29) ffc10f48: 7f 80 f0 40 cmplw cr7,r0,r30 ffc10f4c: 41 9c 01 38 blt- cr7,ffc11084 <_Heap_Allocate_aligned_with_boundary+0x1ec> stats->max_search = search_count; } return (void *) alloc_begin; ffc10f50: 7f e3 fb 78 mr r3,r31 } ffc10f54: 80 01 00 24 lwz r0,36(r1) ffc10f58: 81 81 00 08 lwz r12,8(r1) ffc10f5c: 7c 08 03 a6 mtlr r0 ffc10f60: 83 61 00 0c lwz r27,12(r1) ffc10f64: 83 81 00 10 lwz r28,16(r1) ffc10f68: 7d 80 81 20 mtcrf 8,r12 ffc10f6c: 83 a1 00 14 lwz r29,20(r1) ffc10f70: 83 c1 00 18 lwz r30,24(r1) ffc10f74: 83 e1 00 1c lwz r31,28(r1) ffc10f78: 38 21 00 20 addi r1,r1,32 ffc10f7c: 4e 80 00 20 blr - 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; ffc10f80: 55 6b 00 3c rlwinm r11,r11,0,0,30 ffc10f84: 80 7d 00 14 lwz r3,20(r29) uintptr_t const page_size = heap->page_size; uintptr_t const min_block_size = heap->min_block_size; uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; ffc10f88: 7d 64 5a 14 add r11,r4,r11 uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; uintptr_t alloc_end = block_end + HEAP_ALLOC_BONUS; uintptr_t alloc_begin = alloc_end - alloc_size; ffc10f8c: 7f fc 5a 14 add r31,r28,r11 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10f90: 7f ff 2b 96 divwu r31,r31,r5 ffc10f94: 7f ff 29 d6 mullw r31,r31,r5 uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size + HEAP_BLOCK_HEADER_SIZE + page_size - 1; ffc10f98: 7d 43 d8 50 subf r10,r3,r27 uintptr_t const block_begin = (uintptr_t) block; uintptr_t const block_size = _Heap_Block_size( block ); uintptr_t const block_end = block_begin + block_size; uintptr_t const alloc_begin_floor = _Heap_Alloc_area_of_block( block ); uintptr_t const alloc_begin_ceiling = block_end - min_block_size ffc10f9c: 7d 6a 5a 14 add r11,r10,r11 uintptr_t alloc_begin = alloc_end - alloc_size; alloc_begin = _Heap_Align_down( alloc_begin, alignment ); /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { ffc10fa0: 7f 8b f8 40 cmplw cr7,r11,r31 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc10fa4: 39 84 00 08 addi r12,r4,8 ffc10fa8: 40 9c 00 0c bge- cr7,ffc10fb4 <_Heap_Allocate_aligned_with_boundary+0x11c> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10fac: 7d 6b 2b 96 divwu r11,r11,r5 ffc10fb0: 7f eb 29 d6 mullw r31,r11,r5 } alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { ffc10fb4: 41 92 00 64 beq- cr4,ffc11018 <_Heap_Allocate_aligned_with_boundary+0x180> /* Ensure that the we have a valid new block at the end */ if ( alloc_begin > alloc_begin_ceiling ) { alloc_begin = _Heap_Align_down( alloc_begin_ceiling, alignment ); } alloc_end = alloc_begin + alloc_size; ffc10fb8: 7d 5f 4a 14 add r10,r31,r9 ffc10fbc: 7d 6a 33 96 divwu r11,r10,r6 ffc10fc0: 7d 6b 31 d6 mullw r11,r11,r6 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { ffc10fc4: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10fc8: 40 9c 00 50 bge- cr7,ffc11018 <_Heap_Allocate_aligned_with_boundary+0x180> ffc10fcc: 7f 8a 58 40 cmplw cr7,r10,r11 ffc10fd0: 40 9d 00 48 ble- cr7,ffc11018 <_Heap_Allocate_aligned_with_boundary+0x180> alloc_end = alloc_begin + alloc_size; /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; ffc10fd4: 7d 0c 4a 14 add r8,r12,r9 uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { ffc10fd8: 7f 88 58 40 cmplw cr7,r8,r11 return 0; ffc10fdc: 3b e0 00 00 li r31,0 if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { if ( boundary_line < boundary_floor ) { ffc10fe0: 40 bd 00 10 ble+ cr7,ffc10ff0 <_Heap_Allocate_aligned_with_boundary+0x158> ffc10fe4: 4b ff ff 28 b ffc10f0c <_Heap_Allocate_aligned_with_boundary+0x74> /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { ffc10fe8: 40 99 00 30 ble- cr6,ffc11018 <_Heap_Allocate_aligned_with_boundary+0x180> if ( boundary_line < boundary_floor ) { ffc10fec: 41 85 00 a4 bgt- cr1,ffc11090 <_Heap_Allocate_aligned_with_boundary+0x1f8><== NEVER TAKEN return 0; } alloc_begin = boundary_line - alloc_size; ffc10ff0: 7f e9 58 50 subf r31,r9,r11 ffc10ff4: 7f ff 2b 96 divwu r31,r31,r5 ffc10ff8: 7f ff 29 d6 mullw r31,r31,r5 alloc_begin = _Heap_Align_down( alloc_begin, alignment ); alloc_end = alloc_begin + alloc_size; ffc10ffc: 7d 5f 4a 14 add r10,r31,r9 ffc11000: 7d 6a 33 96 divwu r11,r10,r6 ffc11004: 7d 6b 31 d6 mullw r11,r11,r6 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { ffc11008: 7f 9f 58 40 cmplw cr7,r31,r11 ffc1100c: 7f 0a 58 40 cmplw cr6,r10,r11 if ( boundary_line < boundary_floor ) { ffc11010: 7c 88 58 40 cmplw cr1,r8,r11 /* Ensure boundary constaint */ if ( boundary != 0 ) { uintptr_t const boundary_floor = alloc_begin_floor + alloc_size; uintptr_t boundary_line = _Heap_Align_down( alloc_end, boundary ); while ( alloc_begin < boundary_line && boundary_line < alloc_end ) { ffc11014: 41 9c ff d4 blt+ cr7,ffc10fe8 <_Heap_Allocate_aligned_with_boundary+0x150> boundary_line = _Heap_Align_down( alloc_end, boundary ); } } /* Ensure that the we have a valid new block at the beginning */ if ( alloc_begin >= alloc_begin_floor ) { ffc11018: 7f 8c f8 40 cmplw cr7,r12,r31 ffc1101c: 41 9d 00 74 bgt- cr7,ffc11090 <_Heap_Allocate_aligned_with_boundary+0x1f8> ffc11020: 7d 7f 3b 96 divwu r11,r31,r7 ffc11024: 7d 6b 39 d6 mullw r11,r11,r7 ffc11028: 21 44 ff f8 subfic r10,r4,-8 uintptr_t const alloc_block_begin = (uintptr_t) _Heap_Block_of_alloc_area( alloc_begin, page_size ); uintptr_t const free_size = alloc_block_begin - block_begin; ffc1102c: 7d 6a 5a 14 add r11,r10,r11 if ( free_size >= min_block_size || free_size == 0 ) { ffc11030: 7f 83 58 40 cmplw cr7,r3,r11 ffc11034: 40 bd fe d8 ble- cr7,ffc10f0c <_Heap_Allocate_aligned_with_boundary+0x74> return alloc_begin; } } return 0; ffc11038: 31 6b ff ff addic r11,r11,-1 ffc1103c: 7d 6b 59 10 subfe r11,r11,r11 ffc11040: 7f ff 58 38 and r31,r31,r11 } /* Statistics */ ++search_count; if ( alloc_begin != 0 ) { ffc11044: 2f 9f 00 00 cmpwi cr7,r31,0 ); } } /* Statistics */ ++search_count; ffc11048: 3b de 00 01 addi r30,r30,1 if ( alloc_begin != 0 ) { ffc1104c: 41 9e fe cc beq+ cr7,ffc10f18 <_Heap_Allocate_aligned_with_boundary+0x80> search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; ffc11050: 81 7d 00 48 lwz r11,72(r29) stats->searches += search_count; block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc11054: 7f a3 eb 78 mr r3,r29 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; ffc11058: 80 1d 00 4c lwz r0,76(r29) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc1105c: 7f e5 fb 78 mr r5,r31 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; ffc11060: 39 6b 00 01 addi r11,r11,1 stats->searches += search_count; ffc11064: 7c 00 f2 14 add r0,r0,r30 search_again = _Heap_Protection_free_delayed_blocks( heap, alloc_begin ); } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; ffc11068: 91 7d 00 48 stw r11,72(r29) stats->searches += search_count; block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc1106c: 7d 26 4b 78 mr r6,r9 } while ( search_again ); if ( alloc_begin != 0 ) { /* Statistics */ ++stats->allocs; stats->searches += search_count; ffc11070: 90 1d 00 4c stw r0,76(r29) block = _Heap_Block_allocate( heap, block, alloc_begin, alloc_size ); ffc11074: 4b ff 9b 21 bl ffc0ab94 <_Heap_Block_allocate> boundary ); } /* Statistics */ if ( stats->max_search < search_count ) { ffc11078: 80 1d 00 44 lwz r0,68(r29) ffc1107c: 7f 80 f0 40 cmplw cr7,r0,r30 ffc11080: 40 bc fe d0 bge- cr7,ffc10f50 <_Heap_Allocate_aligned_with_boundary+0xb8> stats->max_search = search_count; ffc11084: 93 dd 00 44 stw r30,68(r29) } return (void *) alloc_begin; ffc11088: 7f e3 fb 78 mr r3,r31 ffc1108c: 4b ff fe c8 b ffc10f54 <_Heap_Allocate_aligned_with_boundary+0xbc> if ( free_size >= min_block_size || free_size == 0 ) { return alloc_begin; } } return 0; ffc11090: 3b e0 00 00 li r31,0 ffc11094: 4b ff fe 78 b ffc10f0c <_Heap_Allocate_aligned_with_boundary+0x74> /* Integer overflow occured */ return NULL; } if ( boundary != 0 ) { if ( boundary < alloc_size ) { ffc11098: 7f 84 30 40 cmplw cr7,r4,r6 ffc1109c: 41 bd fe b8 bgt- cr7,ffc10f54 <_Heap_Allocate_aligned_with_boundary+0xbc> return NULL; } if ( alignment == 0 ) { ffc110a0: 2f 85 00 00 cmpwi cr7,r5,0 ffc110a4: 40 be fe 40 bne- cr7,ffc10ee4 <_Heap_Allocate_aligned_with_boundary+0x4c> alignment = page_size; ffc110a8: 7c e5 3b 78 mr r5,r7 ffc110ac: 4b ff fe 38 b ffc10ee4 <_Heap_Allocate_aligned_with_boundary+0x4c> do { Heap_Block *const free_list_tail = _Heap_Free_list_tail( heap ); block = _Heap_Free_list_first( heap ); while ( block != free_list_tail ) { ffc110b0: 3b c0 00 00 li r30,0 ffc110b4: 3b e0 00 00 li r31,0 ffc110b8: 4b ff fe 8c b ffc10f44 <_Heap_Allocate_aligned_with_boundary+0xac> =============================================================================== ffc10c98 <_Heap_Extend>: Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc10c98: 94 21 ff c0 stwu r1,-64(r1) ffc10c9c: 7d 80 00 26 mfcr r12 ffc10ca0: 7c 08 02 a6 mflr r0 ffc10ca4: 93 a1 00 34 stw r29,52(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; ffc10ca8: 7f a4 2a 14 add r29,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 ) { ffc10cac: 7f 84 e8 40 cmplw cr7,r4,r29 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc10cb0: 90 01 00 44 stw r0,68(r1) ffc10cb4: 93 41 00 28 stw r26,40(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; ffc10cb8: 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 ) { ffc10cbc: 93 c1 00 38 stw r30,56(r1) ffc10cc0: 7c 7e 1b 78 mr r30,r3 ffc10cc4: 93 01 00 20 stw r24,32(r1) ffc10cc8: 93 21 00 24 stw r25,36(r1) ffc10ccc: 7c d9 33 78 mr r25,r6 ffc10cd0: 93 61 00 2c stw r27,44(r1) ffc10cd4: 93 81 00 30 stw r28,48(r1) ffc10cd8: 93 e1 00 3c stw r31,60(r1) ffc10cdc: 7c 9f 23 78 mr r31,r4 Heap_Statistics *const stats = &heap->stats; Heap_Block *const first_block = heap->first_block; ffc10ce0: 83 63 00 20 lwz r27,32(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 ) { return false; ffc10ce4: 38 60 00 00 li r3,0 Heap_Control *heap, void *extend_area_begin_ptr, uintptr_t extend_area_size, uintptr_t *extended_size_ptr ) { ffc10ce8: 92 e1 00 1c stw r23,28(r1) ffc10cec: 91 81 00 18 stw r12,24(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; ffc10cf0: 93 41 00 0c stw r26,12(r1) Heap_Block *extend_last_block = NULL; ffc10cf4: 93 41 00 08 stw r26,8(r1) uintptr_t const page_size = heap->page_size; ffc10cf8: 83 9e 00 10 lwz r28,16(r30) uintptr_t const min_block_size = heap->min_block_size; ffc10cfc: 80 de 00 14 lwz r6,20(r30) 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; ffc10d00: 83 1e 00 30 lwz r24,48(r30) uintptr_t extend_first_block_size = 0; uintptr_t extended_size = 0; bool extend_area_ok = false; if ( extend_area_end < extend_area_begin ) { ffc10d04: 40 9d 00 40 ble- cr7,ffc10d44 <_Heap_Extend+0xac> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } ffc10d08: 80 01 00 44 lwz r0,68(r1) ffc10d0c: 81 81 00 18 lwz r12,24(r1) ffc10d10: 7c 08 03 a6 mtlr r0 ffc10d14: 82 e1 00 1c lwz r23,28(r1) ffc10d18: 83 01 00 20 lwz r24,32(r1) ffc10d1c: 7d 81 81 20 mtcrf 24,r12 ffc10d20: 83 21 00 24 lwz r25,36(r1) ffc10d24: 83 41 00 28 lwz r26,40(r1) ffc10d28: 83 61 00 2c lwz r27,44(r1) ffc10d2c: 83 81 00 30 lwz r28,48(r1) ffc10d30: 83 a1 00 34 lwz r29,52(r1) ffc10d34: 83 c1 00 38 lwz r30,56(r1) ffc10d38: 83 e1 00 3c lwz r31,60(r1) ffc10d3c: 38 21 00 40 addi r1,r1,64 ffc10d40: 4e 80 00 20 blr if ( extend_area_end < extend_area_begin ) { return false; } extend_area_ok = _Heap_Get_first_and_last_block( ffc10d44: 7c 83 23 78 mr r3,r4 ffc10d48: 38 e1 00 0c addi r7,r1,12 ffc10d4c: 7c a4 2b 78 mr r4,r5 ffc10d50: 39 01 00 08 addi r8,r1,8 ffc10d54: 7f 85 e3 78 mr r5,r28 ffc10d58: 4b ff 98 79 bl ffc0a5d0 <_Heap_Get_first_and_last_block> page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { ffc10d5c: 2f 83 00 00 cmpwi cr7,r3,0 /* For simplicity we reject extend areas that are too small */ return false; ffc10d60: 7f 43 d3 78 mr r3,r26 page_size, min_block_size, &extend_first_block, &extend_last_block ); if (!extend_area_ok ) { ffc10d64: 41 be ff a4 beq- cr7,ffc10d08 <_Heap_Extend+0x70> ffc10d68: 7f 69 db 78 mr r9,r27 ffc10d6c: 3a e0 00 00 li r23,0 ffc10d70: 38 00 00 00 li r0,0 ffc10d74: 39 00 00 00 li r8,0 ffc10d78: 48 00 00 44 b ffc10dbc <_Heap_Extend+0x124> return false; } if ( extend_area_end == sub_area_begin ) { merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { ffc10d7c: 7f 9d 58 40 cmplw cr7,r29,r11 ffc10d80: 40 9c 00 08 bge- cr7,ffc10d88 <_Heap_Extend+0xf0> ffc10d84: 7d 20 4b 78 mr r0,r9 ffc10d88: 7d 4b e3 96 divwu r10,r11,r28 link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc10d8c: 7f 8b f8 00 cmpw cr7,r11,r31 ffc10d90: 7d 4a e1 d6 mullw r10,r10,r28 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc10d94: 39 4a ff f8 addi r10,r10,-8 ffc10d98: 41 9e 00 64 beq- cr7,ffc10dfc <_Heap_Extend+0x164> start_block->prev_size = extend_area_end; merge_above_block = end_block; } else if ( sub_area_end < extend_area_begin ) { ffc10d9c: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10da0: 40 9d 00 08 ble- cr7,ffc10da8 <_Heap_Extend+0x110> 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 ) ffc10da4: 7d 57 53 78 mr r23,r10 - 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; ffc10da8: 81 2a 00 04 lwz r9,4(r10) ffc10dac: 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); ffc10db0: 7d 29 52 14 add r9,r9,r10 link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); ffc10db4: 7f 9b 48 00 cmpw cr7,r27,r9 ffc10db8: 41 9e 00 60 beq- cr7,ffc10e18 <_Heap_Extend+0x180> return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; ffc10dbc: 7f 89 d8 00 cmpw cr7,r9,r27 ffc10dc0: 7d 2a 4b 78 mr r10,r9 ffc10dc4: 41 9e 01 b8 beq- cr7,ffc10f7c <_Heap_Extend+0x2e4> uintptr_t const sub_area_end = start_block->prev_size; ffc10dc8: 81 69 00 00 lwz r11,0(r9) Heap_Block *const end_block = _Heap_Block_of_alloc_area( sub_area_end, page_size ); if ( ffc10dcc: 7f 9f 58 40 cmplw cr7,r31,r11 ffc10dd0: 40 9c 00 0c bge- cr7,ffc10ddc <_Heap_Extend+0x144> sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ffc10dd4: 7f 8a e8 40 cmplw cr7,r10,r29 ffc10dd8: 41 9c 02 28 blt- cr7,ffc11000 <_Heap_Extend+0x368> ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc10ddc: 7f 8a e8 00 cmpw cr7,r10,r29 ffc10de0: 40 9e ff 9c bne+ cr7,ffc10d7c <_Heap_Extend+0xe4> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10de4: 7d 4b e3 96 divwu r10,r11,r28 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc10de8: 7f 8b f8 00 cmpw cr7,r11,r31 ffc10dec: 7d 4a e1 d6 mullw r10,r10,r28 sub_area_end > extend_area_begin && extend_area_end > sub_area_begin ) { return false; } if ( extend_area_end == sub_area_begin ) { ffc10df0: 7d 28 4b 78 mr r8,r9 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc10df4: 39 4a ff f8 addi r10,r10,-8 merge_below_block = start_block; } else if ( extend_area_end < sub_area_end ) { link_below_block = start_block; } if ( sub_area_end == extend_area_begin ) { ffc10df8: 40 9e ff a4 bne+ cr7,ffc10d9c <_Heap_Extend+0x104> <== ALWAYS TAKEN start_block->prev_size = extend_area_end; ffc10dfc: 93 a9 00 00 stw r29,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 ) ffc10e00: 7d 5a 53 78 mr r26,r10 - 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; ffc10e04: 81 2a 00 04 lwz r9,4(r10) ffc10e08: 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); ffc10e0c: 7d 29 52 14 add r9,r9,r10 } else if ( sub_area_end < extend_area_begin ) { link_above_block = end_block; } start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); ffc10e10: 7f 9b 48 00 cmpw cr7,r27,r9 ffc10e14: 40 9e ff a8 bne+ cr7,ffc10dbc <_Heap_Extend+0x124> <== NEVER TAKEN if ( extend_area_begin < heap->area_begin ) { ffc10e18: 81 3e 00 18 lwz r9,24(r30) ffc10e1c: 7f 9f 48 40 cmplw cr7,r31,r9 ffc10e20: 41 9c 01 64 blt- cr7,ffc10f84 <_Heap_Extend+0x2ec> heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { ffc10e24: 81 3e 00 1c lwz r9,28(r30) ffc10e28: 7f 9d 48 40 cmplw cr7,r29,r9 ffc10e2c: 40 9d 00 08 ble- cr7,ffc10e34 <_Heap_Extend+0x19c> heap->area_end = extend_area_end; ffc10e30: 93 be 00 1c stw r29,28(r30) extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { ffc10e34: 81 5e 00 20 lwz r10,32(r30) } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; ffc10e38: 81 21 00 0c lwz r9,12(r1) ffc10e3c: 81 61 00 08 lwz r11,8(r1) extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { ffc10e40: 7f 8a 48 40 cmplw cr7,r10,r9 } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; ffc10e44: 93 a9 00 00 stw r29,0(r9) heap->area_begin = extend_area_begin; } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = ffc10e48: 7d 49 58 50 subf r10,r9,r11 (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; ffc10e4c: 61 47 00 01 ori r7,r10,1 _Heap_Protection_block_initialize( heap, extend_first_block ); extend_last_block->prev_size = extend_first_block_size; ffc10e50: 91 4b 00 00 stw r10,0(r11) extend_last_block->size_and_flag = 0; ffc10e54: 39 40 00 00 li r10,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 = ffc10e58: 90 e9 00 04 stw r7,4(r9) 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; ffc10e5c: 91 4b 00 04 stw r10,4(r11) _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { ffc10e60: 40 9d 01 58 ble- cr7,ffc10fb8 <_Heap_Extend+0x320> <== ALWAYS TAKEN heap->first_block = extend_first_block; ffc10e64: 91 3e 00 20 stw r9,32(r30) } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { heap->last_block = extend_last_block; } if ( merge_below_block != NULL ) { ffc10e68: 2e 08 00 00 cmpwi cr4,r8,0 ffc10e6c: 41 92 01 b0 beq- cr4,ffc1101c <_Heap_Extend+0x384> Heap_Control *heap, uintptr_t extend_area_begin, Heap_Block *first_block ) { uintptr_t const page_size = heap->page_size; ffc10e70: 80 1e 00 10 lwz r0,16(r30) uintptr_t const new_first_block_alloc_begin = _Heap_Align_up( extend_area_begin + HEAP_BLOCK_HEADER_SIZE, page_size ); ffc10e74: 3b ff 00 08 addi r31,r31,8 RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_up( uintptr_t value, uintptr_t alignment ) { uintptr_t remainder = value % alignment; ffc10e78: 7d 3f 03 96 divwu r9,r31,r0 ffc10e7c: 7d 29 01 d6 mullw r9,r9,r0 if ( remainder != 0 ) { ffc10e80: 7d 29 f8 51 subf. r9,r9,r31 ffc10e84: 41 82 00 0c beq- ffc10e90 <_Heap_Extend+0x1f8> <== NEVER TAKEN return value - remainder + alignment; ffc10e88: 7f ff 02 14 add r31,r31,r0 ffc10e8c: 7f e9 f8 50 subf r31,r9,r31 uintptr_t const new_first_block_begin = ffc10e90: 38 9f ff f8 addi r4,r31,-8 uintptr_t const first_block_begin = (uintptr_t) first_block; uintptr_t const new_first_block_size = first_block_begin - new_first_block_begin; Heap_Block *const new_first_block = (Heap_Block *) new_first_block_begin; new_first_block->prev_size = first_block->prev_size; ffc10e94: 81 28 00 00 lwz r9,0(r8) 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 = ffc10e98: 7c 04 40 50 subf r0,r4,r8 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; ffc10e9c: 60 00 00 01 ori r0,r0,1 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; ffc10ea0: 91 3f ff f8 stw r9,-8(r31) new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; _Heap_Free_block( heap, new_first_block ); ffc10ea4: 7f c3 f3 78 mr r3,r30 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; new_first_block->size_and_flag = new_first_block_size | HEAP_PREV_BLOCK_USED; ffc10ea8: 90 04 00 04 stw r0,4(r4) _Heap_Free_block( heap, new_first_block ); ffc10eac: 4b ff fd b1 bl ffc10c5c <_Heap_Free_block> link_below_block, extend_last_block ); } if ( merge_above_block != NULL ) { ffc10eb0: 2d 9a 00 00 cmpwi cr3,r26,0 ffc10eb4: 41 8e 01 18 beq- cr3,ffc10fcc <_Heap_Extend+0x334> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc10eb8: 81 3e 00 10 lwz r9,16(r30) ) { 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, ffc10ebc: 38 1d ff f8 addi r0,r29,-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( ffc10ec0: 7c 1a 00 50 subf r0,r26,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) ffc10ec4: 81 7a 00 04 lwz r11,4(r26) ffc10ec8: 7c 00 4b 96 divwu r0,r0,r9 ffc10ecc: 7c 00 49 d6 mullw r0,r0,r9 | HEAP_PREV_BLOCK_USED; _Heap_Block_set_size( last_block, last_block_new_size ); _Heap_Free_block( heap, last_block ); ffc10ed0: 7f c3 f3 78 mr r3,r30 ); 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) ffc10ed4: 7d 60 58 50 subf r11,r0,r11 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = ffc10ed8: 7d 20 d2 14 add r9,r0,r26 (last_block->size_and_flag - last_block_new_size) | HEAP_PREV_BLOCK_USED; ffc10edc: 61 6b 00 01 ori r11,r11,1 page_size ); Heap_Block *const new_last_block = _Heap_Block_at( last_block, last_block_new_size ); new_last_block->size_and_flag = ffc10ee0: 91 69 00 04 stw r11,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 ); ffc10ee4: 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; ffc10ee8: 81 3a 00 04 lwz r9,4(r26) ffc10eec: 55 29 07 fe clrlwi r9,r9,31 block->size_and_flag = size | flag; ffc10ef0: 7c 00 4b 78 or r0,r0,r9 ffc10ef4: 90 1a 00 04 stw r0,4(r26) ffc10ef8: 4b ff fd 65 bl ffc10c5c <_Heap_Free_block> extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { ffc10efc: 41 92 01 0c beq- cr4,ffc11008 <_Heap_Extend+0x370> if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; return true; } ffc10f00: 81 3e 00 24 lwz r9,36(r30) extended_size = stats->free_size - free_size; /* Statistics */ stats->size += extended_size; if ( extended_size_ptr != NULL ) ffc10f04: 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( ffc10f08: 81 7e 00 20 lwz r11,32(r30) *extended_size_ptr = extended_size; return true; ffc10f0c: 38 60 00 01 li r3,1 RTEMS_INLINE_ROUTINE void _Heap_Block_set_size( Heap_Block *block, uintptr_t size ) { uintptr_t flag = block->size_and_flag & HEAP_PREV_BLOCK_USED; ffc10f10: 80 09 00 04 lwz r0,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( ffc10f14: 7d 69 58 50 subf r11,r9,r11 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; ffc10f18: 54 00 07 fe clrlwi r0,r0,31 block->size_and_flag = size | flag; ffc10f1c: 7c 00 5b 78 or r0,r0,r11 ffc10f20: 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; ffc10f24: 81 3e 00 30 lwz r9,48(r30) /* Statistics */ stats->size += extended_size; ffc10f28: 80 1e 00 2c lwz r0,44(r30) _Heap_Free_block( heap, extend_first_block ); } _Heap_Set_last_block_size( heap ); extended_size = stats->free_size - free_size; ffc10f2c: 7f 18 48 50 subf r24,r24,r9 /* Statistics */ stats->size += extended_size; ffc10f30: 7c 00 c2 14 add r0,r0,r24 ffc10f34: 90 1e 00 2c stw r0,44(r30) if ( extended_size_ptr != NULL ) ffc10f38: 41 be fd d0 beq- cr7,ffc10d08 <_Heap_Extend+0x70> <== NEVER TAKEN *extended_size_ptr = extended_size; return true; } ffc10f3c: 80 01 00 44 lwz r0,68(r1) ffc10f40: 81 81 00 18 lwz r12,24(r1) ffc10f44: 7c 08 03 a6 mtlr r0 /* Statistics */ stats->size += extended_size; if ( extended_size_ptr != NULL ) *extended_size_ptr = extended_size; ffc10f48: 93 19 00 00 stw r24,0(r25) return true; } ffc10f4c: 7d 81 81 20 mtcrf 24,r12 ffc10f50: 82 e1 00 1c lwz r23,28(r1) ffc10f54: 83 01 00 20 lwz r24,32(r1) ffc10f58: 83 21 00 24 lwz r25,36(r1) ffc10f5c: 83 41 00 28 lwz r26,40(r1) ffc10f60: 83 61 00 2c lwz r27,44(r1) ffc10f64: 83 81 00 30 lwz r28,48(r1) ffc10f68: 83 a1 00 34 lwz r29,52(r1) ffc10f6c: 83 c1 00 38 lwz r30,56(r1) ffc10f70: 83 e1 00 3c lwz r31,60(r1) ffc10f74: 38 21 00 40 addi r1,r1,64 ffc10f78: 4e 80 00 20 blr return false; } do { uintptr_t const sub_area_begin = (start_block != first_block) ? (uintptr_t) start_block : heap->area_begin; ffc10f7c: 81 5e 00 18 lwz r10,24(r30) ffc10f80: 4b ff fe 48 b ffc10dc8 <_Heap_Extend+0x130> extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { ffc10f84: 81 5e 00 20 lwz r10,32(r30) } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; ffc10f88: 81 21 00 0c lwz r9,12(r1) ffc10f8c: 81 61 00 08 lwz r11,8(r1) extend_last_block->prev_size = extend_first_block_size; extend_last_block->size_and_flag = 0; _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { ffc10f90: 7f 8a 48 40 cmplw cr7,r10,r9 start_block = _Heap_Block_at( end_block, _Heap_Block_size( end_block ) ); } while ( start_block != first_block ); if ( extend_area_begin < heap->area_begin ) { heap->area_begin = extend_area_begin; ffc10f94: 93 fe 00 18 stw r31,24(r30) } else if ( heap->area_end < extend_area_end ) { heap->area_end = extend_area_end; } extend_first_block_size = ffc10f98: 7d 49 58 50 subf r10,r9,r11 (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; ffc10f9c: 61 47 00 01 ori r7,r10,1 } extend_first_block_size = (uintptr_t) extend_last_block - (uintptr_t) extend_first_block; extend_first_block->prev_size = extend_area_end; ffc10fa0: 93 a9 00 00 stw r29,0(r9) extend_first_block->size_and_flag = 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; ffc10fa4: 91 4b 00 00 stw r10,0(r11) extend_last_block->size_and_flag = 0; ffc10fa8: 39 40 00 00 li r10,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 = ffc10fac: 90 e9 00 04 stw r7,4(r9) 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; ffc10fb0: 91 4b 00 04 stw r10,4(r11) _Heap_Protection_block_initialize( heap, extend_last_block ); if ( (uintptr_t) extend_first_block < (uintptr_t) heap->first_block ) { ffc10fb4: 41 bd fe b0 bgt- cr7,ffc10e64 <_Heap_Extend+0x1cc> <== ALWAYS TAKEN heap->first_block = extend_first_block; } else if ( (uintptr_t) extend_last_block > (uintptr_t) heap->last_block ) { ffc10fb8: 81 3e 00 24 lwz r9,36(r30) ffc10fbc: 7f 89 58 40 cmplw cr7,r9,r11 ffc10fc0: 40 bc fe a8 bge- cr7,ffc10e68 <_Heap_Extend+0x1d0> heap->last_block = extend_last_block; ffc10fc4: 91 7e 00 24 stw r11,36(r30) ffc10fc8: 4b ff fe a0 b ffc10e68 <_Heap_Extend+0x1d0> ); } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { ffc10fcc: 2f 97 00 00 cmpwi cr7,r23,0 ffc10fd0: 41 be ff 2c beq- cr7,ffc10efc <_Heap_Extend+0x264> 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; ffc10fd4: 81 37 00 04 lwz r9,4(r23) ) { 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 ); ffc10fd8: 80 01 00 0c lwz r0,12(r1) ffc10fdc: 55 29 07 fe clrlwi r9,r9,31 ffc10fe0: 7c 17 00 50 subf r0,r23,r0 block->size_and_flag = size | flag; ffc10fe4: 7d 20 03 78 or r0,r9,r0 } if ( merge_above_block != NULL ) { _Heap_Merge_above( heap, merge_above_block, extend_area_end ); } else if ( link_above_block != NULL ) { _Heap_Link_above( ffc10fe8: 81 21 00 08 lwz r9,8(r1) ffc10fec: 90 17 00 04 stw r0,4(r23) 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 ); last_block->size_and_flag |= HEAP_PREV_BLOCK_USED; ffc10ff0: 80 09 00 04 lwz r0,4(r9) ffc10ff4: 60 00 00 01 ori r0,r0,1 ffc10ff8: 90 09 00 04 stw r0,4(r9) ffc10ffc: 4b ff ff 00 b ffc10efc <_Heap_Extend+0x264> _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; ffc11000: 38 60 00 00 li r3,0 ffc11004: 4b ff fd 04 b ffc10d08 <_Heap_Extend+0x70> extend_first_block, extend_last_block ); } if ( merge_below_block == NULL && merge_above_block == NULL ) { ffc11008: 40 8e fe f8 bne+ cr3,ffc10f00 <_Heap_Extend+0x268> _Heap_Free_block( heap, extend_first_block ); ffc1100c: 80 81 00 0c lwz r4,12(r1) ffc11010: 7f c3 f3 78 mr r3,r30 ffc11014: 4b ff fc 49 bl ffc10c5c <_Heap_Free_block> ffc11018: 4b ff fe e8 b ffc10f00 <_Heap_Extend+0x268> 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 ) { ffc1101c: 2f 80 00 00 cmpwi cr7,r0,0 ffc11020: 41 be fe 90 beq- cr7,ffc10eb0 <_Heap_Extend+0x218> { 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; ffc11024: 7c 0b 00 50 subf r0,r11,r0 ffc11028: 60 00 00 01 ori r0,r0,1 ) { uintptr_t const last_block_begin = (uintptr_t) last_block; uintptr_t const link_begin = (uintptr_t) link; last_block->size_and_flag = ffc1102c: 90 0b 00 04 stw r0,4(r11) ffc11030: 4b ff fe 80 b ffc10eb0 <_Heap_Extend+0x218> =============================================================================== ffc110bc <_Heap_Free>: /* * 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 ) { ffc110bc: 2c 04 00 00 cmpwi r4,0 return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) { ffc110c0: 94 21 ff f0 stwu r1,-16(r1) ffc110c4: 7c 69 1b 78 mr r9,r3 ffc110c8: 93 e1 00 0c stw r31,12(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; ffc110cc: 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 ) { ffc110d0: 41 82 01 44 beq- ffc11214 <_Heap_Free+0x158> ffc110d4: 80 09 00 10 lwz r0,16(r9) 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 ) ) { return false; ffc110d8: 38 60 00 00 li r3,0 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 ffc110dc: 81 69 00 20 lwz r11,32(r9) RTEMS_INLINE_ROUTINE uintptr_t _Heap_Align_down( uintptr_t value, uintptr_t alignment ) { return value - (value % alignment); ffc110e0: 7c 84 03 96 divwu r4,r4,r0 ffc110e4: 7c 84 01 d6 mullw r4,r4,r0 uintptr_t alloc_begin, uintptr_t page_size ) { return (Heap_Block *) (_Heap_Align_down( alloc_begin, page_size ) - HEAP_BLOCK_HEADER_SIZE); ffc110e8: 38 84 ff f8 addi r4,r4,-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; ffc110ec: 7f 84 58 40 cmplw cr7,r4,r11 ffc110f0: 41 9c 01 24 blt- cr7,ffc11214 <_Heap_Free+0x158> ffc110f4: 80 09 00 24 lwz r0,36(r9) ffc110f8: 7f 84 00 40 cmplw cr7,r4,r0 ffc110fc: 41 9d 01 18 bgt- cr7,ffc11214 <_Heap_Free+0x158> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc11100: 81 04 00 04 lwz r8,4(r4) - 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; ffc11104: 55 07 00 3c rlwinm r7,r8,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); ffc11108: 7d 47 22 14 add r10,r7,r4 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; ffc1110c: 7f 8b 50 40 cmplw cr7,r11,r10 ffc11110: 41 9d 01 04 bgt- cr7,ffc11214 <_Heap_Free+0x158> <== NEVER TAKEN ffc11114: 7f 80 50 40 cmplw cr7,r0,r10 ffc11118: 41 9c 00 fc blt- cr7,ffc11214 <_Heap_Free+0x158> <== NEVER TAKEN ffc1111c: 80 ca 00 04 lwz r6,4(r10) return false; } _Heap_Protection_block_check( heap, next_block ); if ( !_Heap_Is_prev_used( next_block ) ) { ffc11120: 70 c5 00 01 andi. r5,r6,1 ffc11124: 41 82 00 f0 beq- ffc11214 <_Heap_Free+0x158> return true; } next_block_size = _Heap_Block_size( next_block ); next_is_free = next_block != heap->last_block && !_Heap_Is_prev_used( _Heap_Block_at( next_block, next_block_size )); ffc11128: 7f 80 50 00 cmpw cr7,r0,r10 - 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; ffc1112c: 54 c5 00 3c rlwinm r5,r6,0,0,30 ffc11130: 38 c0 00 00 li r6,0 ffc11134: 41 9e 00 18 beq- cr7,ffc1114c <_Heap_Free+0x90> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc11138: 7c ca 2a 14 add r6,r10,r5 block->size_and_flag = size | flag; } RTEMS_INLINE_ROUTINE bool _Heap_Is_prev_used( const Heap_Block *block ) { return block->size_and_flag & HEAP_PREV_BLOCK_USED; ffc1113c: 80 c6 00 04 lwz r6,4(r6) return do_free; } #endif bool _Heap_Free( Heap_Control *heap, void *alloc_begin_ptr ) ffc11140: 70 c3 00 01 andi. r3,r6,1 ffc11144: 7c c0 00 26 mfcr r6 ffc11148: 54 c6 1f fe rlwinm r6,r6,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 ) ) { ffc1114c: 71 08 00 01 andi. r8,r8,1 ffc11150: 40 82 00 6c bne- ffc111bc <_Heap_Free+0x100> uintptr_t const prev_size = block->prev_size; ffc11154: 83 e4 00 00 lwz r31,0(r4) Heap_Block * const prev_block = _Heap_Block_at( block, -prev_size ); if ( !_Heap_Is_block_in_heap( heap, prev_block ) ) { _HAssert( false ); return( false ); ffc11158: 38 60 00 00 li r3,0 RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Block_at( const Heap_Block *block, uintptr_t offset ) { return (Heap_Block *) ((uintptr_t) block + offset); ffc1115c: 7d 9f 20 50 subf r12,r31,r4 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; ffc11160: 7f 8b 60 40 cmplw cr7,r11,r12 ffc11164: 41 9d 00 b0 bgt- cr7,ffc11214 <_Heap_Free+0x158> <== NEVER TAKEN ffc11168: 7f 80 60 40 cmplw cr7,r0,r12 ffc1116c: 7d 03 43 78 mr r3,r8 ffc11170: 41 9c 00 a4 blt- cr7,ffc11214 <_Heap_Free+0x158> <== 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; ffc11174: 80 0c 00 04 lwz r0,4(r12) } /* As we always coalesce free blocks, the block that preceedes prev_block must have been used. */ if ( !_Heap_Is_prev_used ( prev_block) ) { ffc11178: 70 0b 00 01 andi. r11,r0,1 ffc1117c: 41 82 00 98 beq- ffc11214 <_Heap_Free+0x158> <== NEVER TAKEN _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ ffc11180: 2f 86 00 00 cmpwi cr7,r6,0 ffc11184: 41 9e 00 e8 beq- cr7,ffc1126c <_Heap_Free+0x1b0> uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc11188: 81 09 00 38 lwz r8,56(r9) _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ffc1118c: 7f e7 fa 14 add r31,r7,r31 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc11190: 81 6a 00 08 lwz r11,8(r10) _HAssert( false ); return( false ); } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; ffc11194: 7c bf 2a 14 add r5,r31,r5 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc11198: 81 4a 00 0c lwz r10,12(r10) } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc1119c: 39 08 ff ff addi r8,r8,-1 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc111a0: 60 a0 00 01 ori r0,r5,1 RTEMS_INLINE_ROUTINE void _Heap_Free_list_remove( Heap_Block *block ) { Heap_Block *next = block->next; Heap_Block *prev = block->prev; prev->next = next; ffc111a4: 91 6a 00 08 stw r11,8(r10) next->prev = prev; ffc111a8: 91 4b 00 0c stw r10,12(r11) } if ( next_is_free ) { /* coalesce both */ uintptr_t const size = block_size + prev_size + next_block_size; _Heap_Free_list_remove( next_block ); stats->free_blocks -= 1; ffc111ac: 91 09 00 38 stw r8,56(r9) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc111b0: 90 0c 00 04 stw r0,4(r12) next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; ffc111b4: 7c a5 61 2e stwx r5,r5,r12 ffc111b8: 48 00 00 34 b ffc111ec <_Heap_Free+0x130> uintptr_t const size = block_size + prev_size; prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ ffc111bc: 2f 86 00 00 cmpwi cr7,r6,0 ffc111c0: 41 9e 00 60 beq- cr7,ffc11220 <_Heap_Free+0x164> --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc111c4: 81 6a 00 08 lwz r11,8(r10) prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; ffc111c8: 7c a5 3a 14 add r5,r5,r7 --stats->used_blocks; ++stats->frees; stats->free_size += block_size; return( true ); } ffc111cc: 81 4a 00 0c lwz r10,12(r10) next_block->prev_size = size; } } else if ( next_is_free ) { /* coalesce next */ uintptr_t const size = block_size + next_block_size; _Heap_Free_list_replace( next_block, block ); block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc111d0: 60 a0 00 01 ori r0,r5,1 ) { Heap_Block *next = old_block->next; Heap_Block *prev = old_block->prev; new_block->next = next; ffc111d4: 91 64 00 08 stw r11,8(r4) new_block->prev = prev; ffc111d8: 91 44 00 0c stw r10,12(r4) next->prev = new_block; prev->next = new_block; ffc111dc: 90 8a 00 08 stw r4,8(r10) Heap_Block *prev = old_block->prev; new_block->next = next; new_block->prev = prev; next->prev = new_block; ffc111e0: 90 8b 00 0c stw r4,12(r11) ffc111e4: 90 04 00 04 stw r0,4(r4) next_block = _Heap_Block_at( block, size ); next_block->prev_size = size; ffc111e8: 7c a5 21 2e stwx r5,r5,r4 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc111ec: 81 69 00 40 lwz r11,64(r9) ++stats->frees; stats->free_size += block_size; return( true ); ffc111f0: 38 60 00 01 li r3,1 } } /* Statistics */ --stats->used_blocks; ++stats->frees; ffc111f4: 81 09 00 50 lwz r8,80(r9) stats->free_size += block_size; ffc111f8: 81 49 00 30 lwz r10,48(r9) stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc111fc: 39 6b ff ff addi r11,r11,-1 ++stats->frees; ffc11200: 38 08 00 01 addi r0,r8,1 stats->max_free_blocks = stats->free_blocks; } } /* Statistics */ --stats->used_blocks; ffc11204: 91 69 00 40 stw r11,64(r9) ++stats->frees; stats->free_size += block_size; ffc11208: 7c ea 3a 14 add r7,r10,r7 } } /* Statistics */ --stats->used_blocks; ++stats->frees; ffc1120c: 90 09 00 50 stw r0,80(r9) stats->free_size += block_size; ffc11210: 90 e9 00 30 stw r7,48(r9) return( true ); } ffc11214: 83 e1 00 0c lwz r31,12(r1) ffc11218: 38 21 00 10 addi r1,r1,16 ffc1121c: 4e 80 00 20 blr 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; ffc11220: 81 09 00 38 lwz r8,56(r9) if ( stats->max_free_blocks < stats->free_blocks ) { ffc11224: 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; ffc11228: 38 08 00 01 addi r0,r8,1 ) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; ffc1122c: 91 24 00 0c stw r9,12(r4) next_block->prev_size = size; } else { /* no coalesce */ /* Add 'block' to the head of the free blocks list as it tends to produce less fragmentation than adding to the tail. */ _Heap_Free_list_insert_after( _Heap_Free_list_head( heap), block ); block->size_and_flag = block_size | HEAP_PREV_BLOCK_USED; ffc11230: 60 e8 00 01 ori r8,r7,1 ffc11234: 91 04 00 04 stw r8,4(r4) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; if ( stats->max_free_blocks < stats->free_blocks ) { ffc11238: 7f 80 58 40 cmplw cr7,r0,r11 } 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; ffc1123c: 81 0a 00 04 lwz r8,4(r10) RTEMS_INLINE_ROUTINE void _Heap_Free_list_insert_after( Heap_Block *block_before, Heap_Block *new_block ) { Heap_Block *next = block_before->next; ffc11240: 81 69 00 08 lwz r11,8(r9) ffc11244: 55 08 00 3c rlwinm r8,r8,0,0,30 next_block->prev_size = block_size; ffc11248: 7c e7 21 2e stwx r7,r7,r4 new_block->next = next; ffc1124c: 91 64 00 08 stw r11,8(r4) } 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; ffc11250: 91 0a 00 04 stw r8,4(r10) new_block->prev = block_before; block_before->next = new_block; next->prev = new_block; ffc11254: 90 8b 00 0c stw r4,12(r11) { Heap_Block *next = block_before->next; new_block->next = next; new_block->prev = block_before; block_before->next = new_block; ffc11258: 90 89 00 08 stw r4,8(r9) next_block->prev_size = block_size; /* Statistics */ ++stats->free_blocks; ffc1125c: 90 09 00 38 stw r0,56(r9) if ( stats->max_free_blocks < stats->free_blocks ) { ffc11260: 40 bd ff 8c ble- cr7,ffc111ec <_Heap_Free+0x130> stats->max_free_blocks = stats->free_blocks; ffc11264: 90 09 00 3c stw r0,60(r9) ffc11268: 4b ff ff 84 b ffc111ec <_Heap_Free+0x130> prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; next_block = _Heap_Block_at( prev_block, size ); _HAssert(!_Heap_Is_prev_used( next_block)); next_block->prev_size = size; } else { /* coalesce prev */ uintptr_t const size = block_size + prev_size; ffc1126c: 7f e7 fa 14 add r31,r7,r31 prev_block->size_and_flag = size | HEAP_PREV_BLOCK_USED; ffc11270: 63 e0 00 01 ori r0,r31,1 next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; next_block->prev_size = size; ffc11274: 7f e7 21 2e stwx r31,r7,r4 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; ffc11278: 90 0c 00 04 stw r0,4(r12) next_block->size_and_flag &= ~HEAP_PREV_BLOCK_USED; ffc1127c: 80 0a 00 04 lwz r0,4(r10) ffc11280: 54 00 00 3c rlwinm r0,r0,0,0,30 ffc11284: 90 0a 00 04 stw r0,4(r10) ffc11288: 4b ff ff 64 b ffc111ec <_Heap_Free+0x130> =============================================================================== ffc0b338 <_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; ffc0b338: 2f 85 00 00 cmpwi cr7,r5,0 bool _Heap_Walk( Heap_Control *heap, int source, bool dump ) { ffc0b33c: 94 21 ff 98 stwu r1,-104(r1) ffc0b340: 7c 08 02 a6 mflr r0 ffc0b344: 92 e1 00 44 stw r23,68(r1) ffc0b348: 90 01 00 6c stw r0,108(r1) ffc0b34c: 93 01 00 48 stw r24,72(r1) ffc0b350: 93 21 00 4c stw r25,76(r1) ffc0b354: 7c 99 23 78 mr r25,r4 ffc0b358: 93 41 00 50 stw r26,80(r1) ffc0b35c: 93 61 00 54 stw r27,84(r1) ffc0b360: 93 e1 00 64 stw r31,100(r1) ffc0b364: 7c 7f 1b 78 mr r31,r3 ffc0b368: 91 c1 00 20 stw r14,32(r1) ffc0b36c: 91 e1 00 24 stw r15,36(r1) ffc0b370: 92 01 00 28 stw r16,40(r1) ffc0b374: 92 21 00 2c stw r17,44(r1) ffc0b378: 92 41 00 30 stw r18,48(r1) ffc0b37c: 92 61 00 34 stw r19,52(r1) ffc0b380: 92 81 00 38 stw r20,56(r1) ffc0b384: 92 a1 00 3c stw r21,60(r1) ffc0b388: 92 c1 00 40 stw r22,64(r1) ffc0b38c: 93 81 00 58 stw r28,88(r1) ffc0b390: 93 a1 00 5c stw r29,92(r1) ffc0b394: 93 c1 00 60 stw r30,96(r1) uintptr_t const page_size = heap->page_size; ffc0b398: 83 63 00 10 lwz r27,16(r3) uintptr_t const min_block_size = heap->min_block_size; ffc0b39c: 83 03 00 14 lwz r24,20(r3) Heap_Block *const first_block = heap->first_block; ffc0b3a0: 83 43 00 20 lwz r26,32(r3) Heap_Block *const last_block = heap->last_block; ffc0b3a4: 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; ffc0b3a8: 41 9e 00 7c beq- cr7,ffc0b424 <_Heap_Walk+0xec> ffc0b3ac: 3d 20 ff c1 lis r9,-63 ffc0b3b0: 39 29 b2 38 addi r9,r9,-19912 ffc0b3b4: 91 21 00 18 stw r9,24(r1) if ( !_System_state_Is_up( _System_state_Get() ) ) { ffc0b3b8: 3d 20 00 00 lis r9,0 return true; ffc0b3bc: 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() ) ) { ffc0b3c0: 80 09 28 24 lwz r0,10276(r9) ffc0b3c4: 2f 80 00 03 cmpwi cr7,r0,3 ffc0b3c8: 41 9e 00 7c beq- cr7,ffc0b444 <_Heap_Walk+0x10c> <== ALWAYS TAKEN block = next_block; } while ( block != first_block ); return true; } ffc0b3cc: 80 01 00 6c lwz r0,108(r1) ffc0b3d0: 81 c1 00 20 lwz r14,32(r1) ffc0b3d4: 7c 08 03 a6 mtlr r0 ffc0b3d8: 81 e1 00 24 lwz r15,36(r1) ffc0b3dc: 82 01 00 28 lwz r16,40(r1) ffc0b3e0: 82 21 00 2c lwz r17,44(r1) ffc0b3e4: 82 41 00 30 lwz r18,48(r1) ffc0b3e8: 82 61 00 34 lwz r19,52(r1) ffc0b3ec: 82 81 00 38 lwz r20,56(r1) ffc0b3f0: 82 a1 00 3c lwz r21,60(r1) ffc0b3f4: 82 c1 00 40 lwz r22,64(r1) ffc0b3f8: 82 e1 00 44 lwz r23,68(r1) ffc0b3fc: 83 01 00 48 lwz r24,72(r1) ffc0b400: 83 21 00 4c lwz r25,76(r1) ffc0b404: 83 41 00 50 lwz r26,80(r1) ffc0b408: 83 61 00 54 lwz r27,84(r1) ffc0b40c: 83 81 00 58 lwz r28,88(r1) ffc0b410: 83 a1 00 5c lwz r29,92(r1) ffc0b414: 83 c1 00 60 lwz r30,96(r1) ffc0b418: 83 e1 00 64 lwz r31,100(r1) ffc0b41c: 38 21 00 68 addi r1,r1,104 ffc0b420: 4e 80 00 20 blr 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; ffc0b424: 3d 20 ff c1 lis r9,-63 ffc0b428: 39 29 b2 34 addi r9,r9,-19916 ffc0b42c: 91 21 00 18 stw r9,24(r1) if ( !_System_state_Is_up( _System_state_Get() ) ) { ffc0b430: 3d 20 00 00 lis r9,0 return true; ffc0b434: 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() ) ) { ffc0b438: 80 09 28 24 lwz r0,10276(r9) ffc0b43c: 2f 80 00 03 cmpwi cr7,r0,3 ffc0b440: 40 9e ff 8c bne+ cr7,ffc0b3cc <_Heap_Walk+0x94> 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)( ffc0b444: 80 1f 00 0c lwz r0,12(r31) ffc0b448: 3c a0 ff c2 lis r5,-62 ffc0b44c: 81 1f 00 18 lwz r8,24(r31) ffc0b450: 7f 23 cb 78 mr r3,r25 ffc0b454: 81 3f 00 1c lwz r9,28(r31) ffc0b458: 38 80 00 00 li r4,0 ffc0b45c: 81 7f 00 08 lwz r11,8(r31) ffc0b460: 38 a5 b7 f0 addi r5,r5,-18448 ffc0b464: 90 01 00 10 stw r0,16(r1) ffc0b468: 7f 66 db 78 mr r6,r27 ffc0b46c: 7f 07 c3 78 mr r7,r24 ffc0b470: 80 01 00 18 lwz r0,24(r1) ffc0b474: 7f 4a d3 78 mr r10,r26 ffc0b478: 92 e1 00 08 stw r23,8(r1) ffc0b47c: 7c 09 03 a6 mtctr r0 ffc0b480: 91 61 00 0c stw r11,12(r1) ffc0b484: 4c c6 31 82 crclr 4*cr1+eq ffc0b488: 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 ) { ffc0b48c: 2f 9b 00 00 cmpwi cr7,r27,0 ffc0b490: 41 9e 00 ac beq- cr7,ffc0b53c <_Heap_Walk+0x204> (*printer)( source, true, "page size is zero\n" ); return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { ffc0b494: 73 67 00 07 andi. r7,r27,7 ffc0b498: 40 82 00 cc bne- ffc0b564 <_Heap_Walk+0x22c> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b49c: 7c 18 db 96 divwu r0,r24,r27 ffc0b4a0: 7c 00 d9 d6 mullw r0,r0,r27 ); return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { ffc0b4a4: 7f 98 00 00 cmpw cr7,r24,r0 ffc0b4a8: 40 9e 00 e8 bne- cr7,ffc0b590 <_Heap_Walk+0x258> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc0b4ac: 38 1a 00 08 addi r0,r26,8 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b4b0: 7d 20 db 96 divwu r9,r0,r27 ffc0b4b4: 7d 29 d9 d6 mullw r9,r9,r27 ); return false; } if ( ffc0b4b8: 7f 80 48 00 cmpw cr7,r0,r9 ffc0b4bc: 40 9e 01 00 bne- cr7,ffc0b5bc <_Heap_Walk+0x284> block = next_block; } while ( block != first_block ); return true; } ffc0b4c0: 82 da 00 04 lwz r22,4(r26) ); return false; } if ( !_Heap_Is_prev_used( first_block ) ) { ffc0b4c4: 72 c7 00 01 andi. r7,r22,1 ffc0b4c8: 41 82 01 20 beq- ffc0b5e8 <_Heap_Walk+0x2b0> - 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; ffc0b4cc: 81 37 00 04 lwz r9,4(r23) ffc0b4d0: 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); ffc0b4d4: 7d 37 4a 14 add r9,r23,r9 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; ffc0b4d8: 80 09 00 04 lwz r0,4(r9) ); return false; } if ( _Heap_Is_free( last_block ) ) { ffc0b4dc: 70 07 00 01 andi. r7,r0,1 ffc0b4e0: 41 82 00 34 beq- ffc0b514 <_Heap_Walk+0x1dc> ); return false; } if ( ffc0b4e4: 7f 9a 48 00 cmpw cr7,r26,r9 ffc0b4e8: 41 9e 01 28 beq- cr7,ffc0b610 <_Heap_Walk+0x2d8> _Heap_Block_at( last_block, _Heap_Block_size( last_block ) ) != first_block ) { (*printer)( ffc0b4ec: 80 01 00 18 lwz r0,24(r1) ffc0b4f0: 3c a0 ff c2 lis r5,-62 ffc0b4f4: 7f 23 cb 78 mr r3,r25 ffc0b4f8: 38 80 00 01 li r4,1 ffc0b4fc: 7c 09 03 a6 mtctr r0 ffc0b500: 38 a5 b9 58 addi r5,r5,-18088 ffc0b504: 4c c6 31 82 crclr 4*cr1+eq ffc0b508: 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; ffc0b50c: 38 60 00 00 li r3,0 ffc0b510: 4b ff fe bc b ffc0b3cc <_Heap_Walk+0x94> return false; } if ( _Heap_Is_free( last_block ) ) { (*printer)( ffc0b514: 80 01 00 18 lwz r0,24(r1) ffc0b518: 3c a0 ff c2 lis r5,-62 ffc0b51c: 7f 23 cb 78 mr r3,r25 ffc0b520: 38 80 00 01 li r4,1 ffc0b524: 7c 09 03 a6 mtctr r0 ffc0b528: 38 a5 b9 40 addi r5,r5,-18112 ffc0b52c: 4c c6 31 82 crclr 4*cr1+eq ffc0b530: 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; ffc0b534: 38 60 00 00 li r3,0 ffc0b538: 4b ff fe 94 b ffc0b3cc <_Heap_Walk+0x94> first_block, last_block, first_free_block, last_free_block ); if ( page_size == 0 ) { (*printer)( source, true, "page size is zero\n" ); ffc0b53c: 80 01 00 18 lwz r0,24(r1) ffc0b540: 3c a0 ff c2 lis r5,-62 ffc0b544: 7f 23 cb 78 mr r3,r25 ffc0b548: 38 80 00 01 li r4,1 ffc0b54c: 7c 09 03 a6 mtctr r0 ffc0b550: 38 a5 b8 84 addi r5,r5,-18300 ffc0b554: 4c c6 31 82 crclr 4*cr1+eq ffc0b558: 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; ffc0b55c: 38 60 00 00 li r3,0 ffc0b560: 4b ff fe 6c b ffc0b3cc <_Heap_Walk+0x94> return false; } if ( !_Addresses_Is_aligned( (void *) page_size ) ) { (*printer)( ffc0b564: 80 01 00 18 lwz r0,24(r1) ffc0b568: 3c a0 ff c2 lis r5,-62 ffc0b56c: 7f 23 cb 78 mr r3,r25 ffc0b570: 38 80 00 01 li r4,1 ffc0b574: 7c 09 03 a6 mtctr r0 ffc0b578: 38 a5 b8 98 addi r5,r5,-18280 ffc0b57c: 7f 66 db 78 mr r6,r27 ffc0b580: 4c c6 31 82 crclr 4*cr1+eq ffc0b584: 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; ffc0b588: 38 60 00 00 li r3,0 ffc0b58c: 4b ff fe 40 b ffc0b3cc <_Heap_Walk+0x94> return false; } if ( !_Heap_Is_aligned( min_block_size, page_size ) ) { (*printer)( ffc0b590: 80 01 00 18 lwz r0,24(r1) ffc0b594: 3c a0 ff c2 lis r5,-62 ffc0b598: 7f 23 cb 78 mr r3,r25 ffc0b59c: 38 80 00 01 li r4,1 ffc0b5a0: 7c 09 03 a6 mtctr r0 ffc0b5a4: 38 a5 b8 b8 addi r5,r5,-18248 ffc0b5a8: 7f 06 c3 78 mr r6,r24 ffc0b5ac: 4c c6 31 82 crclr 4*cr1+eq ffc0b5b0: 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; ffc0b5b4: 38 60 00 00 li r3,0 ffc0b5b8: 4b ff fe 14 b ffc0b3cc <_Heap_Walk+0x94> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( first_block ), page_size ) ) { (*printer)( ffc0b5bc: 80 01 00 18 lwz r0,24(r1) ffc0b5c0: 3c a0 ff c2 lis r5,-62 ffc0b5c4: 7f 23 cb 78 mr r3,r25 ffc0b5c8: 38 80 00 01 li r4,1 ffc0b5cc: 7c 09 03 a6 mtctr r0 ffc0b5d0: 38 a5 b8 dc addi r5,r5,-18212 ffc0b5d4: 7f 46 d3 78 mr r6,r26 ffc0b5d8: 4c c6 31 82 crclr 4*cr1+eq ffc0b5dc: 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; ffc0b5e0: 38 60 00 00 li r3,0 ffc0b5e4: 4b ff fd e8 b ffc0b3cc <_Heap_Walk+0x94> return false; } if ( !_Heap_Is_prev_used( first_block ) ) { (*printer)( ffc0b5e8: 80 01 00 18 lwz r0,24(r1) ffc0b5ec: 3c a0 ff c2 lis r5,-62 ffc0b5f0: 7f 23 cb 78 mr r3,r25 ffc0b5f4: 38 80 00 01 li r4,1 ffc0b5f8: 7c 09 03 a6 mtctr r0 ffc0b5fc: 38 a5 b9 10 addi r5,r5,-18160 ffc0b600: 4c c6 31 82 crclr 4*cr1+eq ffc0b604: 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; ffc0b608: 38 60 00 00 li r3,0 ffc0b60c: 4b ff fd c0 b ffc0b3cc <_Heap_Walk+0x94> return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; ffc0b610: 80 df 00 08 lwz r6,8(r31) int source, Heap_Walk_printer printer, Heap_Control *heap ) { uintptr_t const page_size = heap->page_size; ffc0b614: 81 1f 00 10 lwz r8,16(r31) 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 ) { ffc0b618: 7f 9f 30 00 cmpw cr7,r31,r6 block = next_block; } while ( block != first_block ); return true; } ffc0b61c: 80 1f 00 20 lwz r0,32(r31) 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 ) { ffc0b620: 41 9e 00 34 beq- cr7,ffc0b654 <_Heap_Walk+0x31c> 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; ffc0b624: 7f 80 30 40 cmplw cr7,r0,r6 ffc0b628: 40 9d 03 24 ble- cr7,ffc0b94c <_Heap_Walk+0x614> <== ALWAYS TAKEN if ( !_Heap_Is_block_in_heap( heap, free_block ) ) { (*printer)( ffc0b62c: 80 01 00 18 lwz r0,24(r1) ffc0b630: 3c a0 ff c2 lis r5,-62 ffc0b634: 7f 23 cb 78 mr r3,r25 ffc0b638: 38 80 00 01 li r4,1 ffc0b63c: 7c 09 03 a6 mtctr r0 ffc0b640: 38 a5 b9 88 addi r5,r5,-18040 ffc0b644: 4c c6 31 82 crclr 4*cr1+eq ffc0b648: 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; ffc0b64c: 38 60 00 00 li r3,0 ffc0b650: 4b ff fd 7c b ffc0b3cc <_Heap_Walk+0x94> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b654: 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)( ffc0b658: 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)( ffc0b65c: 3e 40 ff c2 lis r18,-62 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b660: 7f 5d d3 78 mr r29,r26 "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b664: 3a 73 bb a4 addi r19,r19,-17500 if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { (*printer)( ffc0b668: 3a 94 bb 8c addi r20,r20,-17524 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)( ffc0b66c: 3a 52 ba e8 addi r18,r18,-17688 ffc0b670: 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)" : "") ffc0b674: 3e a0 ff c2 lis r21,-62 ffc0b678: 3d e0 ff c2 lis r15,-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)( ffc0b67c: 3e 00 ff c2 lis r16,-62 block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0b680: 3d c0 ff c2 lis r14,-62 - 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; ffc0b684: 56 dc 00 3c rlwinm r28,r22,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); ffc0b688: 7f dc ea 14 add r30,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; ffc0b68c: 7f 80 f0 40 cmplw cr7,r0,r30 ffc0b690: 40 9d 00 34 ble- cr7,ffc0b6c4 <_Heap_Walk+0x38c> <== ALWAYS TAKEN Heap_Block *const next_block = _Heap_Block_at( block, block_size ); uintptr_t const next_block_begin = (uintptr_t) next_block; bool const is_not_last_block = block != last_block; if ( !_Heap_Is_block_in_heap( heap, next_block ) ) { (*printer)( ffc0b694: 3c a0 ff c2 lis r5,-62 ffc0b698: 7f 23 cb 78 mr r3,r25 ffc0b69c: 38 80 00 01 li r4,1 ffc0b6a0: 38 a5 ba 28 addi r5,r5,-17880 return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( ffc0b6a4: 80 01 00 18 lwz r0,24(r1) ffc0b6a8: 7f a6 eb 78 mr r6,r29 ffc0b6ac: 7f c7 f3 78 mr r7,r30 ffc0b6b0: 7c 09 03 a6 mtctr r0 ffc0b6b4: 4c c6 31 82 crclr 4*cr1+eq ffc0b6b8: 4e 80 04 21 bctrl "block 0x%08x: next block 0x%08x is not a successor\n", block, next_block ); return false; ffc0b6bc: 38 60 00 00 li r3,0 ffc0b6c0: 4b ff fd 0c b ffc0b3cc <_Heap_Walk+0x94> ffc0b6c4: 80 1f 00 24 lwz r0,36(r31) ffc0b6c8: 7f 80 f0 40 cmplw cr7,r0,r30 ffc0b6cc: 41 bc ff c8 blt- cr7,ffc0b694 <_Heap_Walk+0x35c> RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b6d0: 7d 3c db 96 divwu r9,r28,r27 ffc0b6d4: 7d 29 d9 d6 mullw r9,r9,r27 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; ffc0b6d8: 7f a0 ba 78 xor r0,r29,r23 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc0b6dc: 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; ffc0b6e0: 7c 00 00 34 cntlzw r0,r0 ffc0b6e4: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0b6e8: 68 00 00 01 xori r0,r0,1 ); return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { ffc0b6ec: 41 9e 00 0c beq- cr7,ffc0b6f8 <_Heap_Walk+0x3c0> ffc0b6f0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b6f4: 40 9e 01 e0 bne- cr7,ffc0b8d4 <_Heap_Walk+0x59c> ); return false; } if ( block_size < min_block_size && is_not_last_block ) { ffc0b6f8: 7f 98 e0 40 cmplw cr7,r24,r28 ffc0b6fc: 40 9d 00 0c ble- cr7,ffc0b708 <_Heap_Walk+0x3d0> ffc0b700: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b704: 40 9e 02 00 bne- cr7,ffc0b904 <_Heap_Walk+0x5cc> <== ALWAYS TAKEN ); return false; } if ( next_block_begin <= block_begin && is_not_last_block ) { ffc0b708: 7f 9d f0 40 cmplw cr7,r29,r30 ffc0b70c: 41 9c 00 0c blt- cr7,ffc0b718 <_Heap_Walk+0x3e0> ffc0b710: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b714: 40 9e 02 24 bne- cr7,ffc0b938 <_Heap_Walk+0x600> 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; ffc0b718: 80 1e 00 04 lwz r0,4(r30) ffc0b71c: 56 d6 07 fe clrlwi r22,r22,31 ); return false; } if ( !_Heap_Is_prev_used( next_block ) ) { ffc0b720: 70 07 00 01 andi. r7,r0,1 ffc0b724: 41 82 00 74 beq- ffc0b798 <_Heap_Walk+0x460> if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; } } else if (prev_used) { ffc0b728: 2f 96 00 00 cmpwi cr7,r22,0 ffc0b72c: 41 9e 00 40 beq- cr7,ffc0b76c <_Heap_Walk+0x434> (*printer)( ffc0b730: 80 01 00 18 lwz r0,24(r1) ffc0b734: 7f 23 cb 78 mr r3,r25 ffc0b738: 38 80 00 00 li r4,0 ffc0b73c: 7e 85 a3 78 mr r5,r20 ffc0b740: 7c 09 03 a6 mtctr r0 ffc0b744: 7f a6 eb 78 mr r6,r29 ffc0b748: 7f 87 e3 78 mr r7,r28 ffc0b74c: 4c c6 31 82 crclr 4*cr1+eq ffc0b750: 4e 80 04 21 bctrl block->prev_size ); } block = next_block; } while ( block != first_block ); ffc0b754: 7f 9a f0 00 cmpw cr7,r26,r30 ffc0b758: 41 9e 01 0c beq- cr7,ffc0b864 <_Heap_Walk+0x52c> ffc0b75c: 82 de 00 04 lwz r22,4(r30) ffc0b760: 7f dd f3 78 mr r29,r30 ffc0b764: 80 1f 00 20 lwz r0,32(r31) ffc0b768: 4b ff ff 1c b ffc0b684 <_Heap_Walk+0x34c> "block 0x%08x: size %u\n", block, block_size ); } else { (*printer)( ffc0b76c: 80 01 00 18 lwz r0,24(r1) ffc0b770: 7f a6 eb 78 mr r6,r29 ffc0b774: 7f 23 cb 78 mr r3,r25 ffc0b778: 81 1d 00 00 lwz r8,0(r29) ffc0b77c: 38 80 00 00 li r4,0 ffc0b780: 7c 09 03 a6 mtctr r0 ffc0b784: 7e 65 9b 78 mr r5,r19 ffc0b788: 7f 87 e3 78 mr r7,r28 ffc0b78c: 4c c6 31 82 crclr 4*cr1+eq ffc0b790: 4e 80 04 21 bctrl ffc0b794: 4b ff ff c0 b ffc0b754 <_Heap_Walk+0x41c> 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 ? ffc0b798: 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)( ffc0b79c: 81 3f 00 08 lwz r9,8(r31) 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; ffc0b7a0: 80 1f 00 0c lwz r0,12(r31) ffc0b7a4: 7f 89 40 00 cmpw cr7,r9,r8 ffc0b7a8: 41 9e 00 f8 beq- cr7,ffc0b8a0 <_Heap_Walk+0x568> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0b7ac: 7f 9f 40 00 cmpw cr7,r31,r8 ffc0b7b0: 41 9e 01 00 beq- cr7,ffc0b8b0 <_Heap_Walk+0x578> ffc0b7b4: 39 35 bb 58 addi r9,r21,-17576 block->next, block->next == last_free_block ? ffc0b7b8: 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)( ffc0b7bc: 7f 80 50 00 cmpw cr7,r0,r10 ffc0b7c0: 41 9e 00 e8 beq- cr7,ffc0b8a8 <_Heap_Walk+0x570> " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ffc0b7c4: 7f 9f 50 00 cmpw cr7,r31,r10 ffc0b7c8: 41 9e 00 f0 beq- cr7,ffc0b8b8 <_Heap_Walk+0x580> ffc0b7cc: 38 15 bb 58 addi r0,r21,-17576 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)( ffc0b7d0: 90 01 00 08 stw r0,8(r1) ffc0b7d4: 7f 23 cb 78 mr r3,r25 ffc0b7d8: 38 80 00 00 li r4,0 ffc0b7dc: 80 01 00 18 lwz r0,24(r1) ffc0b7e0: 7e 45 93 78 mr r5,r18 ffc0b7e4: 7f a6 eb 78 mr r6,r29 ffc0b7e8: 7f 87 e3 78 mr r7,r28 ffc0b7ec: 7c 09 03 a6 mtctr r0 ffc0b7f0: 4c c6 31 82 crclr 4*cr1+eq ffc0b7f4: 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 ) { ffc0b7f8: 81 1e 00 00 lwz r8,0(r30) ffc0b7fc: 7f 9c 40 00 cmpw cr7,r28,r8 ffc0b800: 40 9e 00 6c bne- cr7,ffc0b86c <_Heap_Walk+0x534> ); return false; } if ( !prev_used ) { ffc0b804: 2f 96 00 00 cmpwi cr7,r22,0 ffc0b808: 41 9e 00 b8 beq- cr7,ffc0b8c0 <_Heap_Walk+0x588> return &heap->free_list; } RTEMS_INLINE_ROUTINE Heap_Block *_Heap_Free_list_first( Heap_Control *heap ) { return _Heap_Free_list_head(heap)->next; ffc0b80c: 81 3f 00 08 lwz r9,8(r31) ) { 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 ) { ffc0b810: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0b814: 41 9e 00 24 beq- cr7,ffc0b838 <_Heap_Walk+0x500> <== NEVER TAKEN if ( free_block == block ) { ffc0b818: 7f 9d 48 00 cmpw cr7,r29,r9 ffc0b81c: 40 be 00 0c bne+ cr7,ffc0b828 <_Heap_Walk+0x4f0> ffc0b820: 4b ff ff 34 b ffc0b754 <_Heap_Walk+0x41c> ffc0b824: 41 ba ff 30 beq- cr6,ffc0b754 <_Heap_Walk+0x41c> return true; } free_block = free_block->next; ffc0b828: 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 ) { ffc0b82c: 7f 9f 48 00 cmpw cr7,r31,r9 if ( free_block == block ) { ffc0b830: 7f 1d 48 00 cmpw cr6,r29,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 ) { ffc0b834: 40 9e ff f0 bne+ cr7,ffc0b824 <_Heap_Walk+0x4ec> return false; } if ( !_Heap_Walk_is_in_free_list( heap, block ) ) { (*printer)( ffc0b838: 3c a0 ff c2 lis r5,-62 ffc0b83c: 7f 23 cb 78 mr r3,r25 ffc0b840: 38 80 00 01 li r4,1 ffc0b844: 38 a5 bb cc addi r5,r5,-17460 ffc0b848: 80 01 00 18 lwz r0,24(r1) ffc0b84c: 7f a6 eb 78 mr r6,r29 ffc0b850: 7c 09 03 a6 mtctr r0 ffc0b854: 4c c6 31 82 crclr 4*cr1+eq ffc0b858: 4e 80 04 21 bctrl return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; ffc0b85c: 38 60 00 00 li r3,0 ffc0b860: 4b ff fb 6c b ffc0b3cc <_Heap_Walk+0x94> } block = next_block; } while ( block != first_block ); return true; ffc0b864: 38 60 00 01 li r3,1 ffc0b868: 4b ff fb 64 b ffc0b3cc <_Heap_Walk+0x94> " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ); if ( block_size != next_block->prev_size ) { (*printer)( ffc0b86c: 80 01 00 18 lwz r0,24(r1) ffc0b870: 3c a0 ff c2 lis r5,-62 ffc0b874: 7f 23 cb 78 mr r3,r25 ffc0b878: 38 80 00 01 li r4,1 ffc0b87c: 7c 09 03 a6 mtctr r0 ffc0b880: 38 a5 bb 20 addi r5,r5,-17632 ffc0b884: 7f a6 eb 78 mr r6,r29 ffc0b888: 7f 87 e3 78 mr r7,r28 ffc0b88c: 7f c9 f3 78 mr r9,r30 ffc0b890: 4c c6 31 82 crclr 4*cr1+eq ffc0b894: 4e 80 04 21 bctrl return false; } if ( !_Heap_Is_prev_used( next_block ) ) { if ( !_Heap_Walk_check_free_block( source, printer, heap, block ) ) { return false; ffc0b898: 38 60 00 00 li r3,0 ffc0b89c: 4b ff fb 30 b ffc0b3cc <_Heap_Walk+0x94> 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)( ffc0b8a0: 39 30 b7 b8 addi r9,r16,-18504 ffc0b8a4: 4b ff ff 14 b ffc0b7b8 <_Heap_Walk+0x480> ffc0b8a8: 38 11 b7 d4 addi r0,r17,-18476 ffc0b8ac: 4b ff ff 24 b ffc0b7d0 <_Heap_Walk+0x498> block, block_size, block->prev, block->prev == first_free_block ? " (= first free)" : (block->prev == free_list_head ? " (= head)" : ""), ffc0b8b0: 39 2e b7 c8 addi r9,r14,-18488 ffc0b8b4: 4b ff ff 04 b ffc0b7b8 <_Heap_Walk+0x480> block->next, block->next == last_free_block ? " (= last free)" : (block->next == free_list_tail ? " (= tail)" : "") ffc0b8b8: 38 0f b7 e4 addi r0,r15,-18460 ffc0b8bc: 4b ff ff 14 b ffc0b7d0 <_Heap_Walk+0x498> return false; } if ( !prev_used ) { (*printer)( ffc0b8c0: 3c a0 ff c2 lis r5,-62 ffc0b8c4: 7f 23 cb 78 mr r3,r25 ffc0b8c8: 38 80 00 01 li r4,1 ffc0b8cc: 38 a5 bb 5c addi r5,r5,-17572 ffc0b8d0: 4b ff ff 78 b ffc0b848 <_Heap_Walk+0x510> return false; } if ( !_Heap_Is_aligned( block_size, page_size ) && is_not_last_block ) { (*printer)( ffc0b8d4: 80 01 00 18 lwz r0,24(r1) ffc0b8d8: 3c a0 ff c2 lis r5,-62 ffc0b8dc: 7f 23 cb 78 mr r3,r25 ffc0b8e0: 38 80 00 01 li r4,1 ffc0b8e4: 7c 09 03 a6 mtctr r0 ffc0b8e8: 38 a5 ba 58 addi r5,r5,-17832 ffc0b8ec: 7f a6 eb 78 mr r6,r29 ffc0b8f0: 7f 87 e3 78 mr r7,r28 ffc0b8f4: 4c c6 31 82 crclr 4*cr1+eq ffc0b8f8: 4e 80 04 21 bctrl "block 0x%08x: block size %u not page aligned\n", block, block_size ); return false; ffc0b8fc: 38 60 00 00 li r3,0 ffc0b900: 4b ff fa cc b ffc0b3cc <_Heap_Walk+0x94> } if ( block_size < min_block_size && is_not_last_block ) { (*printer)( ffc0b904: 80 01 00 18 lwz r0,24(r1) ffc0b908: 3c a0 ff c2 lis r5,-62 ffc0b90c: 7f 23 cb 78 mr r3,r25 ffc0b910: 38 80 00 01 li r4,1 ffc0b914: 7c 09 03 a6 mtctr r0 ffc0b918: 38 a5 ba 88 addi r5,r5,-17784 ffc0b91c: 7f a6 eb 78 mr r6,r29 ffc0b920: 7f 87 e3 78 mr r7,r28 ffc0b924: 7f 08 c3 78 mr r8,r24 ffc0b928: 4c c6 31 82 crclr 4*cr1+eq ffc0b92c: 4e 80 04 21 bctrl block, block_size, min_block_size ); return false; ffc0b930: 38 60 00 00 li r3,0 ffc0b934: 4b ff fa 98 b ffc0b3cc <_Heap_Walk+0x94> } if ( next_block_begin <= block_begin && is_not_last_block ) { (*printer)( ffc0b938: 3c a0 ff c2 lis r5,-62 ffc0b93c: 7f 23 cb 78 mr r3,r25 ffc0b940: 38 80 00 01 li r4,1 ffc0b944: 38 a5 ba b4 addi r5,r5,-17740 ffc0b948: 4b ff fd 5c b ffc0b6a4 <_Heap_Walk+0x36c> 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; ffc0b94c: 81 5f 00 24 lwz r10,36(r31) ffc0b950: 7f 86 50 40 cmplw cr7,r6,r10 ffc0b954: 41 bd fc d8 bgt- cr7,ffc0b62c <_Heap_Walk+0x2f4> <== NEVER TAKEN RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc0b958: 39 26 00 08 addi r9,r6,8 RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b95c: 7d 69 43 96 divwu r11,r9,r8 ffc0b960: 7d 6b 41 d6 mullw r11,r11,r8 ); return false; } if ( ffc0b964: 7f 89 58 00 cmpw cr7,r9,r11 ffc0b968: 40 9e 00 d4 bne- cr7,ffc0ba3c <_Heap_Walk+0x704> <== NEVER TAKEN - HEAP_BLOCK_HEADER_SIZE); } RTEMS_INLINE_ROUTINE uintptr_t _Heap_Block_size( const Heap_Block *block ) { return block->size_and_flag & ~HEAP_PREV_BLOCK_USED; ffc0b96c: 81 26 00 04 lwz r9,4(r6) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b970: 7f eb fb 78 mr r11,r31 ffc0b974: 7c c5 33 78 mr r5,r6 ffc0b978: 55 29 00 3c rlwinm r9,r9,0,0,30 block = next_block; } while ( block != first_block ); return true; } ffc0b97c: 7d 26 4a 14 add r9,r6,r9 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; ffc0b980: 81 29 00 04 lwz r9,4(r9) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b984: 71 27 00 01 andi. r7,r9,1 ffc0b988: 41 a2 00 58 beq+ ffc0b9e0 <_Heap_Walk+0x6a8> <== ALWAYS TAKEN ffc0b98c: 48 00 00 88 b ffc0ba14 <_Heap_Walk+0x6dc> <== NOT EXECUTED return false; } prev_block = free_block; free_block = free_block->next; ffc0b990: 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 ) { ffc0b994: 7f 9f 30 00 cmpw cr7,r31,r6 const Heap_Control *heap, const Heap_Block *block ) { return (uintptr_t) block >= (uintptr_t) heap->first_block && (uintptr_t) block <= (uintptr_t) heap->last_block; ffc0b998: 7f 06 00 40 cmplw cr6,r6,r0 ffc0b99c: 7c 86 50 40 cmplw cr1,r6,r10 ffc0b9a0: 41 be fc b4 beq- cr7,ffc0b654 <_Heap_Walk+0x31c> ffc0b9a4: 41 b8 fc 88 blt- cr6,ffc0b62c <_Heap_Walk+0x2f4> RTEMS_INLINE_ROUTINE uintptr_t _Heap_Alloc_area_of_block( const Heap_Block *block ) { return (uintptr_t) block + HEAP_BLOCK_HEADER_SIZE; ffc0b9a8: 39 26 00 08 addi r9,r6,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; ffc0b9ac: 41 a5 fc 80 bgt- cr1,ffc0b62c <_Heap_Walk+0x2f4> <== NEVER TAKEN RTEMS_INLINE_ROUTINE bool _Heap_Is_aligned( uintptr_t value, uintptr_t alignment ) { return (value % alignment) == 0; ffc0b9b0: 7c e9 43 96 divwu r7,r9,r8 ffc0b9b4: 7c e7 41 d6 mullw r7,r7,r8 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b9b8: 7c ab 2b 78 mr r11,r5 ); return false; } if ( ffc0b9bc: 7f 89 38 00 cmpw cr7,r9,r7 ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b9c0: 7c c5 33 78 mr r5,r6 ); return false; } if ( ffc0b9c4: 40 9e 00 78 bne- cr7,ffc0ba3c <_Heap_Walk+0x704> - 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; ffc0b9c8: 81 26 00 04 lwz r9,4(r6) ffc0b9cc: 55 29 00 3c rlwinm r9,r9,0,0,30 block = next_block; } while ( block != first_block ); return true; } ffc0b9d0: 7d 26 4a 14 add r9,r6,r9 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; ffc0b9d4: 81 29 00 04 lwz r9,4(r9) ); return false; } if ( _Heap_Is_used( free_block ) ) { ffc0b9d8: 71 27 00 01 andi. r7,r9,1 ffc0b9dc: 40 82 00 38 bne- ffc0ba14 <_Heap_Walk+0x6dc> ); return false; } if ( free_block->prev != prev_block ) { ffc0b9e0: 80 e6 00 0c lwz r7,12(r6) ffc0b9e4: 7f 87 58 00 cmpw cr7,r7,r11 ffc0b9e8: 41 9e ff a8 beq+ cr7,ffc0b990 <_Heap_Walk+0x658> (*printer)( ffc0b9ec: 80 01 00 18 lwz r0,24(r1) ffc0b9f0: 3c a0 ff c2 lis r5,-62 ffc0b9f4: 7f 23 cb 78 mr r3,r25 ffc0b9f8: 38 80 00 01 li r4,1 ffc0b9fc: 7c 09 03 a6 mtctr r0 ffc0ba00: 38 a5 b9 f4 addi r5,r5,-17932 ffc0ba04: 4c c6 31 82 crclr 4*cr1+eq ffc0ba08: 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; ffc0ba0c: 38 60 00 00 li r3,0 ffc0ba10: 4b ff f9 bc b ffc0b3cc <_Heap_Walk+0x94> return false; } if ( _Heap_Is_used( free_block ) ) { (*printer)( ffc0ba14: 80 01 00 18 lwz r0,24(r1) ffc0ba18: 3c a0 ff c2 lis r5,-62 ffc0ba1c: 7f 23 cb 78 mr r3,r25 ffc0ba20: 38 80 00 01 li r4,1 ffc0ba24: 7c 09 03 a6 mtctr r0 ffc0ba28: 38 a5 b9 d8 addi r5,r5,-17960 ffc0ba2c: 4c c6 31 82 crclr 4*cr1+eq ffc0ba30: 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; ffc0ba34: 38 60 00 00 li r3,0 ffc0ba38: 4b ff f9 94 b ffc0b3cc <_Heap_Walk+0x94> } if ( !_Heap_Is_aligned( _Heap_Alloc_area_of_block( free_block ), page_size ) ) { (*printer)( ffc0ba3c: 80 01 00 18 lwz r0,24(r1) ffc0ba40: 3c a0 ff c2 lis r5,-62 ffc0ba44: 7f 23 cb 78 mr r3,r25 ffc0ba48: 38 80 00 01 li r4,1 ffc0ba4c: 7c 09 03 a6 mtctr r0 ffc0ba50: 38 a5 b9 a8 addi r5,r5,-18008 ffc0ba54: 4c c6 31 82 crclr 4*cr1+eq ffc0ba58: 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; ffc0ba5c: 38 60 00 00 li r3,0 ffc0ba60: 4b ff f9 6c b ffc0b3cc <_Heap_Walk+0x94> =============================================================================== ffc0b238 <_Heap_Walk_print>: static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc0b238: 94 21 ff 88 stwu r1,-120(r1) ffc0b23c: 7c 08 02 a6 mflr r0 ffc0b240: 93 e1 00 74 stw r31,116(r1) ffc0b244: 90 01 00 7c stw r0,124(r1) ffc0b248: 7c 60 1b 78 mr r0,r3 ffc0b24c: 90 c1 00 1c stw r6,28(r1) ffc0b250: 90 e1 00 20 stw r7,32(r1) ffc0b254: 91 01 00 24 stw r8,36(r1) ffc0b258: 91 21 00 28 stw r9,40(r1) ffc0b25c: 91 41 00 2c stw r10,44(r1) ffc0b260: 40 86 00 24 bne- cr1,ffc0b284 <_Heap_Walk_print+0x4c> <== ALWAYS TAKEN ffc0b264: d8 21 00 30 stfd f1,48(r1) <== NOT EXECUTED ffc0b268: d8 41 00 38 stfd f2,56(r1) <== NOT EXECUTED ffc0b26c: d8 61 00 40 stfd f3,64(r1) <== NOT EXECUTED ffc0b270: d8 81 00 48 stfd f4,72(r1) <== NOT EXECUTED ffc0b274: d8 a1 00 50 stfd f5,80(r1) <== NOT EXECUTED ffc0b278: d8 c1 00 58 stfd f6,88(r1) <== NOT EXECUTED ffc0b27c: d8 e1 00 60 stfd f7,96(r1) <== NOT EXECUTED ffc0b280: d9 01 00 68 stfd f8,104(r1) <== NOT EXECUTED va_list ap; if ( error ) { ffc0b284: 2f 84 00 00 cmpwi cr7,r4,0 { /* Do nothing */ } static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { ffc0b288: 7c bf 2b 78 mr r31,r5 va_list ap; if ( error ) { ffc0b28c: 40 9e 00 58 bne- cr7,ffc0b2e4 <_Heap_Walk_print+0xac> printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); ffc0b290: 3c 60 ff c2 lis r3,-62 ffc0b294: 7c 04 03 78 mr r4,r0 ffc0b298: 38 63 b7 ac addi r3,r3,-18516 ffc0b29c: 4c c6 31 82 crclr 4*cr1+eq ffc0b2a0: 4b ff b1 fd bl ffc0649c } va_start( ap, fmt ); ffc0b2a4: 38 00 00 03 li r0,3 ffc0b2a8: 98 01 00 08 stb r0,8(r1) ffc0b2ac: 38 00 00 00 li r0,0 vprintk( fmt, ap ); ffc0b2b0: 7f e3 fb 78 mr r3,r31 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b2b4: 98 01 00 09 stb r0,9(r1) ffc0b2b8: 38 01 00 80 addi r0,r1,128 vprintk( fmt, ap ); ffc0b2bc: 38 81 00 08 addi r4,r1,8 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b2c0: 90 01 00 0c stw r0,12(r1) ffc0b2c4: 38 01 00 10 addi r0,r1,16 ffc0b2c8: 90 01 00 10 stw r0,16(r1) vprintk( fmt, ap ); ffc0b2cc: 4b ff d5 5d bl ffc08828 va_end( ap ); } ffc0b2d0: 80 01 00 7c lwz r0,124(r1) ffc0b2d4: 83 e1 00 74 lwz r31,116(r1) ffc0b2d8: 38 21 00 78 addi r1,r1,120 ffc0b2dc: 7c 08 03 a6 mtlr r0 ffc0b2e0: 4e 80 00 20 blr static void _Heap_Walk_print( int source, bool error, const char *fmt, ... ) { va_list ap; if ( error ) { printk( "FAIL[%d]: ", source ); ffc0b2e4: 3c 60 ff c2 lis r3,-62 ffc0b2e8: 7c 04 03 78 mr r4,r0 ffc0b2ec: 38 63 b7 a0 addi r3,r3,-18528 ffc0b2f0: 4c c6 31 82 crclr 4*cr1+eq ffc0b2f4: 4b ff b1 a9 bl ffc0649c } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b2f8: 38 00 00 03 li r0,3 ffc0b2fc: 98 01 00 08 stb r0,8(r1) ffc0b300: 38 00 00 00 li r0,0 vprintk( fmt, ap ); ffc0b304: 7f e3 fb 78 mr r3,r31 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b308: 98 01 00 09 stb r0,9(r1) ffc0b30c: 38 01 00 80 addi r0,r1,128 vprintk( fmt, ap ); ffc0b310: 38 81 00 08 addi r4,r1,8 printk( "FAIL[%d]: ", source ); } else { printk( "PASS[%d]: ", source ); } va_start( ap, fmt ); ffc0b314: 90 01 00 0c stw r0,12(r1) ffc0b318: 38 01 00 10 addi r0,r1,16 ffc0b31c: 90 01 00 10 stw r0,16(r1) vprintk( fmt, ap ); ffc0b320: 4b ff d5 09 bl ffc08828 va_end( ap ); } ffc0b324: 80 01 00 7c lwz r0,124(r1) ffc0b328: 83 e1 00 74 lwz r31,116(r1) ffc0b32c: 38 21 00 78 addi r1,r1,120 ffc0b330: 7c 08 03 a6 mtlr r0 ffc0b334: 4e 80 00 20 blr =============================================================================== ffc09dd0 <_IO_Initialize_all_drivers>: * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc09dd0: 94 21 ff f0 stwu r1,-16(r1) ffc09dd4: 7c 08 02 a6 mflr r0 ffc09dd8: 93 c1 00 08 stw r30,8(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09ddc: 3f c0 00 00 lis r30,0 * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc09de0: 90 01 00 14 stw r0,20(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09de4: 80 1e 28 58 lwz r0,10328(r30) * * Output Parameters: NONE */ void _IO_Initialize_all_drivers( void ) { ffc09de8: 93 e1 00 0c stw r31,12(r1) rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09dec: 2f 80 00 00 cmpwi cr7,r0,0 ffc09df0: 41 9e 00 2c beq- cr7,ffc09e1c <_IO_Initialize_all_drivers+0x4c><== NEVER TAKEN ffc09df4: 3b e0 00 00 li r31,0 ffc09df8: 3b de 28 58 addi r30,r30,10328 (void) rtems_io_initialize( major, 0, NULL ); ffc09dfc: 7f e3 fb 78 mr r3,r31 ffc09e00: 38 80 00 00 li r4,0 ffc09e04: 38 a0 00 00 li r5,0 ffc09e08: 48 00 6d d5 bl ffc10bdc void _IO_Initialize_all_drivers( void ) { rtems_device_major_number major; for ( major=0 ; major < _IO_Number_of_drivers ; major ++ ) ffc09e0c: 80 1e 00 00 lwz r0,0(r30) ffc09e10: 3b ff 00 01 addi r31,r31,1 ffc09e14: 7f 80 f8 40 cmplw cr7,r0,r31 ffc09e18: 41 9d ff e4 bgt+ cr7,ffc09dfc <_IO_Initialize_all_drivers+0x2c> (void) rtems_io_initialize( major, 0, NULL ); } ffc09e1c: 80 01 00 14 lwz r0,20(r1) ffc09e20: 83 c1 00 08 lwz r30,8(r1) ffc09e24: 7c 08 03 a6 mtlr r0 ffc09e28: 83 e1 00 0c lwz r31,12(r1) ffc09e2c: 38 21 00 10 addi r1,r1,16 ffc09e30: 4e 80 00 20 blr =============================================================================== ffc09cc0 <_IO_Manager_initialization>: * workspace. * */ void _IO_Manager_initialization(void) { ffc09cc0: 94 21 ff e0 stwu r1,-32(r1) ffc09cc4: 7c 08 02 a6 mflr r0 uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; ffc09cc8: 3d 20 00 00 lis r9,0 * workspace. * */ void _IO_Manager_initialization(void) { ffc09ccc: 90 01 00 24 stw r0,36(r1) uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; ffc09cd0: 39 29 20 04 addi r9,r9,8196 * workspace. * */ void _IO_Manager_initialization(void) { ffc09cd4: 93 a1 00 14 stw r29,20(r1) ffc09cd8: 93 c1 00 18 stw r30,24(r1) uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; drivers_in_table = Configuration.number_of_device_drivers; number_of_drivers = Configuration.maximum_drivers; ffc09cdc: 83 a9 00 2c lwz r29,44(r9) rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; drivers_in_table = Configuration.number_of_device_drivers; ffc09ce0: 83 c9 00 30 lwz r30,48(r9) * workspace. * */ void _IO_Manager_initialization(void) { ffc09ce4: 93 e1 00 1c stw r31,28(r1) /* * If the user claims there are less drivers than are actually in * the table, then let's just go with the table's count. */ if ( number_of_drivers <= drivers_in_table ) ffc09ce8: 7f 9e e8 40 cmplw cr7,r30,r29 * workspace. * */ void _IO_Manager_initialization(void) { ffc09cec: 93 61 00 0c stw r27,12(r1) ffc09cf0: 93 81 00 10 stw r28,16(r1) uint32_t index; rtems_driver_address_table *driver_table; uint32_t drivers_in_table; uint32_t number_of_drivers; driver_table = Configuration.Device_driver_table; ffc09cf4: 83 e9 00 34 lwz r31,52(r9) /* * If the user claims there are less drivers than are actually in * the table, then let's just go with the table's count. */ if ( number_of_drivers <= drivers_in_table ) ffc09cf8: 40 9c 00 a4 bge- cr7,ffc09d9c <_IO_Manager_initialization+0xdc> * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ffc09cfc: 1f 7d 00 18 mulli r27,r29,24 * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( ffc09d00: 7f 63 db 78 mr r3,r27 ffc09d04: 48 00 3e 79 bl ffc0db7c <_Workspace_Allocate_or_fatal_error> /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) ffc09d08: 3f 80 00 00 lis r28,0 _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; ffc09d0c: 3d 20 00 00 lis r9,0 /* * The application requested extra slots in the driver table, so we * have to allocate a new driver table and copy theirs to it. */ _IO_Driver_address_table = (rtems_driver_address_table *) ffc09d10: 90 7c 28 5c stw r3,10332(r28) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; memset( ffc09d14: 38 80 00 00 li r4,0 ffc09d18: 7f 65 db 78 mr r5,r27 _IO_Driver_address_table = (rtems_driver_address_table *) _Workspace_Allocate_or_fatal_error( sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); _IO_Number_of_drivers = number_of_drivers; ffc09d1c: 93 a9 28 58 stw r29,10328(r9) memset( ffc09d20: 48 00 ac f5 bl ffc14a14 _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) ffc09d24: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09d28: 41 9e 00 50 beq- cr7,ffc09d78 <_IO_Manager_initialization+0xb8><== NEVER TAKEN ffc09d2c: 7f c9 03 a6 mtctr r30 ffc09d30: 81 1c 28 5c lwz r8,10332(r28) ffc09d34: 39 40 00 00 li r10,0 _IO_Driver_address_table[index] = driver_table[index]; ffc09d38: 7f e9 fb 78 mr r9,r31 ffc09d3c: 7c a9 50 6e lwzux r5,r9,r10 ffc09d40: 7d 68 52 14 add r11,r8,r10 ffc09d44: 80 e9 00 08 lwz r7,8(r9) ffc09d48: 80 09 00 0c lwz r0,12(r9) ffc09d4c: 80 c9 00 04 lwz r6,4(r9) ffc09d50: 7c a8 51 2e stwx r5,r8,r10 memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) ffc09d54: 39 4a 00 18 addi r10,r10,24 _IO_Driver_address_table[index] = driver_table[index]; ffc09d58: 90 cb 00 04 stw r6,4(r11) ffc09d5c: 90 eb 00 08 stw r7,8(r11) ffc09d60: 90 0b 00 0c stw r0,12(r11) ffc09d64: 80 e9 00 10 lwz r7,16(r9) ffc09d68: 80 09 00 14 lwz r0,20(r9) ffc09d6c: 90 eb 00 10 stw r7,16(r11) ffc09d70: 90 0b 00 14 stw r0,20(r11) memset( _IO_Driver_address_table, 0, sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) ffc09d74: 42 00 ff c4 bdnz+ ffc09d38 <_IO_Manager_initialization+0x78> _IO_Driver_address_table[index] = driver_table[index]; } ffc09d78: 80 01 00 24 lwz r0,36(r1) ffc09d7c: 83 61 00 0c lwz r27,12(r1) ffc09d80: 7c 08 03 a6 mtlr r0 ffc09d84: 83 81 00 10 lwz r28,16(r1) ffc09d88: 83 a1 00 14 lwz r29,20(r1) ffc09d8c: 83 c1 00 18 lwz r30,24(r1) ffc09d90: 83 e1 00 1c lwz r31,28(r1) ffc09d94: 38 21 00 20 addi r1,r1,32 ffc09d98: 4e 80 00 20 blr ffc09d9c: 80 01 00 24 lwz r0,36(r1) * If the maximum number of driver is the same as the number in the * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { _IO_Driver_address_table = driver_table; ffc09da0: 3d 20 00 00 lis r9,0 ffc09da4: 93 e9 28 5c stw r31,10332(r9) _IO_Number_of_drivers = number_of_drivers; ffc09da8: 3d 20 00 00 lis r9,0 sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) _IO_Driver_address_table[index] = driver_table[index]; } ffc09dac: 7c 08 03 a6 mtlr r0 * table, then we do not have to copy the driver table. They can't * register any dynamically. */ if ( number_of_drivers == drivers_in_table ) { _IO_Driver_address_table = driver_table; _IO_Number_of_drivers = number_of_drivers; ffc09db0: 93 c9 28 58 stw r30,10328(r9) sizeof( rtems_driver_address_table ) * ( number_of_drivers ) ); for ( index = 0 ; index < drivers_in_table ; index++ ) _IO_Driver_address_table[index] = driver_table[index]; } ffc09db4: 83 61 00 0c lwz r27,12(r1) ffc09db8: 83 81 00 10 lwz r28,16(r1) ffc09dbc: 83 a1 00 14 lwz r29,20(r1) ffc09dc0: 83 c1 00 18 lwz r30,24(r1) ffc09dc4: 83 e1 00 1c lwz r31,28(r1) ffc09dc8: 38 21 00 20 addi r1,r1,32 ffc09dcc: 4e 80 00 20 blr =============================================================================== ffc0ad00 <_Internal_error_Occurred>: void _Internal_error_Occurred( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0ad00: 94 21 ff f0 stwu r1,-16(r1) ffc0ad04: 7c 08 02 a6 mflr r0 _Internal_errors_What_happened.the_source = the_source; ffc0ad08: 3d 60 00 00 lis r11,0 ffc0ad0c: 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 ) { ffc0ad10: 90 01 00 14 stw r0,20(r1) ffc0ad14: 93 e1 00 0c stw r31,12(r1) ffc0ad18: 7c bf 2b 78 mr r31,r5 _Internal_errors_What_happened.the_source = the_source; _Internal_errors_What_happened.is_internal = is_internal; ffc0ad1c: 98 89 00 04 stb r4,4(r9) _Internal_errors_What_happened.the_error = the_error; ffc0ad20: 90 a9 00 08 stw r5,8(r9) bool is_internal, Internal_errors_t the_error ) { _Internal_errors_What_happened.the_source = the_source; ffc0ad24: 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 ); ffc0ad28: 48 00 27 2d bl ffc0d454 <_User_extensions_Fatal> RTEMS_INLINE_ROUTINE void _System_state_Set ( System_state_Codes state ) { _System_state_Current = state; ffc0ad2c: 38 00 00 05 li r0,5 ffc0ad30: 3d 20 00 00 lis r9,0 _System_state_Set( SYSTEM_STATE_FAILED ); _CPU_Fatal_halt( the_error ); ffc0ad34: 7f e3 fb 78 mr r3,r31 ffc0ad38: 90 09 28 48 stw r0,10312(r9) ffc0ad3c: 4b ff 91 71 bl ffc03eac <_BSP_Fatal_error> ffc0ad40: 48 00 00 00 b ffc0ad40 <_Internal_error_Occurred+0x40><== NOT EXECUTED =============================================================================== ffc0ad58 <_Objects_Allocate>: */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0ad58: 94 21 ff f0 stwu r1,-16(r1) ffc0ad5c: 7c 08 02 a6 mflr r0 ffc0ad60: 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 ) ffc0ad64: 80 03 00 18 lwz r0,24(r3) */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0ad68: 93 e1 00 0c stw r31,12(r1) ffc0ad6c: 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 ) ffc0ad70: 2f 80 00 00 cmpwi cr7,r0,0 */ Objects_Control *_Objects_Allocate( Objects_Information *information ) { ffc0ad74: 93 c1 00 08 stw r30,8(r1) * still attempts to create the object, the information block * should be all zeroed out because it is in the BSS. So let's * check that code for this manager is even present. */ if ( information->size == 0 ) return NULL; ffc0ad78: 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 ) ffc0ad7c: 41 9e 00 58 beq- cr7,ffc0add4 <_Objects_Allocate+0x7c> <== 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 ); ffc0ad80: 3b df 00 20 addi r30,r31,32 ffc0ad84: 7f c3 f3 78 mr r3,r30 ffc0ad88: 4b ff f4 21 bl ffc0a1a8 <_Chain_Get> if ( information->auto_extend ) { ffc0ad8c: 88 1f 00 12 lbz r0,18(r31) ffc0ad90: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ad94: 41 9e 00 40 beq- cr7,ffc0add4 <_Objects_Allocate+0x7c> /* * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { ffc0ad98: 2f 83 00 00 cmpwi cr7,r3,0 ffc0ad9c: 41 9e 00 50 beq- cr7,ffc0adec <_Objects_Allocate+0x94> } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - ffc0ada0: a1 63 00 0a lhz r11,10(r3) ffc0ada4: a0 1f 00 0a lhz r0,10(r31) _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; ffc0ada8: a1 3f 00 14 lhz r9,20(r31) } if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - ffc0adac: 7c 00 58 50 subf r0,r0,r11 _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; information->inactive--; ffc0adb0: a1 7f 00 2c lhz r11,44(r31) if ( the_object ) { uint32_t block; block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; ffc0adb4: 7c 00 4b 96 divwu r0,r0,r9 information->inactive_per_block[ block ]--; ffc0adb8: 81 3f 00 30 lwz r9,48(r31) ffc0adbc: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0adc0: 7d 49 00 2e lwzx r10,r9,r0 information->inactive--; ffc0adc4: 39 6b ff ff addi r11,r11,-1 block = (uint32_t) _Objects_Get_index( the_object->id ) - _Objects_Get_index( information->minimum_id ); block /= information->allocation_size; information->inactive_per_block[ block ]--; ffc0adc8: 39 4a ff ff addi r10,r10,-1 ffc0adcc: 7d 49 01 2e stwx r10,r9,r0 information->inactive--; ffc0add0: b1 7f 00 2c sth r11,44(r31) ); } #endif return the_object; } ffc0add4: 80 01 00 14 lwz r0,20(r1) ffc0add8: 83 c1 00 08 lwz r30,8(r1) ffc0addc: 7c 08 03 a6 mtlr r0 ffc0ade0: 83 e1 00 0c lwz r31,12(r1) ffc0ade4: 38 21 00 10 addi r1,r1,16 ffc0ade8: 4e 80 00 20 blr * If the list is empty then we are out of objects and need to * extend information base. */ if ( !the_object ) { _Objects_Extend_information( information ); ffc0adec: 7f e3 fb 78 mr r3,r31 ffc0adf0: 48 00 00 4d bl ffc0ae3c <_Objects_Extend_information> the_object = (Objects_Control *) _Chain_Get( &information->Inactive ); ffc0adf4: 7f c3 f3 78 mr r3,r30 ffc0adf8: 4b ff f3 b1 bl ffc0a1a8 <_Chain_Get> } if ( the_object ) { ffc0adfc: 2c 03 00 00 cmpwi r3,0 ffc0ae00: 41 82 ff d4 beq+ ffc0add4 <_Objects_Allocate+0x7c> ffc0ae04: 4b ff ff 9c b ffc0ada0 <_Objects_Allocate+0x48> =============================================================================== ffc0ae3c <_Objects_Extend_information>: */ void _Objects_Extend_information( Objects_Information *information ) { ffc0ae3c: 94 21 ff c0 stwu r1,-64(r1) ffc0ae40: 7c 08 02 a6 mflr r0 ffc0ae44: 90 01 00 44 stw r0,68(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 ) ffc0ae48: 81 23 00 34 lwz r9,52(r3) */ void _Objects_Extend_information( Objects_Information *information ) { ffc0ae4c: 93 61 00 2c stw r27,44(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 ) ffc0ae50: 2f 89 00 00 cmpwi cr7,r9,0 */ void _Objects_Extend_information( Objects_Information *information ) { ffc0ae54: 93 81 00 30 stw r28,48(r1) ffc0ae58: 93 e1 00 3c stw r31,60(r1) ffc0ae5c: 7c 7f 1b 78 mr r31,r3 ffc0ae60: 92 c1 00 18 stw r22,24(r1) ffc0ae64: 92 e1 00 1c stw r23,28(r1) ffc0ae68: 93 01 00 20 stw r24,32(r1) ffc0ae6c: 93 21 00 24 stw r25,36(r1) ffc0ae70: 93 41 00 28 stw r26,40(r1) ffc0ae74: 93 a1 00 34 stw r29,52(r1) ffc0ae78: 93 c1 00 38 stw r30,56(r1) /* * 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 ); ffc0ae7c: a3 83 00 0a lhz r28,10(r3) index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc0ae80: a3 63 00 10 lhz r27,16(r3) ffc0ae84: 41 9e 02 80 beq- cr7,ffc0b104 <_Objects_Extend_information+0x2c8> block_count = 0; else { block_count = information->maximum / information->allocation_size; ffc0ae88: a1 63 00 14 lhz r11,20(r3) ffc0ae8c: 7e db 5b 96 divwu r22,r27,r11 for ( ; block < block_count; block++ ) { ffc0ae90: 2f 96 00 00 cmpwi cr7,r22,0 ffc0ae94: 41 9e 02 88 beq- cr7,ffc0b11c <_Objects_Extend_information+0x2e0><== NEVER TAKEN if ( information->object_blocks[ block ] == NULL ) { ffc0ae98: 80 09 00 00 lwz r0,0(r9) ffc0ae9c: 7d 6a 5b 78 mr r10,r11 /* * 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 ); ffc0aea0: 7f 9e e3 78 mr r30,r28 index_base = minimum_index; block = 0; ffc0aea4: 7e c9 03 a6 mtctr r22 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { ffc0aea8: 2f 80 00 00 cmpwi cr7,r0,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; ffc0aeac: 3b a0 00 00 li r29,0 block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { ffc0aeb0: 40 be 00 14 bne+ cr7,ffc0aec4 <_Objects_Extend_information+0x88><== ALWAYS TAKEN ffc0aeb4: 48 00 02 7c b ffc0b130 <_Objects_Extend_information+0x2f4><== NOT EXECUTED ffc0aeb8: 84 09 00 04 lwzu r0,4(r9) ffc0aebc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0aec0: 41 9e 01 f4 beq- cr7,ffc0b0b4 <_Objects_Extend_information+0x278> do_extend = false; break; } else index_base += information->allocation_size; ffc0aec4: 7f de 5a 14 add r30,r30,r11 if ( information->object_blocks == NULL ) block_count = 0; else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { ffc0aec8: 3b bd 00 01 addi r29,r29,1 ffc0aecc: 42 00 ff ec bdnz+ ffc0aeb8 <_Objects_Extend_information+0x7c> /* * 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; ffc0aed0: 3b 20 00 01 li r25,1 } else index_base += information->allocation_size; } } maximum = (uint32_t) information->maximum + information->allocation_size; ffc0aed4: 7f 7b 52 14 add r27,r27,r10 /* * 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 ) { ffc0aed8: 2b 9b ff ff cmplwi cr7,r27,65535 ffc0aedc: 41 9d 01 a0 bgt- cr7,ffc0b07c <_Objects_Extend_information+0x240> /* * 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; if ( information->auto_extend ) { ffc0aee0: 88 1f 00 12 lbz r0,18(r31) /* * 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; ffc0aee4: 80 7f 00 18 lwz r3,24(r31) if ( information->auto_extend ) { ffc0aee8: 2f 80 00 00 cmpwi cr7,r0,0 /* * 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; ffc0aeec: 7c 6a 19 d6 mullw r3,r10,r3 if ( information->auto_extend ) { ffc0aef0: 41 9e 01 cc beq- cr7,ffc0b0bc <_Objects_Extend_information+0x280> new_object_block = _Workspace_Allocate( block_size ); ffc0aef4: 48 00 2c 29 bl ffc0db1c <_Workspace_Allocate> if ( !new_object_block ) ffc0aef8: 7c 7a 1b 79 mr. r26,r3 ffc0aefc: 41 82 01 80 beq- ffc0b07c <_Objects_Extend_information+0x240> } /* * Do we need to grow the tables? */ if ( do_extend ) { ffc0af00: 2f 99 00 00 cmpwi cr7,r25,0 ffc0af04: 41 9e 00 f4 beq- cr7,ffc0aff8 <_Objects_Extend_information+0x1bc> */ /* * Up the block count and maximum */ block_count++; ffc0af08: 3a f6 00 01 addi r23,r22,1 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ffc0af0c: 1c 77 00 03 mulli r3,r23,3 ((maximum + minimum_index) * sizeof(Objects_Control *)); ffc0af10: 7c 7b 1a 14 add r3,r27,r3 /* * Allocate the tables and break it up. */ block_size = block_count * (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ffc0af14: 7c 63 e2 14 add r3,r3,r28 ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); ffc0af18: 54 63 10 3a rlwinm r3,r3,2,0,29 ffc0af1c: 48 00 2c 01 bl ffc0db1c <_Workspace_Allocate> if ( !object_blocks ) { ffc0af20: 7c 78 1b 79 mr. r24,r3 ffc0af24: 41 82 02 18 beq- ffc0b13c <_Objects_Extend_information+0x300> * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { ffc0af28: a0 1f 00 10 lhz r0,16(r31) } /* * Break the block into the various sections. */ inactive_per_block = (uint32_t *) _Addresses_Add_offset( ffc0af2c: 56 f7 10 3a rlwinm r23,r23,2,0,29 RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); ffc0af30: 7f 38 ba 14 add r25,r24,r23 * Take the block count down. Saves all the (block_count - 1) * in the copies. */ block_count--; if ( information->maximum > minimum_index ) { ffc0af34: 7f 9c 00 40 cmplw cr7,r28,r0 ffc0af38: 7e f9 ba 14 add r23,r25,r23 ffc0af3c: 41 9c 01 8c blt- cr7,ffc0b0c8 <_Objects_Extend_information+0x28c> } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { ffc0af40: 2f 9c 00 00 cmpwi cr7,r28,0 local_table[ index ] = NULL; ffc0af44: 7f 89 03 a6 mtctr r28 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, ffc0af48: 39 37 ff fc addi r9,r23,-4 /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { local_table[ index ] = NULL; ffc0af4c: 38 00 00 00 li r0,0 } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { ffc0af50: 41 9e 00 0c beq- cr7,ffc0af5c <_Objects_Extend_information+0x120><== NEVER TAKEN local_table[ index ] = NULL; ffc0af54: 94 09 00 04 stwu r0,4(r9) } else { /* * Deal with the special case of the 0 to minimum_index */ for ( index = 0; index < minimum_index; index++ ) { ffc0af58: 42 00 ff fc bdnz+ ffc0af54 <_Objects_Extend_information+0x118> ffc0af5c: 56 d6 10 3a rlwinm r22,r22,2,0,29 */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); ffc0af60: a1 7f 00 14 lhz r11,20(r31) } /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; ffc0af64: 38 00 00 00 li r0,0 ffc0af68: 7c 18 b1 2e stwx r0,r24,r22 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); ffc0af6c: 7d 7e 5a 14 add r11,r30,r11 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; ffc0af70: 7f 9e 58 40 cmplw cr7,r30,r11 /* * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; ffc0af74: 7c 19 b1 2e stwx r0,r25,r22 for ( index=index_base ; ffc0af78: 40 9c 00 30 bge- cr7,ffc0afa8 <_Objects_Extend_information+0x16c><== NEVER TAKEN ffc0af7c: 38 1e 00 01 addi r0,r30,1 ffc0af80: 7f 80 58 40 cmplw cr7,r0,r11 * information - object information table * * Output parameters: NONE */ void _Objects_Extend_information( ffc0af84: 57 c9 10 3a rlwinm r9,r30,2,0,29 ffc0af88: 39 29 ff fc addi r9,r9,-4 inactive_per_block[block_count] = 0; for ( index=index_base ; index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; ffc0af8c: 7d 7e 58 50 subf r11,r30,r11 * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; ffc0af90: 7d 29 ba 14 add r9,r9,r23 index < ( information->allocation_size + index_base ); index++ ) { local_table[ index ] = NULL; ffc0af94: 7d 69 03 a6 mtctr r11 ffc0af98: 38 00 00 00 li r0,0 ffc0af9c: 41 9d 01 ac bgt- cr7,ffc0b148 <_Objects_Extend_information+0x30c><== NEVER TAKEN ffc0afa0: 94 09 00 04 stwu r0,4(r9) * Initialise the new entries in the table. */ object_blocks[block_count] = NULL; inactive_per_block[block_count] = 0; for ( index=index_base ; ffc0afa4: 42 00 ff fc bdnz+ ffc0afa0 <_Objects_Extend_information+0x164> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0afa8: 7c 00 00 a6 mfmsr r0 ffc0afac: 7d 30 42 a6 mfsprg r9,0 ffc0afb0: 7c 09 48 78 andc r9,r0,r9 ffc0afb4: 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) | ffc0afb8: 81 7f 00 00 lwz r11,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; ffc0afbc: 57 7b 04 3e clrlwi r27,r27,16 information->maximum_id = _Objects_Build_id( ffc0afc0: a1 3f 00 04 lhz r9,4(r31) ffc0afc4: 55 6b c0 0e rlwinm r11,r11,24,0,7 local_table[ index ] = NULL; } _ISR_Disable( level ); old_tables = information->object_blocks; ffc0afc8: 80 7f 00 34 lwz r3,52(r31) ffc0afcc: 65 6b 00 01 oris r11,r11,1 information->object_blocks = object_blocks; information->inactive_per_block = inactive_per_block; ffc0afd0: 93 3f 00 30 stw r25,48(r31) (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc0afd4: 55 29 d8 08 rlwinm r9,r9,27,0,4 ffc0afd8: 7d 69 4b 78 or r9,r11,r9 _ISR_Disable( level ); old_tables = information->object_blocks; information->object_blocks = object_blocks; ffc0afdc: 93 1f 00 34 stw r24,52(r31) uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | ffc0afe0: 7d 29 db 78 or r9,r9,r27 information->inactive_per_block = inactive_per_block; information->local_table = local_table; ffc0afe4: 92 ff 00 1c stw r23,28(r31) information->maximum = (Objects_Maximum) maximum; ffc0afe8: b3 7f 00 10 sth r27,16(r31) information->maximum_id = _Objects_Build_id( ffc0afec: 91 3f 00 0c stw r9,12(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0aff0: 7c 00 01 24 mtmsr r0 information->maximum ); _ISR_Enable( level ); _Workspace_Free( old_tables ); ffc0aff4: 48 00 2b 5d bl ffc0db50 <_Workspace_Free> } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; ffc0aff8: 81 3f 00 34 lwz r9,52(r31) ffc0affc: 57 bd 10 3a rlwinm r29,r29,2,0,29 /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc0b000: a0 bf 00 14 lhz r5,20(r31) ffc0b004: 38 61 00 08 addi r3,r1,8 } /* * Assign the new object block to the object block table. */ information->object_blocks[ block ] = new_object_block; ffc0b008: 7f 49 e9 2e stwx r26,r9,r29 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0b00c: 3b 9f 00 20 addi r28,r31,32 information->object_blocks[ block ] = new_object_block; /* * Initialize objects .. add to a local chain first. */ _Chain_Initialize( ffc0b010: 81 3f 00 34 lwz r9,52(r31) ffc0b014: 80 df 00 18 lwz r6,24(r31) ffc0b018: 7c 89 e8 2e lwzx r4,r9,r29 ffc0b01c: 48 00 5c 31 bl ffc10c4c <_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 ) { ffc0b020: 48 00 00 2c b ffc0b04c <_Objects_Extend_information+0x210> ffc0b024: 81 7f 00 00 lwz r11,0(r31) the_object->id = _Objects_Build_id( ffc0b028: a0 1f 00 04 lhz r0,4(r31) ffc0b02c: 55 6b c0 0e rlwinm r11,r11,24,0,7 ffc0b030: 65 6b 00 01 oris r11,r11,1 (( (Objects_Id) the_class ) << OBJECTS_CLASS_START_BIT) | ffc0b034: 54 00 d8 08 rlwinm r0,r0,27,0,4 ffc0b038: 7d 60 03 78 or r0,r11,r0 uint32_t the_class, uint32_t node, uint32_t index ) { return (( (Objects_Id) the_api ) << OBJECTS_API_START_BIT) | ffc0b03c: 7c 00 f3 78 or r0,r0,r30 ffc0b040: 90 09 00 08 stw r0,8(r9) index ); _Chain_Append( &information->Inactive, &the_object->Node ); index++; ffc0b044: 3b de 00 01 addi r30,r30,1 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0b048: 4b ff f1 09 bl ffc0a150 <_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 ) { ffc0b04c: 38 61 00 08 addi r3,r1,8 ffc0b050: 4b ff f1 59 bl ffc0a1a8 <_Chain_Get> ffc0b054: 7c 69 1b 79 mr. r9,r3 information->the_class, _Objects_Local_node, index ); _Chain_Append( &information->Inactive, &the_object->Node ); ffc0b058: 7f 83 e3 78 mr r3,r28 ffc0b05c: 7d 24 4b 78 mr r4,r9 /* * Move from the local chain, initialise, then append to the inactive chain */ index = index_base; while ((the_object = (Objects_Control *) _Chain_Get( &Inactive )) != NULL ) { ffc0b060: 40 82 ff c4 bne+ ffc0b024 <_Objects_Extend_information+0x1e8> index++; } information->inactive_per_block[ block ] = information->allocation_size; information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); ffc0b064: a1 3f 00 2c lhz r9,44(r31) _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; ffc0b068: a0 1f 00 14 lhz r0,20(r31) ffc0b06c: 81 7f 00 30 lwz r11,48(r31) information->inactive = (Objects_Maximum)(information->inactive + information->allocation_size); ffc0b070: 7d 20 4a 14 add r9,r0,r9 _Chain_Append( &information->Inactive, &the_object->Node ); index++; } information->inactive_per_block[ block ] = information->allocation_size; ffc0b074: 7c 0b e9 2e stwx r0,r11,r29 information->inactive = ffc0b078: b1 3f 00 2c sth r9,44(r31) (Objects_Maximum)(information->inactive + information->allocation_size); } ffc0b07c: 80 01 00 44 lwz r0,68(r1) ffc0b080: 82 c1 00 18 lwz r22,24(r1) ffc0b084: 7c 08 03 a6 mtlr r0 ffc0b088: 82 e1 00 1c lwz r23,28(r1) ffc0b08c: 83 01 00 20 lwz r24,32(r1) ffc0b090: 83 21 00 24 lwz r25,36(r1) ffc0b094: 83 41 00 28 lwz r26,40(r1) ffc0b098: 83 61 00 2c lwz r27,44(r1) ffc0b09c: 83 81 00 30 lwz r28,48(r1) ffc0b0a0: 83 a1 00 34 lwz r29,52(r1) ffc0b0a4: 83 c1 00 38 lwz r30,56(r1) ffc0b0a8: 83 e1 00 3c lwz r31,60(r1) ffc0b0ac: 38 21 00 40 addi r1,r1,64 ffc0b0b0: 4e 80 00 20 blr else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { do_extend = false; ffc0b0b4: 3b 20 00 00 li r25,0 ffc0b0b8: 4b ff fe 1c b ffc0aed4 <_Objects_Extend_information+0x98> if ( information->auto_extend ) { new_object_block = _Workspace_Allocate( block_size ); if ( !new_object_block ) return; } else { new_object_block = _Workspace_Allocate_or_fatal_error( block_size ); ffc0b0bc: 48 00 2a c1 bl ffc0db7c <_Workspace_Allocate_or_fatal_error> ffc0b0c0: 7c 7a 1b 78 mr r26,r3 ffc0b0c4: 4b ff fe 3c b ffc0af00 <_Objects_Extend_information+0xc4> * separate parts as size of each block has changed. */ memcpy( object_blocks, information->object_blocks, block_count * sizeof(void*) ); ffc0b0c8: 56 d6 10 3a rlwinm r22,r22,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, ffc0b0cc: 80 9f 00 34 lwz r4,52(r31) ffc0b0d0: 7e c5 b3 78 mr r5,r22 ffc0b0d4: 48 00 98 5d bl ffc14930 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, ffc0b0d8: 80 9f 00 30 lwz r4,48(r31) ffc0b0dc: 7e c5 b3 78 mr r5,r22 ffc0b0e0: 7f 23 cb 78 mr r3,r25 ffc0b0e4: 48 00 98 4d bl ffc14930 information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc0b0e8: a0 bf 00 10 lhz r5,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, ffc0b0ec: 80 9f 00 1c lwz r4,28(r31) ffc0b0f0: 7e e3 bb 78 mr r3,r23 information->local_table, (information->maximum + minimum_index) * sizeof(Objects_Control *) ); ffc0b0f4: 7c bc 2a 14 add r5,r28,r5 information->object_blocks, block_count * sizeof(void*) ); memcpy( inactive_per_block, information->inactive_per_block, block_count * sizeof(uint32_t) ); memcpy( local_table, ffc0b0f8: 54 a5 10 3a rlwinm r5,r5,2,0,29 ffc0b0fc: 48 00 98 35 bl ffc14930 ffc0b100: 4b ff fe 60 b ffc0af60 <_Objects_Extend_information+0x124> minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) ffc0b104: a1 43 00 14 lhz r10,20(r3) /* * 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 ); ffc0b108: 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; ffc0b10c: 3b 20 00 01 li r25,1 minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc0b110: 3b a0 00 00 li r29,0 /* if ( information->maximum < minimum_index ) */ if ( information->object_blocks == NULL ) block_count = 0; ffc0b114: 3a c0 00 00 li r22,0 ffc0b118: 4b ff fd bc b ffc0aed4 <_Objects_Extend_information+0x98> else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { ffc0b11c: 7d 6a 5b 78 mr r10,r11 <== NOT EXECUTED /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); ffc0b120: 7f 9e e3 78 mr r30,r28 <== NOT EXECUTED /* * Search for a free block of indexes. If we do NOT need to allocate or * extend the block table, then we will change do_extend. */ do_extend = true; ffc0b124: 3b 20 00 01 li r25,1 <== NOT EXECUTED minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc0b128: 3b a0 00 00 li r29,0 <== NOT EXECUTED ffc0b12c: 4b ff fd a8 b ffc0aed4 <_Objects_Extend_information+0x98><== NOT EXECUTED else { block_count = information->maximum / information->allocation_size; for ( ; block < block_count; block++ ) { if ( information->object_blocks[ block ] == NULL ) { do_extend = false; ffc0b130: 3b 20 00 00 li r25,0 <== NOT EXECUTED * extend the block table, then we will change do_extend. */ do_extend = true; minimum_index = _Objects_Get_index( information->minimum_id ); index_base = minimum_index; block = 0; ffc0b134: 3b a0 00 00 li r29,0 <== NOT EXECUTED ffc0b138: 4b ff fd 9c b ffc0aed4 <_Objects_Extend_information+0x98><== NOT EXECUTED (sizeof(void *) + sizeof(uint32_t) + sizeof(Objects_Name *)) + ((maximum + minimum_index) * sizeof(Objects_Control *)); object_blocks = (void**) _Workspace_Allocate( block_size ); if ( !object_blocks ) { _Workspace_Free( new_object_block ); ffc0b13c: 7f 43 d3 78 mr r3,r26 ffc0b140: 48 00 2a 11 bl ffc0db50 <_Workspace_Free> return; ffc0b144: 4b ff ff 38 b ffc0b07c <_Objects_Extend_information+0x240> ffc0b148: 39 60 00 01 li r11,1 <== NOT EXECUTED ffc0b14c: 7d 69 03 a6 mtctr r11 <== NOT EXECUTED ffc0b150: 4b ff fe 50 b ffc0afa0 <_Objects_Extend_information+0x164><== NOT EXECUTED =============================================================================== ffc0b240 <_Objects_Get_information>: Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0b240: 94 21 ff e8 stwu r1,-24(r1) ffc0b244: 7c 08 02 a6 mflr r0 ffc0b248: 93 c1 00 10 stw r30,16(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc0b24c: 7c 9e 23 79 mr. r30,r4 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0b250: 93 a1 00 0c stw r29,12(r1) ffc0b254: 7c 7d 1b 78 mr r29,r3 ffc0b258: 93 e1 00 14 stw r31,20(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) return NULL; ffc0b25c: 3b e0 00 00 li r31,0 Objects_Information *_Objects_Get_information( Objects_APIs the_api, uint16_t the_class ) { ffc0b260: 90 01 00 1c stw r0,28(r1) Objects_Information *info; int the_class_api_maximum; if ( !the_class ) ffc0b264: 41 82 00 4c beq- ffc0b2b0 <_Objects_Get_information+0x70> /* * 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 ); ffc0b268: 48 00 60 25 bl ffc1128c <_Objects_API_maximum_class> if ( the_class_api_maximum == 0 ) ffc0b26c: 2c 03 00 00 cmpwi r3,0 ffc0b270: 41 82 00 40 beq- ffc0b2b0 <_Objects_Get_information+0x70> return NULL; if ( the_class > (uint32_t) the_class_api_maximum ) ffc0b274: 7f 83 f0 40 cmplw cr7,r3,r30 ffc0b278: 41 9c 00 38 blt- cr7,ffc0b2b0 <_Objects_Get_information+0x70> return NULL; if ( !_Objects_Information_table[ the_api ] ) ffc0b27c: 3d 20 00 00 lis r9,0 ffc0b280: 57 bd 10 3a rlwinm r29,r29,2,0,29 ffc0b284: 39 29 2c 60 addi r9,r9,11360 ffc0b288: 7d 29 e8 2e lwzx r9,r9,r29 ffc0b28c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0b290: 41 9e 00 20 beq- cr7,ffc0b2b0 <_Objects_Get_information+0x70><== NEVER TAKEN return NULL; info = _Objects_Information_table[ the_api ][ the_class ]; ffc0b294: 57 de 10 3a rlwinm r30,r30,2,0,29 ffc0b298: 7f e9 f0 2e lwzx r31,r9,r30 if ( !info ) ffc0b29c: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0b2a0: 41 9e 00 10 beq- cr7,ffc0b2b0 <_Objects_Get_information+0x70><== 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 ) ffc0b2a4: a0 1f 00 10 lhz r0,16(r31) ffc0b2a8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b2ac: 41 9e 00 24 beq- cr7,ffc0b2d0 <_Objects_Get_information+0x90> return NULL; #endif return info; } ffc0b2b0: 80 01 00 1c lwz r0,28(r1) ffc0b2b4: 7f e3 fb 78 mr r3,r31 ffc0b2b8: 83 a1 00 0c lwz r29,12(r1) ffc0b2bc: 7c 08 03 a6 mtlr r0 ffc0b2c0: 83 c1 00 10 lwz r30,16(r1) ffc0b2c4: 83 e1 00 14 lwz r31,20(r1) ffc0b2c8: 38 21 00 18 addi r1,r1,24 ffc0b2cc: 4e 80 00 20 blr * Thus we may have 0 local instances and still have a valid object * pointer. */ #if !defined(RTEMS_MULTIPROCESSING) if ( info->maximum == 0 ) return NULL; ffc0b2d0: 3b e0 00 00 li r31,0 ffc0b2d4: 4b ff ff dc b ffc0b2b0 <_Objects_Get_information+0x70> =============================================================================== ffc0cefc <_Objects_Get_name_as_string>: char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { ffc0cefc: 94 21 ff d8 stwu r1,-40(r1) ffc0cf00: 7c 08 02 a6 mflr r0 ffc0cf04: 93 c1 00 20 stw r30,32(r1) char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) ffc0cf08: 7c 9e 23 79 mr. r30,r4 char *_Objects_Get_name_as_string( Objects_Id id, size_t length, char *name ) { ffc0cf0c: 93 e1 00 24 stw r31,36(r1) ffc0cf10: 7c bf 2b 78 mr r31,r5 ffc0cf14: 90 01 00 2c stw r0,44(r1) ffc0cf18: 93 81 00 18 stw r28,24(r1) ffc0cf1c: 93 a1 00 1c stw r29,28(r1) char lname[5]; Objects_Control *the_object; Objects_Locations location; Objects_Id tmpId; if ( length == 0 ) ffc0cf20: 41 82 01 0c beq- ffc0d02c <_Objects_Get_name_as_string+0x130> return NULL; if ( name == NULL ) ffc0cf24: 2f 85 00 00 cmpwi cr7,r5,0 ffc0cf28: 41 9e 00 d0 beq- cr7,ffc0cff8 <_Objects_Get_name_as_string+0xfc> return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; ffc0cf2c: 2f 83 00 00 cmpwi cr7,r3,0 ffc0cf30: 7c 7c 1b 78 mr r28,r3 ffc0cf34: 41 9e 00 e8 beq- cr7,ffc0d01c <_Objects_Get_name_as_string+0x120> information = _Objects_Get_information_id( tmpId ); ffc0cf38: 7f 83 e3 78 mr r3,r28 ffc0cf3c: 4b ff fe 8d bl ffc0cdc8 <_Objects_Get_information_id> if ( !information ) ffc0cf40: 7c 7d 1b 79 mr. r29,r3 ffc0cf44: 41 82 00 e8 beq- ffc0d02c <_Objects_Get_name_as_string+0x130> return NULL; the_object = _Objects_Get( information, tmpId, &location ); ffc0cf48: 7f 84 e3 78 mr r4,r28 ffc0cf4c: 38 a1 00 08 addi r5,r1,8 ffc0cf50: 48 00 01 25 bl ffc0d074 <_Objects_Get> switch ( location ) { ffc0cf54: 80 01 00 08 lwz r0,8(r1) ffc0cf58: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cf5c: 40 9e 00 d0 bne- cr7,ffc0d02c <_Objects_Get_name_as_string+0x130> return NULL; case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { ffc0cf60: 88 1d 00 38 lbz r0,56(r29) ffc0cf64: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cf68: 40 9e 00 ec bne- cr7,ffc0d054 <_Objects_Get_name_as_string+0x158> s = the_object->name.name_p; } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; ffc0cf6c: 81 23 00 0c lwz r9,12(r3) lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; ffc0cf70: 98 01 00 10 stb r0,16(r1) #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; ffc0cf74: 55 2b 84 3e rlwinm r11,r9,16,16,31 lname[ 2 ] = (u32_name >> 8) & 0xff; ffc0cf78: 55 20 c2 3e rlwinm r0,r9,24,8,31 #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; lname[ 1 ] = (u32_name >> 16) & 0xff; ffc0cf7c: 99 61 00 0d stb r11,13(r1) } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; ffc0cf80: 55 2a 46 3e rlwinm r10,r9,8,24,31 lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; ffc0cf84: 98 01 00 0e stb r0,14(r1) lname[ 3 ] = (u32_name >> 0) & 0xff; ffc0cf88: 99 21 00 0f stb r9,15(r1) } else #endif { uint32_t u32_name = (uint32_t) the_object->name.name_u32; lname[ 0 ] = (u32_name >> 24) & 0xff; ffc0cf8c: 99 41 00 0c stb r10,12(r1) lname[ 1 ] = (u32_name >> 16) & 0xff; lname[ 2 ] = (u32_name >> 8) & 0xff; lname[ 3 ] = (u32_name >> 0) & 0xff; lname[ 4 ] = '\0'; s = lname; ffc0cf90: 39 41 00 0c addi r10,r1,12 } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0cf94: 34 1e ff ff addic. r0,r30,-1 ffc0cf98: 7f e9 fb 78 mr r9,r31 ffc0cf9c: 7c 09 03 a6 mtctr r0 ffc0cfa0: 41 82 00 4c beq- ffc0cfec <_Objects_Get_name_as_string+0xf0><== NEVER TAKEN ffc0cfa4: 88 0a 00 00 lbz r0,0(r10) ffc0cfa8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cfac: 41 9e 00 40 beq- cr7,ffc0cfec <_Objects_Get_name_as_string+0xf0> ffc0cfb0: 3d 00 00 00 lis r8,0 ffc0cfb4: 39 08 27 ec addi r8,r8,10220 ffc0cfb8: 48 00 00 10 b ffc0cfc8 <_Objects_Get_name_as_string+0xcc> ffc0cfbc: 8c 0a 00 01 lbzu r0,1(r10) ffc0cfc0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0cfc4: 41 9e 00 28 beq- cr7,ffc0cfec <_Objects_Get_name_as_string+0xf0> *d = (isprint((unsigned char)*s)) ? *s : '*'; ffc0cfc8: 81 68 00 00 lwz r11,0(r8) ffc0cfcc: 7d 6b 02 14 add r11,r11,r0 ffc0cfd0: 89 6b 00 01 lbz r11,1(r11) ffc0cfd4: 71 67 00 97 andi. r7,r11,151 ffc0cfd8: 40 82 00 08 bne- ffc0cfe0 <_Objects_Get_name_as_string+0xe4> ffc0cfdc: 38 00 00 2a li r0,42 ffc0cfe0: 98 09 00 00 stb r0,0(r9) s = lname; } d = name; if ( s ) { for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { ffc0cfe4: 39 29 00 01 addi r9,r9,1 ffc0cfe8: 42 00 ff d4 bdnz+ ffc0cfbc <_Objects_Get_name_as_string+0xc0> *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; ffc0cfec: 38 00 00 00 li r0,0 ffc0cff0: 98 09 00 00 stb r0,0(r9) _Thread_Enable_dispatch(); ffc0cff4: 48 00 11 4d bl ffc0e140 <_Thread_Enable_dispatch> return name; } return NULL; /* unreachable path */ } ffc0cff8: 80 01 00 2c lwz r0,44(r1) ffc0cffc: 7f e3 fb 78 mr r3,r31 ffc0d000: 83 81 00 18 lwz r28,24(r1) ffc0d004: 7c 08 03 a6 mtlr r0 ffc0d008: 83 a1 00 1c lwz r29,28(r1) ffc0d00c: 83 c1 00 20 lwz r30,32(r1) ffc0d010: 83 e1 00 24 lwz r31,36(r1) ffc0d014: 38 21 00 28 addi r1,r1,40 ffc0d018: 4e 80 00 20 blr return NULL; if ( name == NULL ) return NULL; tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; ffc0d01c: 3d 20 00 00 lis r9,0 ffc0d020: 81 29 35 b0 lwz r9,13744(r9) ffc0d024: 83 89 00 08 lwz r28,8(r9) ffc0d028: 4b ff ff 10 b ffc0cf38 <_Objects_Get_name_as_string+0x3c> _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } ffc0d02c: 80 01 00 2c lwz r0,44(r1) #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* not supported */ #endif case OBJECTS_ERROR: return NULL; ffc0d030: 3b e0 00 00 li r31,0 _Thread_Enable_dispatch(); return name; } return NULL; /* unreachable path */ } ffc0d034: 7f e3 fb 78 mr r3,r31 ffc0d038: 83 81 00 18 lwz r28,24(r1) ffc0d03c: 7c 08 03 a6 mtlr r0 ffc0d040: 83 a1 00 1c lwz r29,28(r1) ffc0d044: 83 c1 00 20 lwz r30,32(r1) ffc0d048: 83 e1 00 24 lwz r31,36(r1) ffc0d04c: 38 21 00 28 addi r1,r1,40 ffc0d050: 4e 80 00 20 blr case OBJECTS_LOCAL: #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) { s = the_object->name.name_p; ffc0d054: 81 43 00 0c lwz r10,12(r3) lname[ 4 ] = '\0'; s = lname; } d = name; if ( s ) { ffc0d058: 7f e9 fb 78 mr r9,r31 ffc0d05c: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d060: 40 9e ff 34 bne+ cr7,ffc0cf94 <_Objects_Get_name_as_string+0x98> for ( i=0 ; i<(length-1) && *s ; i++, s++, d++ ) { *d = (isprint((unsigned char)*s)) ? *s : '*'; } } *d = '\0'; ffc0d064: 38 00 00 00 li r0,0 ffc0d068: 98 09 00 00 stb r0,0(r9) _Thread_Enable_dispatch(); ffc0d06c: 48 00 10 d5 bl ffc0e140 <_Thread_Enable_dispatch> ffc0d070: 4b ff ff 88 b ffc0cff8 <_Objects_Get_name_as_string+0xfc> =============================================================================== ffc0ae88 <_Objects_Get_next>: Objects_Information *information, Objects_Id id, Objects_Locations *location_p, Objects_Id *next_id_p ) { ffc0ae88: 94 21 ff e8 stwu r1,-24(r1) ffc0ae8c: 7c 08 02 a6 mflr r0 ffc0ae90: 93 c1 00 10 stw r30,16(r1) Objects_Control *object; Objects_Id next_id; if ( !information ) ffc0ae94: 7c 7e 1b 79 mr. r30,r3 return NULL; ffc0ae98: 38 60 00 00 li r3,0 Objects_Information *information, Objects_Id id, Objects_Locations *location_p, Objects_Id *next_id_p ) { ffc0ae9c: 93 81 00 08 stw r28,8(r1) ffc0aea0: 7c dc 33 78 mr r28,r6 ffc0aea4: 93 e1 00 14 stw r31,20(r1) ffc0aea8: 7c bf 2b 78 mr r31,r5 ffc0aeac: 90 01 00 1c stw r0,28(r1) ffc0aeb0: 93 a1 00 0c stw r29,12(r1) Objects_Control *object; Objects_Id next_id; if ( !information ) ffc0aeb4: 41 82 00 58 beq- ffc0af0c <_Objects_Get_next+0x84> return NULL; if ( !location_p ) ffc0aeb8: 2f 85 00 00 cmpwi cr7,r5,0 ffc0aebc: 41 9e 00 50 beq- cr7,ffc0af0c <_Objects_Get_next+0x84> return NULL; if ( !next_id_p ) ffc0aec0: 2f 86 00 00 cmpwi cr7,r6,0 ffc0aec4: 41 9e 00 48 beq- cr7,ffc0af0c <_Objects_Get_next+0x84> return NULL; if (_Objects_Get_index(id) == OBJECTS_ID_INITIAL_INDEX) ffc0aec8: 54 80 04 3e clrlwi r0,r4,16 ffc0aecc: 2f 80 00 00 cmpwi cr7,r0,0 next_id = information->minimum_id; else next_id = id; ffc0aed0: 7c 9d 23 78 mr r29,r4 return NULL; if ( !next_id_p ) return NULL; if (_Objects_Get_index(id) == OBJECTS_ID_INITIAL_INDEX) ffc0aed4: 41 9e 00 58 beq- cr7,ffc0af2c <_Objects_Get_next+0xa4> else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) ffc0aed8: a1 3e 00 10 lhz r9,16(r30) ffc0aedc: 57 a0 04 3e clrlwi r0,r29,16 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); ffc0aee0: 7f a4 eb 78 mr r4,r29 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) ffc0aee4: 7f 89 00 40 cmplw cr7,r9,r0 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); ffc0aee8: 7f c3 f3 78 mr r3,r30 ffc0aeec: 7f e5 fb 78 mr r5,r31 next_id++; ffc0aef0: 3b bd 00 01 addi r29,r29,1 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) ffc0aef4: 41 9c 00 5c blt- cr7,ffc0af50 <_Objects_Get_next+0xc8> *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); ffc0aef8: 48 00 00 8d bl ffc0af84 <_Objects_Get> next_id++; } while (*location_p != OBJECTS_LOCAL); ffc0aefc: 80 1f 00 00 lwz r0,0(r31) ffc0af00: 2f 80 00 00 cmpwi cr7,r0,0 ffc0af04: 40 9e ff d4 bne+ cr7,ffc0aed8 <_Objects_Get_next+0x50> *next_id_p = next_id; ffc0af08: 93 bc 00 00 stw r29,0(r28) return object; final: *next_id_p = OBJECTS_ID_FINAL; return 0; } ffc0af0c: 80 01 00 1c lwz r0,28(r1) ffc0af10: 83 81 00 08 lwz r28,8(r1) ffc0af14: 7c 08 03 a6 mtlr r0 ffc0af18: 83 a1 00 0c lwz r29,12(r1) ffc0af1c: 83 c1 00 10 lwz r30,16(r1) ffc0af20: 83 e1 00 14 lwz r31,20(r1) ffc0af24: 38 21 00 18 addi r1,r1,24 ffc0af28: 4e 80 00 20 blr if ( !next_id_p ) return NULL; if (_Objects_Get_index(id) == OBJECTS_ID_INITIAL_INDEX) next_id = information->minimum_id; ffc0af2c: 83 be 00 08 lwz r29,8(r30) *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); ffc0af30: 7f c3 f3 78 mr r3,r30 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) ffc0af34: a1 3e 00 10 lhz r9,16(r30) *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); ffc0af38: 7f e5 fb 78 mr r5,r31 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) ffc0af3c: 57 a0 04 3e clrlwi r0,r29,16 ffc0af40: 7f 89 00 40 cmplw cr7,r9,r0 *location_p = OBJECTS_ERROR; goto final; } /* try to grab one */ object = _Objects_Get(information, next_id, location_p); ffc0af44: 7f a4 eb 78 mr r4,r29 next_id++; ffc0af48: 3b bd 00 01 addi r29,r29,1 else next_id = id; do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) ffc0af4c: 40 9c ff ac bge+ cr7,ffc0aef8 <_Objects_Get_next+0x70> <== ALWAYS TAKEN { *location_p = OBJECTS_ERROR; ffc0af50: 38 00 00 01 li r0,1 return object; final: *next_id_p = OBJECTS_ID_FINAL; return 0; } ffc0af54: 83 a1 00 0c lwz r29,12(r1) do { /* walked off end of list? */ if (_Objects_Get_index(next_id) > information->maximum) { *location_p = OBJECTS_ERROR; ffc0af58: 90 1f 00 00 stw r0,0(r31) *next_id_p = next_id; return object; final: *next_id_p = OBJECTS_ID_FINAL; ffc0af5c: 38 00 ff ff li r0,-1 return 0; ffc0af60: 38 60 00 00 li r3,0 *next_id_p = next_id; return object; final: *next_id_p = OBJECTS_ID_FINAL; ffc0af64: 90 1c 00 00 stw r0,0(r28) return 0; } ffc0af68: 80 01 00 1c lwz r0,28(r1) ffc0af6c: 83 81 00 08 lwz r28,8(r1) ffc0af70: 7c 08 03 a6 mtlr r0 ffc0af74: 83 c1 00 10 lwz r30,16(r1) ffc0af78: 83 e1 00 14 lwz r31,20(r1) ffc0af7c: 38 21 00 18 addi r1,r1,24 ffc0af80: 4e 80 00 20 blr =============================================================================== ffc0be58 <_Objects_Id_to_name>: */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0be58: 94 21 ff e0 stwu r1,-32(r1) ffc0be5c: 7c 08 02 a6 mflr r0 ffc0be60: 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; ffc0be64: 7c 60 1b 79 mr. r0,r3 */ Objects_Name_or_id_lookup_errors _Objects_Id_to_name ( Objects_Id id, Objects_Name *name ) { ffc0be68: 93 c1 00 18 stw r30,24(r1) ffc0be6c: 7c 9e 23 78 mr r30,r4 ffc0be70: 93 e1 00 1c stw r31,28(r1) /* * Caller is trusted for name != NULL. */ tmpId = (id == OBJECTS_ID_OF_SELF) ? _Thread_Executing->Object.id : id; ffc0be74: 40 82 00 10 bne- ffc0be84 <_Objects_Id_to_name+0x2c> ffc0be78: 3d 20 00 00 lis r9,0 ffc0be7c: 81 29 31 b0 lwz r9,12720(r9) ffc0be80: 80 09 00 08 lwz r0,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); ffc0be84: 54 09 47 7e rlwinm r9,r0,8,29,31 */ RTEMS_INLINE_ROUTINE bool _Objects_Is_api_valid( uint32_t the_api ) { if ( !the_api || the_api > OBJECTS_APIS_LAST ) ffc0be88: 39 69 ff ff addi r11,r9,-1 ffc0be8c: 2b 8b 00 02 cmplwi cr7,r11,2 the_api = _Objects_Get_API( tmpId ); if ( !_Objects_Is_api_valid( the_api ) ) return OBJECTS_INVALID_ID; ffc0be90: 3b e0 00 03 li r31,3 ffc0be94: 41 9d 00 38 bgt- cr7,ffc0becc <_Objects_Id_to_name+0x74> if ( !_Objects_Information_table[ the_api ] ) ffc0be98: 3d 60 00 00 lis r11,0 ffc0be9c: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc0bea0: 39 6b 2c c0 addi r11,r11,11456 ffc0bea4: 7d 2b 48 2e lwzx r9,r11,r9 ffc0bea8: 2f 89 00 00 cmpwi cr7,r9,0 ffc0beac: 41 9e 00 20 beq- cr7,ffc0becc <_Objects_Id_to_name+0x74> return OBJECTS_INVALID_ID; the_class = _Objects_Get_class( tmpId ); information = _Objects_Information_table[ the_api ][ the_class ]; ffc0beb0: 54 0b 3e 7a rlwinm r11,r0,7,25,29 ffc0beb4: 7c 69 58 2e lwzx r3,r9,r11 if ( !information ) ffc0beb8: 2f 83 00 00 cmpwi cr7,r3,0 ffc0bebc: 41 9e 00 10 beq- cr7,ffc0becc <_Objects_Id_to_name+0x74><== NEVER TAKEN return OBJECTS_INVALID_ID; #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) ffc0bec0: 89 23 00 38 lbz r9,56(r3) ffc0bec4: 2f 89 00 00 cmpwi cr7,r9,0 ffc0bec8: 41 9e 00 20 beq- cr7,ffc0bee8 <_Objects_Id_to_name+0x90><== ALWAYS TAKEN return OBJECTS_INVALID_ID; *name = the_object->name; _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; } ffc0becc: 80 01 00 24 lwz r0,36(r1) ffc0bed0: 7f e3 fb 78 mr r3,r31 ffc0bed4: 83 c1 00 18 lwz r30,24(r1) ffc0bed8: 7c 08 03 a6 mtlr r0 ffc0bedc: 83 e1 00 1c lwz r31,28(r1) ffc0bee0: 38 21 00 20 addi r1,r1,32 ffc0bee4: 4e 80 00 20 blr #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) if ( information->is_string ) return OBJECTS_INVALID_ID; #endif the_object = _Objects_Get( information, tmpId, &ignored_location ); ffc0bee8: 7c 04 03 78 mr r4,r0 ffc0beec: 38 a1 00 08 addi r5,r1,8 ffc0bef0: 4b ff fe c9 bl ffc0bdb8 <_Objects_Get> if ( !the_object ) ffc0bef4: 2c 03 00 00 cmpwi r3,0 ffc0bef8: 41 a2 ff d4 beq- ffc0becc <_Objects_Id_to_name+0x74> return OBJECTS_INVALID_ID; *name = the_object->name; ffc0befc: 80 03 00 0c lwz r0,12(r3) _Thread_Enable_dispatch(); return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; ffc0bf00: 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; ffc0bf04: 90 1e 00 00 stw r0,0(r30) _Thread_Enable_dispatch(); ffc0bf08: 48 00 10 35 bl ffc0cf3c <_Thread_Enable_dispatch> return OBJECTS_NAME_OR_ID_LOOKUP_SUCCESSFUL; ffc0bf0c: 4b ff ff c0 b ffc0becc <_Objects_Id_to_name+0x74> =============================================================================== ffc0b5a8 <_Objects_Shrink_information>: */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0b5a8: 94 21 ff e8 stwu r1,-24(r1) ffc0b5ac: 7c 08 02 a6 mflr r0 ffc0b5b0: 90 01 00 1c stw r0,28(r1) ffc0b5b4: 93 e1 00 14 stw r31,20(r1) /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / ffc0b5b8: a1 43 00 10 lhz r10,16(r3) /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); ffc0b5bc: a3 e3 00 0a lhz r31,10(r3) block_count = (information->maximum - index_base) / ffc0b5c0: a0 03 00 14 lhz r0,20(r3) ffc0b5c4: 7d 5f 50 50 subf r10,r31,r10 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0b5c8: 93 81 00 08 stw r28,8(r1) /* * Search the list to find block or chunk with all objects inactive. */ index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / ffc0b5cc: 7d 4a 03 96 divwu r10,r10,r0 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0b5d0: 93 a1 00 0c stw r29,12(r1) ffc0b5d4: 93 c1 00 10 stw r30,16(r1) index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { ffc0b5d8: 2f 8a 00 00 cmpwi cr7,r10,0 */ void _Objects_Shrink_information( Objects_Information *information ) { ffc0b5dc: 7c 7c 1b 78 mr r28,r3 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { ffc0b5e0: 41 9e 00 3c beq- cr7,ffc0b61c <_Objects_Shrink_information+0x74><== NEVER TAKEN if ( information->inactive_per_block[ block ] == ffc0b5e4: 81 63 00 30 lwz r11,48(r3) ffc0b5e8: 81 2b 00 00 lwz r9,0(r11) ffc0b5ec: 7f 80 48 00 cmpw cr7,r0,r9 ffc0b5f0: 41 9e 00 4c beq- cr7,ffc0b63c <_Objects_Shrink_information+0x94><== NEVER TAKEN index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { ffc0b5f4: 39 20 00 00 li r9,0 ffc0b5f8: 7d 49 03 a6 mtctr r10 ffc0b5fc: 48 00 00 18 b ffc0b614 <_Objects_Shrink_information+0x6c> if ( information->inactive_per_block[ block ] == ffc0b600: 85 4b 00 04 lwzu r10,4(r11) information->inactive -= information->allocation_size; return; } index_base += information->allocation_size; ffc0b604: 7f ff 02 14 add r31,r31,r0 index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { if ( information->inactive_per_block[ block ] == ffc0b608: 55 3d 10 3a rlwinm r29,r9,2,0,29 ffc0b60c: 7f 80 50 00 cmpw cr7,r0,r10 ffc0b610: 41 9e 00 30 beq- cr7,ffc0b640 <_Objects_Shrink_information+0x98> index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { ffc0b614: 39 29 00 01 addi r9,r9,1 ffc0b618: 42 00 ff e8 bdnz+ ffc0b600 <_Objects_Shrink_information+0x58> return; } index_base += information->allocation_size; } } ffc0b61c: 80 01 00 1c lwz r0,28(r1) ffc0b620: 83 81 00 08 lwz r28,8(r1) ffc0b624: 7c 08 03 a6 mtlr r0 ffc0b628: 83 a1 00 0c lwz r29,12(r1) ffc0b62c: 83 c1 00 10 lwz r30,16(r1) ffc0b630: 83 e1 00 14 lwz r31,20(r1) ffc0b634: 38 21 00 18 addi r1,r1,24 ffc0b638: 4e 80 00 20 blr index_base = _Objects_Get_index( information->minimum_id ); block_count = (information->maximum - index_base) / information->allocation_size; for ( block = 0; block < block_count; block++ ) { if ( information->inactive_per_block[ block ] == ffc0b63c: 3b a0 00 00 li r29,0 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc0b640: 80 7c 00 20 lwz r3,32(r28) ffc0b644: 48 00 00 10 b ffc0b654 <_Objects_Shrink_information+0xac> if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); ffc0b648: 2f 9e 00 00 cmpwi cr7,r30,0 index = _Objects_Get_index( the_object->id ); /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; ffc0b64c: 7f c3 f3 78 mr r3,r30 if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); ffc0b650: 41 9e 00 34 beq- cr7,ffc0b684 <_Objects_Shrink_information+0xdc> * Assume the Inactive chain is never empty at this point */ the_object = (Objects_Control *) _Chain_First( &information->Inactive ); do { index = _Objects_Get_index( the_object->id ); ffc0b654: a0 03 00 0a lhz r0,10(r3) /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; ffc0b658: 83 c3 00 00 lwz r30,0(r3) if ((index >= index_base) && ffc0b65c: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0b660: 41 bc ff e8 blt- cr7,ffc0b648 <_Objects_Shrink_information+0xa0> (index < (index_base + information->allocation_size))) { ffc0b664: a1 3c 00 14 lhz r9,20(r28) ffc0b668: 7d 3f 4a 14 add r9,r31,r9 /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; if ((index >= index_base) && ffc0b66c: 7f 80 48 40 cmplw cr7,r0,r9 ffc0b670: 40 9c ff d8 bge+ cr7,ffc0b648 <_Objects_Shrink_information+0xa0> (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); ffc0b674: 4b ff eb 0d bl ffc0a180 <_Chain_Extract> } } while ( the_object ); ffc0b678: 2f 9e 00 00 cmpwi cr7,r30,0 index = _Objects_Get_index( the_object->id ); /* * Get the next node before the node is extracted */ extract_me = the_object; the_object = (Objects_Control *) the_object->Node.next; ffc0b67c: 7f c3 f3 78 mr r3,r30 if ((index >= index_base) && (index < (index_base + information->allocation_size))) { _Chain_Extract( &extract_me->Node ); } } while ( the_object ); ffc0b680: 40 9e ff d4 bne+ cr7,ffc0b654 <_Objects_Shrink_information+0xac><== ALWAYS TAKEN /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); ffc0b684: 81 3c 00 34 lwz r9,52(r28) ffc0b688: 7c 69 e8 2e lwzx r3,r9,r29 ffc0b68c: 48 00 24 c5 bl ffc0db50 <_Workspace_Free> information->object_blocks[ block ] = NULL; ffc0b690: 81 3c 00 34 lwz r9,52(r28) information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; ffc0b694: a1 7c 00 2c lhz r11,44(r28) /* * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; ffc0b698: 7f c9 e9 2e stwx r30,r9,r29 information->inactive_per_block[ block ] = 0; information->inactive -= information->allocation_size; ffc0b69c: a0 1c 00 14 lhz r0,20(r28) * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; ffc0b6a0: 81 3c 00 30 lwz r9,48(r28) information->inactive -= information->allocation_size; ffc0b6a4: 7c 00 58 50 subf r0,r0,r11 return; } index_base += information->allocation_size; } } ffc0b6a8: 83 e1 00 14 lwz r31,20(r1) * Free the memory and reset the structures in the object' information */ _Workspace_Free( information->object_blocks[ block ] ); information->object_blocks[ block ] = NULL; information->inactive_per_block[ block ] = 0; ffc0b6ac: 7f c9 e9 2e stwx r30,r9,r29 information->inactive -= information->allocation_size; ffc0b6b0: b0 1c 00 2c sth r0,44(r28) return; } index_base += information->allocation_size; } } ffc0b6b4: 80 01 00 1c lwz r0,28(r1) ffc0b6b8: 83 81 00 08 lwz r28,8(r1) ffc0b6bc: 7c 08 03 a6 mtlr r0 ffc0b6c0: 83 a1 00 0c lwz r29,12(r1) ffc0b6c4: 83 c1 00 10 lwz r30,16(r1) ffc0b6c8: 38 21 00 18 addi r1,r1,24 ffc0b6cc: 4e 80 00 20 blr =============================================================================== ffc0b444 <_POSIX_Absolute_timeout_to_ticks>: */ POSIX_Absolute_timeout_conversion_results_t _POSIX_Absolute_timeout_to_ticks( const struct timespec *abstime, Watchdog_Interval *ticks_out ) { ffc0b444: 94 21 ff e0 stwu r1,-32(r1) ffc0b448: 7c 08 02 a6 mflr r0 ffc0b44c: 90 01 00 24 stw r0,36(r1) /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0b450: 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 ) { ffc0b454: 93 c1 00 18 stw r30,24(r1) ffc0b458: 7c 7e 1b 78 mr r30,r3 ffc0b45c: 93 e1 00 1c stw r31,28(r1) ffc0b460: 7c 9f 23 78 mr r31,r4 /* * Make sure there is always a value returned. */ *ticks_out = 0; ffc0b464: 90 04 00 00 stw r0,0(r4) /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0b468: 48 00 52 dd bl ffc10744 <_Timespec_Is_valid> ffc0b46c: 2f 83 00 00 cmpwi cr7,r3,0 return POSIX_ABSOLUTE_TIMEOUT_INVALID; ffc0b470: 38 60 00 00 li r3,0 *ticks_out = 0; /* * Is the absolute time even valid? */ if ( !_Timespec_Is_valid(abstime) ) ffc0b474: 40 9e 00 1c bne- cr7,ffc0b490 <_POSIX_Absolute_timeout_to_ticks+0x4c> /* * This is the case we were expecting and it took this long to * get here. */ return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE; } ffc0b478: 80 01 00 24 lwz r0,36(r1) ffc0b47c: 83 c1 00 18 lwz r30,24(r1) ffc0b480: 7c 08 03 a6 mtlr r0 ffc0b484: 83 e1 00 1c lwz r31,28(r1) ffc0b488: 38 21 00 20 addi r1,r1,32 ffc0b48c: 4e 80 00 20 blr return POSIX_ABSOLUTE_TIMEOUT_INVALID; /* * Is the absolute time in the past? */ _TOD_Get( ¤t_time ); ffc0b490: 38 61 00 10 addi r3,r1,16 ffc0b494: 48 00 26 c1 bl ffc0db54 <_TOD_Get> if ( _Timespec_Less_than( abstime, ¤t_time ) ) ffc0b498: 7f c3 f3 78 mr r3,r30 ffc0b49c: 38 81 00 10 addi r4,r1,16 ffc0b4a0: 48 00 52 e1 bl ffc10780 <_Timespec_Less_than> ffc0b4a4: 2f 83 00 00 cmpwi cr7,r3,0 return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST; ffc0b4a8: 38 60 00 01 li r3,1 /* * Is the absolute time in the past? */ _TOD_Get( ¤t_time ); if ( _Timespec_Less_than( abstime, ¤t_time ) ) ffc0b4ac: 40 9e ff cc bne+ cr7,ffc0b478 <_POSIX_Absolute_timeout_to_ticks+0x34> return POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST; /* * How long until the requested absolute time? */ _Timespec_Subtract( ¤t_time, abstime, &difference ); ffc0b4b0: 7f c4 f3 78 mr r4,r30 ffc0b4b4: 38 a1 00 08 addi r5,r1,8 ffc0b4b8: 38 61 00 10 addi r3,r1,16 ffc0b4bc: 48 00 53 01 bl ffc107bc <_Timespec_Subtract> /* * Internally the SuperCore uses ticks, so convert to them. */ *ticks_out = _Timespec_To_ticks( &difference ); ffc0b4c0: 38 61 00 08 addi r3,r1,8 ffc0b4c4: 48 00 53 45 bl ffc10808 <_Timespec_To_ticks> /* * If the difference was 0, then the future is now. It is so bright * we better wear shades. */ if ( !*ticks_out ) ffc0b4c8: 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 ); ffc0b4cc: 90 7f 00 00 stw r3,0(r31) /* * This is the case we were expecting and it took this long to * get here. */ return POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE; ffc0b4d0: 38 60 00 03 li r3,3 /* * If the difference was 0, then the future is now. It is so bright * we better wear shades. */ if ( !*ticks_out ) ffc0b4d4: 40 be ff a4 bne- cr7,ffc0b478 <_POSIX_Absolute_timeout_to_ticks+0x34><== ALWAYS TAKEN return POSIX_ABSOLUTE_TIMEOUT_IS_NOW; ffc0b4d8: 38 60 00 02 li r3,2 <== NOT EXECUTED ffc0b4dc: 4b ff ff 9c b ffc0b478 <_POSIX_Absolute_timeout_to_ticks+0x34><== NOT EXECUTED =============================================================================== ffc0eef0 <_POSIX_Message_queue_Receive_support>: size_t msg_len, unsigned int *msg_prio, bool wait, Watchdog_Interval timeout ) { ffc0eef0: 94 21 ff d0 stwu r1,-48(r1) ffc0eef4: 7c 08 02 a6 mflr r0 ffc0eef8: 93 e1 00 2c stw r31,44(r1) ffc0eefc: 7c 7f 1b 78 mr r31,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( ffc0ef00: 3c 60 00 00 lis r3,0 ffc0ef04: 93 81 00 20 stw r28,32(r1) ffc0ef08: 38 63 36 18 addi r3,r3,13848 ffc0ef0c: 7c 9c 23 78 mr r28,r4 ffc0ef10: 93 c1 00 28 stw r30,40(r1) ffc0ef14: 7f e4 fb 78 mr r4,r31 ffc0ef18: 7c be 2b 78 mr r30,r5 ffc0ef1c: 38 a1 00 0c addi r5,r1,12 ffc0ef20: 90 01 00 34 stw r0,52(r1) ffc0ef24: 93 41 00 18 stw r26,24(r1) ffc0ef28: 7c fa 3b 78 mr r26,r7 ffc0ef2c: 93 61 00 1c stw r27,28(r1) ffc0ef30: 7d 1b 43 78 mr r27,r8 ffc0ef34: 93 a1 00 24 stw r29,36(r1) ffc0ef38: 7c dd 33 78 mr r29,r6 ffc0ef3c: 48 00 40 f5 bl ffc13030 <_Objects_Get> Objects_Locations location; size_t length_out; bool do_wait; the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { ffc0ef40: 80 01 00 0c lwz r0,12(r1) ffc0ef44: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ef48: 41 9e 00 3c beq- cr7,ffc0ef84 <_POSIX_Message_queue_Receive_support+0x94> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); ffc0ef4c: 48 00 d3 69 bl ffc1c2b4 <__errno> ffc0ef50: 38 00 00 09 li r0,9 ffc0ef54: 90 03 00 00 stw r0,0(r3) ffc0ef58: 38 60 ff ff li r3,-1 } ffc0ef5c: 80 01 00 34 lwz r0,52(r1) ffc0ef60: 83 41 00 18 lwz r26,24(r1) ffc0ef64: 7c 08 03 a6 mtlr r0 ffc0ef68: 83 61 00 1c lwz r27,28(r1) ffc0ef6c: 83 81 00 20 lwz r28,32(r1) ffc0ef70: 83 a1 00 24 lwz r29,36(r1) ffc0ef74: 83 c1 00 28 lwz r30,40(r1) ffc0ef78: 83 e1 00 2c lwz r31,44(r1) ffc0ef7c: 38 21 00 30 addi r1,r1,48 ffc0ef80: 4e 80 00 20 blr the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { ffc0ef84: 80 03 00 14 lwz r0,20(r3) ffc0ef88: 54 09 07 be clrlwi r9,r0,30 ffc0ef8c: 2f 89 00 01 cmpwi cr7,r9,1 ffc0ef90: 41 9e 00 e4 beq- cr7,ffc0f074 <_POSIX_Message_queue_Receive_support+0x184> _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; ffc0ef94: 80 63 00 10 lwz r3,16(r3) if ( msg_len < the_mq->Message_queue.maximum_message_size ) { ffc0ef98: 81 23 00 68 lwz r9,104(r3) ffc0ef9c: 7f 89 f0 40 cmplw cr7,r9,r30 ffc0efa0: 41 9d 00 9c bgt- cr7,ffc0f03c <_POSIX_Message_queue_Receive_support+0x14c> length_out = -1; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0efa4: 2f 9a 00 00 cmpwi cr7,r26,0 /* * Now if something goes wrong, we return a "length" of -1 * to indicate an error. */ length_out = -1; ffc0efa8: 39 20 ff ff li r9,-1 ffc0efac: 91 21 00 08 stw r9,8(r1) /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0efb0: 38 e0 00 00 li r7,0 ffc0efb4: 40 9e 00 78 bne- cr7,ffc0f02c <_POSIX_Message_queue_Receive_support+0x13c><== ALWAYS TAKEN do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0efb8: 7f e4 fb 78 mr r4,r31 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0efbc: 3f e0 00 00 lis r31,0 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0efc0: 38 63 00 1c addi r3,r3,28 ffc0efc4: 7f 85 e3 78 mr r5,r28 ffc0efc8: 38 c1 00 08 addi r6,r1,8 ffc0efcc: 7f 68 db 78 mr r8,r27 timeout ); _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0efd0: 3b ff 36 84 addi r31,r31,13956 do_wait = wait; /* * Now perform the actual message receive */ _CORE_message_queue_Seize( ffc0efd4: 48 00 2b 69 bl ffc11b3c <_CORE_message_queue_Seize> &length_out, do_wait, timeout ); _Thread_Enable_dispatch(); ffc0efd8: 48 00 51 e5 bl ffc141bc <_Thread_Enable_dispatch> *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); ffc0efdc: 81 3f 00 0c lwz r9,12(r31) if ( !_Thread_Executing->Wait.return_code ) ffc0efe0: 81 69 00 34 lwz r11,52(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); ffc0efe4: 80 09 00 24 lwz r0,36(r9) ffc0efe8: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0efec: 7c 09 fe 70 srawi r9,r0,31 ffc0eff0: 7d 20 02 78 xor r0,r9,r0 ffc0eff4: 7c 09 00 50 subf r0,r9,r0 do_wait, timeout ); _Thread_Enable_dispatch(); *msg_prio = ffc0eff8: 90 1d 00 00 stw r0,0(r29) _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) ffc0effc: 40 9e 00 58 bne- cr7,ffc0f054 <_POSIX_Message_queue_Receive_support+0x164> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0f000: 80 01 00 34 lwz r0,52(r1) _Thread_Enable_dispatch(); *msg_prio = _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) return length_out; ffc0f004: 80 61 00 08 lwz r3,8(r1) case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0f008: 7c 08 03 a6 mtlr r0 ffc0f00c: 83 41 00 18 lwz r26,24(r1) ffc0f010: 83 61 00 1c lwz r27,28(r1) ffc0f014: 83 81 00 20 lwz r28,32(r1) ffc0f018: 83 a1 00 24 lwz r29,36(r1) ffc0f01c: 83 c1 00 28 lwz r30,40(r1) ffc0f020: 83 e1 00 2c lwz r31,44(r1) ffc0f024: 38 21 00 30 addi r1,r1,48 ffc0f028: 4e 80 00 20 blr /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; ffc0f02c: 70 09 40 00 andi. r9,r0,16384 ffc0f030: 7c e0 00 26 mfcr r7 ffc0f034: 54 e7 1f fe rlwinm r7,r7,3,31,31 ffc0f038: 4b ff ff 80 b ffc0efb8 <_POSIX_Message_queue_Receive_support+0xc8> } the_mq = the_mq_fd->Queue; if ( msg_len < the_mq->Message_queue.maximum_message_size ) { _Thread_Enable_dispatch(); ffc0f03c: 48 00 51 81 bl ffc141bc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EMSGSIZE ); ffc0f040: 48 00 d2 75 bl ffc1c2b4 <__errno> ffc0f044: 38 00 00 7a li r0,122 ffc0f048: 90 03 00 00 stw r0,0(r3) ffc0f04c: 38 60 ff ff li r3,-1 ffc0f050: 4b ff ff 0c b ffc0ef5c <_POSIX_Message_queue_Receive_support+0x6c> _POSIX_Message_queue_Priority_from_core(_Thread_Executing->Wait.count); if ( !_Thread_Executing->Wait.return_code ) return length_out; rtems_set_errno_and_return_minus_one( ffc0f054: 48 00 d2 61 bl ffc1c2b4 <__errno> ffc0f058: 81 3f 00 0c lwz r9,12(r31) ffc0f05c: 7c 7e 1b 78 mr r30,r3 ffc0f060: 80 69 00 34 lwz r3,52(r9) ffc0f064: 48 00 03 71 bl ffc0f3d4 <_POSIX_Message_queue_Translate_core_message_queue_return_code> ffc0f068: 90 7e 00 00 stw r3,0(r30) ffc0f06c: 38 60 ff ff li r3,-1 ffc0f070: 4b ff fe ec b ffc0ef5c <_POSIX_Message_queue_Receive_support+0x6c> the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_WRONLY ) { _Thread_Enable_dispatch(); ffc0f074: 48 00 51 49 bl ffc141bc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EBADF ); ffc0f078: 48 00 d2 3d bl ffc1c2b4 <__errno> ffc0f07c: 38 00 00 09 li r0,9 ffc0f080: 90 03 00 00 stw r0,0(r3) ffc0f084: 38 60 ff ff li r3,-1 ffc0f088: 4b ff fe d4 b ffc0ef5c <_POSIX_Message_queue_Receive_support+0x6c> =============================================================================== ffc0f0b4 <_POSIX_Message_queue_Send_support>: /* * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) ffc0f0b4: 2b 86 00 20 cmplwi cr7,r6,32 size_t msg_len, uint32_t msg_prio, bool wait, Watchdog_Interval timeout ) { ffc0f0b8: 94 21 ff d0 stwu r1,-48(r1) ffc0f0bc: 7c 08 02 a6 mflr r0 ffc0f0c0: 93 41 00 18 stw r26,24(r1) ffc0f0c4: 7c fa 3b 78 mr r26,r7 ffc0f0c8: 93 61 00 1c stw r27,28(r1) ffc0f0cc: 7c 9b 23 78 mr r27,r4 ffc0f0d0: 93 81 00 20 stw r28,32(r1) ffc0f0d4: 7c bc 2b 78 mr r28,r5 ffc0f0d8: 93 a1 00 24 stw r29,36(r1) ffc0f0dc: 7c 7d 1b 78 mr r29,r3 ffc0f0e0: 93 c1 00 28 stw r30,40(r1) ffc0f0e4: 7c de 33 78 mr r30,r6 ffc0f0e8: 93 e1 00 2c stw r31,44(r1) ffc0f0ec: 7d 1f 43 78 mr r31,r8 ffc0f0f0: 90 01 00 34 stw r0,52(r1) /* * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) ffc0f0f4: 41 9d 01 04 bgt- cr7,ffc0f1f8 <_POSIX_Message_queue_Send_support+0x144> 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( ffc0f0f8: 3c 60 00 00 lis r3,0 ffc0f0fc: 38 63 36 18 addi r3,r3,13848 ffc0f100: 7f a4 eb 78 mr r4,r29 ffc0f104: 38 a1 00 08 addi r5,r1,8 ffc0f108: 48 00 3f 29 bl ffc13030 <_Objects_Get> rtems_set_errno_and_return_minus_one( EINVAL ); the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { ffc0f10c: 80 01 00 08 lwz r0,8(r1) ffc0f110: 2f 80 00 00 cmpwi cr7,r0,0 ffc0f114: 40 9e 00 d0 bne- cr7,ffc0f1e4 <_POSIX_Message_queue_Send_support+0x130> case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { ffc0f118: 80 03 00 14 lwz r0,20(r3) ffc0f11c: 70 09 00 03 andi. r9,r0,3 ffc0f120: 41 82 00 ec beq- ffc0f20c <_POSIX_Message_queue_Send_support+0x158> the_mq = the_mq_fd->Queue; /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0f124: 2f 9a 00 00 cmpwi cr7,r26,0 if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EBADF ); } the_mq = the_mq_fd->Queue; ffc0f128: 81 63 00 10 lwz r11,16(r3) /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) ffc0f12c: 39 20 00 00 li r9,0 ffc0f130: 40 9e 00 68 bne- cr7,ffc0f198 <_POSIX_Message_queue_Send_support+0xe4> do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( ffc0f134: 7f ea fb 78 mr r10,r31 ffc0f138: 7f 64 db 78 mr r4,r27 ffc0f13c: 7f 85 e3 78 mr r5,r28 ffc0f140: 7f a6 eb 78 mr r6,r29 ffc0f144: 38 e0 00 00 li r7,0 ffc0f148: 7d 1e 00 d0 neg r8,r30 ffc0f14c: 38 6b 00 1c addi r3,r11,28 ffc0f150: 48 00 2b 81 bl ffc11cd0 <_CORE_message_queue_Submit> ffc0f154: 7c 7f 1b 78 mr r31,r3 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); ffc0f158: 48 00 50 65 bl ffc141bc <_Thread_Enable_dispatch> * after it wakes up. The returned status is correct for * non-blocking operations but if we blocked, then we need * to look at the status in our TCB. */ if ( msg_status == CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT ) ffc0f15c: 2f 9f 00 07 cmpwi cr7,r31,7 ffc0f160: 41 9e 00 74 beq- cr7,ffc0f1d4 <_POSIX_Message_queue_Send_support+0x120><== NEVER TAKEN msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) ffc0f164: 2f 9f 00 00 cmpwi cr7,r31,0 return msg_status; ffc0f168: 38 60 00 00 li r3,0 */ if ( msg_status == CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT ) msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) ffc0f16c: 40 9e 00 b8 bne- cr7,ffc0f224 <_POSIX_Message_queue_Send_support+0x170> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); } ffc0f170: 80 01 00 34 lwz r0,52(r1) ffc0f174: 83 41 00 18 lwz r26,24(r1) ffc0f178: 7c 08 03 a6 mtlr r0 ffc0f17c: 83 61 00 1c lwz r27,28(r1) ffc0f180: 83 81 00 20 lwz r28,32(r1) ffc0f184: 83 a1 00 24 lwz r29,36(r1) ffc0f188: 83 c1 00 28 lwz r30,40(r1) ffc0f18c: 83 e1 00 2c lwz r31,44(r1) ffc0f190: 38 21 00 30 addi r1,r1,48 ffc0f194: 4e 80 00 20 blr /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; ffc0f198: 70 09 40 00 andi. r9,r0,16384 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( ffc0f19c: 7f ea fb 78 mr r10,r31 ffc0f1a0: 7f 64 db 78 mr r4,r27 /* * A timed receive with a bad time will do a poll regardless. */ if ( wait ) do_wait = (the_mq_fd->oflag & O_NONBLOCK) ? false : true; ffc0f1a4: 7d 20 00 26 mfcr r9 ffc0f1a8: 55 29 1f fe rlwinm r9,r9,3,31,31 do_wait = wait; /* * Now perform the actual message receive */ msg_status = _CORE_message_queue_Submit( ffc0f1ac: 7f 85 e3 78 mr r5,r28 ffc0f1b0: 7f a6 eb 78 mr r6,r29 ffc0f1b4: 38 e0 00 00 li r7,0 ffc0f1b8: 7d 1e 00 d0 neg r8,r30 ffc0f1bc: 38 6b 00 1c addi r3,r11,28 ffc0f1c0: 48 00 2b 11 bl ffc11cd0 <_CORE_message_queue_Submit> ffc0f1c4: 7c 7f 1b 78 mr r31,r3 _POSIX_Message_queue_Priority_to_core( msg_prio ), do_wait, timeout /* no timeout */ ); _Thread_Enable_dispatch(); ffc0f1c8: 48 00 4f f5 bl ffc141bc <_Thread_Enable_dispatch> * after it wakes up. The returned status is correct for * non-blocking operations but if we blocked, then we need * to look at the status in our TCB. */ if ( msg_status == CORE_MESSAGE_QUEUE_STATUS_UNSATISFIED_WAIT ) ffc0f1cc: 2f 9f 00 07 cmpwi cr7,r31,7 ffc0f1d0: 40 9e ff 94 bne+ cr7,ffc0f164 <_POSIX_Message_queue_Send_support+0xb0> msg_status = _Thread_Executing->Wait.return_code; ffc0f1d4: 3d 20 00 00 lis r9,0 ffc0f1d8: 81 29 36 90 lwz r9,13968(r9) ffc0f1dc: 83 e9 00 34 lwz r31,52(r9) ffc0f1e0: 4b ff ff 84 b ffc0f164 <_POSIX_Message_queue_Send_support+0xb0> #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EBADF ); ffc0f1e4: 48 00 d0 d1 bl ffc1c2b4 <__errno> ffc0f1e8: 38 00 00 09 li r0,9 ffc0f1ec: 90 03 00 00 stw r0,0(r3) ffc0f1f0: 38 60 ff ff li r3,-1 ffc0f1f4: 4b ff ff 7c b ffc0f170 <_POSIX_Message_queue_Send_support+0xbc> * Validate the priority. * XXX - Do not validate msg_prio is not less than 0. */ if ( msg_prio > MQ_PRIO_MAX ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc0f1f8: 48 00 d0 bd bl ffc1c2b4 <__errno> ffc0f1fc: 38 00 00 16 li r0,22 ffc0f200: 90 03 00 00 stw r0,0(r3) ffc0f204: 38 60 ff ff li r3,-1 ffc0f208: 4b ff ff 68 b ffc0f170 <_POSIX_Message_queue_Send_support+0xbc> the_mq_fd = _POSIX_Message_queue_Get_fd( mqdes, &location ); switch ( location ) { case OBJECTS_LOCAL: if ( (the_mq_fd->oflag & O_ACCMODE) == O_RDONLY ) { _Thread_Enable_dispatch(); ffc0f20c: 48 00 4f b1 bl ffc141bc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EBADF ); ffc0f210: 48 00 d0 a5 bl ffc1c2b4 <__errno> ffc0f214: 38 00 00 09 li r0,9 ffc0f218: 90 03 00 00 stw r0,0(r3) ffc0f21c: 38 60 ff ff li r3,-1 ffc0f220: 4b ff ff 50 b ffc0f170 <_POSIX_Message_queue_Send_support+0xbc> msg_status = _Thread_Executing->Wait.return_code; if ( !msg_status ) return msg_status; rtems_set_errno_and_return_minus_one( ffc0f224: 48 00 d0 91 bl ffc1c2b4 <__errno> ffc0f228: 7c 7e 1b 78 mr r30,r3 ffc0f22c: 7f e3 fb 78 mr r3,r31 ffc0f230: 48 00 01 a5 bl ffc0f3d4 <_POSIX_Message_queue_Translate_core_message_queue_return_code> ffc0f234: 90 7e 00 00 stw r3,0(r30) ffc0f238: 38 60 ff ff li r3,-1 ffc0f23c: 4b ff ff 34 b ffc0f170 <_POSIX_Message_queue_Send_support+0xbc> =============================================================================== ffc0fa0c <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch>: #include void _POSIX_Thread_Evaluate_cancellation_and_enable_dispatch( Thread_Control *the_thread ) { ffc0fa0c: 7c 08 02 a6 mflr r0 ffc0fa10: 94 21 ff f8 stwu r1,-8(r1) ffc0fa14: 90 01 00 0c stw r0,12(r1) POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0fa18: 81 23 01 34 lwz r9,308(r3) if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc0fa1c: 80 09 00 d8 lwz r0,216(r9) ffc0fa20: 2f 80 00 00 cmpwi cr7,r0,0 ffc0fa24: 40 9e 00 10 bne- cr7,ffc0fa34 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x28><== NEVER TAKEN ffc0fa28: 80 09 00 dc lwz r0,220(r9) ffc0fa2c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0fa30: 41 9e 00 18 beq- cr7,ffc0fa48 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x3c> thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); } else _Thread_Enable_dispatch(); ffc0fa34: 4b ff c8 81 bl ffc0c2b4 <_Thread_Enable_dispatch> } ffc0fa38: 80 01 00 0c lwz r0,12(r1) ffc0fa3c: 38 21 00 08 addi r1,r1,8 ffc0fa40: 7c 08 03 a6 mtlr r0 ffc0fa44: 4e 80 00 20 blr POSIX_API_Control *thread_support; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && thread_support->cancelability_type == PTHREAD_CANCEL_ASYNCHRONOUS && ffc0fa48: 80 09 00 e0 lwz r0,224(r9) ffc0fa4c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0fa50: 41 9e ff e4 beq+ cr7,ffc0fa34 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x28> * * This routine decrements the thread dispatch level. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_decrement_disable_level(void) { _Thread_Dispatch_disable_level--; ffc0fa54: 3d 20 00 00 lis r9,0 ffc0fa58: 81 69 28 14 lwz r11,10260(r9) thread_support->cancelation_requested ) { _Thread_Unnest_dispatch(); _POSIX_Thread_Exit( the_thread, PTHREAD_CANCELED ); ffc0fa5c: 38 80 ff ff li r4,-1 ffc0fa60: 38 0b ff ff addi r0,r11,-1 ffc0fa64: 90 09 28 14 stw r0,10260(r9) return _Thread_Dispatch_disable_level; ffc0fa68: 80 09 28 14 lwz r0,10260(r9) ffc0fa6c: 48 00 08 55 bl ffc102c0 <_POSIX_Thread_Exit> ffc0fa70: 4b ff ff c8 b ffc0fa38 <_POSIX_Thread_Evaluate_cancellation_and_enable_dispatch+0x2c> =============================================================================== ffc1120c <_POSIX_Thread_Translate_sched_param>: int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { ffc1120c: 94 21 ff e0 stwu r1,-32(r1) ffc11210: 7c 08 02 a6 mflr r0 ffc11214: 93 c1 00 18 stw r30,24(r1) ffc11218: 7c 7e 1b 78 mr r30,r3 if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc1121c: 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 ) { ffc11220: 93 61 00 0c stw r27,12(r1) ffc11224: 7c db 33 78 mr r27,r6 ffc11228: 93 81 00 10 stw r28,16(r1) if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) return EINVAL; ffc1122c: 3b 80 00 16 li r28,22 int policy, struct sched_param *param, Thread_CPU_budget_algorithms *budget_algorithm, Thread_CPU_budget_algorithm_callout *budget_callout ) { ffc11230: 93 a1 00 14 stw r29,20(r1) ffc11234: 7c bd 2b 78 mr r29,r5 ffc11238: 93 e1 00 1c stw r31,28(r1) ffc1123c: 7c 9f 23 78 mr r31,r4 ffc11240: 90 01 00 24 stw r0,36(r1) if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) ffc11244: 4b ff ff a5 bl ffc111e8 <_POSIX_Priority_Is_valid> ffc11248: 2f 83 00 00 cmpwi cr7,r3,0 ffc1124c: 40 9e 00 2c bne- cr7,ffc11278 <_POSIX_Thread_Translate_sched_param+0x6c><== ALWAYS TAKEN *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc11250: 80 01 00 24 lwz r0,36(r1) ffc11254: 7f 83 e3 78 mr r3,r28 ffc11258: 83 61 00 0c lwz r27,12(r1) ffc1125c: 7c 08 03 a6 mtlr r0 ffc11260: 83 81 00 10 lwz r28,16(r1) ffc11264: 83 a1 00 14 lwz r29,20(r1) ffc11268: 83 c1 00 18 lwz r30,24(r1) ffc1126c: 83 e1 00 1c lwz r31,28(r1) ffc11270: 38 21 00 20 addi r1,r1,32 ffc11274: 4e 80 00 20 blr return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { ffc11278: 2f 9e 00 00 cmpwi cr7,r30,0 ) { if ( !_POSIX_Priority_Is_valid( param->sched_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; ffc1127c: 38 00 00 00 li r0,0 ffc11280: 90 1d 00 00 stw r0,0(r29) *budget_callout = NULL; ffc11284: 90 1b 00 00 stw r0,0(r27) if ( policy == SCHED_OTHER ) { ffc11288: 41 9e 00 a4 beq- cr7,ffc1132c <_POSIX_Thread_Translate_sched_param+0x120> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; return 0; } if ( policy == SCHED_FIFO ) { ffc1128c: 2f 9e 00 01 cmpwi cr7,r30,1 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; ffc11290: 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 ) { ffc11294: 41 be ff bc beq- cr7,ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { ffc11298: 2f 9e 00 02 cmpwi cr7,r30,2 ffc1129c: 41 9e 00 c4 beq- cr7,ffc11360 <_POSIX_Thread_Translate_sched_param+0x154> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; return 0; } if ( policy == SCHED_SPORADIC ) { ffc112a0: 2f 9e 00 04 cmpwi cr7,r30,4 *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; ffc112a4: 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 ) { ffc112a8: 40 9e ff a8 bne+ cr7,ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> if ( (param->sched_ss_repl_period.tv_sec == 0) && ffc112ac: 80 1f 00 08 lwz r0,8(r31) ffc112b0: 2f 80 00 00 cmpwi cr7,r0,0 ffc112b4: 40 9e 00 10 bne- cr7,ffc112c4 <_POSIX_Thread_Translate_sched_param+0xb8> ffc112b8: 80 1f 00 0c lwz r0,12(r31) ffc112bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc112c0: 41 9e ff 90 beq+ cr7,ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> (param->sched_ss_repl_period.tv_nsec == 0) ) return EINVAL; if ( (param->sched_ss_init_budget.tv_sec == 0) && ffc112c4: 80 1f 00 10 lwz r0,16(r31) ffc112c8: 2f 80 00 00 cmpwi cr7,r0,0 ffc112cc: 40 9e 00 14 bne- cr7,ffc112e0 <_POSIX_Thread_Translate_sched_param+0xd4> ffc112d0: 80 1f 00 14 lwz r0,20(r31) (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; ffc112d4: 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) && ffc112d8: 2f 80 00 00 cmpwi cr7,r0,0 ffc112dc: 41 9e ff 74 beq+ cr7,ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> (param->sched_ss_init_budget.tv_nsec == 0) ) return EINVAL; if ( _Timespec_To_ticks( ¶m->sched_ss_repl_period ) < ffc112e0: 38 7f 00 08 addi r3,r31,8 ffc112e4: 4b ff cf 21 bl ffc0e204 <_Timespec_To_ticks> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; ffc112e8: 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 ) < ffc112ec: 7c 7e 1b 78 mr r30,r3 _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) ffc112f0: 38 7f 00 10 addi r3,r31,16 ffc112f4: 4b ff cf 11 bl ffc0e204 <_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 ) < ffc112f8: 7f 9e 18 40 cmplw cr7,r30,r3 ffc112fc: 41 9c ff 54 blt+ cr7,ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> _Timespec_To_ticks( ¶m->sched_ss_init_budget ) ) return EINVAL; if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) ffc11300: 80 7f 00 04 lwz r3,4(r31) ffc11304: 4b ff fe e5 bl ffc111e8 <_POSIX_Priority_Is_valid> ffc11308: 2f 83 00 00 cmpwi cr7,r3,0 ffc1130c: 41 9e ff 44 beq+ cr7,ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; ffc11310: 38 00 00 03 li r0,3 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc11314: 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; ffc11318: 90 1d 00 00 stw r0,0(r29) *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc1131c: 38 09 96 5c addi r0,r9,-27044 return 0; ffc11320: 3b 80 00 00 li r28,0 if ( !_POSIX_Priority_Is_valid( param->sched_ss_low_priority ) ) return EINVAL; *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT; *budget_callout = _POSIX_Threads_Sporadic_budget_callout; ffc11324: 90 1b 00 00 stw r0,0(r27) return 0; ffc11328: 4b ff ff 28 b ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; ffc1132c: 38 00 00 01 li r0,1 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc11330: 83 61 00 0c lwz r27,12(r1) *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; *budget_callout = NULL; if ( policy == SCHED_OTHER ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; ffc11334: 90 1d 00 00 stw r0,0(r29) return 0; ffc11338: 3b 80 00 00 li r28,0 *budget_callout = _POSIX_Threads_Sporadic_budget_callout; return 0; } return EINVAL; } ffc1133c: 7f 83 e3 78 mr r3,r28 ffc11340: 80 01 00 24 lwz r0,36(r1) ffc11344: 83 81 00 10 lwz r28,16(r1) ffc11348: 7c 08 03 a6 mtlr r0 ffc1134c: 83 a1 00 14 lwz r29,20(r1) ffc11350: 83 c1 00 18 lwz r30,24(r1) ffc11354: 83 e1 00 1c lwz r31,28(r1) ffc11358: 38 21 00 20 addi r1,r1,32 ffc1135c: 4e 80 00 20 blr *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; return 0; } if ( policy == SCHED_RR ) { *budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_EXHAUST_TIMESLICE; ffc11360: 93 dd 00 00 stw r30,0(r29) return 0; ffc11364: 4b ff fe ec b ffc11250 <_POSIX_Thread_Translate_sched_param+0x44> =============================================================================== ffc10134 <_POSIX_Threads_Exitted_extension>: * This method is invoked each time a thread exits. */ void _POSIX_Threads_Exitted_extension( Thread_Control *executing ) { ffc10134: 7c 08 02 a6 mflr r0 ffc10138: 94 21 ff f8 stwu r1,-8(r1) ffc1013c: 90 01 00 0c stw r0,12(r1) */ RTEMS_INLINE_ROUTINE Objects_APIs _Objects_Get_API( Objects_Id id ) { return (Objects_APIs) ((id >> OBJECTS_API_START_BIT) & OBJECTS_API_VALID_BITS); ffc10140: 88 03 00 08 lbz r0,8(r3) ffc10144: 54 00 07 7e clrlwi r0,r0,29 /* * If the executing thread was not created with the POSIX API, then this * API do not get to define its exit behavior. */ if ( _Objects_Get_API( executing->Object.id ) == OBJECTS_POSIX_API ) ffc10148: 2f 80 00 03 cmpwi cr7,r0,3 ffc1014c: 41 9e 00 14 beq- cr7,ffc10160 <_POSIX_Threads_Exitted_extension+0x2c> pthread_exit( executing->Wait.return_argument ); } ffc10150: 80 01 00 0c lwz r0,12(r1) ffc10154: 38 21 00 08 addi r1,r1,8 ffc10158: 7c 08 03 a6 mtlr r0 ffc1015c: 4e 80 00 20 blr /* * If the executing thread was not created with the POSIX API, then this * API do not get to define its exit behavior. */ if ( _Objects_Get_API( executing->Object.id ) == OBJECTS_POSIX_API ) pthread_exit( executing->Wait.return_argument ); ffc10160: 80 63 00 28 lwz r3,40(r3) ffc10164: 48 00 33 a9 bl ffc1350c } ffc10168: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc1016c: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc10170: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc10174: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc0923c <_POSIX_Threads_Initialize_user_threads_body>: * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc0923c: 94 21 ff 98 stwu r1,-104(r1) ffc09240: 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; ffc09244: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09248: 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; ffc0924c: 39 29 20 44 addi r9,r9,8260 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09250: 93 e1 00 64 stw r31,100(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; ffc09254: 83 e9 00 34 lwz r31,52(r9) * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09258: 93 a1 00 5c stw r29,92(r1) pthread_attr_t attr; user_threads = Configuration_POSIX_API.User_initialization_threads_table; maximum = Configuration_POSIX_API.number_of_initialization_threads; if ( !user_threads || maximum == 0 ) ffc0925c: 2f 9f 00 00 cmpwi cr7,r31,0 * * Output parameters: NONE */ void _POSIX_Threads_Initialize_user_threads_body(void) { ffc09260: 93 c1 00 60 stw r30,96(r1) posix_initialization_threads_table *user_threads; pthread_t thread_id; pthread_attr_t attr; user_threads = Configuration_POSIX_API.User_initialization_threads_table; maximum = Configuration_POSIX_API.number_of_initialization_threads; ffc09264: 83 a9 00 30 lwz r29,48(r9) if ( !user_threads || maximum == 0 ) ffc09268: 41 9e 00 5c beq- cr7,ffc092c4 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN ffc0926c: 2f 9d 00 00 cmpwi cr7,r29,0 ffc09270: 41 9e 00 54 beq- cr7,ffc092c4 <_POSIX_Threads_Initialize_user_threads_body+0x88><== NEVER TAKEN ffc09274: 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 ); ffc09278: 38 61 00 0c addi r3,r1,12 ffc0927c: 48 00 80 ed bl ffc11368 (void) pthread_attr_setinheritsched( &attr, PTHREAD_EXPLICIT_SCHED ); ffc09280: 38 80 00 02 li r4,2 ffc09284: 38 61 00 0c addi r3,r1,12 ffc09288: 48 00 81 21 bl ffc113a8 (void) pthread_attr_setstacksize(&attr, user_threads[ index ].stack_size); ffc0928c: 80 9f 00 04 lwz r4,4(r31) ffc09290: 38 61 00 0c addi r3,r1,12 ffc09294: 48 00 81 49 bl ffc113dc status = pthread_create( ffc09298: 80 bf 00 00 lwz r5,0(r31) ffc0929c: 38 61 00 08 addi r3,r1,8 ffc092a0: 38 81 00 0c addi r4,r1,12 ffc092a4: 38 c0 00 00 li r6,0 ffc092a8: 4b ff fb c1 bl ffc08e68 &thread_id, &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) ffc092ac: 7c 65 1b 79 mr. r5,r3 ffc092b0: 40 82 00 30 bne- ffc092e0 <_POSIX_Threads_Initialize_user_threads_body+0xa4> * * Setting the attributes explicitly is critical, since we don't want * to inherit the idle tasks attributes. */ for ( index=0 ; index < maximum ; index++ ) { ffc092b4: 3b de 00 01 addi r30,r30,1 ffc092b8: 7f 9d f0 00 cmpw cr7,r29,r30 ffc092bc: 3b ff 00 08 addi r31,r31,8 ffc092c0: 40 9e ff b8 bne+ cr7,ffc09278 <_POSIX_Threads_Initialize_user_threads_body+0x3c><== NEVER TAKEN NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); } } ffc092c4: 80 01 00 6c lwz r0,108(r1) ffc092c8: 83 a1 00 5c lwz r29,92(r1) ffc092cc: 7c 08 03 a6 mtlr r0 ffc092d0: 83 c1 00 60 lwz r30,96(r1) ffc092d4: 83 e1 00 64 lwz r31,100(r1) ffc092d8: 38 21 00 68 addi r1,r1,104 ffc092dc: 4e 80 00 20 blr &attr, user_threads[ index ].thread_entry, NULL ); if ( status ) _Internal_error_Occurred( INTERNAL_ERROR_POSIX_API, true, status ); ffc092e0: 38 60 00 02 li r3,2 ffc092e4: 38 80 00 01 li r4,1 ffc092e8: 48 00 29 6d bl ffc0bc54 <_Internal_error_Occurred> =============================================================================== ffc103a8 <_POSIX_Threads_Sporadic_budget_TSR>: */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { ffc103a8: 94 21 ff f0 stwu r1,-16(r1) ffc103ac: 7c 08 02 a6 mflr r0 ffc103b0: 90 01 00 14 stw r0,20(r1) ffc103b4: 93 e1 00 0c stw r31,12(r1) Thread_Control *the_thread; POSIX_API_Control *api; the_thread = argument; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc103b8: 83 e4 01 34 lwz r31,308(r4) */ void _POSIX_Threads_Sporadic_budget_TSR( Objects_Id id __attribute__((unused)), void *argument ) { ffc103bc: 93 c1 00 08 stw r30,8(r1) ffc103c0: 7c 9e 23 78 mr r30,r4 the_thread = argument; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); ffc103c4: 38 7f 00 98 addi r3,r31,152 ffc103c8: 48 00 12 7d bl ffc11644 <_Timespec_To_ticks> */ #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 ) { ffc103cc: 80 1e 00 1c lwz r0,28(r30) RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); ffc103d0: 3d 20 00 00 lis r9,0 ffc103d4: 2f 80 00 00 cmpwi cr7,r0,0 ffc103d8: 88 89 27 24 lbz r4,10020(r9) ffc103dc: 80 1f 00 88 lwz r0,136(r31) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_init_budget ); the_thread->cpu_time_budget = ticks; ffc103e0: 90 7e 00 78 stw r3,120(r30) ffc103e4: 7c 80 20 50 subf r4,r0,r4 new_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); the_thread->real_priority = new_priority; ffc103e8: 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 ) { ffc103ec: 40 9e 00 10 bne- cr7,ffc103fc <_POSIX_Threads_Sporadic_budget_TSR+0x54><== NEVER TAKEN /* * If this would make them less important, then do not change it. */ if ( the_thread->current_priority > new_priority ) { ffc103f0: 80 1e 00 14 lwz r0,20(r30) ffc103f4: 7f 80 20 40 cmplw cr7,r0,r4 ffc103f8: 41 9d 00 38 bgt- cr7,ffc10430 <_POSIX_Threads_Sporadic_budget_TSR+0x88> #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); ffc103fc: 38 7f 00 90 addi r3,r31,144 ffc10400: 48 00 12 45 bl ffc11644 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc10404: 38 9f 00 a8 addi r4,r31,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc10408: 90 7f 00 b4 stw r3,180(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc1040c: 3c 60 00 00 lis r3,0 ffc10410: 38 63 2d 68 addi r3,r3,11624 ffc10414: 4b ff d3 15 bl ffc0d728 <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } ffc10418: 80 01 00 14 lwz r0,20(r1) ffc1041c: 83 c1 00 08 lwz r30,8(r1) ffc10420: 7c 08 03 a6 mtlr r0 ffc10424: 83 e1 00 0c lwz r31,12(r1) ffc10428: 38 21 00 10 addi r1,r1,16 ffc1042c: 4e 80 00 20 blr if ( the_thread->resource_count == 0 ) { /* * If this would make them less important, then do not change it. */ if ( the_thread->current_priority > new_priority ) { _Thread_Change_priority( the_thread, new_priority, true ); ffc10430: 7f c3 f3 78 mr r3,r30 ffc10434: 38 a0 00 01 li r5,1 ffc10438: 4b ff b9 c1 bl ffc0bdf8 <_Thread_Change_priority> #endif } } /* ticks is guaranteed to be at least one */ ticks = _Timespec_To_ticks( &api->schedparam.sched_ss_repl_period ); ffc1043c: 38 7f 00 90 addi r3,r31,144 ffc10440: 48 00 12 05 bl ffc11644 <_Timespec_To_ticks> ffc10444: 38 9f 00 a8 addi r4,r31,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc10448: 90 7f 00 b4 stw r3,180(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc1044c: 3c 60 00 00 lis r3,0 ffc10450: 38 63 2d 68 addi r3,r3,11624 ffc10454: 4b ff d2 d5 bl ffc0d728 <_Watchdog_Insert> _Watchdog_Insert_ticks( &api->Sporadic_timer, ticks ); } ffc10458: 80 01 00 14 lwz r0,20(r1) ffc1045c: 83 c1 00 08 lwz r30,8(r1) ffc10460: 7c 08 03 a6 mtlr r0 ffc10464: 83 e1 00 0c lwz r31,12(r1) ffc10468: 38 21 00 10 addi r1,r1,16 ffc1046c: 4e 80 00 20 blr =============================================================================== ffc10470 <_POSIX_Threads_Sporadic_budget_callout>: * _POSIX_Threads_Sporadic_budget_callout */ void _POSIX_Threads_Sporadic_budget_callout( Thread_Control *the_thread ) { ffc10470: 7c 08 02 a6 mflr r0 ffc10474: 94 21 ff f8 stwu r1,-8(r1) ffc10478: 90 01 00 0c stw r0,12(r1) */ #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 ) { ffc1047c: 80 03 00 1c lwz r0,28(r3) ) { POSIX_API_Control *api; uint32_t new_priority; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc10480: 81 63 01 34 lwz r11,308(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 ) { ffc10484: 2f 80 00 00 cmpwi cr7,r0,0 ffc10488: 80 0b 00 8c lwz r0,140(r11) ffc1048c: 3d 60 00 00 lis r11,0 ffc10490: 88 8b 27 24 lbz r4,10020(r11) ffc10494: 7c 80 20 50 subf r4,r0,r4 /* * 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 */ ffc10498: 38 00 ff ff li r0,-1 new_priority = _POSIX_Priority_To_core(api->schedparam.sched_ss_low_priority); the_thread->real_priority = new_priority; ffc1049c: 90 83 00 18 stw r4,24(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 */ ffc104a0: 90 03 00 78 stw r0,120(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 ) { ffc104a4: 40 9e 00 10 bne- cr7,ffc104b4 <_POSIX_Threads_Sporadic_budget_callout+0x44><== NEVER TAKEN /* * Make sure we are actually lowering it. If they have lowered it * to logically lower than sched_ss_low_priority, then we do not want to * change it. */ if ( the_thread->current_priority < new_priority ) { ffc104a8: 80 03 00 14 lwz r0,20(r3) ffc104ac: 7f 80 20 40 cmplw cr7,r0,r4 ffc104b0: 41 9c 00 14 blt- cr7,ffc104c4 <_POSIX_Threads_Sporadic_budget_callout+0x54><== ALWAYS TAKEN #if 0 printk( "lower priority\n" ); #endif } } } ffc104b4: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc104b8: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc104bc: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc104c0: 4e 80 00 20 blr <== NOT EXECUTED * 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 ) { _Thread_Change_priority( the_thread, new_priority, true ); ffc104c4: 38 a0 00 01 li r5,1 ffc104c8: 4b ff b9 31 bl ffc0bdf8 <_Thread_Change_priority> #if 0 printk( "lower priority\n" ); #endif } } } ffc104cc: 80 01 00 0c lwz r0,12(r1) ffc104d0: 38 21 00 08 addi r1,r1,8 ffc104d4: 7c 08 03 a6 mtlr r0 ffc104d8: 4e 80 00 20 blr =============================================================================== ffc13078 <_POSIX_Threads_cancel_run>: #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { ffc13078: 94 21 ff e8 stwu r1,-24(r1) ffc1307c: 7c 08 02 a6 mflr r0 ffc13080: 90 01 00 1c stw r0,28(r1) ffc13084: 93 c1 00 10 stw r30,16(r1) POSIX_Cancel_Handler_control *handler; Chain_Control *handler_stack; POSIX_API_Control *thread_support; ISR_Level level; thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc13088: 83 c3 01 34 lwz r30,308(r3) #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { ffc1308c: 93 a1 00 0c stw r29,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 ); ffc13090: 3b be 00 e8 addi r29,r30,232 handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { ffc13094: 80 1e 00 e4 lwz r0,228(r30) #include void _POSIX_Threads_cancel_run( Thread_Control *the_thread ) { ffc13098: 93 e1 00 14 stw r31,20(r1) handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { ffc1309c: 7f 80 e8 00 cmpw cr7,r0,r29 thread_support = the_thread->API_Extensions[ THREAD_API_POSIX ]; handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; ffc130a0: 38 00 00 01 li r0,1 ffc130a4: 90 1e 00 d8 stw r0,216(r30) while ( !_Chain_Is_empty( handler_stack ) ) { ffc130a8: 41 9e 00 50 beq- cr7,ffc130f8 <_POSIX_Threads_cancel_run+0x80> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc130ac: 7c 00 00 a6 mfmsr r0 ffc130b0: 7d 30 42 a6 mfsprg r9,0 ffc130b4: 7c 09 48 78 andc r9,r0,r9 ffc130b8: 7d 20 01 24 mtmsr r9 _ISR_Disable( level ); handler = (POSIX_Cancel_Handler_control *) ffc130bc: 83 fe 00 ec lwz r31,236(r30) ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc130c0: 81 7f 00 00 lwz r11,0(r31) previous = the_node->previous; ffc130c4: 81 3f 00 04 lwz r9,4(r31) next->previous = previous; ffc130c8: 91 2b 00 04 stw r9,4(r11) previous->next = next; ffc130cc: 91 69 00 00 stw r11,0(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc130d0: 7c 00 01 24 mtmsr r0 _Chain_Tail( handler_stack )->previous; _Chain_Extract_unprotected( &handler->Node ); _ISR_Enable( level ); (*handler->routine)( handler->arg ); ffc130d4: 80 1f 00 08 lwz r0,8(r31) ffc130d8: 80 7f 00 0c lwz r3,12(r31) ffc130dc: 7c 09 03 a6 mtctr r0 ffc130e0: 4e 80 04 21 bctrl _Workspace_Free( handler ); ffc130e4: 7f e3 fb 78 mr r3,r31 ffc130e8: 4b ff aa 69 bl ffc0db50 <_Workspace_Free> handler_stack = &thread_support->Cancellation_Handlers; thread_support->cancelability_state = PTHREAD_CANCEL_DISABLE; while ( !_Chain_Is_empty( handler_stack ) ) { ffc130ec: 80 1e 00 e4 lwz r0,228(r30) ffc130f0: 7f 80 e8 00 cmpw cr7,r0,r29 ffc130f4: 40 9e ff b8 bne+ cr7,ffc130ac <_POSIX_Threads_cancel_run+0x34><== NEVER TAKEN (*handler->routine)( handler->arg ); _Workspace_Free( handler ); } } ffc130f8: 80 01 00 1c lwz r0,28(r1) ffc130fc: 83 a1 00 0c lwz r29,12(r1) ffc13100: 7c 08 03 a6 mtlr r0 ffc13104: 83 c1 00 10 lwz r30,16(r1) ffc13108: 83 e1 00 14 lwz r31,20(r1) ffc1310c: 38 21 00 18 addi r1,r1,24 ffc13110: 4e 80 00 20 blr =============================================================================== ffc0903c <_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) { ffc0903c: 94 21 ff f0 stwu r1,-16(r1) ffc09040: 7c 08 02 a6 mflr r0 ffc09044: 90 01 00 14 stw r0,20(r1) /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc09048: 80 04 00 54 lwz r0,84(r4) bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; ffc0904c: 81 24 00 68 lwz r9,104(r4) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc09050: 2f 80 00 00 cmpwi cr7,r0,0 * This is the operation that is run when a timer expires */ void _POSIX_Timer_TSR( Objects_Id timer __attribute__((unused)), void *data) { ffc09054: 93 e1 00 0c stw r31,12(r1) bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; ffc09058: 38 09 00 01 addi r0,r9,1 * This is the operation that is run when a timer expires */ void _POSIX_Timer_TSR( Objects_Id timer __attribute__((unused)), void *data) { ffc0905c: 7c 9f 23 78 mr r31,r4 bool activated; ptimer = (POSIX_Timer_Control *)data; /* Increment the number of expirations. */ ptimer->overrun = ptimer->overrun + 1; ffc09060: 90 04 00 68 stw r0,104(r4) /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ffc09064: 40 9e 00 40 bne- cr7,ffc090a4 <_POSIX_Timer_TSR+0x68> ffc09068: 80 04 00 58 lwz r0,88(r4) ffc0906c: 2f 80 00 00 cmpwi cr7,r0,0 ffc09070: 40 9e 00 34 bne- cr7,ffc090a4 <_POSIX_Timer_TSR+0x68> <== ALWAYS TAKEN /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; } else { /* Indicates that the timer is stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; ffc09074: 38 00 00 04 li r0,4 <== NOT EXECUTED ffc09078: 98 04 00 3c stb r0,60(r4) <== NOT EXECUTED /* * The sending of the signal to the process running the handling function * specified for that signal is simulated */ if ( pthread_kill ( ptimer->thread_id, ptimer->inf.sigev_signo ) ) { ffc0907c: 80 7f 00 38 lwz r3,56(r31) ffc09080: 80 9f 00 44 lwz r4,68(r31) ffc09084: 48 00 79 0d bl ffc10990 } /* After the signal handler returns, the count of expirations of the * timer must be set to 0. */ ptimer->overrun = 0; ffc09088: 38 00 00 00 li r0,0 ffc0908c: 90 1f 00 68 stw r0,104(r31) } ffc09090: 80 01 00 14 lwz r0,20(r1) ffc09094: 83 e1 00 0c lwz r31,12(r1) ffc09098: 38 21 00 10 addi r1,r1,16 ffc0909c: 7c 08 03 a6 mtlr r0 ffc090a0: 4e 80 00 20 blr ptimer->overrun = ptimer->overrun + 1; /* The timer must be reprogrammed */ if ( ( ptimer->timer_data.it_interval.tv_sec != 0 ) || ( ptimer->timer_data.it_interval.tv_nsec != 0 ) ) { activated = _POSIX_Timer_Insert_helper( ffc090a4: 80 9f 00 64 lwz r4,100(r31) ffc090a8: 3c c0 ff c1 lis r6,-63 ffc090ac: 80 bf 00 08 lwz r5,8(r31) ffc090b0: 38 7f 00 10 addi r3,r31,16 ffc090b4: 38 c6 90 3c addi r6,r6,-28612 ffc090b8: 7f e7 fb 78 mr r7,r31 ffc090bc: 48 00 7e e1 bl ffc10f9c <_POSIX_Timer_Insert_helper> ptimer->ticks, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) ffc090c0: 2f 83 00 00 cmpwi cr7,r3,0 ffc090c4: 41 9e ff cc beq+ cr7,ffc09090 <_POSIX_Timer_TSR+0x54> <== NEVER TAKEN return; /* Store the time when the timer was started again */ _TOD_Get( &ptimer->time ); ffc090c8: 38 7f 00 6c addi r3,r31,108 ffc090cc: 48 00 1d c1 bl ffc0ae8c <_TOD_Get> /* The state really did not change but just to be safe */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc090d0: 38 00 00 03 li r0,3 ffc090d4: 98 1f 00 3c stb r0,60(r31) ffc090d8: 4b ff ff a4 b ffc0907c <_POSIX_Timer_TSR+0x40> =============================================================================== ffc131f4 <_POSIX_signals_Check_signal>: bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc131f4: 94 21 ff 98 stwu r1,-104(r1) ffc131f8: 7c 08 02 a6 mflr r0 ffc131fc: 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, ffc13200: 38 e0 00 01 li r7,1 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc13204: 93 c1 00 60 stw r30,96(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, ffc13208: 38 a1 00 08 addi r5,r1,8 bool _POSIX_signals_Check_signal( POSIX_API_Control *api, int signo, bool is_global ) { ffc1320c: 93 e1 00 64 stw r31,100(r1) ffc13210: 7c 9e 23 78 mr r30,r4 ffc13214: 7c 7f 1b 78 mr r31,r3 ffc13218: 90 01 00 6c stw r0,108(r1) ffc1321c: 93 21 00 4c stw r25,76(r1) ffc13220: 93 41 00 50 stw r26,80(r1) ffc13224: 93 61 00 54 stw r27,84(r1) ffc13228: 93 81 00 58 stw r28,88(r1) ffc1322c: 93 a1 00 5c stw r29,92(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, ffc13230: 48 00 00 cd bl ffc132fc <_POSIX_signals_Clear_signals> ffc13234: 2f 83 00 00 cmpwi cr7,r3,0 is_global, true ) ) return false; ffc13238: 38 60 00 00 li r3,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, ffc1323c: 41 9e 00 80 beq- cr7,ffc132bc <_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 ) ffc13240: 1f 9e 00 0c mulli r28,r30,12 ffc13244: 3f 60 00 00 lis r27,0 ffc13248: 3b 7b 31 c0 addi r27,r27,12736 ffc1324c: 7d 3b e2 14 add r9,r27,r28 ffc13250: 83 a9 00 08 lwz r29,8(r9) ffc13254: 2f 9d 00 01 cmpwi cr7,r29,1 ffc13258: 41 9e 00 64 beq- cr7,ffc132bc <_POSIX_signals_Check_signal+0xc8><== NEVER TAKEN return false; /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; ffc1325c: 83 5f 00 d0 lwz r26,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, ffc13260: 3f 20 00 00 lis r25,0 /* * Block the signals requested in sa_mask */ saved_signals_blocked = api->signals_blocked; api->signals_blocked |= _POSIX_signals_Vectors[ signo ].sa_mask; ffc13264: 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, ffc13268: 3b 39 31 44 addi r25,r25,12612 ffc1326c: 80 99 00 0c lwz r4,12(r25) ffc13270: 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; ffc13274: 7c 00 d3 78 or r0,r0,r26 ffc13278: 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, ffc1327c: 38 84 00 20 addi r4,r4,32 ffc13280: 38 a0 00 28 li r5,40 ffc13284: 48 00 16 ad bl ffc14930 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { ffc13288: 7c 1b e0 2e lwzx r0,r27,r28 case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( ffc1328c: 7f c3 f3 78 mr r3,r30 sizeof( Thread_Wait_information )); /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { ffc13290: 2f 80 00 02 cmpwi cr7,r0,2 ffc13294: 41 9e 00 54 beq- cr7,ffc132e8 <_POSIX_signals_Check_signal+0xf4> &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; default: (*_POSIX_signals_Vectors[ signo ].sa_handler)( signo ); ffc13298: 7f a9 03 a6 mtctr r29 ffc1329c: 4e 80 04 21 bctrl } /* * Restore the blocking information */ memcpy( &_Thread_Executing->Wait, &stored_thread_wait_information, ffc132a0: 80 79 00 0c lwz r3,12(r25) ffc132a4: 38 81 00 14 addi r4,r1,20 ffc132a8: 38 a0 00 28 li r5,40 ffc132ac: 38 63 00 20 addi r3,r3,32 ffc132b0: 48 00 16 81 bl ffc14930 sizeof( Thread_Wait_information )); /* * Restore the previous set of blocked signals */ api->signals_blocked = saved_signals_blocked; ffc132b4: 93 5f 00 d0 stw r26,208(r31) return true; ffc132b8: 38 60 00 01 li r3,1 } ffc132bc: 80 01 00 6c lwz r0,108(r1) ffc132c0: 83 21 00 4c lwz r25,76(r1) ffc132c4: 7c 08 03 a6 mtlr r0 ffc132c8: 83 41 00 50 lwz r26,80(r1) ffc132cc: 83 61 00 54 lwz r27,84(r1) ffc132d0: 83 81 00 58 lwz r28,88(r1) ffc132d4: 83 a1 00 5c lwz r29,92(r1) ffc132d8: 83 c1 00 60 lwz r30,96(r1) ffc132dc: 83 e1 00 64 lwz r31,100(r1) ffc132e0: 38 21 00 68 addi r1,r1,104 ffc132e4: 4e 80 00 20 blr /* * Here, the signal handler function executes */ switch ( _POSIX_signals_Vectors[ signo ].sa_flags ) { case SA_SIGINFO: (*_POSIX_signals_Vectors[ signo ].sa_sigaction)( ffc132e8: 38 81 00 08 addi r4,r1,8 ffc132ec: 7f a9 03 a6 mtctr r29 ffc132f0: 38 a0 00 00 li r5,0 ffc132f4: 4e 80 04 21 bctrl signo, &siginfo_struct, NULL /* context is undefined per 1003.1b-1993, p. 66 */ ); break; ffc132f8: 4b ff ff a8 b ffc132a0 <_POSIX_signals_Check_signal+0xac> =============================================================================== ffc13b68 <_POSIX_signals_Clear_process_signals>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc13b68: 7d 60 00 a6 mfmsr r11 ffc13b6c: 7c 10 42 a6 mfsprg r0,0 ffc13b70: 7d 60 00 78 andc r0,r11,r0 ffc13b74: 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 ) { ffc13b78: 3d 20 00 00 lis r9,0 ffc13b7c: 1c 03 00 0c mulli r0,r3,12 ffc13b80: 39 29 31 c0 addi r9,r9,12736 ffc13b84: 7d 29 00 2e lwzx r9,r9,r0 ffc13b88: 2f 89 00 02 cmpwi cr7,r9,2 ffc13b8c: 41 9e 00 28 beq- cr7,ffc13bb4 <_POSIX_signals_Clear_process_signals+0x4c> if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) clear_signal = false; } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; ffc13b90: 3d 20 00 00 lis r9,0 ffc13b94: 80 09 28 50 lwz r0,10320(r9) ffc13b98: 39 40 ff fe li r10,-2 ffc13b9c: 38 63 ff ff addi r3,r3,-1 ffc13ba0: 5d 43 18 3e rotlw r3,r10,r3 ffc13ba4: 7c 63 00 38 and r3,r3,r0 ffc13ba8: 90 69 28 50 stw r3,10320(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc13bac: 7d 60 01 24 mtmsr r11 } _ISR_Enable( level ); } ffc13bb0: 4e 80 00 20 blr ISR_Level level; _ISR_Disable( level ); if ( _POSIX_signals_Vectors[ signo ].sa_flags == SA_SIGINFO ) { if ( !_Chain_Is_empty( &_POSIX_signals_Siginfo[ signo ] ) ) ffc13bb4: 3d 20 00 00 lis r9,0 ffc13bb8: 39 29 33 b4 addi r9,r9,13236 ffc13bbc: 7d 40 4a 14 add r10,r0,r9 ffc13bc0: 7d 29 00 2e lwzx r9,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 ); ffc13bc4: 38 0a 00 04 addi r0,r10,4 ffc13bc8: 7f 89 00 00 cmpw cr7,r9,r0 ffc13bcc: 41 be ff c4 beq- cr7,ffc13b90 <_POSIX_signals_Clear_process_signals+0x28><== ALWAYS TAKEN ffc13bd0: 7d 60 01 24 mtmsr r11 <== NOT EXECUTED } if ( clear_signal ) { _POSIX_signals_Pending &= ~mask; } _ISR_Enable( level ); } ffc13bd4: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc09c70 <_POSIX_signals_Get_lowest>: ffc09c70: 38 00 00 05 li r0,5 ffc09c74: 7c 09 03 a6 mtctr r0 sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc09c78: 39 20 00 1b li r9,27 ffc09c7c: 39 60 00 01 li r11,1 #include #include #include #include int _POSIX_signals_Get_lowest( ffc09c80: 38 09 ff ff addi r0,r9,-1 ffc09c84: 7d 60 00 30 slw r0,r11,r0 ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { if ( set & signo_to_mask( signo ) ) { ffc09c88: 7c 0a 18 39 and. r10,r0,r3 ffc09c8c: 40 82 00 38 bne- ffc09cc4 <_POSIX_signals_Get_lowest+0x54><== NEVER TAKEN sigset_t set ) { int signo; for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc09c90: 39 29 00 01 addi r9,r9,1 ffc09c94: 42 00 ff ec bdnz+ ffc09c80 <_POSIX_signals_Get_lowest+0x10> ffc09c98: 38 00 00 1a li r0,26 ffc09c9c: 39 20 00 01 li r9,1 ffc09ca0: 7c 09 03 a6 mtctr r0 ffc09ca4: 39 60 00 01 li r11,1 ffc09ca8: 48 00 00 0c b ffc09cb4 <_POSIX_signals_Get_lowest+0x44> */ #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { ffc09cac: 39 29 00 01 addi r9,r9,1 ffc09cb0: 42 40 00 14 bdz- ffc09cc4 <_POSIX_signals_Get_lowest+0x54> #include #include #include #include int _POSIX_signals_Get_lowest( ffc09cb4: 38 09 ff ff addi r0,r9,-1 ffc09cb8: 7d 60 00 30 slw r0,r11,r0 #if (SIGHUP != 1) #error "Assumption that SIGHUP==1 violated!!" #endif for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { if ( set & signo_to_mask( signo ) ) { ffc09cbc: 7c 0a 18 39 and. r10,r0,r3 ffc09cc0: 41 82 ff ec beq+ ffc09cac <_POSIX_signals_Get_lowest+0x3c> * a return 0. This routine will NOT be called unless a signal * is pending in the set passed in. */ found_it: return signo; } ffc09cc4: 7d 23 4b 78 mr r3,r9 ffc09cc8: 4e 80 00 20 blr =============================================================================== ffc0fea0 <_POSIX_signals_Post_switch_extension>: */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0fea0: 94 21 ff e8 stwu r1,-24(r1) ffc0fea4: 7c 08 02 a6 mflr r0 ffc0fea8: 90 01 00 1c stw r0,28(r1) ffc0feac: 93 c1 00 10 stw r30,16(r1) POSIX_API_Control *api; int signo; ISR_Level level; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0feb0: 83 c3 01 34 lwz r30,308(r3) */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0feb4: 93 a1 00 0c stw r29,12(r1) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; /* * api may be NULL in case of a thread close in progress */ if ( !api ) ffc0feb8: 2f 9e 00 00 cmpwi cr7,r30,0 */ void _POSIX_signals_Post_switch_extension( Thread_Control *the_thread ) { ffc0febc: 93 e1 00 14 stw r31,20(r1) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; /* * api may be NULL in case of a thread close in progress */ if ( !api ) ffc0fec0: 41 9e 00 c4 beq- cr7,ffc0ff84 <_POSIX_signals_Post_switch_extension+0xe4> ffc0fec4: 3f a0 00 00 lis r29,0 ffc0fec8: 3b bd 28 50 addi r29,r29,10320 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0fecc: 7c 00 00 a6 mfmsr r0 ffc0fed0: 7d 30 42 a6 mfsprg r9,0 ffc0fed4: 7c 09 48 78 andc r9,r0,r9 ffc0fed8: 7d 20 01 24 mtmsr r9 * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0fedc: 81 5d 00 00 lwz r10,0(r29) ffc0fee0: 81 3e 00 d4 lwz r9,212(r30) * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & ffc0fee4: 81 7e 00 d0 lwz r11,208(r30) (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0fee8: 7d 49 4b 78 or r9,r10,r9 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0feec: 7c 00 01 24 mtmsr r0 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & ffc0fef0: 7d 2a 58 79 andc. r10,r9,r11 ffc0fef4: 41 82 00 90 beq- ffc0ff84 <_POSIX_signals_Post_switch_extension+0xe4> _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc0fef8: 3b e0 00 1b li r31,27 _POSIX_signals_Check_signal( api, signo, false ); ffc0fefc: 7f e4 fb 78 mr r4,r31 ffc0ff00: 38 a0 00 00 li r5,0 ffc0ff04: 7f c3 f3 78 mr r3,r30 ffc0ff08: 48 00 32 ed bl ffc131f4 <_POSIX_signals_Check_signal> _POSIX_signals_Check_signal( api, signo, true ); ffc0ff0c: 7f e4 fb 78 mr r4,r31 ffc0ff10: 7f c3 f3 78 mr r3,r30 ffc0ff14: 38 a0 00 01 li r5,1 ffc0ff18: 48 00 32 dd bl ffc131f4 <_POSIX_signals_Check_signal> _ISR_Enable( level ); break; } _ISR_Enable( level ); for ( signo = SIGRTMIN ; signo <= SIGRTMAX ; signo++ ) { ffc0ff1c: 2f 9f 00 1f cmpwi cr7,r31,31 ffc0ff20: 3b ff 00 01 addi r31,r31,1 ffc0ff24: 40 9e ff d8 bne+ cr7,ffc0fefc <_POSIX_signals_Post_switch_extension+0x5c> ffc0ff28: 3b e0 00 01 li r31,1 _POSIX_signals_Check_signal( api, signo, true ); } /* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */ for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); ffc0ff2c: 7f e4 fb 78 mr r4,r31 ffc0ff30: 38 a0 00 00 li r5,0 ffc0ff34: 7f c3 f3 78 mr r3,r30 ffc0ff38: 48 00 32 bd bl ffc131f4 <_POSIX_signals_Check_signal> _POSIX_signals_Check_signal( api, signo, true ); ffc0ff3c: 7f e4 fb 78 mr r4,r31 ffc0ff40: 7f c3 f3 78 mr r3,r30 ffc0ff44: 38 a0 00 01 li r5,1 ffc0ff48: 48 00 32 ad bl ffc131f4 <_POSIX_signals_Check_signal> _POSIX_signals_Check_signal( api, signo, false ); _POSIX_signals_Check_signal( api, signo, true ); } /* Unfortunately - nothing like __SIGFIRSTNOTRT in newlib signal .h */ for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { ffc0ff4c: 2f 9f 00 1a cmpwi cr7,r31,26 ffc0ff50: 3b ff 00 01 addi r31,r31,1 ffc0ff54: 40 9e ff d8 bne+ cr7,ffc0ff2c <_POSIX_signals_Post_switch_extension+0x8c> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0ff58: 7c 00 00 a6 mfmsr r0 ffc0ff5c: 7d 30 42 a6 mfsprg r9,0 ffc0ff60: 7c 09 48 78 andc r9,r0,r9 ffc0ff64: 7d 20 01 24 mtmsr r9 * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0ff68: 81 5d 00 00 lwz r10,0(r29) ffc0ff6c: 81 3e 00 d4 lwz r9,212(r30) * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & ffc0ff70: 81 7e 00 d0 lwz r11,208(r30) (api->signals_pending | _POSIX_signals_Pending)) ) { ffc0ff74: 7d 49 4b 78 or r9,r10,r9 return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0ff78: 7c 00 01 24 mtmsr r0 * The first thing done is to check there are any signals to be * processed at all. No point in doing this loop otherwise. */ while (1) { _ISR_Disable( level ); if ( !(~api->signals_blocked & ffc0ff7c: 7d 2a 58 79 andc. r10,r9,r11 ffc0ff80: 40 82 ff 78 bne+ ffc0fef8 <_POSIX_signals_Post_switch_extension+0x58><== NEVER TAKEN for ( signo = SIGHUP ; signo <= __SIGLASTNOTRT ; signo++ ) { _POSIX_signals_Check_signal( api, signo, false ); _POSIX_signals_Check_signal( api, signo, true ); } } } ffc0ff84: 80 01 00 1c lwz r0,28(r1) ffc0ff88: 83 a1 00 0c lwz r29,12(r1) ffc0ff8c: 7c 08 03 a6 mtlr r0 ffc0ff90: 83 c1 00 10 lwz r30,16(r1) ffc0ff94: 83 e1 00 14 lwz r31,20(r1) ffc0ff98: 38 21 00 18 addi r1,r1,24 ffc0ff9c: 4e 80 00 20 blr =============================================================================== ffc1f118 <_POSIX_signals_Unblock_thread>: bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1f118: 94 21 ff f0 stwu r1,-16(r1) ffc1f11c: 7c 08 02 a6 mflr r0 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc1f120: 3d 20 10 00 lis r9,4096 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1f124: 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 ) ) { ffc1f128: 61 29 80 00 ori r9,r9,32768 ffc1f12c: 80 03 00 10 lwz r0,16(r3) bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1f130: 93 e1 00 0c stw r31,12(r1) ffc1f134: 7c 7f 1b 78 mr r31,r3 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc1f138: 7c 0b 48 38 and r11,r0,r9 ffc1f13c: 7f 8b 48 00 cmpw cr7,r11,r9 bool _POSIX_signals_Unblock_thread( Thread_Control *the_thread, int signo, siginfo_t *info ) { ffc1f140: 93 c1 00 08 stw r30,8(r1) ffc1f144: 39 64 ff ff addi r11,r4,-1 ffc1f148: 39 20 00 01 li r9,1 POSIX_API_Control *api; sigset_t mask; siginfo_t *the_info = NULL; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc1f14c: 81 43 01 34 lwz r10,308(r3) ffc1f150: 7d 2b 58 30 slw r11,r9,r11 /* * Is the thread is specifically waiting for a signal? */ if ( _States_Is_interruptible_signal( the_thread->current_state ) ) { ffc1f154: 41 9e 00 70 beq- cr7,ffc1f1c4 <_POSIX_signals_Unblock_thread+0xac> } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc1f158: 81 4a 00 d0 lwz r10,208(r10) } else if ( the_thread->current_state == STATES_READY ) { if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; ffc1f15c: 3b c0 00 00 li r30,0 } /* * Thread is not waiting due to a sigwait. */ if ( ~api->signals_blocked & mask ) { ffc1f160: 7d 68 50 79 andc. r8,r11,r10 ffc1f164: 41 82 00 44 beq- ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90> * 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 ) ) { ffc1f168: 74 0b 10 00 andis. r11,r0,4096 ffc1f16c: 41 82 00 b8 beq- ffc1f224 <_POSIX_signals_Unblock_thread+0x10c> */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); ffc1f170: 3d 20 00 03 lis r9,3 ffc1f174: 61 29 be e0 ori r9,r9,48864 the_thread->Wait.return_code = EINTR; /* * 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) ) ffc1f178: 7c 08 48 39 and. r8,r0,r9 * 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 ) ) { the_thread->Wait.return_code = EINTR; ffc1f17c: 39 20 00 04 li r9,4 ffc1f180: 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) ) ffc1f184: 40 82 00 e4 bne- ffc1f268 <_POSIX_signals_Unblock_thread+0x150> _Thread_queue_Extract_with_proxy( the_thread ); else if ( _States_Is_delaying(the_thread->current_state) ) { ffc1f188: 70 09 00 08 andi. r9,r0,8 ffc1f18c: 41 a2 00 1c beq+ ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN (void) _Watchdog_Remove( &the_thread->Timer ); ffc1f190: 38 63 00 48 addi r3,r3,72 ffc1f194: 4b fe e7 5d bl ffc0d8f0 <_Watchdog_Remove> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc1f198: 3c 80 10 03 lis r4,4099 ffc1f19c: 7f e3 fb 78 mr r3,r31 ffc1f1a0: 60 84 ff f8 ori r4,r4,65528 ffc1f1a4: 4b fe cd f1 bl ffc0bf94 <_Thread_Clear_state> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc1f1a8: 80 01 00 14 lwz r0,20(r1) ffc1f1ac: 7f c3 f3 78 mr r3,r30 ffc1f1b0: 83 e1 00 0c lwz r31,12(r1) ffc1f1b4: 7c 08 03 a6 mtlr r0 ffc1f1b8: 83 c1 00 08 lwz r30,8(r1) ffc1f1bc: 38 21 00 10 addi r1,r1,16 ffc1f1c0: 4e 80 00 20 blr * 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) ) { ffc1f1c4: 80 03 00 30 lwz r0,48(r3) ffc1f1c8: 7d 68 00 39 and. r8,r11,r0 ffc1f1cc: 41 82 00 88 beq- ffc1f254 <_POSIX_signals_Unblock_thread+0x13c> the_thread->Wait.return_code = EINTR; the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc1f1d0: 2f 85 00 00 cmpwi cr7,r5,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; ffc1f1d4: 81 3f 00 28 lwz r9,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; ffc1f1d8: 38 00 00 04 li r0,4 ffc1f1dc: 90 1f 00 34 stw r0,52(r31) the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { ffc1f1e0: 41 9e 00 90 beq- cr7,ffc1f270 <_POSIX_signals_Unblock_thread+0x158> the_info->si_signo = signo; the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; } else { *the_info = *info; ffc1f1e4: 81 45 00 00 lwz r10,0(r5) ffc1f1e8: 81 65 00 04 lwz r11,4(r5) ffc1f1ec: 80 05 00 08 lwz r0,8(r5) ffc1f1f0: 91 49 00 00 stw r10,0(r9) ffc1f1f4: 91 69 00 04 stw r11,4(r9) ffc1f1f8: 90 09 00 08 stw r0,8(r9) } _Thread_queue_Extract_with_proxy( the_thread ); ffc1f1fc: 7f e3 fb 78 mr r3,r31 ffc1f200: 4b fe da f5 bl ffc0ccf4 <_Thread_queue_Extract_with_proxy> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc1f204: 80 01 00 14 lwz r0,20(r1) } else { *the_info = *info; } _Thread_queue_Extract_with_proxy( the_thread ); return true; ffc1f208: 3b c0 00 01 li r30,1 if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; } } return false; } ffc1f20c: 83 e1 00 0c lwz r31,12(r1) ffc1f210: 7c 08 03 a6 mtlr r0 ffc1f214: 7f c3 f3 78 mr r3,r30 ffc1f218: 83 c1 00 08 lwz r30,8(r1) ffc1f21c: 38 21 00 10 addi r1,r1,16 ffc1f220: 4e 80 00 20 blr else if ( _States_Is_delaying(the_thread->current_state) ) { (void) _Watchdog_Remove( &the_thread->Timer ); _Thread_Unblock( the_thread ); } } else if ( the_thread->current_state == STATES_READY ) { ffc1f224: 2f 80 00 00 cmpwi cr7,r0,0 ffc1f228: 40 be ff 80 bne- cr7,ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc1f22c: 3d 60 00 00 lis r11,0 ffc1f230: 39 6b 31 44 addi r11,r11,12612 ffc1f234: 80 0b 00 08 lwz r0,8(r11) ffc1f238: 2f 80 00 00 cmpwi cr7,r0,0 ffc1f23c: 41 be ff 6c beq- cr7,ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90> ffc1f240: 80 0b 00 0c lwz r0,12(r11) ffc1f244: 7f 83 00 00 cmpw cr7,r3,r0 ffc1f248: 40 9e ff 60 bne+ cr7,ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90><== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc1f24c: 99 2b 00 18 stb r9,24(r11) ffc1f250: 4b ff ff 58 b ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90> * 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) ) { ffc1f254: 80 0a 00 d0 lwz r0,208(r10) /* * This should only be reached via pthread_kill(). */ return false; ffc1f258: 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) ) { ffc1f25c: 7d 69 00 79 andc. r9,r11,r0 ffc1f260: 40 82 ff 70 bne+ ffc1f1d0 <_POSIX_signals_Unblock_thread+0xb8> ffc1f264: 4b ff ff 44 b ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90> /* * In pthread_cond_wait, a thread will be blocking on a thread * queue, but is also interruptible by a POSIX signal. */ if ( _States_Is_waiting_on_thread_queue(the_thread->current_state) ) _Thread_queue_Extract_with_proxy( the_thread ); ffc1f268: 4b fe da 8d bl ffc0ccf4 <_Thread_queue_Extract_with_proxy> ffc1f26c: 4b ff ff 3c b ffc1f1a8 <_POSIX_signals_Unblock_thread+0x90> the_info = (siginfo_t *) the_thread->Wait.return_argument; if ( !info ) { the_info->si_signo = signo; the_info->si_code = SI_USER; ffc1f270: 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; ffc1f274: 90 89 00 00 stw r4,0(r9) the_info->si_code = SI_USER; ffc1f278: 90 09 00 04 stw r0,4(r9) the_info->si_value.sival_int = 0; ffc1f27c: 90 a9 00 08 stw r5,8(r9) ffc1f280: 4b ff ff 7c b ffc1f1fc <_POSIX_signals_Unblock_thread+0xe4> =============================================================================== ffc0bd6c <_RBTree_Extract_unprotected>: */ void _RBTree_Extract_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { ffc0bd6c: 94 21 ff e8 stwu r1,-24(r1) ffc0bd70: 7c 08 02 a6 mflr r0 ffc0bd74: 93 c1 00 10 stw r30,16(r1) RBTree_Node *leaf, *target; RBTree_Color victim_color; RBTree_Direction dir; if(!the_node) return; ffc0bd78: 7c 9e 23 79 mr. r30,r4 */ void _RBTree_Extract_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { ffc0bd7c: 93 81 00 08 stw r28,8(r1) ffc0bd80: 7c 7c 1b 78 mr r28,r3 ffc0bd84: 90 01 00 1c stw r0,28(r1) ffc0bd88: 93 a1 00 0c stw r29,12(r1) ffc0bd8c: 93 e1 00 14 stw r31,20(r1) RBTree_Node *leaf, *target; RBTree_Color victim_color; RBTree_Direction dir; if(!the_node) return; ffc0bd90: 41 82 01 2c beq- ffc0bebc <_RBTree_Extract_unprotected+0x150> /* check if min needs to be updated */ if (the_node == the_rbtree->first[RBT_LEFT]) { ffc0bd94: 80 03 00 08 lwz r0,8(r3) ffc0bd98: 7f 80 f0 00 cmpw cr7,r0,r30 ffc0bd9c: 41 9e 01 74 beq- cr7,ffc0bf10 <_RBTree_Extract_unprotected+0x1a4> the_rbtree->first[RBT_LEFT])) the_rbtree->first[RBT_LEFT] = NULL; } } /* check if max needs to be updated: note, min can equal max (1 element) */ if (the_node == the_rbtree->first[RBT_RIGHT]) { ffc0bda0: 80 1c 00 0c lwz r0,12(r28) ffc0bda4: 7f 80 f0 00 cmpw cr7,r0,r30 ffc0bda8: 41 9e 01 34 beq- cr7,ffc0bedc <_RBTree_Extract_unprotected+0x170> * 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]) { ffc0bdac: 83 fe 00 04 lwz r31,4(r30) ffc0bdb0: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0bdb4: 41 9e 01 44 beq- cr7,ffc0bef8 <_RBTree_Extract_unprotected+0x18c> ffc0bdb8: 80 1e 00 08 lwz r0,8(r30) ffc0bdbc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bdc0: 40 be 00 0c bne+ cr7,ffc0bdcc <_RBTree_Extract_unprotected+0x60> ffc0bdc4: 48 00 01 60 b ffc0bf24 <_RBTree_Extract_unprotected+0x1b8> target = the_node->child[RBT_LEFT]; /* find max in node->child[RBT_LEFT] */ while (target->child[RBT_RIGHT]) target = target->child[RBT_RIGHT]; ffc0bdc8: 7c 1f 03 78 mr r31,r0 ffc0bdcc: 80 1f 00 08 lwz r0,8(r31) ffc0bdd0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bdd4: 40 9e ff f4 bne+ cr7,ffc0bdc8 <_RBTree_Extract_unprotected+0x5c> * 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]; ffc0bdd8: 83 bf 00 04 lwz r29,4(r31) if(leaf) { ffc0bddc: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0bde0: 41 9e 01 b4 beq- cr7,ffc0bf94 <_RBTree_Extract_unprotected+0x228><== ALWAYS TAKEN leaf->parent = target->parent; ffc0bde4: 80 1f 00 00 lwz r0,0(r31) <== NOT EXECUTED ffc0bde8: 90 1d 00 00 stw r0,0(r29) <== NOT EXECUTED } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); } victim_color = target->color; dir = target != target->parent->child[0]; ffc0bdec: 81 7f 00 00 lwz r11,0(r31) target->parent->child[dir] = leaf; /* now replace the_node with target */ dir = the_node != the_node->parent->child[0]; ffc0bdf0: 81 3e 00 00 lwz r9,0(r30) } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); } victim_color = target->color; dir = target != target->parent->child[0]; ffc0bdf4: 80 0b 00 04 lwz r0,4(r11) 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; ffc0bdf8: 81 5f 00 10 lwz r10,16(r31) dir = target != target->parent->child[0]; ffc0bdfc: 7f e0 02 78 xor r0,r31,r0 ffc0be00: 7c 00 00 34 cntlzw r0,r0 ffc0be04: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0be08: 68 00 00 01 xori r0,r0,1 target->parent->child[dir] = leaf; ffc0be0c: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0be10: 7d 6b 02 14 add r11,r11,r0 ffc0be14: 93 ab 00 04 stw r29,4(r11) /* now replace the_node with target */ dir = the_node != the_node->parent->child[0]; ffc0be18: 80 09 00 04 lwz r0,4(r9) ffc0be1c: 7f c0 02 78 xor r0,r30,r0 ffc0be20: 7c 00 00 34 cntlzw r0,r0 ffc0be24: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0be28: 68 00 00 01 xori r0,r0,1 the_node->parent->child[dir] = target; ffc0be2c: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0be30: 7d 29 02 14 add r9,r9,r0 ffc0be34: 93 e9 00 04 stw r31,4(r9) /* set target's new children to the original node's children */ target->child[RBT_RIGHT] = the_node->child[RBT_RIGHT]; ffc0be38: 80 1e 00 08 lwz r0,8(r30) ffc0be3c: 90 1f 00 08 stw r0,8(r31) if (the_node->child[RBT_RIGHT]) ffc0be40: 81 3e 00 08 lwz r9,8(r30) ffc0be44: 2f 89 00 00 cmpwi cr7,r9,0 ffc0be48: 41 9e 00 08 beq- cr7,ffc0be50 <_RBTree_Extract_unprotected+0xe4><== NEVER TAKEN the_node->child[RBT_RIGHT]->parent = target; ffc0be4c: 93 e9 00 00 stw r31,0(r9) target->child[RBT_LEFT] = the_node->child[RBT_LEFT]; ffc0be50: 80 1e 00 04 lwz r0,4(r30) ffc0be54: 90 1f 00 04 stw r0,4(r31) if (the_node->child[RBT_LEFT]) ffc0be58: 81 3e 00 04 lwz r9,4(r30) ffc0be5c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0be60: 41 9e 00 08 beq- cr7,ffc0be68 <_RBTree_Extract_unprotected+0xfc> the_node->child[RBT_LEFT]->parent = target; ffc0be64: 93 e9 00 00 stw r31,0(r9) /* 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; ffc0be68: 81 3e 00 00 lwz r9,0(r30) target->color = the_node->color; ffc0be6c: 80 1e 00 10 lwz r0,16(r30) /* 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; ffc0be70: 91 3f 00 00 stw r9,0(r31) target->color = the_node->color; ffc0be74: 90 1f 00 10 stw r0,16(r31) * 1. Deleted a red node, its child must be black. Nothing must be done. * 2. Deleted a black node and the child is red. Paint child black. * 3. Deleted a black node and its child is black. This requires some * care and rotations. */ if (victim_color == RBT_BLACK) { /* eliminate case 1 */ ffc0be78: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0be7c: 40 9e 00 20 bne- cr7,ffc0be9c <_RBTree_Extract_unprotected+0x130> */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0be80: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0be84: 41 9e 00 18 beq- cr7,ffc0be9c <_RBTree_Extract_unprotected+0x130> ffc0be88: 80 1d 00 10 lwz r0,16(r29) ffc0be8c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0be90: 41 9e 00 cc beq- cr7,ffc0bf5c <_RBTree_Extract_unprotected+0x1f0><== ALWAYS TAKEN if (_RBTree_Is_red(leaf)) leaf->color = RBT_BLACK; /* case 2 */ else if(leaf) _RBTree_Extract_validate_unprotected(leaf); /* case 3 */ ffc0be94: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc0be98: 4b ff fb 9d bl ffc0ba34 <_RBTree_Extract_validate_unprotected><== NOT EXECUTED /* 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; ffc0be9c: 81 3c 00 04 lwz r9,4(r28) */ RTEMS_INLINE_ROUTINE void _RBTree_Set_off_rbtree( RBTree_Node *node ) { node->parent = node->child[RBT_LEFT] = node->child[RBT_RIGHT] = NULL; ffc0bea0: 38 00 00 00 li r0,0 ffc0bea4: 90 1e 00 08 stw r0,8(r30) ffc0bea8: 2f 89 00 00 cmpwi cr7,r9,0 ffc0beac: 90 1e 00 04 stw r0,4(r30) ffc0beb0: 90 1e 00 00 stw r0,0(r30) ffc0beb4: 41 9e 00 08 beq- cr7,ffc0bebc <_RBTree_Extract_unprotected+0x150> ffc0beb8: 90 09 00 10 stw r0,16(r9) } ffc0bebc: 80 01 00 1c lwz r0,28(r1) ffc0bec0: 83 81 00 08 lwz r28,8(r1) ffc0bec4: 7c 08 03 a6 mtlr r0 ffc0bec8: 83 a1 00 0c lwz r29,12(r1) ffc0becc: 83 c1 00 10 lwz r30,16(r1) ffc0bed0: 83 e1 00 14 lwz r31,20(r1) ffc0bed4: 38 21 00 18 addi r1,r1,24 ffc0bed8: 4e 80 00 20 blr the_rbtree->first[RBT_LEFT] = NULL; } } /* 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]) ffc0bedc: 80 1e 00 04 lwz r0,4(r30) ffc0bee0: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bee4: 41 9e 00 98 beq- cr7,ffc0bf7c <_RBTree_Extract_unprotected+0x210> the_rbtree->first[RBT_RIGHT] = the_node->child[RBT_LEFT]; else { the_rbtree->first[RBT_RIGHT] = the_node->parent; if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, the_rbtree->first[RBT_RIGHT])) the_rbtree->first[RBT_RIGHT] = NULL; ffc0bee8: 90 1c 00 0c stw r0,12(r28) * 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]) { ffc0beec: 83 fe 00 04 lwz r31,4(r30) ffc0bef0: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0bef4: 40 9e fe c4 bne+ cr7,ffc0bdb8 <_RBTree_Extract_unprotected+0x4c> * the_node's location in the tree. This may cause the coloring to be * 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]; ffc0bef8: 83 be 00 08 lwz r29,8(r30) if( leaf ) { ffc0befc: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0bf00: 40 be 00 28 bne+ cr7,ffc0bf28 <_RBTree_Extract_unprotected+0x1bc> leaf->parent = the_node->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(the_node); ffc0bf04: 7f c3 f3 78 mr r3,r30 ffc0bf08: 4b ff fb 2d bl ffc0ba34 <_RBTree_Extract_validate_unprotected> ffc0bf0c: 48 00 00 24 b ffc0bf30 <_RBTree_Extract_unprotected+0x1c4> if(!the_node) return; /* check if min needs to be updated */ if (the_node == the_rbtree->first[RBT_LEFT]) { if (the_node->child[RBT_RIGHT]) ffc0bf10: 80 1e 00 08 lwz r0,8(r30) ffc0bf14: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bf18: 41 9e 00 4c beq- cr7,ffc0bf64 <_RBTree_Extract_unprotected+0x1f8> the_rbtree->first[RBT_LEFT] = the_node->child[RBT_RIGHT]; else { the_rbtree->first[RBT_LEFT] = the_node->parent; if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, the_rbtree->first[RBT_LEFT])) the_rbtree->first[RBT_LEFT] = NULL; ffc0bf1c: 90 1c 00 08 stw r0,8(r28) ffc0bf20: 4b ff fe 80 b ffc0bda0 <_RBTree_Extract_unprotected+0x34> * 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]) { ffc0bf24: 7f fd fb 78 mr r29,r31 * For now we store the color of the node being deleted in victim_color. */ leaf = the_node->child[RBT_LEFT] ? the_node->child[RBT_LEFT] : the_node->child[RBT_RIGHT]; if( leaf ) { leaf->parent = the_node->parent; ffc0bf28: 80 1e 00 00 lwz r0,0(r30) ffc0bf2c: 90 1d 00 00 stw r0,0(r29) _RBTree_Extract_validate_unprotected(the_node); } victim_color = the_node->color; /* remove the_node from the tree */ dir = the_node != the_node->parent->child[0]; ffc0bf30: 81 3e 00 00 lwz r9,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; ffc0bf34: 81 5e 00 10 lwz r10,16(r30) /* remove the_node from the tree */ dir = the_node != the_node->parent->child[0]; ffc0bf38: 80 09 00 04 lwz r0,4(r9) ffc0bf3c: 7f c0 02 78 xor r0,r30,r0 ffc0bf40: 7c 00 00 34 cntlzw r0,r0 ffc0bf44: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0bf48: 68 00 00 01 xori r0,r0,1 the_node->parent->child[dir] = leaf; ffc0bf4c: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0bf50: 7d 29 02 14 add r9,r9,r0 ffc0bf54: 93 a9 00 04 stw r29,4(r9) ffc0bf58: 4b ff ff 20 b ffc0be78 <_RBTree_Extract_unprotected+0x10c> * 3. Deleted a black node and its child is black. This requires some * care and rotations. */ if (victim_color == RBT_BLACK) { /* eliminate case 1 */ if (_RBTree_Is_red(leaf)) leaf->color = RBT_BLACK; /* case 2 */ ffc0bf5c: 91 5d 00 10 stw r10,16(r29) ffc0bf60: 4b ff ff 3c b ffc0be9c <_RBTree_Extract_unprotected+0x130> /* 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; ffc0bf64: 81 3e 00 00 lwz r9,0(r30) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0bf68: 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; ffc0bf6c: 91 23 00 08 stw r9,8(r3) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0bf70: 40 9e fe 30 bne+ cr7,ffc0bda0 <_RBTree_Extract_unprotected+0x34> the_rbtree->first[RBT_LEFT])) the_rbtree->first[RBT_LEFT] = NULL; ffc0bf74: 90 1c 00 08 stw r0,8(r28) ffc0bf78: 4b ff fe 28 b ffc0bda0 <_RBTree_Extract_unprotected+0x34> /* 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; ffc0bf7c: 81 3e 00 00 lwz r9,0(r30) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0bf80: 7f 9c 48 00 cmpw cr7,r28,r9 /* 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; ffc0bf84: 91 3c 00 0c stw r9,12(r28) if(_RBTree_Are_nodes_equal((RBTree_Node *)the_rbtree, ffc0bf88: 40 9e fe 24 bne+ cr7,ffc0bdac <_RBTree_Extract_unprotected+0x40> the_rbtree->first[RBT_RIGHT])) the_rbtree->first[RBT_RIGHT] = NULL; ffc0bf8c: 90 1c 00 0c stw r0,12(r28) ffc0bf90: 4b ff ff 5c b ffc0beec <_RBTree_Extract_unprotected+0x180> leaf = target->child[RBT_LEFT]; if(leaf) { leaf->parent = target->parent; } else { /* fix the tree here if the child is a null leaf. */ _RBTree_Extract_validate_unprotected(target); ffc0bf94: 7f e3 fb 78 mr r3,r31 ffc0bf98: 4b ff fa 9d bl ffc0ba34 <_RBTree_Extract_validate_unprotected> ffc0bf9c: 4b ff fe 50 b ffc0bdec <_RBTree_Extract_unprotected+0x80> =============================================================================== ffc0ba34 <_RBTree_Extract_validate_unprotected>: ) { RBTree_Node *parent, *sibling; RBTree_Direction dir; parent = the_node->parent; ffc0ba34: 81 63 00 00 lwz r11,0(r3) if(!parent->parent) return; ffc0ba38: 80 0b 00 00 lwz r0,0(r11) ffc0ba3c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ba40: 4d 9e 00 20 beqlr cr7 { 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]) ffc0ba44: 81 2b 00 04 lwz r9,4(r11) ffc0ba48: 2f 03 00 00 cmpwi cr6,r3,0 ffc0ba4c: 7f 83 48 00 cmpw cr7,r3,r9 ffc0ba50: 41 9e 03 14 beq- cr7,ffc0bd64 <_RBTree_Extract_validate_unprotected+0x330> /* sibling is black, see if both of its children are also black. */ if (sibling && !_RBTree_Is_red(sibling->child[RBT_RIGHT]) && !_RBTree_Is_red(sibling->child[RBT_LEFT])) { sibling->color = RBT_RED; ffc0ba54: 38 a0 00 01 li r5,1 RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; ffc0ba58: 38 80 00 00 li r4,0 */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0ba5c: 41 9a 00 10 beq- cr6,ffc0ba6c <_RBTree_Extract_validate_unprotected+0x38><== NEVER TAKEN ffc0ba60: 80 03 00 10 lwz r0,16(r3) ffc0ba64: 2f 80 00 01 cmpwi cr7,r0,1 ffc0ba68: 41 9e 01 44 beq- cr7,ffc0bbac <_RBTree_Extract_validate_unprotected+0x178> 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) { ffc0ba6c: 81 4b 00 00 lwz r10,0(r11) ffc0ba70: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0ba74: 41 9e 01 38 beq- cr7,ffc0bbac <_RBTree_Extract_validate_unprotected+0x178> ffc0ba78: 2f 89 00 00 cmpwi cr7,r9,0 ffc0ba7c: 41 be ff e0 beq- cr7,ffc0ba5c <_RBTree_Extract_validate_unprotected+0x28><== NEVER TAKEN ffc0ba80: 80 09 00 10 lwz r0,16(r9) ffc0ba84: 2f 80 00 01 cmpwi cr7,r0,1 ffc0ba88: 41 9e 00 78 beq- cr7,ffc0bb00 <_RBTree_Extract_validate_unprotected+0xcc> sibling = parent->child[!dir]; } /* sibling is black, see if both of its children are also black. */ if (sibling && !_RBTree_Is_red(sibling->child[RBT_RIGHT]) && ffc0ba8c: 81 49 00 08 lwz r10,8(r9) ffc0ba90: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0ba94: 41 9e 00 10 beq- cr7,ffc0baa4 <_RBTree_Extract_validate_unprotected+0x70> ffc0ba98: 80 0a 00 10 lwz r0,16(r10) ffc0ba9c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0baa0: 41 9e 01 5c beq- cr7,ffc0bbfc <_RBTree_Extract_validate_unprotected+0x1c8> !_RBTree_Is_red(sibling->child[RBT_LEFT])) { ffc0baa4: 81 49 00 04 lwz r10,4(r9) ffc0baa8: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0baac: 41 9e 00 10 beq- cr7,ffc0babc <_RBTree_Extract_validate_unprotected+0x88> ffc0bab0: 80 0a 00 10 lwz r0,16(r10) ffc0bab4: 2f 80 00 01 cmpwi cr7,r0,1 ffc0bab8: 41 9e 01 44 beq- cr7,ffc0bbfc <_RBTree_Extract_validate_unprotected+0x1c8> sibling->color = RBT_RED; ffc0babc: 90 a9 00 10 stw r5,16(r9) ffc0bac0: 80 0b 00 10 lwz r0,16(r11) ffc0bac4: 2f 80 00 01 cmpwi cr7,r0,1 ffc0bac8: 41 9e 00 dc beq- cr7,ffc0bba4 <_RBTree_Extract_validate_unprotected+0x170> if (_RBTree_Is_red(parent)) { parent->color = RBT_BLACK; break; } the_node = parent; /* done if parent is red */ parent = the_node->parent; ffc0bacc: 81 4b 00 00 lwz r10,0(r11) RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; ffc0bad0: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0bad4: 41 9e 00 f0 beq- cr7,ffc0bbc4 <_RBTree_Extract_validate_unprotected+0x190><== NEVER TAKEN if(!(the_node->parent->parent)) return NULL; ffc0bad8: 80 0a 00 00 lwz r0,0(r10) ffc0badc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bae0: 41 9e 00 f8 beq- cr7,ffc0bbd8 <_RBTree_Extract_validate_unprotected+0x1a4> if(the_node == the_node->parent->child[RBT_LEFT]) ffc0bae4: 81 2a 00 04 lwz r9,4(r10) return the_node->parent->child[RBT_RIGHT]; ffc0bae8: 7d 63 5b 78 mr r3,r11 { 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]) ffc0baec: 7f 8b 48 00 cmpw cr7,r11,r9 ffc0baf0: 41 9e 00 fc beq- cr7,ffc0bbec <_RBTree_Extract_validate_unprotected+0x1b8> ffc0baf4: 2f 0b 00 00 cmpwi cr6,r11,0 ffc0baf8: 7d 4b 53 78 mr r11,r10 ffc0bafc: 4b ff ff 60 b ffc0ba5c <_RBTree_Extract_validate_unprotected+0x28> * update sibling pointer. */ if (_RBTree_Is_red(sibling)) { parent->color = RBT_RED; sibling->color = RBT_BLACK; dir = the_node != parent->child[0]; ffc0bb00: 81 0b 00 04 lwz r8,4(r11) * 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; ffc0bb04: 90 0b 00 10 stw r0,16(r11) sibling->color = RBT_BLACK; dir = the_node != parent->child[0]; ffc0bb08: 7c 60 42 78 xor r0,r3,r8 ffc0bb0c: 7c 00 00 34 cntlzw r0,r0 * 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; ffc0bb10: 90 89 00 10 stw r4,16(r9) dir = the_node != parent->child[0]; ffc0bb14: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0bb18: 68 00 00 01 xori r0,r0,1 RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[(1-dir)] == NULL) return; ffc0bb1c: 20 e0 00 01 subfic r7,r0,1 ffc0bb20: 54 e7 10 3a rlwinm r7,r7,2,0,29 ffc0bb24: 7c eb 3a 14 add r7,r11,r7 ffc0bb28: 81 07 00 04 lwz r8,4(r7) ffc0bb2c: 2f 88 00 00 cmpwi cr7,r8,0 ffc0bb30: 41 9e 00 58 beq- cr7,ffc0bb88 <_RBTree_Extract_validate_unprotected+0x154><== NEVER TAKEN c = the_node->child[(1-dir)]; the_node->child[(1-dir)] = c->child[dir]; ffc0bb34: 54 09 10 3a rlwinm r9,r0,2,0,29 ffc0bb38: 7c c8 4a 14 add r6,r8,r9 ffc0bb3c: 81 86 00 04 lwz r12,4(r6) ffc0bb40: 91 87 00 04 stw r12,4(r7) if (c->child[dir]) ffc0bb44: 80 e6 00 04 lwz r7,4(r6) ffc0bb48: 2f 87 00 00 cmpwi cr7,r7,0 ffc0bb4c: 41 9e 00 0c beq- cr7,ffc0bb58 <_RBTree_Extract_validate_unprotected+0x124><== NEVER TAKEN c->child[dir]->parent = the_node; ffc0bb50: 91 67 00 00 stw r11,0(r7) ffc0bb54: 81 4b 00 00 lwz r10,0(r11) c->child[dir] = the_node; ffc0bb58: 7d 28 4a 14 add r9,r8,r9 the_node->parent->child[the_node != the_node->parent->child[0]] = c; c->parent = the_node->parent; ffc0bb5c: 91 48 00 00 stw r10,0(r8) the_node->child[(1-dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; ffc0bb60: 91 69 00 04 stw r11,4(r9) the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bb64: 81 2a 00 04 lwz r9,4(r10) c->parent = the_node->parent; the_node->parent = c; ffc0bb68: 91 0b 00 00 stw r8,0(r11) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bb6c: 7d 69 4a 78 xor r9,r11,r9 ffc0bb70: 7d 29 00 34 cntlzw r9,r9 ffc0bb74: 55 29 d9 7e rlwinm r9,r9,27,5,31 ffc0bb78: 69 29 00 01 xori r9,r9,1 ffc0bb7c: 55 29 10 3a rlwinm r9,r9,2,0,29 ffc0bb80: 7d 4a 4a 14 add r10,r10,r9 ffc0bb84: 91 0a 00 04 stw r8,4(r10) _RBTree_Rotate(parent, dir); sibling = parent->child[!dir]; ffc0bb88: 68 00 00 01 xori r0,r0,1 ffc0bb8c: 54 09 10 3a rlwinm r9,r0,2,0,29 ffc0bb90: 7d 2b 4a 14 add r9,r11,r9 ffc0bb94: 81 29 00 04 lwz r9,4(r9) } /* sibling is black, see if both of its children are also black. */ if (sibling && ffc0bb98: 2f 89 00 00 cmpwi cr7,r9,0 ffc0bb9c: 40 9e fe f0 bne+ cr7,ffc0ba8c <_RBTree_Extract_validate_unprotected+0x58><== ALWAYS TAKEN ffc0bba0: 4b ff fe bc b ffc0ba5c <_RBTree_Extract_validate_unprotected+0x28><== NOT EXECUTED !_RBTree_Is_red(sibling->child[RBT_RIGHT]) && !_RBTree_Is_red(sibling->child[RBT_LEFT])) { sibling->color = RBT_RED; if (_RBTree_Is_red(parent)) { parent->color = RBT_BLACK; ffc0bba4: 38 00 00 00 li r0,0 ffc0bba8: 90 0b 00 10 stw r0,16(r11) sibling->child[!dir]->color = RBT_BLACK; _RBTree_Rotate(parent, dir); break; /* done */ } } /* while */ if(!the_node->parent->parent) the_node->color = RBT_BLACK; ffc0bbac: 81 23 00 00 lwz r9,0(r3) ffc0bbb0: 80 09 00 00 lwz r0,0(r9) ffc0bbb4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bbb8: 4c be 00 20 bnelr+ cr7 ffc0bbbc: 90 03 00 10 stw r0,16(r3) ffc0bbc0: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Sibling( RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; ffc0bbc4: 7d 63 5b 78 mr r3,r11 <== NOT EXECUTED ffc0bbc8: 39 20 00 00 li r9,0 <== NOT EXECUTED ffc0bbcc: 39 60 00 00 li r11,0 <== NOT EXECUTED ffc0bbd0: 2f 03 00 00 cmpwi cr6,r3,0 <== NOT EXECUTED ffc0bbd4: 4b ff fe 88 b ffc0ba5c <_RBTree_Extract_validate_unprotected+0x28><== NOT EXECUTED if(!(the_node->parent->parent)) return NULL; ffc0bbd8: 7d 63 5b 78 mr r3,r11 ffc0bbdc: 39 20 00 00 li r9,0 ffc0bbe0: 7d 4b 53 78 mr r11,r10 ffc0bbe4: 2f 03 00 00 cmpwi cr6,r3,0 ffc0bbe8: 4b ff fe 74 b ffc0ba5c <_RBTree_Extract_validate_unprotected+0x28> if(the_node == the_node->parent->child[RBT_LEFT]) return the_node->parent->child[RBT_RIGHT]; ffc0bbec: 81 2a 00 08 lwz r9,8(r10) ffc0bbf0: 7d 4b 53 78 mr r11,r10 ffc0bbf4: 2f 03 00 00 cmpwi cr6,r3,0 ffc0bbf8: 4b ff fe 64 b ffc0ba5c <_RBTree_Extract_validate_unprotected+0x28> * 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]; ffc0bbfc: 80 0b 00 04 lwz r0,4(r11) ffc0bc00: 7c 60 02 78 xor r0,r3,r0 ffc0bc04: 7c 00 00 34 cntlzw r0,r0 ffc0bc08: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0bc0c: 68 00 00 01 xori r0,r0,1 if (!_RBTree_Is_red(sibling->child[!dir])) { ffc0bc10: 68 07 00 01 xori r7,r0,1 ffc0bc14: 54 e7 10 3a rlwinm r7,r7,2,0,29 ffc0bc18: 7d 49 3a 14 add r10,r9,r7 ffc0bc1c: 81 0a 00 04 lwz r8,4(r10) */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0bc20: 2f 88 00 00 cmpwi cr7,r8,0 ffc0bc24: 41 9e 00 10 beq- cr7,ffc0bc34 <_RBTree_Extract_validate_unprotected+0x200> ffc0bc28: 81 48 00 10 lwz r10,16(r8) ffc0bc2c: 2f 8a 00 01 cmpwi cr7,r10,1 ffc0bc30: 41 9e 00 a0 beq- cr7,ffc0bcd0 <_RBTree_Extract_validate_unprotected+0x29c> sibling->color = RBT_RED; sibling->child[dir]->color = RBT_BLACK; _RBTree_Rotate(sibling, !dir); ffc0bc34: 68 06 00 01 xori r6,r0,1 RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[(1-dir)] == NULL) return; ffc0bc38: 21 06 00 01 subfic r8,r6,1 ffc0bc3c: 55 08 10 3a rlwinm r8,r8,2,0,29 ffc0bc40: 7d 09 42 14 add r8,r9,r8 ffc0bc44: 81 48 00 04 lwz r10,4(r8) * 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; ffc0bc48: 54 05 10 3a rlwinm r5,r0,2,0,29 ffc0bc4c: 7c a9 2a 14 add r5,r9,r5 ffc0bc50: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0bc54: 80 a5 00 04 lwz r5,4(r5) * 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])) { sibling->color = RBT_RED; ffc0bc58: 38 80 00 01 li r4,1 ffc0bc5c: 90 89 00 10 stw r4,16(r9) sibling->child[dir]->color = RBT_BLACK; ffc0bc60: 38 80 00 00 li r4,0 ffc0bc64: 90 85 00 10 stw r4,16(r5) ffc0bc68: 41 9e 00 58 beq- cr7,ffc0bcc0 <_RBTree_Extract_validate_unprotected+0x28c><== NEVER TAKEN c = the_node->child[(1-dir)]; the_node->child[(1-dir)] = c->child[dir]; ffc0bc6c: 54 c6 10 3a rlwinm r6,r6,2,0,29 ffc0bc70: 7c aa 32 14 add r5,r10,r6 ffc0bc74: 80 85 00 04 lwz r4,4(r5) ffc0bc78: 90 88 00 04 stw r4,4(r8) if (c->child[dir]) ffc0bc7c: 81 05 00 04 lwz r8,4(r5) ffc0bc80: 2f 88 00 00 cmpwi cr7,r8,0 ffc0bc84: 41 9e 00 08 beq- cr7,ffc0bc8c <_RBTree_Extract_validate_unprotected+0x258> c->child[dir]->parent = the_node; ffc0bc88: 91 28 00 00 stw r9,0(r8) c->child[dir] = the_node; ffc0bc8c: 7d 0a 32 14 add r8,r10,r6 the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bc90: 80 c9 00 00 lwz r6,0(r9) the_node->child[(1-dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; ffc0bc94: 91 28 00 04 stw r9,4(r8) the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bc98: 81 06 00 04 lwz r8,4(r6) c->parent = the_node->parent; ffc0bc9c: 90 ca 00 00 stw r6,0(r10) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bca0: 7d 28 42 78 xor r8,r9,r8 ffc0bca4: 7d 08 00 34 cntlzw r8,r8 c->parent = the_node->parent; the_node->parent = c; ffc0bca8: 91 49 00 00 stw r10,0(r9) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bcac: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc0bcb0: 69 08 00 01 xori r8,r8,1 ffc0bcb4: 55 08 10 3a rlwinm r8,r8,2,0,29 ffc0bcb8: 7c c6 42 14 add r6,r6,r8 ffc0bcbc: 91 46 00 04 stw r10,4(r6) _RBTree_Rotate(sibling, !dir); sibling = parent->child[!dir]; ffc0bcc0: 7d 2b 3a 14 add r9,r11,r7 ffc0bcc4: 81 29 00 04 lwz r9,4(r9) ffc0bcc8: 7c e9 3a 14 add r7,r9,r7 ffc0bccc: 81 07 00 04 lwz r8,4(r7) RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[(1-dir)] == NULL) return; ffc0bcd0: 20 c0 00 01 subfic r6,r0,1 } sibling->color = parent->color; ffc0bcd4: 80 ab 00 10 lwz r5,16(r11) ffc0bcd8: 54 c6 10 3a rlwinm r6,r6,2,0,29 ffc0bcdc: 7c cb 32 14 add r6,r11,r6 ffc0bce0: 90 a9 00 10 stw r5,16(r9) parent->color = RBT_BLACK; ffc0bce4: 38 e0 00 00 li r7,0 ffc0bce8: 81 46 00 04 lwz r10,4(r6) ffc0bcec: 90 eb 00 10 stw r7,16(r11) ffc0bcf0: 2f 8a 00 00 cmpwi cr7,r10,0 sibling->child[!dir]->color = RBT_BLACK; ffc0bcf4: 90 e8 00 10 stw r7,16(r8) ffc0bcf8: 41 be fe b4 beq- cr7,ffc0bbac <_RBTree_Extract_validate_unprotected+0x178><== NEVER TAKEN c = the_node->child[(1-dir)]; the_node->child[(1-dir)] = c->child[dir]; ffc0bcfc: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0bd00: 7d 2a 02 14 add r9,r10,r0 ffc0bd04: 81 09 00 04 lwz r8,4(r9) ffc0bd08: 91 06 00 04 stw r8,4(r6) if (c->child[dir]) ffc0bd0c: 81 29 00 04 lwz r9,4(r9) ffc0bd10: 2f 89 00 00 cmpwi cr7,r9,0 ffc0bd14: 41 9e 00 08 beq- cr7,ffc0bd1c <_RBTree_Extract_validate_unprotected+0x2e8> c->child[dir]->parent = the_node; ffc0bd18: 91 69 00 00 stw r11,0(r9) c->child[dir] = the_node; ffc0bd1c: 7d 0a 02 14 add r8,r10,r0 the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bd20: 81 2b 00 00 lwz r9,0(r11) the_node->child[(1-dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; ffc0bd24: 91 68 00 04 stw r11,4(r8) the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bd28: 80 09 00 04 lwz r0,4(r9) c->parent = the_node->parent; ffc0bd2c: 91 2a 00 00 stw r9,0(r10) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bd30: 7d 60 02 78 xor r0,r11,r0 ffc0bd34: 7c 00 00 34 cntlzw r0,r0 c->parent = the_node->parent; the_node->parent = c; ffc0bd38: 91 4b 00 00 stw r10,0(r11) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0bd3c: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0bd40: 68 00 00 01 xori r0,r0,1 ffc0bd44: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0bd48: 7d 29 02 14 add r9,r9,r0 ffc0bd4c: 91 49 00 04 stw r10,4(r9) _RBTree_Rotate(parent, dir); break; /* done */ } } /* while */ if(!the_node->parent->parent) the_node->color = RBT_BLACK; ffc0bd50: 81 23 00 00 lwz r9,0(r3) ffc0bd54: 80 09 00 00 lwz r0,0(r9) ffc0bd58: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bd5c: 4c be 00 20 bnelr+ cr7 ffc0bd60: 4b ff fe 5c b ffc0bbbc <_RBTree_Extract_validate_unprotected+0x188><== NOT EXECUTED if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(the_node == the_node->parent->child[RBT_LEFT]) return the_node->parent->child[RBT_RIGHT]; ffc0bd64: 81 2b 00 08 lwz r9,8(r11) ffc0bd68: 4b ff fc ec b ffc0ba54 <_RBTree_Extract_validate_unprotected+0x20> =============================================================================== ffc0c024 <_RBTree_Find>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0c024: 7d 20 00 a6 mfmsr r9 ffc0c028: 7c 10 42 a6 mfsprg r0,0 ffc0c02c: 7d 20 00 78 andc r0,r9,r0 ffc0c030: 7c 00 01 24 mtmsr r0 return_node = NULL; _ISR_Disable( level ); return_node = _RBTree_Find_unprotected( the_rbtree, the_value ); _ISR_Enable( level ); return return_node; } ffc0c034: 80 63 00 04 lwz r3,4(r3) RBTree_Control *the_rbtree, unsigned int the_value ) { RBTree_Node* iter_node = the_rbtree->root; while (iter_node) { ffc0c038: 2f 83 00 00 cmpwi cr7,r3,0 ffc0c03c: 40 be 00 28 bne+ cr7,ffc0c064 <_RBTree_Find+0x40> <== ALWAYS TAKEN ffc0c040: 48 00 00 30 b ffc0c070 <_RBTree_Find+0x4c> <== NOT EXECUTED if (the_value == iter_node->value) return(iter_node); RBTree_Direction dir = the_value > iter_node->value; ffc0c044: 7c 04 00 10 subfc r0,r4,r0 ffc0c048: 7c 00 01 10 subfe r0,r0,r0 ffc0c04c: 7c 00 00 d0 neg r0,r0 iter_node = iter_node->child[dir]; ffc0c050: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0c054: 7c 63 02 14 add r3,r3,r0 ffc0c058: 80 63 00 04 lwz r3,4(r3) RBTree_Control *the_rbtree, unsigned int the_value ) { RBTree_Node* iter_node = the_rbtree->root; while (iter_node) { ffc0c05c: 2f 83 00 00 cmpwi cr7,r3,0 ffc0c060: 41 9e 00 10 beq- cr7,ffc0c070 <_RBTree_Find+0x4c> <== NEVER TAKEN if (the_value == iter_node->value) return(iter_node); ffc0c064: 80 03 00 0c lwz r0,12(r3) ffc0c068: 7f 84 00 00 cmpw cr7,r4,r0 ffc0c06c: 40 9e ff d8 bne+ cr7,ffc0c044 <_RBTree_Find+0x20> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0c070: 7d 20 01 24 mtmsr r9 ffc0c074: 4e 80 00 20 blr =============================================================================== ffc0bfdc <_RBTree_Find_header>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0bfdc: 7d 60 00 a6 mfmsr r11 ffc0bfe0: 7c 10 42 a6 mfsprg r0,0 ffc0bfe4: 7d 60 00 78 andc r0,r11,r0 ffc0bfe8: 7c 00 01 24 mtmsr r0 */ RTEMS_INLINE_ROUTINE RBTree_Control *_RBTree_Find_header_unprotected( RBTree_Node *the_node ) { if(!the_node) return NULL; ffc0bfec: 2f 83 00 00 cmpwi cr7,r3,0 ffc0bff0: 39 20 00 00 li r9,0 ffc0bff4: 41 9e 00 24 beq- cr7,ffc0c018 <_RBTree_Find_header+0x3c><== NEVER TAKEN if(!(the_node->parent)) return NULL; ffc0bff8: 81 23 00 00 lwz r9,0(r3) ffc0bffc: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c000: 40 be 00 0c bne+ cr7,ffc0c00c <_RBTree_Find_header+0x30><== ALWAYS TAKEN ffc0c004: 48 00 00 14 b ffc0c018 <_RBTree_Find_header+0x3c> <== NOT EXECUTED while(the_node->parent) the_node = the_node->parent; ffc0c008: 7c 09 03 78 mr r9,r0 RTEMS_INLINE_ROUTINE RBTree_Control *_RBTree_Find_header_unprotected( RBTree_Node *the_node ) { if(!the_node) return NULL; if(!(the_node->parent)) return NULL; ffc0c00c: 80 09 00 00 lwz r0,0(r9) while(the_node->parent) the_node = the_node->parent; ffc0c010: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c014: 40 9e ff f4 bne+ cr7,ffc0c008 <_RBTree_Find_header+0x2c> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0c018: 7d 60 01 24 mtmsr r11 return_header = NULL; _ISR_Disable( level ); return_header = _RBTree_Find_header_unprotected( the_node ); _ISR_Enable( level ); return return_header; } ffc0c01c: 7d 23 4b 78 mr r3,r9 ffc0c020: 4e 80 00 20 blr =============================================================================== ffc0c298 <_RBTree_Insert_unprotected>: RBTree_Node *_RBTree_Insert_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { if(!the_node) return (RBTree_Node*)-1; ffc0c298: 2c 04 00 00 cmpwi r4,0 */ RBTree_Node *_RBTree_Insert_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { ffc0c29c: 94 21 ff f8 stwu r1,-8(r1) ffc0c2a0: 7c 08 02 a6 mflr r0 if(!the_node) return (RBTree_Node*)-1; ffc0c2a4: 39 20 ff ff li r9,-1 */ RBTree_Node *_RBTree_Insert_unprotected( RBTree_Control *the_rbtree, RBTree_Node *the_node ) { ffc0c2a8: 90 01 00 0c stw r0,12(r1) if(!the_node) return (RBTree_Node*)-1; ffc0c2ac: 41 82 00 4c beq- ffc0c2f8 <_RBTree_Insert_unprotected+0x60><== NEVER TAKEN RBTree_Node *iter_node = the_rbtree->root; ffc0c2b0: 81 23 00 04 lwz r9,4(r3) if (!iter_node) { /* special case: first node inserted */ ffc0c2b4: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c2b8: 41 9e 00 a4 beq- cr7,ffc0c35c <_RBTree_Insert_unprotected+0xc4> the_node->color = RBT_RED; iter_node->child[dir] = the_node; the_node->parent = iter_node; /* update min/max */ if (_RBTree_Is_first(the_rbtree, iter_node, dir)) { the_rbtree->first[dir] = the_node; ffc0c2bc: 81 04 00 0c lwz r8,12(r4) ffc0c2c0: 48 00 00 14 b ffc0c2d4 <_RBTree_Insert_unprotected+0x3c> } else { /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { if(the_node->value == iter_node->value) return(iter_node); RBTree_Direction dir = the_node->value > iter_node->value; if (!iter_node->child[dir]) { ffc0c2c4: 81 6a 00 04 lwz r11,4(r10) ffc0c2c8: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0c2cc: 41 9e 00 40 beq- cr7,ffc0c30c <_RBTree_Insert_unprotected+0x74> ffc0c2d0: 7d 69 5b 78 mr r9,r11 the_node->parent = (RBTree_Node *) the_rbtree; the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; } else { /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { if(the_node->value == iter_node->value) return(iter_node); ffc0c2d4: 81 69 00 0c lwz r11,12(r9) ffc0c2d8: 7f 88 58 00 cmpw cr7,r8,r11 RBTree_Direction dir = the_node->value > iter_node->value; ffc0c2dc: 7c 08 58 10 subfc r0,r8,r11 ffc0c2e0: 7c 00 01 10 subfe r0,r0,r0 ffc0c2e4: 7c 00 00 d0 neg r0,r0 if (!iter_node->child[dir]) { ffc0c2e8: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0c2ec: 7d 49 02 14 add r10,r9,r0 ffc0c2f0: 38 ea 00 04 addi r7,r10,4 the_node->parent = (RBTree_Node *) the_rbtree; the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; } else { /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { if(the_node->value == iter_node->value) return(iter_node); ffc0c2f4: 40 9e ff d0 bne+ cr7,ffc0c2c4 <_RBTree_Insert_unprotected+0x2c> /* verify red-black properties */ _RBTree_Validate_insert_unprotected(the_node); } return (RBTree_Node*)0; } ffc0c2f8: 80 01 00 0c lwz r0,12(r1) ffc0c2fc: 7d 23 4b 78 mr r3,r9 ffc0c300: 38 21 00 08 addi r1,r1,8 ffc0c304: 7c 08 03 a6 mtlr r0 ffc0c308: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_First( RBTree_Control *the_rbtree, RBTree_Direction dir ) { return the_rbtree->first[dir]; ffc0c30c: 7c 63 02 14 add r3,r3,r0 the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; the_node->color = RBT_RED; iter_node->child[dir] = the_node; the_node->parent = iter_node; /* update min/max */ if (_RBTree_Is_first(the_rbtree, iter_node, dir)) { ffc0c310: 80 03 00 08 lwz r0,8(r3) /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { if(the_node->value == iter_node->value) return(iter_node); RBTree_Direction dir = the_node->value > iter_node->value; if (!iter_node->child[dir]) { the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; ffc0c314: 91 64 00 08 stw r11,8(r4) the_node->color = RBT_RED; iter_node->child[dir] = the_node; the_node->parent = iter_node; /* update min/max */ if (_RBTree_Is_first(the_rbtree, iter_node, dir)) { ffc0c318: 7f 89 00 00 cmpw cr7,r9,r0 while (iter_node) { if(the_node->value == iter_node->value) return(iter_node); RBTree_Direction dir = the_node->value > iter_node->value; if (!iter_node->child[dir]) { the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; the_node->color = RBT_RED; ffc0c31c: 38 00 00 01 li r0,1 /* typical binary search tree insert, descend tree to leaf and insert */ while (iter_node) { if(the_node->value == iter_node->value) return(iter_node); RBTree_Direction dir = the_node->value > iter_node->value; if (!iter_node->child[dir]) { the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; ffc0c320: 91 64 00 04 stw r11,4(r4) the_node->color = RBT_RED; ffc0c324: 90 04 00 10 stw r0,16(r4) iter_node->child[dir] = the_node; ffc0c328: 90 87 00 00 stw r4,0(r7) the_node->parent = iter_node; ffc0c32c: 91 24 00 00 stw r9,0(r4) /* update min/max */ if (_RBTree_Is_first(the_rbtree, iter_node, dir)) { ffc0c330: 41 9e 00 24 beq- cr7,ffc0c354 <_RBTree_Insert_unprotected+0xbc> } } /* while(iter_node) */ /* verify red-black properties */ _RBTree_Validate_insert_unprotected(the_node); ffc0c334: 7c 83 23 78 mr r3,r4 ffc0c338: 4b ff fd 99 bl ffc0c0d0 <_RBTree_Validate_insert_unprotected> } return (RBTree_Node*)0; } ffc0c33c: 80 01 00 0c lwz r0,12(r1) } /* while(iter_node) */ /* verify red-black properties */ _RBTree_Validate_insert_unprotected(the_node); } return (RBTree_Node*)0; ffc0c340: 39 20 00 00 li r9,0 } ffc0c344: 7c 08 03 a6 mtlr r0 ffc0c348: 7d 23 4b 78 mr r3,r9 ffc0c34c: 38 21 00 08 addi r1,r1,8 ffc0c350: 4e 80 00 20 blr the_node->color = RBT_RED; iter_node->child[dir] = the_node; the_node->parent = iter_node; /* update min/max */ if (_RBTree_Is_first(the_rbtree, iter_node, dir)) { the_rbtree->first[dir] = the_node; ffc0c354: 90 83 00 08 stw r4,8(r3) ffc0c358: 4b ff ff dc b ffc0c334 <_RBTree_Insert_unprotected+0x9c> if(!the_node) return (RBTree_Node*)-1; RBTree_Node *iter_node = the_rbtree->root; if (!iter_node) { /* special case: first node inserted */ the_node->color = RBT_BLACK; ffc0c35c: 91 24 00 10 stw r9,16(r4) the_rbtree->root = the_node; ffc0c360: 90 83 00 04 stw r4,4(r3) the_rbtree->first[0] = the_rbtree->first[1] = the_node; ffc0c364: 90 83 00 0c stw r4,12(r3) ffc0c368: 90 83 00 08 stw r4,8(r3) the_node->parent = (RBTree_Node *) the_rbtree; ffc0c36c: 90 64 00 00 stw r3,0(r4) the_node->child[RBT_LEFT] = the_node->child[RBT_RIGHT] = NULL; ffc0c370: 91 24 00 08 stw r9,8(r4) ffc0c374: 91 24 00 04 stw r9,4(r4) ffc0c378: 4b ff ff 80 b ffc0c2f8 <_RBTree_Insert_unprotected+0x60> =============================================================================== ffc0c0d0 <_RBTree_Validate_insert_unprotected>: * append operation. */ void _RBTree_Validate_insert_unprotected( RBTree_Node *the_node ) { ffc0c0d0: 94 21 ff f0 stwu r1,-16(r1) /* 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; ffc0c0d4: 38 a0 00 00 li r5,0 g->color = RBT_RED; ffc0c0d8: 39 80 00 01 li r12,1 * append operation. */ void _RBTree_Validate_insert_unprotected( RBTree_Node *the_node ) { ffc0c0dc: 93 e1 00 0c stw r31,12(r1) ISR_Level level; _ISR_Disable( level ); _RBTree_Insert_unprotected( tree, node ); _ISR_Enable( level ); } ffc0c0e0: 81 23 00 00 lwz r9,0(r3) */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Parent( RBTree_Node *the_node ) { if (!the_node->parent->parent) return NULL; ffc0c0e4: 81 69 00 00 lwz r11,0(r9) ffc0c0e8: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0c0ec: 7d 68 5b 78 mr r8,r11 ffc0c0f0: 41 9e 01 70 beq- cr7,ffc0c260 <_RBTree_Validate_insert_unprotected+0x190> */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0c0f4: 80 09 00 10 lwz r0,16(r9) ffc0c0f8: 2f 80 00 01 cmpwi cr7,r0,1 ffc0c0fc: 41 9e 00 10 beq- cr7,ffc0c10c <_RBTree_Validate_insert_unprotected+0x3c> /* 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; } ffc0c100: 83 e1 00 0c lwz r31,12(r1) ffc0c104: 38 21 00 10 addi r1,r1,16 ffc0c108: 4e 80 00 20 blr ) { 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; ffc0c10c: 80 0b 00 00 lwz r0,0(r11) ffc0c110: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c114: 80 0b 00 04 lwz r0,4(r11) ffc0c118: 41 9e 00 24 beq- cr7,ffc0c13c <_RBTree_Validate_insert_unprotected+0x6c><== 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]) ffc0c11c: 7f 89 00 00 cmpw cr7,r9,r0 ffc0c120: 7c 0a 03 78 mr r10,r0 ffc0c124: 41 9e 01 6c beq- cr7,ffc0c290 <_RBTree_Validate_insert_unprotected+0x1c0> */ RTEMS_INLINE_ROUTINE bool _RBTree_Is_red( const RBTree_Node *the_node ) { return (the_node && the_node->color == RBT_RED); ffc0c128: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0c12c: 41 9e 00 10 beq- cr7,ffc0c13c <_RBTree_Validate_insert_unprotected+0x6c> ffc0c130: 80 ea 00 10 lwz r7,16(r10) ffc0c134: 2f 87 00 01 cmpwi cr7,r7,1 ffc0c138: 41 9e 01 38 beq- cr7,ffc0c270 <_RBTree_Validate_insert_unprotected+0x1a0> 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]; ffc0c13c: 81 49 00 04 lwz r10,4(r9) RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0c140: 7d 20 02 78 xor r0,r9,r0 ffc0c144: 7c 00 00 34 cntlzw r0,r0 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]; ffc0c148: 7c 6a 52 78 xor r10,r3,r10 ffc0c14c: 7d 4a 00 34 cntlzw r10,r10 ffc0c150: 55 4a d9 7e rlwinm r10,r10,27,5,31 RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0c154: 54 00 d9 7e rlwinm r0,r0,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]; ffc0c158: 69 4a 00 01 xori r10,r10,1 RBTree_Direction pdir = the_node->parent != g->child[0]; ffc0c15c: 68 00 00 01 xori r0,r0,1 /* ensure node is on the same branch direction as parent */ if (dir != pdir) { ffc0c160: 7f 8a 00 00 cmpw cr7,r10,r0 ffc0c164: 41 9e 01 20 beq- cr7,ffc0c284 <_RBTree_Validate_insert_unprotected+0x1b4> RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[(1-dir)] == NULL) return; ffc0c168: 20 c0 00 01 subfic r6,r0,1 ffc0c16c: 54 ca 10 3a rlwinm r10,r6,2,0,29 ffc0c170: 7d 49 52 14 add r10,r9,r10 ffc0c174: 80 ea 00 04 lwz r7,4(r10) ffc0c178: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0c17c: 2f 87 00 00 cmpwi cr7,r7,0 ffc0c180: 41 9e 00 54 beq- cr7,ffc0c1d4 <_RBTree_Validate_insert_unprotected+0x104><== NEVER TAKEN c = the_node->child[(1-dir)]; the_node->child[(1-dir)] = c->child[dir]; ffc0c184: 7c 87 02 14 add r4,r7,r0 ffc0c188: 83 e4 00 04 lwz r31,4(r4) ffc0c18c: 93 ea 00 04 stw r31,4(r10) if (c->child[dir]) ffc0c190: 81 44 00 04 lwz r10,4(r4) ffc0c194: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0c198: 41 9e 00 0c beq- cr7,ffc0c1a4 <_RBTree_Validate_insert_unprotected+0xd4> c->child[dir]->parent = the_node; ffc0c19c: 91 2a 00 00 stw r9,0(r10) ffc0c1a0: 81 69 00 00 lwz r11,0(r9) c->child[dir] = the_node; ffc0c1a4: 7d 47 02 14 add r10,r7,r0 the_node->parent->child[the_node != the_node->parent->child[0]] = c; c->parent = the_node->parent; ffc0c1a8: 91 67 00 00 stw r11,0(r7) the_node->child[(1-dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; ffc0c1ac: 91 2a 00 04 stw r9,4(r10) the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0c1b0: 81 4b 00 04 lwz r10,4(r11) c->parent = the_node->parent; the_node->parent = c; ffc0c1b4: 90 e9 00 00 stw r7,0(r9) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0c1b8: 7d 2a 52 78 xor r10,r9,r10 ffc0c1bc: 7d 4a 00 34 cntlzw r10,r10 ffc0c1c0: 55 4a d9 7e rlwinm r10,r10,27,5,31 ffc0c1c4: 69 4a 00 01 xori r10,r10,1 ffc0c1c8: 55 4a 10 3a rlwinm r10,r10,2,0,29 ffc0c1cc: 7d 6b 52 14 add r11,r11,r10 ffc0c1d0: 90 eb 00 04 stw r7,4(r11) _RBTree_Rotate(the_node->parent, pdir); the_node = the_node->child[pdir]; ffc0c1d4: 7c 63 02 14 add r3,r3,r0 ffc0c1d8: 80 63 00 04 lwz r3,4(r3) ffc0c1dc: 81 23 00 00 lwz r9,0(r3) RBTree_Direction dir ) { RBTree_Node *c; if (the_node == NULL) return; if (the_node->child[(1-dir)] == NULL) return; ffc0c1e0: 7d 48 02 14 add r10,r8,r0 } the_node->parent->color = RBT_BLACK; ffc0c1e4: 90 a9 00 10 stw r5,16(r9) ffc0c1e8: 81 6a 00 04 lwz r11,4(r10) g->color = RBT_RED; ffc0c1ec: 91 88 00 10 stw r12,16(r8) ffc0c1f0: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0c1f4: 41 be fe ec beq- cr7,ffc0c0e0 <_RBTree_Validate_insert_unprotected+0x10><== NEVER TAKEN c = the_node->child[(1-dir)]; the_node->child[(1-dir)] = c->child[dir]; ffc0c1f8: 54 c6 10 3a rlwinm r6,r6,2,0,29 ffc0c1fc: 7d 2b 32 14 add r9,r11,r6 ffc0c200: 80 09 00 04 lwz r0,4(r9) ffc0c204: 90 0a 00 04 stw r0,4(r10) if (c->child[dir]) ffc0c208: 81 29 00 04 lwz r9,4(r9) ffc0c20c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c210: 41 9e 00 08 beq- cr7,ffc0c218 <_RBTree_Validate_insert_unprotected+0x148> c->child[dir]->parent = the_node; ffc0c214: 91 09 00 00 stw r8,0(r9) c->child[dir] = the_node; ffc0c218: 7c cb 32 14 add r6,r11,r6 the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0c21c: 81 28 00 00 lwz r9,0(r8) the_node->child[(1-dir)] = c->child[dir]; if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; ffc0c220: 91 06 00 04 stw r8,4(r6) the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0c224: 80 09 00 04 lwz r0,4(r9) c->parent = the_node->parent; ffc0c228: 91 2b 00 00 stw r9,0(r11) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0c22c: 7d 00 02 78 xor r0,r8,r0 ffc0c230: 7c 00 00 34 cntlzw r0,r0 c->parent = the_node->parent; the_node->parent = c; ffc0c234: 91 68 00 00 stw r11,0(r8) if (c->child[dir]) c->child[dir]->parent = the_node; c->child[dir] = the_node; the_node->parent->child[the_node != the_node->parent->child[0]] = c; ffc0c238: 54 00 d9 7e rlwinm r0,r0,27,5,31 ffc0c23c: 68 00 00 01 xori r0,r0,1 ffc0c240: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0c244: 7d 29 02 14 add r9,r9,r0 ffc0c248: 91 69 00 04 stw r11,4(r9) ISR_Level level; _ISR_Disable( level ); _RBTree_Insert_unprotected( tree, node ); _ISR_Enable( level ); } ffc0c24c: 81 23 00 00 lwz r9,0(r3) */ RTEMS_INLINE_ROUTINE RBTree_Node *_RBTree_Parent( RBTree_Node *the_node ) { if (!the_node->parent->parent) return NULL; ffc0c250: 81 69 00 00 lwz r11,0(r9) ffc0c254: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0c258: 7d 68 5b 78 mr r8,r11 ffc0c25c: 40 9e fe 98 bne+ cr7,ffc0c0f4 <_RBTree_Validate_insert_unprotected+0x24><== ALWAYS TAKEN /* 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; } ffc0c260: 83 e1 00 0c lwz r31,12(r1) ffc0c264: 38 21 00 10 addi r1,r1,16 /* 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; ffc0c268: 91 63 00 10 stw r11,16(r3) } ffc0c26c: 4e 80 00 20 blr 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; ffc0c270: 90 a9 00 10 stw r5,16(r9) u->color = RBT_BLACK; g->color = RBT_RED; ffc0c274: 7d 63 5b 78 mr r3,r11 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; ffc0c278: 90 aa 00 10 stw r5,16(r10) g->color = RBT_RED; ffc0c27c: 90 eb 00 10 stw r7,16(r11) ffc0c280: 4b ff fe 60 b ffc0c0e0 <_RBTree_Validate_insert_unprotected+0x10> } else { /* if uncle is black */ 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) { ffc0c284: 20 ca 00 01 subfic r6,r10,1 ffc0c288: 55 40 10 3a rlwinm r0,r10,2,0,29 ffc0c28c: 4b ff ff 54 b ffc0c1e0 <_RBTree_Validate_insert_unprotected+0x110> if(!the_node) return NULL; if(!(the_node->parent)) return NULL; if(!(the_node->parent->parent)) return NULL; if(the_node == the_node->parent->child[RBT_LEFT]) return the_node->parent->child[RBT_RIGHT]; ffc0c290: 81 4b 00 08 lwz r10,8(r11) ffc0c294: 4b ff fe 94 b ffc0c128 <_RBTree_Validate_insert_unprotected+0x58> =============================================================================== ffc09848 <_RTEMS_tasks_Initialize_user_tasks_body>: * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc09848: 94 21 ff d8 stwu r1,-40(r1) ffc0984c: 7c 08 02 a6 mflr r0 rtems_initialization_tasks_table *user_tasks; /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; ffc09850: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc09854: 90 01 00 2c stw r0,44(r1) rtems_initialization_tasks_table *user_tasks; /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; ffc09858: 39 29 20 44 addi r9,r9,8260 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc0985c: 93 e1 00 24 stw r31,36(r1) rtems_initialization_tasks_table *user_tasks; /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; ffc09860: 83 e9 00 2c lwz r31,44(r9) * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc09864: 93 a1 00 1c stw r29,28(r1) maximum = Configuration_RTEMS_API.number_of_initialization_tasks; /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) ffc09868: 2f 9f 00 00 cmpwi cr7,r31,0 * * Output parameters: NONE */ void _RTEMS_tasks_Initialize_user_tasks_body( void ) { ffc0986c: 93 c1 00 20 stw r30,32(r1) /* * Move information into local variables */ user_tasks = Configuration_RTEMS_API.User_initialization_tasks_table; maximum = Configuration_RTEMS_API.number_of_initialization_tasks; ffc09870: 83 a9 00 28 lwz r29,40(r9) /* * Verify that we have a set of user tasks to iterate */ if ( !user_tasks ) ffc09874: 41 9e 00 5c beq- cr7,ffc098d0 <_RTEMS_tasks_Initialize_user_tasks_body+0x88> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { ffc09878: 2f 9d 00 00 cmpwi cr7,r29,0 ffc0987c: 41 9e 00 54 beq- cr7,ffc098d0 <_RTEMS_tasks_Initialize_user_tasks_body+0x88><== NEVER TAKEN ffc09880: 3b c0 00 00 li r30,0 return_value = rtems_task_create( ffc09884: 80 bf 00 04 lwz r5,4(r31) ffc09888: 39 01 00 08 addi r8,r1,8 ffc0988c: 80 7f 00 00 lwz r3,0(r31) ffc09890: 80 9f 00 08 lwz r4,8(r31) ffc09894: 80 df 00 14 lwz r6,20(r31) ffc09898: 80 ff 00 0c lwz r7,12(r31) ffc0989c: 4b ff fd 0d bl ffc095a8 user_tasks[ index ].stack_size, user_tasks[ index ].mode_set, user_tasks[ index ].attribute_set, &id ); if ( !rtems_is_status_successful( return_value ) ) ffc098a0: 7c 65 1b 79 mr. r5,r3 ffc098a4: 40 82 00 48 bne- ffc098ec <_RTEMS_tasks_Initialize_user_tasks_body+0xa4> _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); return_value = rtems_task_start( ffc098a8: 80 bf 00 18 lwz r5,24(r31) ffc098ac: 80 61 00 08 lwz r3,8(r1) ffc098b0: 80 9f 00 10 lwz r4,16(r31) ffc098b4: 48 00 00 45 bl ffc098f8 id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) ffc098b8: 7c 65 1b 79 mr. r5,r3 ffc098bc: 40 82 00 30 bne- ffc098ec <_RTEMS_tasks_Initialize_user_tasks_body+0xa4> return; /* * Now iterate over the initialization tasks and create/start them. */ for ( index=0 ; index < maximum ; index++ ) { ffc098c0: 3b de 00 01 addi r30,r30,1 ffc098c4: 7f 9e e8 00 cmpw cr7,r30,r29 ffc098c8: 3b ff 00 1c addi r31,r31,28 ffc098cc: 40 9e ff b8 bne+ cr7,ffc09884 <_RTEMS_tasks_Initialize_user_tasks_body+0x3c><== NEVER TAKEN user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); } } ffc098d0: 80 01 00 2c lwz r0,44(r1) ffc098d4: 83 a1 00 1c lwz r29,28(r1) ffc098d8: 7c 08 03 a6 mtlr r0 ffc098dc: 83 c1 00 20 lwz r30,32(r1) ffc098e0: 83 e1 00 24 lwz r31,36(r1) ffc098e4: 38 21 00 28 addi r1,r1,40 ffc098e8: 4e 80 00 20 blr id, user_tasks[ index ].entry_point, user_tasks[ index ].argument ); if ( !rtems_is_status_successful( return_value ) ) _Internal_error_Occurred( INTERNAL_ERROR_RTEMS_API, true, return_value ); ffc098ec: 38 60 00 01 li r3,1 ffc098f0: 38 80 00 01 li r4,1 ffc098f4: 48 00 14 0d bl ffc0ad00 <_Internal_error_Occurred> =============================================================================== ffc1085c <_RTEMS_tasks_Switch_extension>: /* * Per Task Variables */ tvp = executing->task_variables; ffc1085c: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc10860: 2f 89 00 00 cmpwi cr7,r9,0 ffc10864: 41 9e 00 24 beq- cr7,ffc10888 <_RTEMS_tasks_Switch_extension+0x2c> tvp->tval = *tvp->ptr; ffc10868: 81 69 00 04 lwz r11,4(r9) *tvp->ptr = tvp->gval; ffc1086c: 80 09 00 08 lwz r0,8(r9) * Per Task Variables */ tvp = executing->task_variables; while (tvp) { tvp->tval = *tvp->ptr; ffc10870: 81 4b 00 00 lwz r10,0(r11) ffc10874: 91 49 00 0c stw r10,12(r9) *tvp->ptr = tvp->gval; ffc10878: 90 0b 00 00 stw r0,0(r11) tvp = (rtems_task_variable_t *)tvp->next; ffc1087c: 81 29 00 00 lwz r9,0(r9) /* * Per Task Variables */ tvp = executing->task_variables; while (tvp) { ffc10880: 2f 89 00 00 cmpwi cr7,r9,0 ffc10884: 40 9e ff e4 bne+ cr7,ffc10868 <_RTEMS_tasks_Switch_extension+0xc><== NEVER TAKEN tvp->tval = *tvp->ptr; *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; ffc10888: 81 24 01 3c lwz r9,316(r4) while (tvp) { ffc1088c: 2f 89 00 00 cmpwi cr7,r9,0 ffc10890: 4d 9e 00 20 beqlr cr7 tvp->gval = *tvp->ptr; ffc10894: 81 69 00 04 lwz r11,4(r9) *tvp->ptr = tvp->tval; ffc10898: 80 09 00 0c lwz r0,12(r9) tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { tvp->gval = *tvp->ptr; ffc1089c: 81 4b 00 00 lwz r10,0(r11) ffc108a0: 91 49 00 08 stw r10,8(r9) *tvp->ptr = tvp->tval; ffc108a4: 90 0b 00 00 stw r0,0(r11) tvp = (rtems_task_variable_t *)tvp->next; ffc108a8: 81 29 00 00 lwz r9,0(r9) *tvp->ptr = tvp->gval; tvp = (rtems_task_variable_t *)tvp->next; } tvp = heir->task_variables; while (tvp) { ffc108ac: 2f 89 00 00 cmpwi cr7,r9,0 ffc108b0: 40 9e ff e4 bne+ cr7,ffc10894 <_RTEMS_tasks_Switch_extension+0x38><== NEVER TAKEN ffc108b4: 4e 80 00 20 blr =============================================================================== ffc0a7e4 <_Rate_monotonic_Timeout>: void _Rate_monotonic_Timeout( Objects_Id id, void *ignored ) { ffc0a7e4: 94 21 ff e0 stwu r1,-32(r1) ffc0a7e8: 7c 08 02 a6 mflr r0 ffc0a7ec: 7c 64 1b 78 mr r4,r3 ffc0a7f0: 3c 60 00 00 lis r3,0 ffc0a7f4: 90 01 00 24 stw r0,36(r1) ffc0a7f8: 38 63 2c 78 addi r3,r3,11384 ffc0a7fc: 38 a1 00 08 addi r5,r1,8 ffc0a800: 93 e1 00 1c stw r31,28(r1) ffc0a804: 48 00 27 dd bl ffc0cfe0 <_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 ) { ffc0a808: 80 01 00 08 lwz r0,8(r1) ffc0a80c: 7c 7f 1b 78 mr r31,r3 ffc0a810: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a814: 40 9e 00 4c bne- cr7,ffc0a860 <_Rate_monotonic_Timeout+0x7c><== NEVER TAKEN case OBJECTS_LOCAL: the_thread = the_period->owner; ffc0a818: 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); ffc0a81c: 80 03 00 10 lwz r0,16(r3) if ( _States_Is_waiting_for_period( the_thread->current_state ) && ffc0a820: 70 09 40 00 andi. r9,r0,16384 ffc0a824: 41 82 00 14 beq- ffc0a838 <_Rate_monotonic_Timeout+0x54> ffc0a828: 81 23 00 20 lwz r9,32(r3) ffc0a82c: 80 1f 00 08 lwz r0,8(r31) ffc0a830: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a834: 41 9e 00 6c beq- cr7,ffc0a8a0 <_Rate_monotonic_Timeout+0xbc> _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 ) { ffc0a838: 80 1f 00 38 lwz r0,56(r31) ffc0a83c: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a840: 41 9e 00 34 beq- cr7,ffc0a874 <_Rate_monotonic_Timeout+0x90> _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else the_period->state = RATE_MONOTONIC_EXPIRED; ffc0a844: 38 00 00 04 li r0,4 ffc0a848: 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--; ffc0a84c: 3d 20 00 00 lis r9,0 ffc0a850: 81 69 28 4c lwz r11,10316(r9) ffc0a854: 38 0b ff ff addi r0,r11,-1 ffc0a858: 90 09 28 4c stw r0,10316(r9) return _Thread_Dispatch_disable_level; ffc0a85c: 80 09 28 4c lwz r0,10316(r9) case OBJECTS_REMOTE: /* impossible */ #endif case OBJECTS_ERROR: break; } } ffc0a860: 80 01 00 24 lwz r0,36(r1) ffc0a864: 83 e1 00 1c lwz r31,28(r1) ffc0a868: 38 21 00 20 addi r1,r1,32 ffc0a86c: 7c 08 03 a6 mtlr r0 ffc0a870: 4e 80 00 20 blr _Rate_monotonic_Initiate_statistics( the_period ); _Watchdog_Insert_ticks( &the_period->Timer, the_period->next_length ); } else if ( the_period->state == RATE_MONOTONIC_OWNER_IS_BLOCKING ) { the_period->state = RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING; ffc0a874: 38 00 00 03 li r0,3 ffc0a878: 90 1f 00 38 stw r0,56(r31) _Rate_monotonic_Initiate_statistics( the_period ); ffc0a87c: 7f e3 fb 78 mr r3,r31 ffc0a880: 4b ff f7 d1 bl ffc0a050 <_Rate_monotonic_Initiate_statistics> Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a884: 80 1f 00 3c lwz r0,60(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a888: 3c 60 00 00 lis r3,0 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a88c: 90 1f 00 1c stw r0,28(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a890: 38 63 2e 48 addi r3,r3,11848 ffc0a894: 38 9f 00 10 addi r4,r31,16 ffc0a898: 48 00 4c 41 bl ffc0f4d8 <_Watchdog_Insert> ffc0a89c: 4b ff ff b0 b ffc0a84c <_Rate_monotonic_Timeout+0x68> RTEMS_INLINE_ROUTINE void _Thread_Unblock ( Thread_Control *the_thread ) { _Thread_Clear_state( the_thread, STATES_BLOCKED ); ffc0a8a0: 3c 80 10 03 lis r4,4099 ffc0a8a4: 60 84 ff f8 ori r4,r4,65528 ffc0a8a8: 48 00 33 85 bl ffc0dc2c <_Thread_Clear_state> ffc0a8ac: 4b ff ff d0 b ffc0a87c <_Rate_monotonic_Timeout+0x98> =============================================================================== ffc0b800 <_Scheduler_priority_Block>: ) { Scheduler_priority_Per_thread *sched_info; Chain_Control *ready; sched_info = (Scheduler_priority_Per_thread *) the_thread->scheduler_info; ffc0b800: 81 63 00 8c lwz r11,140(r3) ready = sched_info->ready_chain; ffc0b804: 81 2b 00 00 lwz r9,0(r11) if ( _Chain_Has_only_one_node( ready ) ) { ffc0b808: 81 49 00 00 lwz r10,0(r9) ffc0b80c: 80 09 00 08 lwz r0,8(r9) ffc0b810: 7f 8a 00 00 cmpw cr7,r10,r0 ffc0b814: 41 9e 00 a4 beq- cr7,ffc0b8b8 <_Scheduler_priority_Block+0xb8> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc0b818: 81 63 00 00 lwz r11,0(r3) previous = the_node->previous; ffc0b81c: 81 23 00 04 lwz r9,4(r3) next->previous = previous; ffc0b820: 91 2b 00 04 stw r9,4(r11) previous->next = next; ffc0b824: 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 ); ffc0b828: 3d 20 00 00 lis r9,0 ffc0b82c: 39 29 31 44 addi r9,r9,12612 { _Scheduler_priority_Ready_queue_extract( the_thread ); /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) ffc0b830: 80 09 00 10 lwz r0,16(r9) ffc0b834: 7f 83 00 00 cmpw cr7,r3,r0 ffc0b838: 41 9e 00 1c beq- cr7,ffc0b854 <_Scheduler_priority_Block+0x54> _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) ffc0b83c: 80 09 00 0c lwz r0,12(r9) ffc0b840: 7f 83 00 00 cmpw cr7,r3,r0 ffc0b844: 4c be 00 20 bnelr+ cr7 _Thread_Dispatch_necessary = true; ffc0b848: 38 00 00 01 li r0,1 ffc0b84c: 98 09 00 18 stb r0,24(r9) ffc0b850: 4e 80 00 20 blr 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 ); ffc0b854: 3c a0 00 00 lis r5,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 ffc0b858: 3d 40 00 00 lis r10,0 ffc0b85c: 81 65 28 4c lwz r11,10316(r5) ffc0b860: 81 4a 20 e0 lwz r10,8416(r10) ffc0b864: 7d 66 00 34 cntlzw r6,r11 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b868: 3c e0 00 00 lis r7,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 ); ffc0b86c: 91 65 28 4c stw r11,10316(r5) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b870: 38 e7 31 80 addi r7,r7,12672 ffc0b874: 54 c8 10 3a rlwinm r8,r6,2,0,29 ffc0b878: 7c 07 40 2e lwzx r0,r7,r8 ffc0b87c: 7c 0b 00 34 cntlzw r11,r0 return (_Priority_Bits_index( major ) << 4) + ffc0b880: 54 c6 20 36 rlwinm r6,r6,4,0,27 { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0b884: 7c 07 41 2e stwx r0,r7,r8 return (_Priority_Bits_index( major ) << 4) + ffc0b888: 7d 66 5a 14 add r11,r6,r11 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) ffc0b88c: 1d 6b 00 0c mulli r11,r11,12 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0b890: 7c 0a 58 2e lwzx r0,r10,r11 ffc0b894: 7d 0a 5a 14 add r8,r10,r11 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc0b898: 39 68 00 04 addi r11,r8,4 ffc0b89c: 7f 80 58 00 cmpw cr7,r0,r11 ffc0b8a0: 41 9e 00 60 beq- cr7,ffc0b900 <_Scheduler_priority_Block+0x100><== NEVER TAKEN * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0b8a4: 90 09 00 10 stw r0,16(r9) /* TODO: flash critical section? */ if ( _Thread_Is_heir( the_thread ) ) _Scheduler_priority_Schedule_body(); if ( _Thread_Is_executing( the_thread ) ) ffc0b8a8: 80 09 00 0c lwz r0,12(r9) ffc0b8ac: 7f 83 00 00 cmpw cr7,r3,r0 ffc0b8b0: 4c be 00 20 bnelr+ cr7 ffc0b8b4: 4b ff ff 94 b ffc0b848 <_Scheduler_priority_Block+0x48> RTEMS_INLINE_ROUTINE void _Priority_bit_map_Remove ( Priority_bit_map_Information *the_priority_map ) { *the_priority_map->minor &= the_priority_map->block_minor; ffc0b8b8: 81 4b 00 04 lwz r10,4(r11) 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 ); ffc0b8bc: 39 09 00 04 addi r8,r9,4 ffc0b8c0: 80 0b 00 14 lwz r0,20(r11) ffc0b8c4: 80 ea 00 00 lwz r7,0(r10) head->next = tail; ffc0b8c8: 91 09 00 00 stw r8,0(r9) head->previous = NULL; ffc0b8cc: 39 00 00 00 li r8,0 ffc0b8d0: 7c e0 00 38 and r0,r7,r0 if ( *the_priority_map->minor == 0 ) ffc0b8d4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0b8d8: 91 09 00 04 stw r8,4(r9) tail->previous = head; ffc0b8dc: 91 29 00 08 stw r9,8(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; ffc0b8e0: 90 0a 00 00 stw r0,0(r10) if ( *the_priority_map->minor == 0 ) ffc0b8e4: 40 be ff 44 bne- cr7,ffc0b828 <_Scheduler_priority_Block+0x28> _Priority_Major_bit_map &= the_priority_map->block_major; ffc0b8e8: 3d 20 00 00 lis r9,0 ffc0b8ec: 80 0b 00 10 lwz r0,16(r11) ffc0b8f0: 81 49 28 4c lwz r10,10316(r9) ffc0b8f4: 7d 40 00 38 and r0,r10,r0 ffc0b8f8: 90 09 28 4c stw r0,10316(r9) ffc0b8fc: 4b ff ff 2c b ffc0b828 <_Scheduler_priority_Block+0x28> Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc0b900: 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( ffc0b904: 90 09 00 10 stw r0,16(r9) <== NOT EXECUTED ffc0b908: 4b ff ff a0 b ffc0b8a8 <_Scheduler_priority_Block+0xa8><== NOT EXECUTED =============================================================================== ffc0bad8 <_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 ); ffc0bad8: 3c c0 00 00 lis r6,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 ffc0badc: 3d 60 00 00 lis r11,0 ffc0bae0: 81 26 28 4c lwz r9,10316(r6) ffc0bae4: 81 6b 20 e0 lwz r11,8416(r11) ffc0bae8: 7d 27 00 34 cntlzw r7,r9 _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0baec: 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 ); ffc0baf0: 91 26 28 4c stw r9,10316(r6) _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0baf4: 39 08 31 80 addi r8,r8,12672 ffc0baf8: 54 ea 10 3a rlwinm r10,r7,2,0,29 ffc0bafc: 7c 08 50 2e lwzx r0,r8,r10 ffc0bb00: 7c 06 00 34 cntlzw r6,r0 return (_Priority_Bits_index( major ) << 4) + ffc0bb04: 54 e9 20 36 rlwinm r9,r7,4,0,27 { Priority_bit_map_Control minor; Priority_bit_map_Control major; _Bitfield_Find_first_bit( _Priority_Major_bit_map, major ); _Bitfield_Find_first_bit( _Priority_Bit_map[major], minor ); ffc0bb08: 7c 08 51 2e stwx r0,r8,r10 return (_Priority_Bits_index( major ) << 4) + ffc0bb0c: 7d 29 32 14 add r9,r9,r6 Chain_Control *the_ready_queue ) { Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) ffc0bb10: 1d 29 00 0c mulli r9,r9,12 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0bb14: 7c 0b 48 2e lwzx r0,r11,r9 ffc0bb18: 7d 4b 4a 14 add r10,r11,r9 RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc0bb1c: 39 2a 00 04 addi r9,r10,4 ffc0bb20: 7f 80 48 00 cmpw cr7,r0,r9 ffc0bb24: 41 9e 00 10 beq- cr7,ffc0bb34 <_Scheduler_priority_Schedule+0x5c><== NEVER TAKEN * * @param[in] the_thread - pointer to thread */ RTEMS_INLINE_ROUTINE void _Scheduler_priority_Schedule_body(void) { _Thread_Heir = _Scheduler_priority_Ready_queue_first( ffc0bb28: 3d 20 00 00 lis r9,0 ffc0bb2c: 90 09 31 54 stw r0,12628(r9) #include void _Scheduler_priority_Schedule(void) { _Scheduler_priority_Schedule_body(); } ffc0bb30: 4e 80 00 20 blr Priority_Control index = _Priority_bit_map_Get_highest(); if ( !_Chain_Is_empty( &the_ready_queue[ index ] ) ) return (Thread_Control *) _Chain_First( &the_ready_queue[ index ] ); return NULL; ffc0bb34: 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( ffc0bb38: 3d 20 00 00 lis r9,0 <== NOT EXECUTED ffc0bb3c: 90 09 31 54 stw r0,12628(r9) <== NOT EXECUTED ffc0bb40: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc0bb44 <_Scheduler_priority_Tick>: #include #include void _Scheduler_priority_Tick( void ) { ffc0bb44: 7c 08 02 a6 mflr r0 ffc0bb48: 94 21 ff f0 stwu r1,-16(r1) Thread_Control *executing; executing = _Thread_Executing; ffc0bb4c: 3d 20 00 00 lis r9,0 #include #include void _Scheduler_priority_Tick( void ) { ffc0bb50: 90 01 00 14 stw r0,20(r1) Thread_Control *executing; executing = _Thread_Executing; ffc0bb54: 80 69 31 50 lwz r3,12624(r9) /* * If the thread is not preemptible or is not ready, then * just return. */ if ( !executing->is_preemptible ) ffc0bb58: 88 03 00 74 lbz r0,116(r3) ffc0bb5c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bb60: 41 9e 00 2c beq- cr7,ffc0bb8c <_Scheduler_priority_Tick+0x48> return; if ( !_States_Is_ready( executing->current_state ) ) ffc0bb64: 80 03 00 10 lwz r0,16(r3) ffc0bb68: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bb6c: 40 9e 00 20 bne- cr7,ffc0bb8c <_Scheduler_priority_Tick+0x48> /* * The cpu budget algorithm determines what happens next. */ switch ( executing->budget_algorithm ) { ffc0bb70: 80 03 00 7c lwz r0,124(r3) ffc0bb74: 2b 80 00 01 cmplwi cr7,r0,1 ffc0bb78: 41 9c 00 14 blt- cr7,ffc0bb8c <_Scheduler_priority_Tick+0x48> ffc0bb7c: 2b 80 00 02 cmplwi cr7,r0,2 ffc0bb80: 40 9d 00 40 ble- cr7,ffc0bbc0 <_Scheduler_priority_Tick+0x7c> ffc0bb84: 2f 80 00 03 cmpwi cr7,r0,3 ffc0bb88: 41 9e 00 14 beq- cr7,ffc0bb9c <_Scheduler_priority_Tick+0x58><== ALWAYS TAKEN if ( --executing->cpu_time_budget == 0 ) (*executing->budget_callout)( executing ); break; #endif } } ffc0bb8c: 80 01 00 14 lwz r0,20(r1) ffc0bb90: 38 21 00 10 addi r1,r1,16 ffc0bb94: 7c 08 03 a6 mtlr r0 ffc0bb98: 4e 80 00 20 blr } break; #if defined(RTEMS_SCORE_THREAD_ENABLE_SCHEDULER_CALLOUT) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: if ( --executing->cpu_time_budget == 0 ) ffc0bb9c: 81 23 00 78 lwz r9,120(r3) ffc0bba0: 38 09 ff ff addi r0,r9,-1 ffc0bba4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bba8: 90 03 00 78 stw r0,120(r3) ffc0bbac: 40 9e ff e0 bne+ cr7,ffc0bb8c <_Scheduler_priority_Tick+0x48> (*executing->budget_callout)( executing ); ffc0bbb0: 80 03 00 80 lwz r0,128(r3) ffc0bbb4: 7c 09 03 a6 mtctr r0 ffc0bbb8: 4e 80 04 21 bctrl ffc0bbbc: 4b ff ff d0 b ffc0bb8c <_Scheduler_priority_Tick+0x48> 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 ) { ffc0bbc0: 81 23 00 78 lwz r9,120(r3) ffc0bbc4: 38 09 ff ff addi r0,r9,-1 ffc0bbc8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bbcc: 90 03 00 78 stw r0,120(r3) ffc0bbd0: 41 9d ff bc bgt+ cr7,ffc0bb8c <_Scheduler_priority_Tick+0x48> * always operates on the scheduler that 'owns' the currently executing * thread. */ RTEMS_INLINE_ROUTINE void _Scheduler_Yield( void ) { _Scheduler.Operations.yield(); ffc0bbd4: 3d 20 00 00 lis r9,0 ffc0bbd8: 90 61 00 08 stw r3,8(r1) ffc0bbdc: 80 09 20 ec lwz r0,8428(r9) ffc0bbe0: 7c 09 03 a6 mtctr r0 ffc0bbe4: 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; ffc0bbe8: 3d 20 00 00 lis r9,0 ffc0bbec: 80 09 28 08 lwz r0,10248(r9) ffc0bbf0: 80 61 00 08 lwz r3,8(r1) ffc0bbf4: 90 03 00 78 stw r0,120(r3) ffc0bbf8: 4b ff ff 94 b ffc0bb8c <_Scheduler_priority_Tick+0x48> =============================================================================== ffc0bcf4 <_Scheduler_priority_Yield>: Scheduler_priority_Per_thread *sched_info; ISR_Level level; Thread_Control *executing; Chain_Control *ready; executing = _Thread_Executing; ffc0bcf4: 3d 40 00 00 lis r10,0 ffc0bcf8: 39 4a 31 44 addi r10,r10,12612 ffc0bcfc: 81 2a 00 0c lwz r9,12(r10) sched_info = (Scheduler_priority_Per_thread *) executing->scheduler_info; ready = sched_info->ready_chain; ffc0bd00: 81 69 00 8c lwz r11,140(r9) ffc0bd04: 81 6b 00 00 lwz r11,0(r11) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0bd08: 7c 00 00 a6 mfmsr r0 ffc0bd0c: 7d 10 42 a6 mfsprg r8,0 ffc0bd10: 7c 08 40 78 andc r8,r0,r8 ffc0bd14: 7d 00 01 24 mtmsr r8 _ISR_Disable( level ); if ( !_Chain_Has_only_one_node( ready ) ) { ffc0bd18: 80 eb 00 00 lwz r7,0(r11) ffc0bd1c: 81 0b 00 08 lwz r8,8(r11) ffc0bd20: 7f 87 40 00 cmpw cr7,r7,r8 ffc0bd24: 41 9e 00 60 beq- cr7,ffc0bd84 <_Scheduler_priority_Yield+0x90> ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc0bd28: 80 c9 00 00 lwz r6,0(r9) RTEMS_INLINE_ROUTINE void _Chain_Append_unprotected( Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); ffc0bd2c: 38 ab 00 04 addi r5,r11,4 { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; ffc0bd30: 80 e9 00 04 lwz r7,4(r9) next->previous = previous; ffc0bd34: 90 e6 00 04 stw r7,4(r6) Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; ffc0bd38: 81 0b 00 08 lwz r8,8(r11) Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; previous->next = next; ffc0bd3c: 90 c7 00 00 stw r6,0(r7) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; ffc0bd40: 91 2b 00 08 stw r9,8(r11) ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; ffc0bd44: 90 a9 00 00 stw r5,0(r9) tail->previous = the_node; old_last->next = the_node; the_node->previous = old_last; ffc0bd48: 91 09 00 04 stw r8,4(r9) Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; old_last->next = the_node; ffc0bd4c: 91 28 00 00 stw r9,0(r8) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0bd50: 7d 00 00 a6 mfmsr r8 ffc0bd54: 7c 00 01 24 mtmsr r0 ffc0bd58: 7d 00 01 24 mtmsr r8 _Chain_Extract_unprotected( &executing->Object.Node ); _Chain_Append_unprotected( ready, &executing->Object.Node ); _ISR_Flash( level ); if ( _Thread_Is_heir( executing ) ) ffc0bd5c: 81 0a 00 10 lwz r8,16(r10) ffc0bd60: 7f 89 40 00 cmpw cr7,r9,r8 ffc0bd64: 41 9e 00 14 beq- cr7,ffc0bd78 <_Scheduler_priority_Yield+0x84><== ALWAYS TAKEN _Thread_Heir = (Thread_Control *) _Chain_First( ready ); _Thread_Dispatch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) _Thread_Dispatch_necessary = true; ffc0bd68: 39 20 00 01 li r9,1 ffc0bd6c: 99 2a 00 18 stb r9,24(r10) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0bd70: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); } ffc0bd74: 4e 80 00 20 blr _Chain_Append_unprotected( ready, &executing->Object.Node ); _ISR_Flash( level ); if ( _Thread_Is_heir( executing ) ) _Thread_Heir = (Thread_Control *) _Chain_First( ready ); ffc0bd78: 81 2b 00 00 lwz r9,0(r11) ffc0bd7c: 91 2a 00 10 stw r9,16(r10) ffc0bd80: 4b ff ff e8 b ffc0bd68 <_Scheduler_priority_Yield+0x74> _Thread_Dispatch_necessary = true; } else if ( !_Thread_Is_heir( executing ) ) ffc0bd84: 81 6a 00 10 lwz r11,16(r10) ffc0bd88: 7f 89 58 00 cmpw cr7,r9,r11 ffc0bd8c: 40 9e ff dc bne+ cr7,ffc0bd68 <_Scheduler_priority_Yield+0x74> ffc0bd90: 4b ff ff e0 b ffc0bd70 <_Scheduler_priority_Yield+0x7c> =============================================================================== ffc0c51c <_Scheduler_simple_Ready_queue_enqueue_first>: { Chain_Control *ready; Chain_Node *the_node; Thread_Control *current; ready = (Chain_Control *)_Scheduler.information; ffc0c51c: 3d 20 00 00 lis r9,0 */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { ffc0c520: 81 63 00 14 lwz r11,20(r3) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc0c524: 81 29 20 e0 lwz r9,8416(r9) ffc0c528: 81 29 00 00 lwz r9,0(r9) ffc0c52c: 80 09 00 14 lwz r0,20(r9) ffc0c530: 7f 80 58 40 cmplw cr7,r0,r11 ffc0c534: 40 9c 00 14 bge- cr7,ffc0c548 <_Scheduler_simple_Ready_queue_enqueue_first+0x2c> * Do NOT need to check for end of chain because there is always * at least one task on the ready chain -- the IDLE task. It can * never block, should never attempt to obtain a semaphore or mutex, * and thus will always be there. */ for ( the_node = _Chain_First(ready) ; ; the_node = the_node->next ) { ffc0c538: 81 29 00 00 lwz r9,0(r9) current = (Thread_Control *) the_node; /* break when AT HEAD OF (or PAST) our priority */ if ( the_thread->current_priority <= current->current_priority ) { ffc0c53c: 80 09 00 14 lwz r0,20(r9) ffc0c540: 7f 80 58 40 cmplw cr7,r0,r11 ffc0c544: 41 9c ff f4 blt+ cr7,ffc0c538 <_Scheduler_simple_Ready_queue_enqueue_first+0x1c><== NEVER TAKEN current = (Thread_Control *)current->Object.Node.previous; ffc0c548: 81 29 00 04 lwz r9,4(r9) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0c54c: 81 69 00 00 lwz r11,0(r9) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0c550: 91 23 00 04 stw r9,4(r3) before_node = after_node->next; after_node->next = the_node; ffc0c554: 90 69 00 00 stw r3,0(r9) the_node->next = before_node; before_node->previous = the_node; ffc0c558: 90 6b 00 04 stw r3,4(r11) Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; ffc0c55c: 91 63 00 00 stw r11,0(r3) } } /* enqueue */ _Chain_Insert_unprotected( (Chain_Node *)current, &the_thread->Object.Node ); } ffc0c560: 4e 80 00 20 blr =============================================================================== ffc0bdf8 <_Thread_Change_priority>: void _Thread_Change_priority( Thread_Control *the_thread, Priority_Control new_priority, bool prepend_it ) { ffc0bdf8: 94 21 ff e8 stwu r1,-24(r1) ffc0bdfc: 7c 08 02 a6 mflr r0 ffc0be00: 90 01 00 1c stw r0,28(r1) ffc0be04: 93 e1 00 14 stw r31,20(r1) ffc0be08: 7c 7f 1b 78 mr r31,r3 ffc0be0c: 93 81 00 08 stw r28,8(r1) ffc0be10: 7c bc 2b 78 mr r28,r5 ffc0be14: 93 a1 00 0c stw r29,12(r1) ffc0be18: 93 c1 00 10 stw r30,16(r1) ffc0be1c: 7c 9e 23 78 mr r30,r4 States_Control state, original_state; /* * Save original state */ original_state = the_thread->current_state; ffc0be20: 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 ); ffc0be24: 48 00 11 69 bl ffc0cf8c <_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 ) ffc0be28: 80 1f 00 14 lwz r0,20(r31) ffc0be2c: 7f 80 f0 00 cmpw cr7,r0,r30 ffc0be30: 41 9e 00 10 beq- cr7,ffc0be40 <_Thread_Change_priority+0x48> _Thread_Set_priority( the_thread, new_priority ); ffc0be34: 7f e3 fb 78 mr r3,r31 ffc0be38: 7f c4 f3 78 mr r4,r30 ffc0be3c: 48 00 10 a9 bl ffc0cee4 <_Thread_Set_priority> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0be40: 7f c0 00 a6 mfmsr r30 ffc0be44: 7c 10 42 a6 mfsprg r0,0 ffc0be48: 7f c0 00 78 andc r0,r30,r0 ffc0be4c: 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; ffc0be50: 80 1f 00 10 lwz r0,16(r31) if ( state != STATES_TRANSIENT ) { ffc0be54: 2f 80 00 04 cmpwi cr7,r0,4 ffc0be58: 41 9e 00 88 beq- cr7,ffc0bee0 <_Thread_Change_priority+0xe8> /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) ffc0be5c: 73 a9 00 04 andi. r9,r29,4 ffc0be60: 41 82 00 38 beq- ffc0be98 <_Thread_Change_priority+0xa0><== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0be64: 7f c0 01 24 mtmsr r30 <== NOT EXECUTED */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); ffc0be68: 3d 20 00 03 lis r9,3 <== NOT EXECUTED ffc0be6c: 61 29 be e0 ori r9,r9,48864 <== NOT EXECUTED the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); _ISR_Enable( level ); if ( _States_Is_waiting_on_thread_queue( state ) ) { ffc0be70: 7c 0b 48 39 and. r11,r0,r9 <== NOT EXECUTED ffc0be74: 40 82 00 40 bne- ffc0beb4 <_Thread_Change_priority+0xbc><== NOT EXECUTED if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } ffc0be78: 80 01 00 1c lwz r0,28(r1) ffc0be7c: 83 81 00 08 lwz r28,8(r1) ffc0be80: 7c 08 03 a6 mtlr r0 ffc0be84: 83 a1 00 0c lwz r29,12(r1) ffc0be88: 83 c1 00 10 lwz r30,16(r1) ffc0be8c: 83 e1 00 14 lwz r31,20(r1) ffc0be90: 38 21 00 18 addi r1,r1,24 ffc0be94: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE States_Control _States_Clear ( States_Control states_to_clear, States_Control current_state ) { return (current_state & ~states_to_clear); ffc0be98: 54 09 07 b8 rlwinm r9,r0,0,30,28 */ state = the_thread->current_state; if ( state != STATES_TRANSIENT ) { /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) the_thread->current_state = _States_Clear( STATES_TRANSIENT, state ); ffc0be9c: 91 3f 00 10 stw r9,16(r31) ffc0bea0: 7f c0 01 24 mtmsr r30 */ RTEMS_INLINE_ROUTINE bool _States_Is_waiting_on_thread_queue ( States_Control the_states ) { return (the_states & STATES_WAITING_ON_THREAD_QUEUE); ffc0bea4: 3d 20 00 03 lis r9,3 ffc0bea8: 61 29 be e0 ori r9,r9,48864 _ISR_Enable( level ); if ( _States_Is_waiting_on_thread_queue( state ) ) { ffc0beac: 7c 0b 48 39 and. r11,r0,r9 ffc0beb0: 41 82 ff c8 beq+ ffc0be78 <_Thread_Change_priority+0x80> _Thread_queue_Requeue( the_thread->Wait.queue, the_thread ); ffc0beb4: 80 7f 00 44 lwz r3,68(r31) ffc0beb8: 7f e4 fb 78 mr r4,r31 ffc0bebc: 48 00 0f 2d bl ffc0cde8 <_Thread_queue_Requeue> if ( !_Thread_Is_executing_also_the_heir() && _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; _ISR_Enable( level ); } ffc0bec0: 80 01 00 1c lwz r0,28(r1) ffc0bec4: 83 81 00 08 lwz r28,8(r1) ffc0bec8: 7c 08 03 a6 mtlr r0 ffc0becc: 83 a1 00 0c lwz r29,12(r1) ffc0bed0: 83 c1 00 10 lwz r30,16(r1) ffc0bed4: 83 e1 00 14 lwz r31,20(r1) ffc0bed8: 38 21 00 18 addi r1,r1,24 ffc0bedc: 4e 80 00 20 blr } return; } /* Only clear the transient state if it wasn't set already */ if ( ! _States_Is_transient( original_state ) ) { ffc0bee0: 73 bd 00 04 andi. r29,r29,4 ffc0bee4: 41 82 00 74 beq- ffc0bf58 <_Thread_Change_priority+0x160><== ALWAYS TAKEN ffc0bee8: 3f a0 00 00 lis r29,0 <== NOT EXECUTED ffc0beec: 3b bd 20 e0 addi r29,r29,8416 <== NOT EXECUTED static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0bef0: 7c 00 00 a6 mfmsr r0 ffc0bef4: 7f c0 01 24 mtmsr r30 ffc0bef8: 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(); ffc0befc: 80 1d 00 08 lwz r0,8(r29) ffc0bf00: 7c 09 03 a6 mtctr r0 ffc0bf04: 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 ); ffc0bf08: 3d 20 00 00 lis r9,0 ffc0bf0c: 39 29 31 44 addi r9,r9,12612 ffc0bf10: 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() && ffc0bf14: 80 09 00 10 lwz r0,16(r9) ffc0bf18: 7f 8b 00 00 cmpw cr7,r11,r0 ffc0bf1c: 41 9e 00 18 beq- cr7,ffc0bf34 <_Thread_Change_priority+0x13c> ffc0bf20: 88 0b 00 74 lbz r0,116(r11) ffc0bf24: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bf28: 41 9e 00 0c beq- cr7,ffc0bf34 <_Thread_Change_priority+0x13c> _Thread_Executing->is_preemptible ) _Thread_Dispatch_necessary = true; ffc0bf2c: 38 00 00 01 li r0,1 ffc0bf30: 98 09 00 18 stb r0,24(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0bf34: 7f c0 01 24 mtmsr r30 _ISR_Enable( level ); } ffc0bf38: 80 01 00 1c lwz r0,28(r1) ffc0bf3c: 83 81 00 08 lwz r28,8(r1) ffc0bf40: 7c 08 03 a6 mtlr r0 ffc0bf44: 83 a1 00 0c lwz r29,12(r1) ffc0bf48: 83 c1 00 10 lwz r30,16(r1) ffc0bf4c: 83 e1 00 14 lwz r31,20(r1) ffc0bf50: 38 21 00 18 addi r1,r1,24 ffc0bf54: 4e 80 00 20 blr * 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 ) ffc0bf58: 2f 9c 00 00 cmpwi cr7,r28,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 ); ffc0bf5c: 93 bf 00 10 stw r29,16(r31) */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue_first( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue_first( the_thread ); ffc0bf60: 3f a0 00 00 lis r29,0 ffc0bf64: 3b bd 20 e0 addi r29,r29,8416 if ( prepend_it ) ffc0bf68: 41 9e 00 18 beq- cr7,ffc0bf80 <_Thread_Change_priority+0x188> ffc0bf6c: 80 1d 00 28 lwz r0,40(r29) ffc0bf70: 7f e3 fb 78 mr r3,r31 ffc0bf74: 7c 09 03 a6 mtctr r0 ffc0bf78: 4e 80 04 21 bctrl ffc0bf7c: 4b ff ff 74 b ffc0bef0 <_Thread_Change_priority+0xf8> */ RTEMS_INLINE_ROUTINE void _Scheduler_Enqueue( Thread_Control *the_thread ) { _Scheduler.Operations.enqueue( the_thread ); ffc0bf80: 80 1d 00 24 lwz r0,36(r29) ffc0bf84: 7f e3 fb 78 mr r3,r31 ffc0bf88: 7c 09 03 a6 mtctr r0 ffc0bf8c: 4e 80 04 21 bctrl ffc0bf90: 4b ff ff 60 b ffc0bef0 <_Thread_Change_priority+0xf8> =============================================================================== ffc0c20c <_Thread_Delay_ended>: void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0c20c: 94 21 ff e8 stwu r1,-24(r1) ffc0c210: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0c214: 38 81 00 08 addi r4,r1,8 void _Thread_Delay_ended( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0c218: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0c21c: 48 00 02 35 bl ffc0c450 <_Thread_Get> switch ( location ) { ffc0c220: 80 01 00 08 lwz r0,8(r1) ffc0c224: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c228: 40 9e 00 24 bne- cr7,ffc0c24c <_Thread_Delay_ended+0x40><== NEVER TAKEN #if defined(RTEMS_MULTIPROCESSING) case OBJECTS_REMOTE: /* impossible */ #endif break; case OBJECTS_LOCAL: _Thread_Clear_state( ffc0c22c: 3c 80 10 00 lis r4,4096 ffc0c230: 60 84 00 18 ori r4,r4,24 ffc0c234: 4b ff fd 61 bl ffc0bf94 <_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--; ffc0c238: 3d 20 00 00 lis r9,0 ffc0c23c: 81 69 28 0c lwz r11,10252(r9) ffc0c240: 38 0b ff ff addi r0,r11,-1 ffc0c244: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc0c248: 80 09 28 0c lwz r0,10252(r9) | STATES_INTERRUPTIBLE_BY_SIGNAL ); _Thread_Unnest_dispatch(); break; } } ffc0c24c: 80 01 00 1c lwz r0,28(r1) ffc0c250: 38 21 00 18 addi r1,r1,24 ffc0c254: 7c 08 03 a6 mtlr r0 ffc0c258: 4e 80 00 20 blr =============================================================================== ffc0c25c <_Thread_Dispatch>: * INTERRUPT LATENCY: * dispatch thread * no dispatch thread */ void _Thread_Dispatch( void ) { ffc0c25c: 94 21 ff c8 stwu r1,-56(r1) ffc0c260: 7c 08 02 a6 mflr r0 ffc0c264: 93 21 00 1c stw r25,28(r1) * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc0c268: 3f 20 00 00 lis r25,0 ffc0c26c: 81 39 28 0c lwz r9,10252(r25) ffc0c270: 90 01 00 3c stw r0,60(r1) ffc0c274: 38 09 00 01 addi r0,r9,1 ffc0c278: 90 19 28 0c stw r0,10252(r25) ffc0c27c: 93 01 00 18 stw r24,24(r1) return _Thread_Dispatch_disable_level; ffc0c280: 80 19 28 0c lwz r0,10252(r25) ffc0c284: 93 41 00 20 stw r26,32(r1) ffc0c288: 93 61 00 24 stw r27,36(r1) ffc0c28c: 93 81 00 28 stw r28,40(r1) ffc0c290: 93 a1 00 2c stw r29,44(r1) ffc0c294: 93 c1 00 30 stw r30,48(r1) ffc0c298: 93 e1 00 34 stw r31,52(r1) #endif /* * Now determine if we need to perform a dispatch on the current CPU. */ executing = _Thread_Executing; ffc0c29c: 3f a0 00 00 lis r29,0 ffc0c2a0: 3b bd 31 44 addi r29,r29,12612 ffc0c2a4: 83 fd 00 0c lwz r31,12(r29) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0c2a8: 7c 00 00 a6 mfmsr r0 ffc0c2ac: 7d 30 42 a6 mfsprg r9,0 ffc0c2b0: 7c 09 48 78 andc r9,r0,r9 ffc0c2b4: 7d 20 01 24 mtmsr r9 _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { ffc0c2b8: 89 3d 00 18 lbz r9,24(r29) ffc0c2bc: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c2c0: 41 9e 01 14 beq- cr7,ffc0c3d4 <_Thread_Dispatch+0x178> heir = _Thread_Heir; ffc0c2c4: 83 dd 00 10 lwz r30,16(r29) _Thread_Dispatch_necessary = false; ffc0c2c8: 39 20 00 00 li r9,0 ffc0c2cc: 99 3d 00 18 stb r9,24(r29) /* * 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 ) ffc0c2d0: 7f 9f f0 00 cmpw cr7,r31,r30 _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_necessary = false; _Thread_Executing = heir; ffc0c2d4: 93 dd 00 0c stw r30,12(r29) /* * 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 ) ffc0c2d8: 41 9e 00 fc beq- cr7,ffc0c3d4 <_Thread_Dispatch+0x178> ffc0c2dc: 3f 80 00 00 lis r28,0 ffc0c2e0: 3b 7d 00 1c addi r27,r29,28 ffc0c2e4: 3b 9c 28 20 addi r28,r28,10272 #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; ffc0c2e8: 3f 00 00 00 lis r24,0 executing = _Thread_Executing; _ISR_Disable( level ); while ( _Thread_Dispatch_necessary == true ) { heir = _Thread_Heir; _Thread_Dispatch_necessary = false; ffc0c2ec: 3b 40 00 00 li r26,0 ffc0c2f0: 48 00 00 cc b ffc0c3bc <_Thread_Dispatch+0x160> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0c2f4: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ { Timestamp_Control uptime, ran; _TOD_Get_uptime( &uptime ); ffc0c2f8: 38 61 00 10 addi r3,r1,16 ffc0c2fc: 48 00 4b 05 bl ffc10e00 <_TOD_Get_uptime> _Timestamp_Subtract( ffc0c300: 7f 63 db 78 mr r3,r27 ffc0c304: 38 81 00 10 addi r4,r1,16 ffc0c308: 38 a1 00 08 addi r5,r1,8 ffc0c30c: 48 00 0f 0d bl ffc0d218 <_Timespec_Subtract> &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); ffc0c310: 38 81 00 08 addi r4,r1,8 ffc0c314: 38 7f 00 84 addi r3,r31,132 ffc0c318: 48 00 0e a5 bl ffc0d1bc <_Timespec_Add_to> #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0c31c: 81 3c 00 00 lwz r9,0(r28) &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; ffc0c320: 81 41 00 10 lwz r10,16(r1) if ( _Thread_libc_reent ) { executing->libc_reent = *_Thread_libc_reent; *_Thread_libc_reent = heir->libc_reent; } _User_extensions_Thread_switch( executing, heir ); ffc0c324: 7f e3 fb 78 mr r3,r31 #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0c328: 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; ffc0c32c: 81 61 00 14 lwz r11,20(r1) if ( _Thread_libc_reent ) { executing->libc_reent = *_Thread_libc_reent; *_Thread_libc_reent = heir->libc_reent; } _User_extensions_Thread_switch( executing, heir ); ffc0c330: 7f c4 f3 78 mr r4,r30 &_Thread_Time_of_last_context_switch, &uptime, &ran ); _Timestamp_Add_to( &executing->cpu_time_used, &ran ); _Thread_Time_of_last_context_switch = uptime; ffc0c334: 91 5d 00 1c stw r10,28(r29) ffc0c338: 91 7d 00 20 stw r11,32(r29) #endif /* * Switch libc's task specific data. */ if ( _Thread_libc_reent ) { ffc0c33c: 41 9e 00 14 beq- cr7,ffc0c350 <_Thread_Dispatch+0xf4> <== NEVER TAKEN executing->libc_reent = *_Thread_libc_reent; ffc0c340: 80 09 00 00 lwz r0,0(r9) ffc0c344: 90 1f 01 2c stw r0,300(r31) *_Thread_libc_reent = heir->libc_reent; ffc0c348: 80 1e 01 2c lwz r0,300(r30) ffc0c34c: 90 09 00 00 stw r0,0(r9) } _User_extensions_Thread_switch( executing, heir ); ffc0c350: 48 00 13 5d bl ffc0d6ac <_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 ) ffc0c354: 80 1f 01 28 lwz r0,296(r31) _Context_Save_fp( &executing->fp_context ); ffc0c358: 38 7f 01 28 addi r3,r31,296 * operations. */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) #if ( CPU_USE_DEFERRED_FP_SWITCH != TRUE ) if ( executing->fp_context != NULL ) ffc0c35c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c360: 41 9e 00 08 beq- cr7,ffc0c368 <_Thread_Dispatch+0x10c> _Context_Save_fp( &executing->fp_context ); ffc0c364: 48 01 20 dd bl ffc1e440 <_CPU_Context_save_fp> #endif #endif _Context_Switch( &executing->Registers, &heir->Registers ); ffc0c368: 38 7f 00 c8 addi r3,r31,200 ffc0c36c: 38 9e 00 c8 addi r4,r30,200 ffc0c370: 48 01 22 51 bl ffc1e5c0 <_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 ) ffc0c374: 80 1f 01 28 lwz r0,296(r31) _Context_Restore_fp( &executing->fp_context ); ffc0c378: 38 7f 01 28 addi r3,r31,296 _Context_Save_fp( &_Thread_Allocated_fp->fp_context ); _Context_Restore_fp( &executing->fp_context ); _Thread_Allocated_fp = executing; } #else if ( executing->fp_context != NULL ) ffc0c37c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0c380: 41 9e 00 08 beq- cr7,ffc0c388 <_Thread_Dispatch+0x12c> _Context_Restore_fp( &executing->fp_context ); ffc0c384: 48 01 21 7d bl ffc1e500 <_CPU_Context_restore_fp> #endif #endif executing = _Thread_Executing; ffc0c388: 83 fd 00 0c lwz r31,12(r29) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0c38c: 7c 00 00 a6 mfmsr r0 ffc0c390: 7d 30 42 a6 mfsprg r9,0 ffc0c394: 7c 09 48 78 andc r9,r0,r9 ffc0c398: 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 ) { ffc0c39c: 89 3d 00 18 lbz r9,24(r29) ffc0c3a0: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c3a4: 41 9e 00 30 beq- cr7,ffc0c3d4 <_Thread_Dispatch+0x178> heir = _Thread_Heir; ffc0c3a8: 83 dd 00 10 lwz r30,16(r29) _Thread_Dispatch_necessary = false; ffc0c3ac: 9b 5d 00 18 stb r26,24(r29) /* * 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 ) ffc0c3b0: 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; ffc0c3b4: 93 dd 00 0c stw r30,12(r29) /* * 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 ) ffc0c3b8: 41 9e 00 1c beq- cr7,ffc0c3d4 <_Thread_Dispatch+0x178> <== NEVER TAKEN */ #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 ) ffc0c3bc: 81 3e 00 7c lwz r9,124(r30) ffc0c3c0: 2f 89 00 01 cmpwi cr7,r9,1 ffc0c3c4: 40 9e ff 30 bne+ cr7,ffc0c2f4 <_Thread_Dispatch+0x98> heir->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0c3c8: 81 38 28 08 lwz r9,10248(r24) ffc0c3cc: 91 3e 00 78 stw r9,120(r30) ffc0c3d0: 4b ff ff 24 b ffc0c2f4 <_Thread_Dispatch+0x98> * This routine sets thread dispatch level to the * value passed in. */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_set_disable_level(uint32_t value) { _Thread_Dispatch_disable_level = value; ffc0c3d4: 39 20 00 00 li r9,0 ffc0c3d8: 91 39 28 0c stw r9,10252(r25) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0c3dc: 7c 00 01 24 mtmsr r0 post_switch: _Thread_Dispatch_set_disable_level( 0 ); _ISR_Enable( level ); _API_extensions_Run_postswitch(); ffc0c3e0: 4b ff db ad bl ffc09f8c <_API_extensions_Run_postswitch> } ffc0c3e4: 80 01 00 3c lwz r0,60(r1) ffc0c3e8: 83 01 00 18 lwz r24,24(r1) ffc0c3ec: 7c 08 03 a6 mtlr r0 ffc0c3f0: 83 21 00 1c lwz r25,28(r1) ffc0c3f4: 83 41 00 20 lwz r26,32(r1) ffc0c3f8: 83 61 00 24 lwz r27,36(r1) ffc0c3fc: 83 81 00 28 lwz r28,40(r1) ffc0c400: 83 a1 00 2c lwz r29,44(r1) ffc0c404: 83 c1 00 30 lwz r30,48(r1) ffc0c408: 83 e1 00 34 lwz r31,52(r1) ffc0c40c: 38 21 00 38 addi r1,r1,56 ffc0c410: 4e 80 00 20 blr =============================================================================== ffc13994 <_Thread_Handler>: * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc13994: 94 21 ff f0 stwu r1,-16(r1) ffc13998: 7c 08 02 a6 mflr r0 #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; ffc1399c: 3d 20 00 00 lis r9,0 * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc139a0: 90 01 00 14 stw r0,20(r1) ffc139a4: 93 e1 00 0c stw r31,12(r1) #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) static char doneConstructors; char doneCons; #endif executing = _Thread_Executing; ffc139a8: 83 e9 31 50 lwz r31,12624(r9) * * Output parameters: NONE */ void _Thread_Handler( void ) { ffc139ac: 93 c1 00 08 stw r30,8(r1) /* * have to put level into a register for those cpu's that use * inline asm here */ level = executing->Start.isr_level; ffc139b0: 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); ffc139b4: 38 00 00 00 li r0,0 ffc139b8: 7c 00 00 a6 mfmsr r0 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc139bc: 71 2b 00 01 andi. r11,r9,1 static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; __asm__ volatile ( ffc139c0: 7d 30 42 a6 mfsprg r9,0 ffc139c4: 40 82 00 5c bne- ffc13a20 <_Thread_Handler+0x8c> msr |= ppc_interrupt_get_disable_mask(); ffc139c8: 7d 20 03 78 or r0,r9,r0 } else { msr &= ~ppc_interrupt_get_disable_mask(); } _CPU_MSR_SET(msr); ffc139cc: 7c 00 01 24 mtmsr r0 _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; ffc139d0: 3d 20 00 00 lis r9,0 ffc139d4: 8b c9 29 f8 lbz r30,10744(r9) doneConstructors = 1; ffc139d8: 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 ); ffc139dc: 7f e3 fb 78 mr r3,r31 level = executing->Start.isr_level; _ISR_Set_level(level); #if defined(EXECUTE_GLOBAL_CONSTRUCTORS) doneCons = doneConstructors; doneConstructors = 1; ffc139e0: 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 ); ffc139e4: 4b ff 99 8d bl ffc0d370 <_User_extensions_Thread_begin> /* * At this point, the dispatch disable level BETTER be 1. */ _Thread_Enable_dispatch(); ffc139e8: 4b ff 8a 2d bl ffc0c414 <_Thread_Enable_dispatch> /* * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { ffc139ec: 2f 9e 00 00 cmpwi cr7,r30,0 ffc139f0: 41 9e 00 38 beq- cr7,ffc13a28 <_Thread_Handler+0x94> #endif } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { ffc139f4: 80 1f 00 94 lwz r0,148(r31) ffc139f8: 2f 80 00 00 cmpwi cr7,r0,0 ffc139fc: 41 9e 00 34 beq- cr7,ffc13a30 <_Thread_Handler+0x9c> (*(Thread_Entry_numeric) executing->Start.entry_point)( executing->Start.numeric_argument ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { ffc13a00: 2f 80 00 01 cmpwi cr7,r0,1 ffc13a04: 41 9e 00 44 beq- cr7,ffc13a48 <_Thread_Handler+0xb4> <== ALWAYS TAKEN * 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 ); ffc13a08: 7f e3 fb 78 mr r3,r31 ffc13a0c: 4b ff 99 d9 bl ffc0d3e4 <_User_extensions_Thread_exitted> _Internal_error_Occurred( ffc13a10: 38 60 00 00 li r3,0 ffc13a14: 38 80 00 01 li r4,1 ffc13a18: 38 a0 00 05 li r5,5 ffc13a1c: 4b ff 72 e5 bl ffc0ad00 <_Internal_error_Occurred> _CPU_MSR_GET(msr); if (!(level & CPU_MODES_INTERRUPT_MASK)) { msr |= ppc_interrupt_get_disable_mask(); } else { msr &= ~ppc_interrupt_get_disable_mask(); ffc13a20: 7c 00 48 78 andc r0,r0,r9 ffc13a24: 4b ff ff a8 b ffc139cc <_Thread_Handler+0x38> * _init could be a weak symbol and we SHOULD test it but it isn't * in any configuration I know of and it generates a warning on every * RTEMS target configuration. --joel (12 May 2007) */ if (!doneCons) /* && (volatile void *)_init) */ { INIT_NAME (); ffc13a28: 48 00 bd d5 bl ffc1f7fc <_init> ffc13a2c: 4b ff ff c8 b ffc139f4 <_Thread_Handler+0x60> } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = (*(Thread_Entry_numeric) executing->Start.entry_point)( ffc13a30: 80 1f 00 90 lwz r0,144(r31) ffc13a34: 80 7f 00 9c lwz r3,156(r31) ffc13a38: 7c 09 03 a6 mtctr r0 ffc13a3c: 4e 80 04 21 bctrl } #endif if ( executing->Start.prototype == THREAD_START_NUMERIC ) { executing->Wait.return_argument = ffc13a40: 90 7f 00 28 stw r3,40(r31) ffc13a44: 4b ff ff c4 b ffc13a08 <_Thread_Handler+0x74> ); } #if defined(RTEMS_POSIX_API) else if ( executing->Start.prototype == THREAD_START_POINTER ) { executing->Wait.return_argument = (*(Thread_Entry_pointer) executing->Start.entry_point)( ffc13a48: 80 1f 00 90 lwz r0,144(r31) ffc13a4c: 80 7f 00 98 lwz r3,152(r31) ffc13a50: 7c 09 03 a6 mtctr r0 ffc13a54: 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 = ffc13a58: 90 7f 00 28 stw r3,40(r31) ffc13a5c: 4b ff ff ac b ffc13a08 <_Thread_Handler+0x74> =============================================================================== ffc0c520 <_Thread_Initialize>: Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0c520: 94 21 ff c8 stwu r1,-56(r1) ffc0c524: 7c 08 02 a6 mflr r0 ffc0c528: 93 c1 00 30 stw r30,48(r1) if ( !actual_stack_size || actual_stack_size < stack_size ) return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { ffc0c52c: 7c be 2b 79 mr. r30,r5 Thread_CPU_budget_algorithms budget_algorithm, Thread_CPU_budget_algorithm_callout budget_callout, uint32_t isr_level, Objects_Name name ) { ffc0c530: 90 01 00 3c stw r0,60(r1) /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; ffc0c534: 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 ) { ffc0c538: 93 61 00 24 stw r27,36(r1) ffc0c53c: 7d 3b 4b 78 mr r27,r9 ffc0c540: 81 21 00 48 lwz r9,72(r1) ffc0c544: 92 e1 00 14 stw r23,20(r1) ffc0c548: 93 21 00 1c stw r25,28(r1) ffc0c54c: 7d 59 53 78 mr r25,r10 ffc0c550: 93 81 00 28 stw r28,40(r1) ffc0c554: 7d 1c 43 78 mr r28,r8 ffc0c558: 93 a1 00 2c stw r29,44(r1) ffc0c55c: 7c 7d 1b 78 mr r29,r3 ffc0c560: 93 e1 00 34 stw r31,52(r1) ffc0c564: 7c 9f 23 78 mr r31,r4 ffc0c568: 93 01 00 18 stw r24,24(r1) ffc0c56c: 93 41 00 20 stw r26,32(r1) ffc0c570: 82 e9 00 00 lwz r23,0(r9) /* * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; ffc0c574: 90 04 01 30 stw r0,304(r4) ffc0c578: 90 04 01 34 stw r0,308(r4) extensions_area = NULL; the_thread->libc_reent = NULL; ffc0c57c: 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 ) { ffc0c580: 41 82 01 d0 beq- ffc0c750 <_Thread_Initialize+0x230> stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; } else { stack = stack_area; actual_stack_size = stack_size; the_thread->Start.core_allocated_stack = false; ffc0c584: 98 04 00 b4 stb r0,180(r4) ffc0c588: 7c c0 33 78 mr r0,r6 /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { ffc0c58c: 2f 87 00 00 cmpwi cr7,r7,0 Stack_Control *the_stack, void *starting_address, size_t size ) { the_stack->area = starting_address; ffc0c590: 93 df 00 bc stw r30,188(r31) extensions_area = NULL; the_thread->libc_reent = NULL; #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) fp_area = NULL; ffc0c594: 3b 40 00 00 li r26,0 the_stack->size = size; ffc0c598: 90 1f 00 b8 stw r0,184(r31) /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { ffc0c59c: 40 9e 01 48 bne- cr7,ffc0c6e4 <_Thread_Initialize+0x1c4> #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0c5a0: 3f c0 00 00 lis r30,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; ffc0c5a4: 93 5f 01 28 stw r26,296(r31) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0c5a8: 38 00 00 00 li r0,0 #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0c5ac: 81 3e 28 2c lwz r9,10284(r30) 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; ffc0c5b0: 93 5f 00 c0 stw r26,192(r31) #endif /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { ffc0c5b4: 2f 89 00 00 cmpwi cr7,r9,0 ffc0c5b8: 90 1f 00 50 stw r0,80(r31) the_watchdog->routine = routine; ffc0c5bc: 90 1f 00 64 stw r0,100(r31) the_watchdog->id = id; ffc0c5c0: 90 1f 00 68 stw r0,104(r31) the_watchdog->user_data = user_data; ffc0c5c4: 90 1f 00 6c stw r0,108(r31) ffc0c5c8: 40 9e 01 38 bne- cr7,ffc0c700 <_Thread_Initialize+0x1e0> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0c5cc: 91 3f 01 38 stw r9,312(r31) * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; ffc0c5d0: 3b 00 00 00 li r24,0 the_thread->Start.is_preemptible = is_preemptible; the_thread->Start.budget_algorithm = budget_algorithm; the_thread->Start.budget_callout = budget_callout; switch ( budget_algorithm ) { ffc0c5d4: 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; ffc0c5d8: 80 01 00 40 lwz r0,64(r1) /* * General initialization */ the_thread->Start.is_preemptible = is_preemptible; ffc0c5dc: 9b 7f 00 a0 stb r27,160(r31) the_thread->Start.budget_algorithm = budget_algorithm; ffc0c5e0: 93 3f 00 a4 stw r25,164(r31) the_thread->Start.budget_callout = budget_callout; ffc0c5e4: 90 1f 00 a8 stw r0,168(r31) switch ( budget_algorithm ) { ffc0c5e8: 40 be 00 10 bne+ cr7,ffc0c5f8 <_Thread_Initialize+0xd8> 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; ffc0c5ec: 3d 20 00 00 lis r9,0 ffc0c5f0: 80 09 28 08 lwz r0,10248(r9) ffc0c5f4: 90 1f 00 78 stw r0,120(r31) case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0c5f8: 80 01 00 44 lwz r0,68(r1) */ RTEMS_INLINE_ROUTINE void* _Scheduler_Allocate( Thread_Control *the_thread ) { return _Scheduler.Operations.allocate( the_thread ); ffc0c5fc: 3d 20 00 00 lis r9,0 the_thread->current_state = STATES_DORMANT; the_thread->Wait.queue = NULL; ffc0c600: 3b c0 00 00 li r30,0 the_thread->resource_count = 0; the_thread->real_priority = priority; ffc0c604: 93 9f 00 18 stw r28,24(r31) ffc0c608: 7f e3 fb 78 mr r3,r31 case THREAD_CPU_BUDGET_ALGORITHM_CALLOUT: break; #endif } the_thread->Start.isr_level = isr_level; ffc0c60c: 90 1f 00 ac stw r0,172(r31) the_thread->current_state = STATES_DORMANT; ffc0c610: 38 00 00 01 li r0,1 ffc0c614: 90 1f 00 10 stw r0,16(r31) ffc0c618: 80 09 20 f8 lwz r0,8440(r9) the_thread->Wait.queue = NULL; ffc0c61c: 93 df 00 44 stw r30,68(r31) ffc0c620: 7c 09 03 a6 mtctr r0 the_thread->resource_count = 0; ffc0c624: 93 df 00 1c stw r30,28(r31) the_thread->real_priority = priority; the_thread->Start.initial_priority = priority; ffc0c628: 93 9f 00 b0 stw r28,176(r31) ffc0c62c: 4e 80 04 21 bctrl sched =_Scheduler_Allocate( the_thread ); if ( !sched ) ffc0c630: 7c 7b 1b 79 mr. r27,r3 ffc0c634: 41 82 00 40 beq- ffc0c674 <_Thread_Initialize+0x154> goto failed; _Thread_Set_priority( the_thread, priority ); ffc0c638: 7f e3 fb 78 mr r3,r31 ffc0c63c: 7f 84 e3 78 mr r4,r28 ffc0c640: 48 00 08 a5 bl ffc0cee4 <_Thread_Set_priority> Objects_Information *information, Objects_Control *the_object, Objects_Name name ) { _Objects_Set_local_object( ffc0c644: a0 1f 00 0a lhz r0,10(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0c648: 81 3d 00 1c lwz r9,28(r29) * 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 ); ffc0c64c: 7f e3 fb 78 mr r3,r31 ffc0c650: 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 ); ffc0c654: 93 df 00 84 stw r30,132(r31) ffc0c658: 93 df 00 88 stw r30,136(r31) ffc0c65c: 7f e9 01 2e stwx r31,r9,r0 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc0c660: 92 ff 00 0c stw r23,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 ); ffc0c664: 48 00 0e 81 bl ffc0d4e4 <_User_extensions_Thread_create> if ( extension_status ) ffc0c668: 2f 83 00 00 cmpwi cr7,r3,0 return true; ffc0c66c: 38 60 00 01 li r3,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 ) ffc0c670: 40 9e 00 40 bne- cr7,ffc0c6b0 <_Thread_Initialize+0x190> return true; failed: _Workspace_Free( the_thread->libc_reent ); ffc0c674: 80 7f 01 2c lwz r3,300(r31) ffc0c678: 48 00 14 d9 bl ffc0db50 <_Workspace_Free> for ( i=0 ; i <= THREAD_API_LAST ; i++ ) _Workspace_Free( the_thread->API_Extensions[i] ); ffc0c67c: 80 7f 01 30 lwz r3,304(r31) ffc0c680: 48 00 14 d1 bl ffc0db50 <_Workspace_Free> ffc0c684: 80 7f 01 34 lwz r3,308(r31) ffc0c688: 48 00 14 c9 bl ffc0db50 <_Workspace_Free> _Workspace_Free( extensions_area ); ffc0c68c: 7f 03 c3 78 mr r3,r24 ffc0c690: 48 00 14 c1 bl ffc0db50 <_Workspace_Free> #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) _Workspace_Free( fp_area ); ffc0c694: 7f 43 d3 78 mr r3,r26 ffc0c698: 48 00 14 b9 bl ffc0db50 <_Workspace_Free> #endif _Workspace_Free( sched ); ffc0c69c: 7f 63 db 78 mr r3,r27 ffc0c6a0: 48 00 14 b1 bl ffc0db50 <_Workspace_Free> _Thread_Stack_Free( the_thread ); ffc0c6a4: 7f e3 fb 78 mr r3,r31 ffc0c6a8: 48 00 09 e9 bl ffc0d090 <_Thread_Stack_Free> return false; ffc0c6ac: 38 60 00 00 li r3,0 } ffc0c6b0: 80 01 00 3c lwz r0,60(r1) ffc0c6b4: 82 e1 00 14 lwz r23,20(r1) ffc0c6b8: 7c 08 03 a6 mtlr r0 ffc0c6bc: 83 01 00 18 lwz r24,24(r1) ffc0c6c0: 83 21 00 1c lwz r25,28(r1) ffc0c6c4: 83 41 00 20 lwz r26,32(r1) ffc0c6c8: 83 61 00 24 lwz r27,36(r1) ffc0c6cc: 83 81 00 28 lwz r28,40(r1) ffc0c6d0: 83 a1 00 2c lwz r29,44(r1) ffc0c6d4: 83 c1 00 30 lwz r30,48(r1) ffc0c6d8: 83 e1 00 34 lwz r31,52(r1) ffc0c6dc: 38 21 00 38 addi r1,r1,56 ffc0c6e0: 4e 80 00 20 blr /* * Allocate the floating point area for this thread */ #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( is_fp ) { fp_area = _Workspace_Allocate( CONTEXT_FP_SIZE ); ffc0c6e4: 38 60 01 08 li r3,264 ffc0c6e8: 48 00 14 35 bl ffc0db1c <_Workspace_Allocate> if ( !fp_area ) ffc0c6ec: 7c 7a 1b 79 mr. r26,r3 ffc0c6f0: 40 82 fe b0 bne+ ffc0c5a0 <_Thread_Initialize+0x80> * Zero out all the allocated memory fields */ for ( i=0 ; i <= THREAD_API_LAST ; i++ ) the_thread->API_Extensions[i] = NULL; extensions_area = NULL; ffc0c6f4: 3b 00 00 00 li r24,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; ffc0c6f8: 3b 60 00 00 li r27,0 ffc0c6fc: 4b ff ff 78 b ffc0c674 <_Thread_Initialize+0x154> /* * Allocate the extensions area for this thread */ if ( _Thread_Maximum_extensions ) { extensions_area = _Workspace_Allocate( ffc0c700: 39 29 00 01 addi r9,r9,1 ffc0c704: 55 23 10 3a rlwinm r3,r9,2,0,29 ffc0c708: 48 00 14 15 bl ffc0db1c <_Workspace_Allocate> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) ffc0c70c: 7c 78 1b 79 mr. r24,r3 ffc0c710: 41 82 00 84 beq- ffc0c794 <_Thread_Initialize+0x274> goto failed; } the_thread->extensions = (void **) extensions_area; ffc0c714: 93 1f 01 38 stw r24,312(r31) ffc0c718: 7f 0b c3 78 mr r11,r24 * 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++ ) ffc0c71c: 38 00 00 00 li r0,0 (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0c720: 81 1e 28 2c lwz r8,10284(r30) ffc0c724: 39 20 00 00 li r9,0 * so they cannot rely on the thread create user extension * call. */ if ( the_thread->extensions ) { for ( i = 0; i <= _Thread_Maximum_extensions ; i++ ) the_thread->extensions[i] = NULL; ffc0c728: 39 40 00 00 li r10,0 ffc0c72c: 48 00 00 08 b ffc0c734 <_Thread_Initialize+0x214> (_Thread_Maximum_extensions + 1) * sizeof( void * ) ); if ( !extensions_area ) goto failed; } the_thread->extensions = (void **) extensions_area; ffc0c730: 81 7f 01 38 lwz r11,312(r31) * 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++ ) ffc0c734: 39 29 00 01 addi r9,r9,1 ffc0c738: 7f 89 40 40 cmplw cr7,r9,r8 the_thread->extensions[i] = NULL; ffc0c73c: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0c740: 7d 4b 01 2e stwx r10,r11,r0 * 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++ ) ffc0c744: 7d 20 4b 78 mr r0,r9 ffc0c748: 40 9d ff e8 ble+ cr7,ffc0c730 <_Thread_Initialize+0x210> ffc0c74c: 4b ff fe 88 b ffc0c5d4 <_Thread_Initialize+0xb4> return false; /* stack allocation failed */ stack = the_thread->Start.stack; #else if ( !stack_area ) { actual_stack_size = _Thread_Stack_Allocate( the_thread, stack_size ); ffc0c750: 7c 83 23 78 mr r3,r4 ffc0c754: 90 c1 00 08 stw r6,8(r1) ffc0c758: 7c c4 33 78 mr r4,r6 ffc0c75c: 90 e1 00 0c stw r7,12(r1) ffc0c760: 48 00 08 89 bl ffc0cfe8 <_Thread_Stack_Allocate> if ( !actual_stack_size || actual_stack_size < stack_size ) ffc0c764: 7c 60 1b 79 mr. r0,r3 ffc0c768: 80 c1 00 08 lwz r6,8(r1) return false; /* stack allocation failed */ ffc0c76c: 38 60 00 00 li r3,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 ) ffc0c770: 80 e1 00 0c lwz r7,12(r1) ffc0c774: 41 a2 ff 3c beq- ffc0c6b0 <_Thread_Initialize+0x190> ffc0c778: 7f 86 00 40 cmplw cr7,r6,r0 return false; /* stack allocation failed */ ffc0c77c: 7f c3 f3 78 mr r3,r30 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 ) ffc0c780: 41 bd ff 30 bgt- cr7,ffc0c6b0 <_Thread_Initialize+0x190><== NEVER TAKEN return false; /* stack allocation failed */ stack = the_thread->Start.stack; the_thread->Start.core_allocated_stack = true; ffc0c784: 39 20 00 01 li r9,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; ffc0c788: 83 df 00 c4 lwz r30,196(r31) the_thread->Start.core_allocated_stack = true; ffc0c78c: 99 3f 00 b4 stb r9,180(r31) ffc0c790: 4b ff fd fc b ffc0c58c <_Thread_Initialize+0x6c> 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; ffc0c794: 3b 60 00 00 li r27,0 ffc0c798: 4b ff fe dc b ffc0c674 <_Thread_Initialize+0x154> =============================================================================== ffc0d9b0 <_Thread_Restart>: bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0d9b0: 94 21 ff e8 stwu r1,-24(r1) ffc0d9b4: 7c 08 02 a6 mflr r0 ffc0d9b8: 90 01 00 1c stw r0,28(r1) */ RTEMS_INLINE_ROUTINE bool _States_Is_dormant ( States_Control the_states ) { return (the_states & STATES_DORMANT); ffc0d9bc: 80 03 00 10 lwz r0,16(r3) ffc0d9c0: 93 e1 00 14 stw r31,20(r1) ffc0d9c4: 7c 7f 1b 78 mr r31,r3 if ( !_States_Is_dormant( the_thread->current_state ) ) { ffc0d9c8: 70 09 00 01 andi. r9,r0,1 bool _Thread_Restart( Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { ffc0d9cc: 93 c1 00 10 stw r30,16(r1) _Thread_Restart_self(); return true; } return false; ffc0d9d0: 38 00 00 00 li r0,0 Thread_Control *the_thread, void *pointer_argument, Thread_Entry_numeric_type numeric_argument ) { if ( !_States_Is_dormant( the_thread->current_state ) ) { ffc0d9d4: 41 82 00 20 beq- ffc0d9f4 <_Thread_Restart+0x44> return true; } return false; } ffc0d9d8: 7c 03 03 78 mr r3,r0 ffc0d9dc: 80 01 00 1c lwz r0,28(r1) ffc0d9e0: 83 c1 00 10 lwz r30,16(r1) ffc0d9e4: 7c 08 03 a6 mtlr r0 ffc0d9e8: 83 e1 00 14 lwz r31,20(r1) ffc0d9ec: 38 21 00 18 addi r1,r1,24 ffc0d9f0: 4e 80 00 20 blr Thread_Entry_numeric_type numeric_argument ) { if ( !_States_Is_dormant( the_thread->current_state ) ) { _Thread_Set_transient( the_thread ); ffc0d9f4: 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 ); ffc0d9f8: 3f c0 00 00 lis r30,0 ffc0d9fc: 3b de 31 64 addi r30,r30,12644 ffc0da00: 90 a1 00 0c stw r5,12(r1) ffc0da04: 48 00 01 05 bl ffc0db08 <_Thread_Set_transient> _Thread_Reset( the_thread, pointer_argument, numeric_argument ); ffc0da08: 7f e3 fb 78 mr r3,r31 ffc0da0c: 80 81 00 08 lwz r4,8(r1) ffc0da10: 80 a1 00 0c lwz r5,12(r1) ffc0da14: 48 00 48 35 bl ffc12248 <_Thread_Reset> _Thread_Load_environment( the_thread ); ffc0da18: 7f e3 fb 78 mr r3,r31 ffc0da1c: 48 00 44 99 bl ffc11eb4 <_Thread_Load_environment> _Thread_Ready( the_thread ); ffc0da20: 7f e3 fb 78 mr r3,r31 ffc0da24: 48 00 47 d5 bl ffc121f8 <_Thread_Ready> _User_extensions_Thread_restart( the_thread ); ffc0da28: 7f e3 fb 78 mr r3,r31 ffc0da2c: 48 00 07 75 bl ffc0e1a0 <_User_extensions_Thread_restart> if ( _Thread_Is_executing ( the_thread ) ) ffc0da30: 81 3e 00 0c lwz r9,12(r30) _Thread_Restart_self(); return true; ffc0da34: 38 00 00 01 li r0,1 _Thread_Ready( the_thread ); _User_extensions_Thread_restart( the_thread ); if ( _Thread_Is_executing ( the_thread ) ) ffc0da38: 7f 9f 48 00 cmpw cr7,r31,r9 ffc0da3c: 40 9e ff 9c bne+ cr7,ffc0d9d8 <_Thread_Restart+0x28> */ RTEMS_INLINE_ROUTINE void _Thread_Restart_self( void ) { #if ( CPU_HARDWARE_FP == TRUE ) || ( CPU_SOFTWARE_FP == TRUE ) if ( _Thread_Executing->fp_context != NULL ) ffc0da40: 80 1f 01 28 lwz r0,296(r31) ffc0da44: 2f 80 00 00 cmpwi cr7,r0,0 ffc0da48: 41 9e 00 0c beq- cr7,ffc0da54 <_Thread_Restart+0xa4> <== NEVER TAKEN _Context_Restore_fp( &_Thread_Executing->fp_context ); ffc0da4c: 38 7f 01 28 addi r3,r31,296 ffc0da50: 48 01 17 31 bl ffc1f180 <_CPU_Context_restore_fp> #endif _CPU_Context_Restart_self( &_Thread_Executing->Registers ); ffc0da54: 80 7e 00 0c lwz r3,12(r30) ffc0da58: 38 63 00 c8 addi r3,r3,200 ffc0da5c: 48 01 18 e5 bl ffc1f340 <_CPU_Context_restore> =============================================================================== ffc0cde8 <_Thread_queue_Requeue>: void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0cde8: 94 21 ff d8 stwu r1,-40(r1) ffc0cdec: 7c 08 02 a6 mflr r0 ffc0cdf0: 93 e1 00 24 stw r31,36(r1) /* * Just in case the thread really wasn't blocked on a thread queue * when we get here. */ if ( !the_thread_queue ) ffc0cdf4: 7c 7f 1b 79 mr. r31,r3 void _Thread_queue_Requeue( Thread_queue_Control *the_thread_queue, Thread_Control *the_thread ) { ffc0cdf8: 93 c1 00 20 stw r30,32(r1) ffc0cdfc: 7c 9e 23 78 mr r30,r4 ffc0ce00: 90 01 00 2c stw r0,44(r1) ffc0ce04: 93 a1 00 1c stw r29,28(r1) /* * Just in case the thread really wasn't blocked on a thread queue * when we get here. */ if ( !the_thread_queue ) ffc0ce08: 41 82 00 10 beq- ffc0ce18 <_Thread_queue_Requeue+0x30> <== 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 ) { ffc0ce0c: 80 1f 00 34 lwz r0,52(r31) ffc0ce10: 2f 80 00 01 cmpwi cr7,r0,1 ffc0ce14: 41 9e 00 20 beq- cr7,ffc0ce34 <_Thread_queue_Requeue+0x4c><== ALWAYS TAKEN _Thread_queue_Extract_priority_helper( tq, the_thread, true ); (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); } _ISR_Enable( level ); } } ffc0ce18: 80 01 00 2c lwz r0,44(r1) <== NOT EXECUTED ffc0ce1c: 83 a1 00 1c lwz r29,28(r1) <== NOT EXECUTED ffc0ce20: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0ce24: 83 c1 00 20 lwz r30,32(r1) <== NOT EXECUTED ffc0ce28: 83 e1 00 24 lwz r31,36(r1) <== NOT EXECUTED ffc0ce2c: 38 21 00 28 addi r1,r1,40 <== NOT EXECUTED ffc0ce30: 4e 80 00 20 blr <== NOT EXECUTED static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0ce34: 7f a0 00 a6 mfmsr r29 ffc0ce38: 7d 30 42 a6 mfsprg r9,0 ffc0ce3c: 7f a9 48 78 andc r9,r29,r9 ffc0ce40: 7d 20 01 24 mtmsr r9 ffc0ce44: 3d 60 00 03 lis r11,3 ffc0ce48: 81 24 00 10 lwz r9,16(r4) ffc0ce4c: 61 6b be e0 ori r11,r11,48864 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 ) ) { ffc0ce50: 7d 6a 48 39 and. r10,r11,r9 ffc0ce54: 40 82 00 24 bne- ffc0ce78 <_Thread_queue_Requeue+0x90> <== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0ce58: 7f a0 01 24 mtmsr r29 <== NOT EXECUTED _Thread_queue_Extract_priority_helper( tq, the_thread, true ); (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); } _ISR_Enable( level ); } } ffc0ce5c: 80 01 00 2c lwz r0,44(r1) ffc0ce60: 83 a1 00 1c lwz r29,28(r1) ffc0ce64: 7c 08 03 a6 mtlr r0 ffc0ce68: 83 c1 00 20 lwz r30,32(r1) ffc0ce6c: 83 e1 00 24 lwz r31,36(r1) ffc0ce70: 38 21 00 28 addi r1,r1,40 ffc0ce74: 4e 80 00 20 blr 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; ffc0ce78: 90 1f 00 30 stw r0,48(r31) ISR_Level level_ignored; _ISR_Disable( level ); if ( _States_Is_waiting_on_thread_queue( the_thread->current_state ) ) { _Thread_queue_Enter_critical_section( tq ); _Thread_queue_Extract_priority_helper( tq, the_thread, true ); ffc0ce7c: 38 a0 00 01 li r5,1 ffc0ce80: 48 00 46 0d bl ffc1148c <_Thread_queue_Extract_priority_helper> (void) _Thread_queue_Enqueue_priority( tq, the_thread, &level_ignored ); ffc0ce84: 7f e3 fb 78 mr r3,r31 ffc0ce88: 7f c4 f3 78 mr r4,r30 ffc0ce8c: 38 a1 00 08 addi r5,r1,8 ffc0ce90: 4b ff fc 81 bl ffc0cb10 <_Thread_queue_Enqueue_priority> ffc0ce94: 7f a0 01 24 mtmsr r29 ffc0ce98: 4b ff ff c4 b ffc0ce5c <_Thread_queue_Requeue+0x74> =============================================================================== ffc0ce9c <_Thread_queue_Timeout>: void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0ce9c: 94 21 ff e8 stwu r1,-24(r1) ffc0cea0: 7c 08 02 a6 mflr r0 Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0cea4: 38 81 00 08 addi r4,r1,8 void _Thread_queue_Timeout( Objects_Id id, void *ignored __attribute__((unused)) ) { ffc0cea8: 90 01 00 1c stw r0,28(r1) Thread_Control *the_thread; Objects_Locations location; the_thread = _Thread_Get( id, &location ); ffc0ceac: 4b ff f5 a5 bl ffc0c450 <_Thread_Get> switch ( location ) { ffc0ceb0: 80 01 00 08 lwz r0,8(r1) ffc0ceb4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ceb8: 40 9e 00 1c bne- cr7,ffc0ced4 <_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 ); ffc0cebc: 48 00 46 d1 bl ffc1158c <_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--; ffc0cec0: 3d 20 00 00 lis r9,0 ffc0cec4: 81 69 28 0c lwz r11,10252(r9) ffc0cec8: 38 0b ff ff addi r0,r11,-1 ffc0cecc: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc0ced0: 80 09 28 0c lwz r0,10252(r9) _Thread_Unnest_dispatch(); break; } } ffc0ced4: 80 01 00 1c lwz r0,28(r1) ffc0ced8: 38 21 00 18 addi r1,r1,24 ffc0cedc: 7c 08 03 a6 mtlr r0 ffc0cee0: 4e 80 00 20 blr =============================================================================== ffc1c394 <_Timer_server_Body>: * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc1c394: 94 21 ff 98 stwu r1,-104(r1) ffc1c398: 7c 08 02 a6 mflr r0 ffc1c39c: 92 a1 00 3c stw r21,60(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc1c3a0: 3a a1 00 14 addi r21,r1,20 ffc1c3a4: 90 01 00 6c stw r0,108(r1) head->previous = NULL; ffc1c3a8: 38 00 00 00 li r0,0 ffc1c3ac: 92 e1 00 44 stw r23,68(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc1c3b0: 3a e1 00 0c addi r23,r1,12 ffc1c3b4: 93 41 00 50 stw r26,80(r1) ffc1c3b8: 3b 41 00 18 addi r26,r1,24 ffc1c3bc: 93 81 00 58 stw r28,88(r1) head->previous = NULL; tail->previous = head; ffc1c3c0: 3b 81 00 08 addi r28,r1,8 ffc1c3c4: 92 81 00 38 stw r20,56(r1) ffc1c3c8: 3e 80 00 00 lis r20,0 ffc1c3cc: 3a 94 28 e0 addi r20,r20,10464 ffc1c3d0: 93 01 00 48 stw r24,72(r1) ffc1c3d4: 3f 00 00 00 lis r24,0 ffc1c3d8: 3b 18 29 14 addi r24,r24,10516 ffc1c3dc: 93 21 00 4c stw r25,76(r1) ffc1c3e0: 3f 20 00 00 lis r25,0 ffc1c3e4: 3b 39 28 f8 addi r25,r25,10488 ffc1c3e8: 93 c1 00 60 stw r30,96(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc1c3ec: 93 41 00 14 stw r26,20(r1) head->previous = NULL; ffc1c3f0: 90 01 00 18 stw r0,24(r1) tail->previous = head; ffc1c3f4: 92 a1 00 1c stw r21,28(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc1c3f8: 92 e1 00 08 stw r23,8(r1) head->previous = NULL; ffc1c3fc: 90 01 00 0c stw r0,12(r1) tail->previous = head; ffc1c400: 93 81 00 10 stw r28,16(r1) ffc1c404: 92 01 00 28 stw r16,40(r1) ffc1c408: 3a 03 00 08 addi r16,r3,8 ffc1c40c: 92 21 00 2c stw r17,44(r1) ffc1c410: 3a 23 00 40 addi r17,r3,64 ffc1c414: 92 41 00 30 stw r18,48(r1) * the active flag of the timer server is true. */ (*watchdog->routine)( watchdog->id, watchdog->user_data ); } } else { ts->active = false; ffc1c418: 3a 40 00 00 li r18,0 * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc1c41c: 92 61 00 34 stw r19,52(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; ffc1c420: 3a 60 00 01 li r19,1 * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc1c424: 92 c1 00 40 stw r22,64(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; ffc1c428: 3a c0 00 00 li r22,0 * @a arg points to the corresponding timer server control block. */ static rtems_task _Timer_server_Body( rtems_task_argument arg ) { ffc1c42c: 93 61 00 54 stw r27,84(r1) ffc1c430: 3b 63 00 68 addi r27,r3,104 ffc1c434: 93 a1 00 5c stw r29,92(r1) ffc1c438: 3b a3 00 30 addi r29,r3,48 ffc1c43c: 93 e1 00 64 stw r31,100(r1) ffc1c440: 7c 7f 1b 78 mr r31,r3 { /* * 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; ffc1c444: 92 bf 00 78 stw r21,120(r31) */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1c448: 7f 85 e3 78 mr r5,r28 ffc1c44c: 7f a3 eb 78 mr r3,r29 static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; ffc1c450: 80 18 00 00 lwz r0,0(r24) /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; ffc1c454: 80 9f 00 3c lwz r4,60(r31) watchdogs->last_snapshot = snapshot; ffc1c458: 90 1f 00 3c stw r0,60(r31) _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1c45c: 7c 84 00 50 subf r4,r4,r0 ffc1c460: 48 00 59 d5 bl ffc21e34 <_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(); ffc1c464: 83 d9 00 00 lwz r30,0(r25) Watchdog_Interval last_snapshot = watchdogs->last_snapshot; ffc1c468: 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 ) { ffc1c46c: 7f 9e 28 40 cmplw cr7,r30,r5 ffc1c470: 41 9d 00 98 bgt- cr7,ffc1c508 <_Timer_server_Body+0x174> * TOD has been set forward. */ delta = snapshot - last_snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); } else if ( snapshot < last_snapshot ) { ffc1c474: 41 9c 00 a8 blt- cr7,ffc1c51c <_Timer_server_Body+0x188> */ delta = last_snapshot - snapshot; _Watchdog_Adjust( &watchdogs->Chain, WATCHDOG_BACKWARD, delta ); } watchdogs->last_snapshot = snapshot; ffc1c478: 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 ); ffc1c47c: 80 7f 00 78 lwz r3,120(r31) ffc1c480: 48 00 0e 91 bl ffc1d310 <_Chain_Get> if ( timer == NULL ) { ffc1c484: 7c 64 1b 79 mr. r4,r3 ffc1c488: 41 82 00 34 beq- ffc1c4bc <_Timer_server_Body+0x128> static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1c48c: 80 04 00 38 lwz r0,56(r4) ffc1c490: 2f 80 00 01 cmpwi cr7,r0,1 _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc1c494: 2f 00 00 03 cmpwi cr6,r0,3 static void _Timer_server_Insert_timer( Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1c498: 41 9e 00 98 beq- cr7,ffc1c530 <_Timer_server_Body+0x19c> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc1c49c: 40 9a ff e0 bne+ cr6,ffc1c47c <_Timer_server_Body+0xe8> <== NEVER TAKEN _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc1c4a0: 38 84 00 10 addi r4,r4,16 ffc1c4a4: 7f 63 db 78 mr r3,r27 ffc1c4a8: 48 00 5a 45 bl ffc21eec <_Watchdog_Insert> } static void _Timer_server_Process_insertions( Timer_server_Control *ts ) { while ( true ) { Timer_Control *timer = (Timer_Control *) _Chain_Get( ts->insert_chain ); ffc1c4ac: 80 7f 00 78 lwz r3,120(r31) ffc1c4b0: 48 00 0e 61 bl ffc1d310 <_Chain_Get> if ( timer == NULL ) { ffc1c4b4: 7c 64 1b 79 mr. r4,r3 ffc1c4b8: 40 82 ff d4 bne+ ffc1c48c <_Timer_server_Body+0xf8> <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1c4bc: 7d 20 00 a6 mfmsr r9 ffc1c4c0: 7c 10 42 a6 mfsprg r0,0 ffc1c4c4: 7d 20 00 78 andc r0,r9,r0 ffc1c4c8: 7c 00 01 24 mtmsr r0 * body loop. */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ffc1c4cc: 80 01 00 14 lwz r0,20(r1) ffc1c4d0: 7f 80 d0 00 cmpw cr7,r0,r26 ffc1c4d4: 41 9e 00 6c beq- cr7,ffc1c540 <_Timer_server_Body+0x1ac><== ALWAYS TAKEN return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1c4d8: 7d 20 01 24 mtmsr r9 <== NOT EXECUTED static void _Timer_server_Process_interval_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; ffc1c4dc: 80 18 00 00 lwz r0,0(r24) <== NOT EXECUTED */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1c4e0: 7f 85 e3 78 mr r5,r28 <== NOT EXECUTED Watchdog_Interval snapshot = _Watchdog_Ticks_since_boot; /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; ffc1c4e4: 80 9f 00 3c lwz r4,60(r31) <== NOT EXECUTED watchdogs->last_snapshot = snapshot; _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1c4e8: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED /* * We assume adequate unsigned arithmetic here. */ Watchdog_Interval delta = snapshot - watchdogs->last_snapshot; watchdogs->last_snapshot = snapshot; ffc1c4ec: 90 1f 00 3c stw r0,60(r31) <== NOT EXECUTED _Watchdog_Adjust_to_chain( &watchdogs->Chain, delta, fire_chain ); ffc1c4f0: 7c 84 00 50 subf r4,r4,r0 <== NOT EXECUTED ffc1c4f4: 48 00 59 41 bl ffc21e34 <_Watchdog_Adjust_to_chain> <== NOT EXECUTED static void _Timer_server_Process_tod_watchdogs( Timer_server_Watchdogs *watchdogs, Chain_Control *fire_chain ) { Watchdog_Interval snapshot = (Watchdog_Interval) _TOD_Seconds_since_epoch(); ffc1c4f8: 83 d9 00 00 lwz r30,0(r25) <== NOT EXECUTED Watchdog_Interval last_snapshot = watchdogs->last_snapshot; ffc1c4fc: 80 bf 00 74 lwz r5,116(r31) <== NOT EXECUTED /* * 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 ) { ffc1c500: 7f 9e 28 40 cmplw cr7,r30,r5 <== NOT EXECUTED ffc1c504: 40 9d ff 70 ble+ cr7,ffc1c474 <_Timer_server_Body+0xe0> <== NOT EXECUTED /* * 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 ); ffc1c508: 7c 85 f0 50 subf r4,r5,r30 ffc1c50c: 7f 63 db 78 mr r3,r27 ffc1c510: 7f 85 e3 78 mr r5,r28 ffc1c514: 48 00 59 21 bl ffc21e34 <_Watchdog_Adjust_to_chain> ffc1c518: 4b ff ff 60 b ffc1c478 <_Timer_server_Body+0xe4> /* * 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 ); ffc1c51c: 7f 63 db 78 mr r3,r27 ffc1c520: 38 80 00 01 li r4,1 ffc1c524: 7c be 28 50 subf r5,r30,r5 ffc1c528: 48 00 57 f1 bl ffc21d18 <_Watchdog_Adjust> ffc1c52c: 4b ff ff 4c b ffc1c478 <_Timer_server_Body+0xe4> Timer_server_Control *ts, Timer_Control *timer ) { if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc1c530: 7f a3 eb 78 mr r3,r29 ffc1c534: 38 84 00 10 addi r4,r4,16 ffc1c538: 48 00 59 b5 bl ffc21eec <_Watchdog_Insert> ffc1c53c: 4b ff ff 40 b ffc1c47c <_Timer_server_Body+0xe8> */ _Timer_server_Process_insertions( ts ); _ISR_Disable( level ); if ( _Chain_Is_empty( insert_chain ) ) { ts->insert_chain = NULL; ffc1c540: 90 9f 00 78 stw r4,120(r31) ffc1c544: 7d 20 01 24 mtmsr r9 _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 ) ) { ffc1c548: 80 01 00 08 lwz r0,8(r1) ffc1c54c: 7f 80 b8 00 cmpw cr7,r0,r23 ffc1c550: 40 be 00 30 bne+ cr7,ffc1c580 <_Timer_server_Body+0x1ec> ffc1c554: 48 00 00 50 b ffc1c5a4 <_Timer_server_Body+0x210> Chain_Control *the_chain ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *old_first = head->next; Chain_Node *new_first = old_first->next; ffc1c558: 81 69 00 00 lwz r11,0(r9) head->next = new_first; new_first->previous = head; ffc1c55c: 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; ffc1c560: 91 61 00 08 stw r11,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; ffc1c564: 92 c9 00 08 stw r22,8(r9) ffc1c568: 7c 00 01 24 mtmsr r0 /* * 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 ); ffc1c56c: 80 09 00 1c lwz r0,28(r9) ffc1c570: 80 69 00 20 lwz r3,32(r9) ffc1c574: 80 89 00 24 lwz r4,36(r9) ffc1c578: 7c 09 03 a6 mtctr r0 ffc1c57c: 4e 80 04 21 bctrl static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1c580: 7c 00 00 a6 mfmsr r0 ffc1c584: 7d 30 42 a6 mfsprg r9,0 ffc1c588: 7c 09 48 78 andc r9,r0,r9 ffc1c58c: 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; ffc1c590: 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)) ffc1c594: 7f 89 b8 00 cmpw cr7,r9,r23 ffc1c598: 40 9e ff c0 bne+ cr7,ffc1c558 <_Timer_server_Body+0x1c4> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1c59c: 7c 00 01 24 mtmsr r0 ffc1c5a0: 4b ff fe a4 b ffc1c444 <_Timer_server_Body+0xb0> } } else { ts->active = false; ffc1c5a4: 9a 5f 00 7c stb r18,124(r31) * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc1c5a8: 80 14 00 00 lwz r0,0(r20) ffc1c5ac: 30 00 00 01 addic r0,r0,1 ffc1c5b0: 90 14 00 00 stw r0,0(r20) return _Thread_Dispatch_disable_level; ffc1c5b4: 80 14 00 00 lwz r0,0(r20) /* * Block until there is something to do. */ _Thread_Disable_dispatch(); _Thread_Set_state( ts->thread, STATES_DELAYING ); ffc1c5b8: 80 7f 00 00 lwz r3,0(r31) ffc1c5bc: 38 80 00 08 li r4,8 ffc1c5c0: 48 00 4e 45 bl ffc21404 <_Thread_Set_state> _Timer_server_Reset_interval_system_watchdog( ts ); ffc1c5c4: 7f e3 fb 78 mr r3,r31 ffc1c5c8: 4b ff fc a5 bl ffc1c26c <_Timer_server_Reset_interval_system_watchdog> _Timer_server_Reset_tod_system_watchdog( ts ); ffc1c5cc: 7f e3 fb 78 mr r3,r31 ffc1c5d0: 4b ff fd 31 bl ffc1c300 <_Timer_server_Reset_tod_system_watchdog> _Thread_Enable_dispatch(); ffc1c5d4: 48 00 42 81 bl ffc20854 <_Thread_Enable_dispatch> ts->active = true; ffc1c5d8: 9a 7f 00 7c stb r19,124(r31) static void _Timer_server_Stop_interval_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->Interval_watchdogs.System_watchdog ); ffc1c5dc: 7e 03 83 78 mr r3,r16 ffc1c5e0: 48 00 5a d5 bl ffc220b4 <_Watchdog_Remove> static void _Timer_server_Stop_tod_system_watchdog( Timer_server_Control *ts ) { _Watchdog_Remove( &ts->TOD_watchdogs.System_watchdog ); ffc1c5e4: 7e 23 8b 78 mr r3,r17 ffc1c5e8: 48 00 5a cd bl ffc220b4 <_Watchdog_Remove> ffc1c5ec: 4b ff fe 58 b ffc1c444 <_Timer_server_Body+0xb0> =============================================================================== ffc1c5f0 <_Timer_server_Schedule_operation_method>: static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc1c5f0: 94 21 ff f0 stwu r1,-16(r1) ffc1c5f4: 7c 08 02 a6 mflr r0 ffc1c5f8: 7c 89 23 78 mr r9,r4 ffc1c5fc: 90 01 00 14 stw r0,20(r1) if ( ts->insert_chain == NULL ) { ffc1c600: 80 03 00 78 lwz r0,120(r3) static void _Timer_server_Schedule_operation_method( Timer_server_Control *ts, Timer_Control *timer ) { ffc1c604: 93 e1 00 0c stw r31,12(r1) ffc1c608: 7c 7f 1b 78 mr r31,r3 if ( ts->insert_chain == NULL ) { ffc1c60c: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c610: 41 9e 00 20 beq- cr7,ffc1c630 <_Timer_server_Schedule_operation_method+0x40> * 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 ); ffc1c614: 80 63 00 78 lwz r3,120(r3) ffc1c618: 48 00 0c a1 bl ffc1d2b8 <_Chain_Append> } } ffc1c61c: 80 01 00 14 lwz r0,20(r1) ffc1c620: 83 e1 00 0c lwz r31,12(r1) ffc1c624: 38 21 00 10 addi r1,r1,16 ffc1c628: 7c 08 03 a6 mtlr r0 ffc1c62c: 4e 80 00 20 blr * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc1c630: 3d 60 00 00 lis r11,0 ffc1c634: 81 4b 28 e0 lwz r10,10464(r11) ffc1c638: 38 0a 00 01 addi r0,r10,1 ffc1c63c: 90 0b 28 e0 stw r0,10464(r11) return _Thread_Dispatch_disable_level; ffc1c640: 80 0b 28 e0 lwz r0,10464(r11) * being inserted. This could result in an integer overflow. */ _Thread_Disable_dispatch(); if ( timer->the_class == TIMER_INTERVAL_ON_TASK ) { ffc1c644: 80 04 00 38 lwz r0,56(r4) ffc1c648: 2f 80 00 01 cmpwi cr7,r0,1 ffc1c64c: 41 9e 00 ac beq- cr7,ffc1c6f8 <_Timer_server_Schedule_operation_method+0x108> _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); if ( !ts->active ) { _Timer_server_Reset_interval_system_watchdog( ts ); } } else if ( timer->the_class == TIMER_TIME_OF_DAY_ON_TASK ) { ffc1c650: 2f 80 00 03 cmpwi cr7,r0,3 ffc1c654: 41 9e 00 1c beq- cr7,ffc1c670 <_Timer_server_Schedule_operation_method+0x80> if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); ffc1c658: 48 00 41 fd bl ffc20854 <_Thread_Enable_dispatch> * 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 ); } } ffc1c65c: 80 01 00 14 lwz r0,20(r1) ffc1c660: 83 e1 00 0c lwz r31,12(r1) ffc1c664: 38 21 00 10 addi r1,r1,16 ffc1c668: 7c 08 03 a6 mtlr r0 ffc1c66c: 4e 80 00 20 blr static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1c670: 7c c0 00 a6 mfmsr r6 ffc1c674: 7c 10 42 a6 mfsprg r0,0 ffc1c678: 7c c0 00 78 andc r0,r6,r0 ffc1c67c: 7c 00 01 24 mtmsr r0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc1c680: 81 63 00 68 lwz r11,104(r3) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc1c684: 38 03 00 6c addi r0,r3,108 /* * 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(); ffc1c688: 3d 40 00 00 lis r10,0 last_snapshot = ts->TOD_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { ffc1c68c: 7f 8b 00 00 cmpw cr7,r11,r0 /* * 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(); ffc1c690: 80 0a 28 f8 lwz r0,10488(r10) last_snapshot = ts->TOD_watchdogs.last_snapshot; ffc1c694: 81 43 00 74 lwz r10,116(r3) if ( !_Chain_Is_empty( &ts->TOD_watchdogs.Chain ) ) { ffc1c698: 41 9e 00 30 beq- cr7,ffc1c6c8 <_Timer_server_Schedule_operation_method+0xd8> first_watchdog = _Watchdog_First( &ts->TOD_watchdogs.Chain ); delta_interval = first_watchdog->delta_interval; if ( snapshot > last_snapshot ) { ffc1c69c: 7f 80 50 40 cmplw cr7,r0,r10 _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; ffc1c6a0: 80 eb 00 10 lwz r7,16(r11) } } else { /* * Someone put us in the past. */ delta = last_snapshot - snapshot; ffc1c6a4: 7d 07 52 14 add r8,r7,r10 delta_interval += delta; ffc1c6a8: 7d 00 40 50 subf r8,r0,r8 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 ) { ffc1c6ac: 40 9d 00 18 ble- cr7,ffc1c6c4 <_Timer_server_Schedule_operation_method+0xd4> /* * We advanced in time. */ delta = snapshot - last_snapshot; ffc1c6b0: 7d 4a 00 50 subf r10,r10,r0 if (delta_interval > delta) { ffc1c6b4: 7f 87 50 40 cmplw cr7,r7,r10 delta_interval -= delta; } else { delta_interval = 0; ffc1c6b8: 39 00 00 00 li r8,0 if ( snapshot > last_snapshot ) { /* * We advanced in time. */ delta = snapshot - last_snapshot; if (delta_interval > delta) { ffc1c6bc: 40 9d 00 08 ble- cr7,ffc1c6c4 <_Timer_server_Schedule_operation_method+0xd4><== NEVER TAKEN delta_interval -= delta; ffc1c6c0: 7d 0a 38 50 subf r8,r10,r7 * Someone put us in the past. */ delta = last_snapshot - snapshot; delta_interval += delta; } first_watchdog->delta_interval = delta_interval; ffc1c6c4: 91 0b 00 10 stw r8,16(r11) } ts->TOD_watchdogs.last_snapshot = snapshot; ffc1c6c8: 90 1f 00 74 stw r0,116(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1c6cc: 7c c0 01 24 mtmsr r6 _ISR_Enable( level ); _Watchdog_Insert( &ts->TOD_watchdogs.Chain, &timer->Ticker ); ffc1c6d0: 38 7f 00 68 addi r3,r31,104 ffc1c6d4: 38 89 00 10 addi r4,r9,16 ffc1c6d8: 48 00 58 15 bl ffc21eec <_Watchdog_Insert> if ( !ts->active ) { ffc1c6dc: 88 1f 00 7c lbz r0,124(r31) ffc1c6e0: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c6e4: 40 9e ff 74 bne+ cr7,ffc1c658 <_Timer_server_Schedule_operation_method+0x68> _Timer_server_Reset_tod_system_watchdog( ts ); ffc1c6e8: 7f e3 fb 78 mr r3,r31 ffc1c6ec: 4b ff fc 15 bl ffc1c300 <_Timer_server_Reset_tod_system_watchdog> } } _Thread_Enable_dispatch(); ffc1c6f0: 48 00 41 65 bl ffc20854 <_Thread_Enable_dispatch> ffc1c6f4: 4b ff ff 68 b ffc1c65c <_Timer_server_Schedule_operation_method+0x6c> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1c6f8: 7c c0 00 a6 mfmsr r6 ffc1c6fc: 7c 10 42 a6 mfsprg r0,0 ffc1c700: 7c c0 00 78 andc r0,r6,r0 ffc1c704: 7c 00 01 24 mtmsr r0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc1c708: 81 63 00 30 lwz r11,48(r3) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc1c70c: 38 03 00 34 addi r0,r3,52 /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = _Watchdog_Ticks_since_boot; ffc1c710: 3d 40 00 00 lis r10,0 last_snapshot = ts->Interval_watchdogs.last_snapshot; if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { ffc1c714: 7f 8b 00 00 cmpw cr7,r11,r0 /* * We have to advance the last known ticks value of the server and update * the watchdog chain accordingly. */ _ISR_Disable( level ); snapshot = _Watchdog_Ticks_since_boot; ffc1c718: 80 0a 29 14 lwz r0,10516(r10) last_snapshot = ts->Interval_watchdogs.last_snapshot; ffc1c71c: 81 03 00 3c lwz r8,60(r3) if ( !_Chain_Is_empty( &ts->Interval_watchdogs.Chain ) ) { ffc1c720: 41 9e 00 20 beq- cr7,ffc1c740 <_Timer_server_Schedule_operation_method+0x150> /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; ffc1c724: 80 eb 00 10 lwz r7,16(r11) first_watchdog = _Watchdog_First( &ts->Interval_watchdogs.Chain ); /* * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; ffc1c728: 7d 08 00 50 subf r8,r8,r0 delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { delta_interval -= delta; } else { delta_interval = 0; ffc1c72c: 39 40 00 00 li r10,0 * We assume adequate unsigned arithmetic here. */ delta = snapshot - last_snapshot; delta_interval = first_watchdog->delta_interval; if (delta_interval > delta) { ffc1c730: 7f 88 38 40 cmplw cr7,r8,r7 ffc1c734: 40 9c 00 08 bge- cr7,ffc1c73c <_Timer_server_Schedule_operation_method+0x14c> delta_interval -= delta; ffc1c738: 7d 48 38 50 subf r10,r8,r7 } else { delta_interval = 0; } first_watchdog->delta_interval = delta_interval; ffc1c73c: 91 4b 00 10 stw r10,16(r11) } ts->Interval_watchdogs.last_snapshot = snapshot; ffc1c740: 90 1f 00 3c stw r0,60(r31) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1c744: 7c c0 01 24 mtmsr r6 _ISR_Enable( level ); _Watchdog_Insert( &ts->Interval_watchdogs.Chain, &timer->Ticker ); ffc1c748: 38 7f 00 30 addi r3,r31,48 ffc1c74c: 38 89 00 10 addi r4,r9,16 ffc1c750: 48 00 57 9d bl ffc21eec <_Watchdog_Insert> if ( !ts->active ) { ffc1c754: 88 1f 00 7c lbz r0,124(r31) ffc1c758: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c75c: 40 9e fe fc bne+ cr7,ffc1c658 <_Timer_server_Schedule_operation_method+0x68> _Timer_server_Reset_interval_system_watchdog( ts ); ffc1c760: 7f e3 fb 78 mr r3,r31 ffc1c764: 4b ff fb 09 bl ffc1c26c <_Timer_server_Reset_interval_system_watchdog> if ( !ts->active ) { _Timer_server_Reset_tod_system_watchdog( ts ); } } _Thread_Enable_dispatch(); ffc1c768: 48 00 40 ed bl ffc20854 <_Thread_Enable_dispatch> ffc1c76c: 4b ff fe f0 b ffc1c65c <_Timer_server_Schedule_operation_method+0x6c> =============================================================================== ffc0d454 <_User_extensions_Fatal>: void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0d454: 94 21 ff e0 stwu r1,-32(r1) ffc0d458: 7c 08 02 a6 mflr r0 ffc0d45c: 93 c1 00 18 stw r30,24(r1) ffc0d460: 3f c0 00 00 lis r30,0 ffc0d464: 3b de 2d f4 addi r30,r30,11764 ffc0d468: 93 e1 00 1c stw r31,28(r1) ffc0d46c: 83 fe 00 08 lwz r31,8(r30) ffc0d470: 93 61 00 0c stw r27,12(r1) ffc0d474: 7c 7b 1b 78 mr r27,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d478: 7f 9f f0 00 cmpw cr7,r31,r30 void _User_extensions_Fatal ( Internal_errors_Source the_source, bool is_internal, Internal_errors_t the_error ) { ffc0d47c: 93 81 00 10 stw r28,16(r1) ffc0d480: 7c 9c 23 78 mr r28,r4 ffc0d484: 93 a1 00 14 stw r29,20(r1) ffc0d488: 7c bd 2b 78 mr r29,r5 ffc0d48c: 90 01 00 24 stw r0,36(r1) Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d490: 41 9e 00 30 beq- cr7,ffc0d4c0 <_User_extensions_Fatal+0x6c><== NEVER TAKEN !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) ffc0d494: 80 1f 00 30 lwz r0,48(r31) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0d498: 7f 63 db 78 mr r3,r27 ffc0d49c: 7f 84 e3 78 mr r4,r28 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) ffc0d4a0: 2f 80 00 00 cmpwi cr7,r0,0 (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0d4a4: 7f a5 eb 78 mr r5,r29 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) ffc0d4a8: 41 9e 00 0c beq- cr7,ffc0d4b4 <_User_extensions_Fatal+0x60> (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); ffc0d4ac: 7c 09 03 a6 mtctr r0 ffc0d4b0: 4e 80 04 21 bctrl Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { ffc0d4b4: 83 ff 00 04 lwz r31,4(r31) ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d4b8: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d4bc: 40 9e ff d8 bne+ cr7,ffc0d494 <_User_extensions_Fatal+0x40> the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.fatal != NULL ) (*the_extension->Callouts.fatal)( the_source, is_internal, the_error ); } } ffc0d4c0: 80 01 00 24 lwz r0,36(r1) ffc0d4c4: 83 61 00 0c lwz r27,12(r1) ffc0d4c8: 7c 08 03 a6 mtlr r0 ffc0d4cc: 83 81 00 10 lwz r28,16(r1) ffc0d4d0: 83 a1 00 14 lwz r29,20(r1) ffc0d4d4: 83 c1 00 18 lwz r30,24(r1) ffc0d4d8: 83 e1 00 1c lwz r31,28(r1) ffc0d4dc: 38 21 00 20 addi r1,r1,32 ffc0d4e0: 4e 80 00 20 blr =============================================================================== ffc0d264 <_User_extensions_Handler_initialization>: #include #include #include void _User_extensions_Handler_initialization(void) { ffc0d264: 94 21 ff e8 stwu r1,-24(r1) ffc0d268: 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; ffc0d26c: 3c e0 00 00 lis r7,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0d270: 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; ffc0d274: 38 e7 20 04 addi r7,r7,8196 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0d278: 3d 00 00 00 lis r8,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0d27c: 93 a1 00 0c stw r29,12(r1) ffc0d280: 3d 40 00 00 lis r10,0 ffc0d284: 39 68 2d f4 addi r11,r8,11764 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; ffc0d288: 83 a7 00 3c lwz r29,60(r7) ffc0d28c: 39 2a 2c d0 addi r9,r10,11472 head->previous = NULL; ffc0d290: 38 00 00 00 li r0,0 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0d294: 93 c1 00 10 stw r30,16(r1) initial_extensions = Configuration.User_extension_table; _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { ffc0d298: 2f 9d 00 00 cmpwi cr7,r29,0 ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0d29c: 38 ab 00 04 addi r5,r11,4 #include #include #include void _User_extensions_Handler_initialization(void) { ffc0d2a0: 93 81 00 08 stw r28,8(r1) ffc0d2a4: 38 c9 00 04 addi r6,r9,4 ffc0d2a8: 93 e1 00 14 stw r31,20(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; ffc0d2ac: 83 c7 00 38 lwz r30,56(r7) ffc0d2b0: 90 a8 2d f4 stw r5,11764(r8) head->previous = NULL; ffc0d2b4: 90 0b 00 04 stw r0,4(r11) tail->previous = head; ffc0d2b8: 91 6b 00 08 stw r11,8(r11) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc0d2bc: 90 ca 2c d0 stw r6,11472(r10) head->previous = NULL; ffc0d2c0: 90 09 00 04 stw r0,4(r9) tail->previous = head; ffc0d2c4: 91 29 00 08 stw r9,8(r9) initial_extensions = Configuration.User_extension_table; _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { ffc0d2c8: 41 9e 00 88 beq- cr7,ffc0d350 <_User_extensions_Handler_initialization+0xec><== NEVER TAKEN extension = (User_extensions_Control *) _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ffc0d2cc: 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 *) ffc0d2d0: 7f 83 e3 78 mr r3,r28 ffc0d2d4: 48 00 08 a9 bl ffc0db7c <_Workspace_Allocate_or_fatal_error> _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0d2d8: 38 80 00 00 li r4,0 ffc0d2dc: 7f 85 e3 78 mr r5,r28 _Chain_Initialize_empty( &_User_extensions_List ); _Chain_Initialize_empty( &_User_extensions_Switches_list ); if ( initial_extensions ) { extension = (User_extensions_Control *) ffc0d2e0: 7c 7f 1b 78 mr r31,r3 _Workspace_Allocate_or_fatal_error( number_of_extensions * sizeof( User_extensions_Control ) ); memset ( ffc0d2e4: 48 00 77 31 bl ffc14a14 extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0d2e8: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0d2ec: 41 9e 00 64 beq- cr7,ffc0d350 <_User_extensions_Handler_initialization+0xec><== NEVER TAKEN ffc0d2f0: 3b 80 00 00 li r28,0 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; ffc0d2f4: 81 5d 00 00 lwz r10,0(r29) _User_extensions_Add_set( extension ); ffc0d2f8: 7f e3 fb 78 mr r3,r31 RTEMS_INLINE_ROUTINE void _User_extensions_Add_set_with_table( User_extensions_Control *extension, const User_extensions_Table *extension_table ) { extension->Callouts = *extension_table; ffc0d2fc: 81 7d 00 04 lwz r11,4(r29) ffc0d300: 3b 9c 00 01 addi r28,r28,1 ffc0d304: 81 3d 00 08 lwz r9,8(r29) ffc0d308: 80 1d 00 0c lwz r0,12(r29) ffc0d30c: 91 5f 00 14 stw r10,20(r31) ffc0d310: 91 7f 00 18 stw r11,24(r31) ffc0d314: 91 3f 00 1c stw r9,28(r31) ffc0d318: 90 1f 00 20 stw r0,32(r31) ffc0d31c: 81 5d 00 10 lwz r10,16(r29) ffc0d320: 81 7d 00 14 lwz r11,20(r29) ffc0d324: 81 3d 00 18 lwz r9,24(r29) ffc0d328: 80 1d 00 1c lwz r0,28(r29) ffc0d32c: 3b bd 00 20 addi r29,r29,32 ffc0d330: 91 5f 00 24 stw r10,36(r31) ffc0d334: 91 7f 00 28 stw r11,40(r31) ffc0d338: 91 3f 00 2c stw r9,44(r31) ffc0d33c: 90 1f 00 30 stw r0,48(r31) _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; ffc0d340: 3b ff 00 34 addi r31,r31,52 _User_extensions_Add_set( extension ); ffc0d344: 48 00 43 8d bl ffc116d0 <_User_extensions_Add_set> extension, 0, number_of_extensions * sizeof( User_extensions_Control ) ); for ( i = 0 ; i < number_of_extensions ; i++ ) { ffc0d348: 7f 9c f0 00 cmpw cr7,r28,r30 ffc0d34c: 40 9e ff a8 bne+ cr7,ffc0d2f4 <_User_extensions_Handler_initialization+0x90> _User_extensions_Add_set_with_table (extension, &initial_extensions[i]); extension++; } } } ffc0d350: 80 01 00 1c lwz r0,28(r1) ffc0d354: 83 81 00 08 lwz r28,8(r1) ffc0d358: 7c 08 03 a6 mtlr r0 ffc0d35c: 83 a1 00 0c lwz r29,12(r1) ffc0d360: 83 c1 00 10 lwz r30,16(r1) ffc0d364: 83 e1 00 14 lwz r31,20(r1) ffc0d368: 38 21 00 18 addi r1,r1,24 ffc0d36c: 4e 80 00 20 blr =============================================================================== ffc0d370 <_User_extensions_Thread_begin>: #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0d370: 94 21 ff e8 stwu r1,-24(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc0d374: 3d 20 00 00 lis r9,0 ffc0d378: 7c 08 02 a6 mflr r0 ffc0d37c: 93 c1 00 10 stw r30,16(r1) ffc0d380: 3b c9 2d f4 addi r30,r9,11764 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d384: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0d388: 93 e1 00 14 stw r31,20(r1) ffc0d38c: 83 e9 2d f4 lwz r31,11764(r9) ffc0d390: 93 a1 00 0c stw r29,12(r1) ffc0d394: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d398: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_begin ( Thread_Control *executing ) { ffc0d39c: 90 01 00 1c stw r0,28(r1) Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d3a0: 41 9e 00 28 beq- cr7,ffc0d3c8 <_User_extensions_Thread_begin+0x58><== NEVER TAKEN !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_begin != NULL ) ffc0d3a4: 80 1f 00 28 lwz r0,40(r31) (*the_extension->Callouts.thread_begin)( executing ); ffc0d3a8: 7f a3 eb 78 mr r3,r29 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_begin != NULL ) ffc0d3ac: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d3b0: 41 9e 00 0c beq- cr7,ffc0d3bc <_User_extensions_Thread_begin+0x4c> (*the_extension->Callouts.thread_begin)( executing ); ffc0d3b4: 7c 09 03 a6 mtctr r0 ffc0d3b8: 4e 80 04 21 bctrl Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { ffc0d3bc: 83 ff 00 00 lwz r31,0(r31) ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d3c0: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d3c4: 40 9e ff e0 bne+ cr7,ffc0d3a4 <_User_extensions_Thread_begin+0x34> the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_begin != NULL ) (*the_extension->Callouts.thread_begin)( executing ); } } ffc0d3c8: 80 01 00 1c lwz r0,28(r1) ffc0d3cc: 83 a1 00 0c lwz r29,12(r1) ffc0d3d0: 7c 08 03 a6 mtlr r0 ffc0d3d4: 83 c1 00 10 lwz r30,16(r1) ffc0d3d8: 83 e1 00 14 lwz r31,20(r1) ffc0d3dc: 38 21 00 18 addi r1,r1,24 ffc0d3e0: 4e 80 00 20 blr =============================================================================== ffc0d4e4 <_User_extensions_Thread_create>: #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0d4e4: 94 21 ff e8 stwu r1,-24(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc0d4e8: 3d 20 00 00 lis r9,0 ffc0d4ec: 7c 08 02 a6 mflr r0 ffc0d4f0: 93 c1 00 10 stw r30,16(r1) ffc0d4f4: 3b c9 2d f4 addi r30,r9,11764 Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d4f8: 3b de 00 04 addi r30,r30,4 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0d4fc: 93 e1 00 14 stw r31,20(r1) ffc0d500: 83 e9 2d f4 lwz r31,11764(r9) ffc0d504: 93 a1 00 0c stw r29,12(r1) ffc0d508: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d50c: 7f 9f f0 00 cmpw cr7,r31,r30 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0d510: 90 01 00 1c stw r0,28(r1) if ( !status ) return false; } } return true; ffc0d514: 38 60 00 01 li r3,1 #include bool _User_extensions_Thread_create ( Thread_Control *the_thread ) { ffc0d518: 93 81 00 08 stw r28,8(r1) Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d51c: 41 9e 00 40 beq- cr7,ffc0d55c <_User_extensions_Thread_create+0x78><== NEVER TAKEN the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { status = (*the_extension->Callouts.thread_create)( ffc0d520: 3f 80 00 00 lis r28,0 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { ffc0d524: 80 1f 00 14 lwz r0,20(r31) status = (*the_extension->Callouts.thread_create)( ffc0d528: 39 3c 31 44 addi r9,r28,12612 ffc0d52c: 7f a4 eb 78 mr r4,r29 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_create != NULL ) { ffc0d530: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d534: 41 9e 00 18 beq- cr7,ffc0d54c <_User_extensions_Thread_create+0x68> status = (*the_extension->Callouts.thread_create)( ffc0d538: 80 69 00 0c lwz r3,12(r9) ffc0d53c: 7c 09 03 a6 mtctr r0 ffc0d540: 4e 80 04 21 bctrl _Thread_Executing, the_thread ); if ( !status ) ffc0d544: 2f 83 00 00 cmpwi cr7,r3,0 ffc0d548: 41 9e 00 34 beq- cr7,ffc0d57c <_User_extensions_Thread_create+0x98> User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { ffc0d54c: 83 ff 00 00 lwz r31,0(r31) { Chain_Node *the_node; User_extensions_Control *the_extension; bool status; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d550: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d554: 40 9e ff d0 bne+ cr7,ffc0d524 <_User_extensions_Thread_create+0x40> if ( !status ) return false; } } return true; ffc0d558: 38 60 00 01 li r3,1 } ffc0d55c: 80 01 00 1c lwz r0,28(r1) ffc0d560: 83 81 00 08 lwz r28,8(r1) ffc0d564: 7c 08 03 a6 mtlr r0 ffc0d568: 83 a1 00 0c lwz r29,12(r1) ffc0d56c: 83 c1 00 10 lwz r30,16(r1) ffc0d570: 83 e1 00 14 lwz r31,20(r1) ffc0d574: 38 21 00 18 addi r1,r1,24 ffc0d578: 4e 80 00 20 blr ffc0d57c: 80 01 00 1c lwz r0,28(r1) status = (*the_extension->Callouts.thread_create)( _Thread_Executing, the_thread ); if ( !status ) return false; ffc0d580: 38 60 00 00 li r3,0 } } return true; } ffc0d584: 83 81 00 08 lwz r28,8(r1) ffc0d588: 7c 08 03 a6 mtlr r0 ffc0d58c: 83 a1 00 0c lwz r29,12(r1) ffc0d590: 83 c1 00 10 lwz r30,16(r1) ffc0d594: 83 e1 00 14 lwz r31,20(r1) ffc0d598: 38 21 00 18 addi r1,r1,24 ffc0d59c: 4e 80 00 20 blr =============================================================================== ffc0d5a0 <_User_extensions_Thread_delete>: #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0d5a0: 94 21 ff e8 stwu r1,-24(r1) ffc0d5a4: 7c 08 02 a6 mflr r0 ffc0d5a8: 93 c1 00 10 stw r30,16(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Last( Chain_Control *the_chain ) { return _Chain_Tail( the_chain )->previous; ffc0d5ac: 3f c0 00 00 lis r30,0 ffc0d5b0: 3b de 2d f4 addi r30,r30,11764 ffc0d5b4: 93 e1 00 14 stw r31,20(r1) ffc0d5b8: 83 fe 00 08 lwz r31,8(r30) ffc0d5bc: 93 a1 00 0c stw r29,12(r1) ffc0d5c0: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d5c4: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_delete ( Thread_Control *the_thread ) { ffc0d5c8: 90 01 00 1c stw r0,28(r1) ffc0d5cc: 93 81 00 08 stw r28,8(r1) Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d5d0: 41 9e 00 34 beq- cr7,ffc0d604 <_User_extensions_Thread_delete+0x64><== NEVER TAKEN the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_delete != NULL ) (*the_extension->Callouts.thread_delete)( ffc0d5d4: 3f 80 00 00 lis r28,0 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_delete != NULL ) ffc0d5d8: 80 1f 00 20 lwz r0,32(r31) (*the_extension->Callouts.thread_delete)( ffc0d5dc: 39 3c 31 44 addi r9,r28,12612 ffc0d5e0: 7f a4 eb 78 mr r4,r29 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_delete != NULL ) ffc0d5e4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d5e8: 41 9e 00 10 beq- cr7,ffc0d5f8 <_User_extensions_Thread_delete+0x58> (*the_extension->Callouts.thread_delete)( ffc0d5ec: 80 69 00 0c lwz r3,12(r9) ffc0d5f0: 7c 09 03 a6 mtctr r0 ffc0d5f4: 4e 80 04 21 bctrl Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { ffc0d5f8: 83 ff 00 04 lwz r31,4(r31) ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d5fc: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d600: 40 9e ff d8 bne+ cr7,ffc0d5d8 <_User_extensions_Thread_delete+0x38> (*the_extension->Callouts.thread_delete)( _Thread_Executing, the_thread ); } } ffc0d604: 80 01 00 1c lwz r0,28(r1) ffc0d608: 83 81 00 08 lwz r28,8(r1) ffc0d60c: 7c 08 03 a6 mtlr r0 ffc0d610: 83 a1 00 0c lwz r29,12(r1) ffc0d614: 83 c1 00 10 lwz r30,16(r1) ffc0d618: 83 e1 00 14 lwz r31,20(r1) ffc0d61c: 38 21 00 18 addi r1,r1,24 ffc0d620: 4e 80 00 20 blr =============================================================================== ffc0d3e4 <_User_extensions_Thread_exitted>: void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0d3e4: 94 21 ff e8 stwu r1,-24(r1) ffc0d3e8: 7c 08 02 a6 mflr r0 ffc0d3ec: 93 c1 00 10 stw r30,16(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_Last( Chain_Control *the_chain ) { return _Chain_Tail( the_chain )->previous; ffc0d3f0: 3f c0 00 00 lis r30,0 ffc0d3f4: 3b de 2d f4 addi r30,r30,11764 ffc0d3f8: 93 e1 00 14 stw r31,20(r1) ffc0d3fc: 83 fe 00 08 lwz r31,8(r30) ffc0d400: 93 a1 00 0c stw r29,12(r1) ffc0d404: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d408: 7f 9f f0 00 cmpw cr7,r31,r30 } void _User_extensions_Thread_exitted ( Thread_Control *executing ) { ffc0d40c: 90 01 00 1c stw r0,28(r1) Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d410: 41 9e 00 28 beq- cr7,ffc0d438 <_User_extensions_Thread_exitted+0x54><== NEVER TAKEN !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) ffc0d414: 80 1f 00 2c lwz r0,44(r31) (*the_extension->Callouts.thread_exitted)( executing ); ffc0d418: 7f a3 eb 78 mr r3,r29 !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) ffc0d41c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d420: 41 9e 00 0c beq- cr7,ffc0d42c <_User_extensions_Thread_exitted+0x48> (*the_extension->Callouts.thread_exitted)( executing ); ffc0d424: 7c 09 03 a6 mtctr r0 ffc0d428: 4e 80 04 21 bctrl Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); !_Chain_Is_head( &_User_extensions_List, the_node ) ; the_node = the_node->previous ) { ffc0d42c: 83 ff 00 04 lwz r31,4(r31) ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_Last( &_User_extensions_List ); ffc0d430: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d434: 40 9e ff e0 bne+ cr7,ffc0d414 <_User_extensions_Thread_exitted+0x30> the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_exitted != NULL ) (*the_extension->Callouts.thread_exitted)( executing ); } } ffc0d438: 80 01 00 1c lwz r0,28(r1) ffc0d43c: 83 a1 00 0c lwz r29,12(r1) ffc0d440: 7c 08 03 a6 mtlr r0 ffc0d444: 83 c1 00 10 lwz r30,16(r1) ffc0d448: 83 e1 00 14 lwz r31,20(r1) ffc0d44c: 38 21 00 18 addi r1,r1,24 ffc0d450: 4e 80 00 20 blr =============================================================================== ffc0e1a0 <_User_extensions_Thread_restart>: #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1a0: 94 21 ff e8 stwu r1,-24(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc0e1a4: 3d 20 00 00 lis r9,0 ffc0e1a8: 7c 08 02 a6 mflr r0 ffc0e1ac: 93 c1 00 10 stw r30,16(r1) ffc0e1b0: 3b c9 2e 14 addi r30,r9,11796 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0e1b4: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1b8: 93 e1 00 14 stw r31,20(r1) ffc0e1bc: 83 e9 2e 14 lwz r31,11796(r9) ffc0e1c0: 93 a1 00 0c stw r29,12(r1) ffc0e1c4: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0e1c8: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_restart ( Thread_Control *the_thread ) { ffc0e1cc: 90 01 00 1c stw r0,28(r1) ffc0e1d0: 93 81 00 08 stw r28,8(r1) Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0e1d4: 41 9e 00 34 beq- cr7,ffc0e208 <_User_extensions_Thread_restart+0x68><== NEVER TAKEN the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_restart != NULL ) (*the_extension->Callouts.thread_restart)( ffc0e1d8: 3f 80 00 00 lis r28,0 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_restart != NULL ) ffc0e1dc: 80 1f 00 1c lwz r0,28(r31) (*the_extension->Callouts.thread_restart)( ffc0e1e0: 39 3c 31 64 addi r9,r28,12644 ffc0e1e4: 7f a4 eb 78 mr r4,r29 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_restart != NULL ) ffc0e1e8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e1ec: 41 9e 00 10 beq- cr7,ffc0e1fc <_User_extensions_Thread_restart+0x5c> (*the_extension->Callouts.thread_restart)( ffc0e1f0: 80 69 00 0c lwz r3,12(r9) ffc0e1f4: 7c 09 03 a6 mtctr r0 ffc0e1f8: 4e 80 04 21 bctrl Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { ffc0e1fc: 83 ff 00 00 lwz r31,0(r31) ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0e200: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0e204: 40 9e ff d8 bne+ cr7,ffc0e1dc <_User_extensions_Thread_restart+0x3c> (*the_extension->Callouts.thread_restart)( _Thread_Executing, the_thread ); } } ffc0e208: 80 01 00 1c lwz r0,28(r1) ffc0e20c: 83 81 00 08 lwz r28,8(r1) ffc0e210: 7c 08 03 a6 mtlr r0 ffc0e214: 83 a1 00 0c lwz r29,12(r1) ffc0e218: 83 c1 00 10 lwz r30,16(r1) ffc0e21c: 83 e1 00 14 lwz r31,20(r1) ffc0e220: 38 21 00 18 addi r1,r1,24 ffc0e224: 4e 80 00 20 blr =============================================================================== ffc0d624 <_User_extensions_Thread_start>: #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d624: 94 21 ff e8 stwu r1,-24(r1) */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc0d628: 3d 20 00 00 lis r9,0 ffc0d62c: 7c 08 02 a6 mflr r0 ffc0d630: 93 c1 00 10 stw r30,16(r1) ffc0d634: 3b c9 2d f4 addi r30,r9,11764 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d638: 3b de 00 04 addi r30,r30,4 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d63c: 93 e1 00 14 stw r31,20(r1) ffc0d640: 83 e9 2d f4 lwz r31,11764(r9) ffc0d644: 93 a1 00 0c stw r29,12(r1) ffc0d648: 7c 7d 1b 78 mr r29,r3 Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d64c: 7f 9f f0 00 cmpw cr7,r31,r30 #include void _User_extensions_Thread_start ( Thread_Control *the_thread ) { ffc0d650: 90 01 00 1c stw r0,28(r1) ffc0d654: 93 81 00 08 stw r28,8(r1) Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d658: 41 9e 00 34 beq- cr7,ffc0d68c <_User_extensions_Thread_start+0x68><== NEVER TAKEN the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_start != NULL ) (*the_extension->Callouts.thread_start)( ffc0d65c: 3f 80 00 00 lis r28,0 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_start != NULL ) ffc0d660: 80 1f 00 18 lwz r0,24(r31) (*the_extension->Callouts.thread_start)( ffc0d664: 39 3c 31 44 addi r9,r28,12612 ffc0d668: 7f a4 eb 78 mr r4,r29 !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { the_extension = (User_extensions_Control *) the_node; if ( the_extension->Callouts.thread_start != NULL ) ffc0d66c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0d670: 41 9e 00 10 beq- cr7,ffc0d680 <_User_extensions_Thread_start+0x5c> (*the_extension->Callouts.thread_start)( ffc0d674: 80 69 00 0c lwz r3,12(r9) ffc0d678: 7c 09 03 a6 mtctr r0 ffc0d67c: 4e 80 04 21 bctrl Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); !_Chain_Is_tail( &_User_extensions_List, the_node ) ; the_node = the_node->next ) { ffc0d680: 83 ff 00 00 lwz r31,0(r31) ) { Chain_Node *the_node; User_extensions_Control *the_extension; for ( the_node = _Chain_First( &_User_extensions_List ); ffc0d684: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d688: 40 9e ff d8 bne+ cr7,ffc0d660 <_User_extensions_Thread_start+0x3c> (*the_extension->Callouts.thread_start)( _Thread_Executing, the_thread ); } } ffc0d68c: 80 01 00 1c lwz r0,28(r1) ffc0d690: 83 81 00 08 lwz r28,8(r1) ffc0d694: 7c 08 03 a6 mtlr r0 ffc0d698: 83 a1 00 0c lwz r29,12(r1) ffc0d69c: 83 c1 00 10 lwz r30,16(r1) ffc0d6a0: 83 e1 00 14 lwz r31,20(r1) ffc0d6a4: 38 21 00 18 addi r1,r1,24 ffc0d6a8: 4e 80 00 20 blr =============================================================================== ffc0d6ac <_User_extensions_Thread_switch>: void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d6ac: 94 21 ff e8 stwu r1,-24(r1) ffc0d6b0: 3d 20 00 00 lis r9,0 ffc0d6b4: 7c 08 02 a6 mflr r0 ffc0d6b8: 93 c1 00 10 stw r30,16(r1) ffc0d6bc: 3b c9 2c d0 addi r30,r9,11472 Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); ffc0d6c0: 3b de 00 04 addi r30,r30,4 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d6c4: 93 e1 00 14 stw r31,20(r1) ffc0d6c8: 83 e9 2c d0 lwz r31,11472(r9) ffc0d6cc: 93 81 00 08 stw r28,8(r1) ffc0d6d0: 7c 7c 1b 78 mr r28,r3 Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); ffc0d6d4: 7f 9f f0 00 cmpw cr7,r31,r30 void _User_extensions_Thread_switch ( Thread_Control *executing, Thread_Control *heir ) { ffc0d6d8: 93 a1 00 0c stw r29,12(r1) ffc0d6dc: 7c 9d 23 78 mr r29,r4 ffc0d6e0: 90 01 00 1c stw r0,28(r1) Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); ffc0d6e4: 41 9e 00 24 beq- cr7,ffc0d708 <_User_extensions_Thread_switch+0x5c><== NEVER TAKEN !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); ffc0d6e8: 80 1f 00 08 lwz r0,8(r31) ffc0d6ec: 7f 83 e3 78 mr r3,r28 ffc0d6f0: 7f a4 eb 78 mr r4,r29 ffc0d6f4: 7c 09 03 a6 mtctr r0 ffc0d6f8: 4e 80 04 21 bctrl Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); !_Chain_Is_tail( &_User_extensions_Switches_list, the_node ) ; the_node = the_node->next ) { ffc0d6fc: 83 ff 00 00 lwz r31,0(r31) ) { Chain_Node *the_node; User_extensions_Switch_control *the_extension_switch; for ( the_node = _Chain_First( &_User_extensions_Switches_list ); ffc0d700: 7f 9f f0 00 cmpw cr7,r31,r30 ffc0d704: 40 9e ff e4 bne+ cr7,ffc0d6e8 <_User_extensions_Thread_switch+0x3c> the_extension_switch = (User_extensions_Switch_control *) the_node; (*the_extension_switch->thread_switch)( executing, heir ); } } ffc0d708: 80 01 00 1c lwz r0,28(r1) ffc0d70c: 83 81 00 08 lwz r28,8(r1) ffc0d710: 7c 08 03 a6 mtlr r0 ffc0d714: 83 a1 00 0c lwz r29,12(r1) ffc0d718: 83 c1 00 10 lwz r30,16(r1) ffc0d71c: 83 e1 00 14 lwz r31,20(r1) ffc0d720: 38 21 00 18 addi r1,r1,24 ffc0d724: 4e 80 00 20 blr =============================================================================== ffc0f5b8 <_Watchdog_Adjust>: void _Watchdog_Adjust( Chain_Control *header, Watchdog_Adjust_directions direction, Watchdog_Interval units ) { ffc0f5b8: 94 21 ff e0 stwu r1,-32(r1) ffc0f5bc: 7c 08 02 a6 mflr r0 ffc0f5c0: 90 01 00 24 stw r0,36(r1) ffc0f5c4: 93 c1 00 18 stw r30,24(r1) ffc0f5c8: 7c be 2b 78 mr r30,r5 ffc0f5cc: 93 e1 00 1c stw r31,28(r1) ffc0f5d0: 7c 7f 1b 78 mr r31,r3 ffc0f5d4: 93 61 00 0c stw r27,12(r1) ffc0f5d8: 93 81 00 10 stw r28,16(r1) ffc0f5dc: 93 a1 00 14 stw r29,20(r1) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0f5e0: 7c 00 00 a6 mfmsr r0 ffc0f5e4: 7d 30 42 a6 mfsprg r9,0 ffc0f5e8: 7c 09 48 78 andc r9,r0,r9 ffc0f5ec: 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; ffc0f5f0: 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 ); ffc0f5f4: 3b 83 00 04 addi r28,r3,4 * hence the compiler must not assume *header to remain * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { ffc0f5f8: 7f 89 e0 00 cmpw cr7,r9,r28 ffc0f5fc: 41 9e 00 68 beq- cr7,ffc0f664 <_Watchdog_Adjust+0xac> switch ( direction ) { ffc0f600: 2f 84 00 00 cmpwi cr7,r4,0 ffc0f604: 40 9e 00 88 bne- cr7,ffc0f68c <_Watchdog_Adjust+0xd4> case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f608: 2f 85 00 00 cmpwi cr7,r5,0 ffc0f60c: 41 9e 00 58 beq- cr7,ffc0f664 <_Watchdog_Adjust+0xac> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { ffc0f610: 83 a9 00 10 lwz r29,16(r9) _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; ffc0f614: 3b 60 00 01 li r27,1 case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { ffc0f618: 7f 85 e8 40 cmplw cr7,r5,r29 ffc0f61c: 40 bc 00 18 bge+ cr7,ffc0f634 <_Watchdog_Adjust+0x7c> <== ALWAYS TAKEN ffc0f620: 48 00 00 a8 b ffc0f6c8 <_Watchdog_Adjust+0x110> <== NOT EXECUTED switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f624: 41 82 00 40 beq- ffc0f664 <_Watchdog_Adjust+0xac> <== NEVER TAKEN if ( units < _Watchdog_First( header )->delta_interval ) { ffc0f628: 83 a9 00 10 lwz r29,16(r9) ffc0f62c: 7f 9d f0 40 cmplw cr7,r29,r30 ffc0f630: 41 9d 00 98 bgt- cr7,ffc0f6c8 <_Watchdog_Adjust+0x110> _Watchdog_First( header )->delta_interval -= units; break; } else { units -= _Watchdog_First( header )->delta_interval; _Watchdog_First( header )->delta_interval = 1; ffc0f634: 93 69 00 10 stw r27,16(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0f638: 7c 00 01 24 mtmsr r0 _ISR_Enable( level ); _Watchdog_Tickle( header ); ffc0f63c: 7f e3 fb 78 mr r3,r31 ffc0f640: 48 00 03 2d bl ffc0f96c <_Watchdog_Tickle> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0f644: 7c 00 00 a6 mfmsr r0 ffc0f648: 7d 30 42 a6 mfsprg r9,0 ffc0f64c: 7c 09 48 78 andc r9,r0,r9 ffc0f650: 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; ffc0f654: 81 3f 00 00 lwz r9,0(r31) switch ( direction ) { case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { ffc0f658: 7f dd f0 51 subf. r30,r29,r30 _Watchdog_Tickle( header ); _ISR_Disable( level ); if ( _Chain_Is_empty( header ) ) ffc0f65c: 7f 9c 48 00 cmpw cr7,r28,r9 ffc0f660: 40 9e ff c4 bne+ cr7,ffc0f624 <_Watchdog_Adjust+0x6c> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0f664: 7c 00 01 24 mtmsr r0 } } _ISR_Enable( level ); } ffc0f668: 80 01 00 24 lwz r0,36(r1) ffc0f66c: 83 61 00 0c lwz r27,12(r1) ffc0f670: 7c 08 03 a6 mtlr r0 ffc0f674: 83 81 00 10 lwz r28,16(r1) ffc0f678: 83 a1 00 14 lwz r29,20(r1) ffc0f67c: 83 c1 00 18 lwz r30,24(r1) ffc0f680: 83 e1 00 1c lwz r31,28(r1) ffc0f684: 38 21 00 20 addi r1,r1,32 ffc0f688: 4e 80 00 20 blr * unmodified across that call. * * Till Straumann, 7/2003 */ if ( !_Chain_Is_empty( header ) ) { switch ( direction ) { ffc0f68c: 2f 84 00 01 cmpwi cr7,r4,1 ffc0f690: 40 9e ff d4 bne+ cr7,ffc0f664 <_Watchdog_Adjust+0xac> <== NEVER TAKEN case WATCHDOG_BACKWARD: _Watchdog_First( header )->delta_interval += units; ffc0f694: 81 69 00 10 lwz r11,16(r9) ffc0f698: 7f cb 2a 14 add r30,r11,r5 ffc0f69c: 93 c9 00 10 stw r30,16(r9) ffc0f6a0: 7c 00 01 24 mtmsr r0 } } _ISR_Enable( level ); } ffc0f6a4: 80 01 00 24 lwz r0,36(r1) ffc0f6a8: 83 61 00 0c lwz r27,12(r1) ffc0f6ac: 7c 08 03 a6 mtlr r0 ffc0f6b0: 83 81 00 10 lwz r28,16(r1) ffc0f6b4: 83 a1 00 14 lwz r29,20(r1) ffc0f6b8: 83 c1 00 18 lwz r30,24(r1) ffc0f6bc: 83 e1 00 1c lwz r31,28(r1) ffc0f6c0: 38 21 00 20 addi r1,r1,32 ffc0f6c4: 4e 80 00 20 blr _Watchdog_First( header )->delta_interval += units; break; case WATCHDOG_FORWARD: while ( units ) { if ( units < _Watchdog_First( header )->delta_interval ) { _Watchdog_First( header )->delta_interval -= units; ffc0f6c8: 7f de e8 50 subf r30,r30,r29 ffc0f6cc: 93 c9 00 10 stw r30,16(r9) break; ffc0f6d0: 4b ff ff 94 b ffc0f664 <_Watchdog_Adjust+0xac> =============================================================================== ffc21e34 <_Watchdog_Adjust_to_chain>: { Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { ffc21e34: 2c 04 00 00 cmpwi r4,0 Chain_Control *header, Watchdog_Interval units_arg, Chain_Control *to_fire ) { ffc21e38: 94 21 ff f0 stwu r1,-16(r1) ffc21e3c: 93 e1 00 0c stw r31,12(r1) Watchdog_Interval units = units_arg; ISR_Level level; Watchdog_Control *first; if ( units <= 0 ) { ffc21e40: 41 82 00 94 beq- ffc21ed4 <_Watchdog_Adjust_to_chain+0xa0> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc21e44: 7c c0 00 a6 mfmsr r6 ffc21e48: 7c 10 42 a6 mfsprg r0,0 ffc21e4c: 7c c0 00 78 andc r0,r6,r0 ffc21e50: 7c 00 01 24 mtmsr r0 return; } _ISR_Disable( level ); ffc21e54: 81 23 00 00 lwz r9,0(r3) /* * The first set happens in less than units, so take all of them * off the chain and adjust units to reflect this. */ units -= first->delta_interval; first->delta_interval = 0; ffc21e58: 3b e0 00 00 li r31,0 ffc21e5c: 38 e3 00 04 addi r7,r3,4 ffc21e60: 39 85 00 04 addi r12,r5,4 while ( 1 ) { if ( units <= 0 ) { break; } if ( _Chain_Is_empty( header ) ) { ffc21e64: 7f 87 48 00 cmpw cr7,r7,r9 ffc21e68: 41 9e 00 68 beq- cr7,ffc21ed0 <_Watchdog_Adjust_to_chain+0x9c> /* * If it is longer than "units" until the first element on the chain * fires, then bump it and quit. */ if ( units < first->delta_interval ) { ffc21e6c: 80 09 00 10 lwz r0,16(r9) ffc21e70: 7f 80 20 40 cmplw cr7,r0,r4 ffc21e74: 41 9d 00 6c bgt- cr7,ffc21ee0 <_Watchdog_Adjust_to_chain+0xac> /* * The first set happens in less than units, so take all of them * off the chain and adjust units to reflect this. */ units -= first->delta_interval; first->delta_interval = 0; ffc21e78: 93 e9 00 10 stw r31,16(r9) /* * The first set happens in less than units, so take all of them * off the chain and adjust units to reflect this. */ units -= first->delta_interval; ffc21e7c: 7c 80 20 50 subf r4,r0,r4 ) { Chain_Node *next; Chain_Node *previous; next = the_node->next; ffc21e80: 81 09 00 00 lwz r8,0(r9) previous = the_node->previous; ffc21e84: 81 49 00 04 lwz r10,4(r9) next->previous = previous; ffc21e88: 91 48 00 04 stw r10,4(r8) Chain_Control *the_chain, Chain_Node *the_node ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; ffc21e8c: 81 65 00 08 lwz r11,8(r5) Chain_Node *previous; next = the_node->next; previous = the_node->previous; next->previous = previous; previous->next = next; ffc21e90: 91 0a 00 00 stw r8,0(r10) ) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; ffc21e94: 91 89 00 00 stw r12,0(r9) tail->previous = the_node; old_last->next = the_node; ffc21e98: 91 2b 00 00 stw r9,0(r11) { Chain_Node *tail = _Chain_Tail( the_chain ); Chain_Node *old_last = tail->previous; the_node->next = tail; tail->previous = the_node; ffc21e9c: 91 25 00 08 stw r9,8(r5) old_last->next = the_node; the_node->previous = old_last; ffc21ea0: 91 69 00 04 stw r11,4(r9) static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc21ea4: 7c 00 00 a6 mfmsr r0 ffc21ea8: 7c c0 01 24 mtmsr r6 ffc21eac: 7c 00 01 24 mtmsr r0 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc21eb0: 81 23 00 00 lwz r9,0(r3) _Chain_Extract_unprotected( &first->Node ); _Chain_Append_unprotected( to_fire, &first->Node ); _ISR_Flash( level ); if ( _Chain_Is_empty( header ) ) ffc21eb4: 7f 87 48 00 cmpw cr7,r7,r9 ffc21eb8: 41 9e 00 10 beq- cr7,ffc21ec8 <_Watchdog_Adjust_to_chain+0x94> break; first = _Watchdog_First( header ); if ( first->delta_interval != 0 ) ffc21ebc: 80 09 00 10 lwz r0,16(r9) ffc21ec0: 2f 80 00 00 cmpwi cr7,r0,0 ffc21ec4: 41 9e ff bc beq+ cr7,ffc21e80 <_Watchdog_Adjust_to_chain+0x4c><== NEVER TAKEN } _ISR_Disable( level ); while ( 1 ) { if ( units <= 0 ) { ffc21ec8: 2f 84 00 00 cmpwi cr7,r4,0 ffc21ecc: 40 9e ff 98 bne+ cr7,ffc21e64 <_Watchdog_Adjust_to_chain+0x30> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc21ed0: 7c c0 01 24 mtmsr r6 break; } } _ISR_Enable( level ); } ffc21ed4: 83 e1 00 0c lwz r31,12(r1) ffc21ed8: 38 21 00 10 addi r1,r1,16 ffc21edc: 4e 80 00 20 blr /* * If it is longer than "units" until the first element on the chain * fires, then bump it and quit. */ if ( units < first->delta_interval ) { first->delta_interval -= units; ffc21ee0: 7c 04 00 50 subf r0,r4,r0 ffc21ee4: 90 09 00 10 stw r0,16(r9) break; ffc21ee8: 4b ff ff e8 b ffc21ed0 <_Watchdog_Adjust_to_chain+0x9c> =============================================================================== ffc0d728 <_Watchdog_Insert>: Watchdog_Control *after; uint32_t insert_isr_nest_level; Watchdog_Interval delta_interval; insert_isr_nest_level = _ISR_Nest_level; ffc0d728: 3d 20 00 00 lis r9,0 ffc0d72c: 80 09 31 4c lwz r0,12620(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0d730: 7d 00 00 a6 mfmsr r8 ffc0d734: 7d 30 42 a6 mfsprg r9,0 ffc0d738: 7d 09 48 78 andc r9,r8,r9 ffc0d73c: 7d 20 01 24 mtmsr r9 /* * Check to see if the watchdog has just been inserted by a * higher priority interrupt. If so, abandon this insert. */ if ( the_watchdog->state != WATCHDOG_INACTIVE ) { ffc0d740: 81 24 00 08 lwz r9,8(r4) ffc0d744: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d748: 40 9e 01 04 bne- cr7,ffc0d84c <_Watchdog_Insert+0x124> _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; _Watchdog_Sync_count++; ffc0d74c: 3c c0 00 00 lis r6,0 ffc0d750: 81 26 28 3c lwz r9,10300(r6) if ( the_watchdog->state != WATCHDOG_INACTIVE ) { _ISR_Enable( level ); return; } the_watchdog->state = WATCHDOG_BEING_INSERTED; ffc0d754: 39 60 00 01 li r11,1 ffc0d758: 91 64 00 08 stw r11,8(r4) ffc0d75c: 3c a0 00 00 lis r5,0 _Watchdog_Sync_count++; ffc0d760: 39 29 00 01 addi r9,r9,1 ffc0d764: 91 26 28 3c stw r9,10300(r6) restart: delta_interval = the_watchdog->initial; ffc0d768: 81 24 00 0c lwz r9,12(r4) ffc0d76c: 81 63 00 00 lwz r11,0(r3) for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d770: 2f 89 00 00 cmpwi cr7,r9,0 ffc0d774: 41 9e 00 98 beq- cr7,ffc0d80c <_Watchdog_Insert+0xe4> ffc0d778: 81 4b 00 00 lwz r10,0(r11) ffc0d77c: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d780: 41 9e 00 8c beq- cr7,ffc0d80c <_Watchdog_Insert+0xe4> break; if ( delta_interval < after->delta_interval ) { ffc0d784: 81 4b 00 10 lwz r10,16(r11) ffc0d788: 7f 89 50 40 cmplw cr7,r9,r10 ffc0d78c: 41 9c 00 c8 blt- cr7,ffc0d854 <_Watchdog_Insert+0x12c> static inline void ppc_interrupt_flash( uint32_t level ) { uint32_t current_level; __asm__ volatile ( ffc0d790: 7c e0 00 a6 mfmsr r7 ffc0d794: 7d 00 01 24 mtmsr r8 ffc0d798: 7c e0 01 24 mtmsr r7 delta_interval -= after->delta_interval; _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d79c: 80 e4 00 08 lwz r7,8(r4) ffc0d7a0: 2f 87 00 01 cmpwi cr7,r7,1 ffc0d7a4: 40 9e 00 98 bne- cr7,ffc0d83c <_Watchdog_Insert+0x114> goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d7a8: 81 85 28 34 lwz r12,10292(r5) ffc0d7ac: 38 e5 28 34 addi r7,r5,10292 if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; ffc0d7b0: 7d 2a 48 50 subf r9,r10,r9 if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d7b4: 7f 80 60 40 cmplw cr7,r0,r12 ffc0d7b8: 40 bc 00 48 bge+ cr7,ffc0d800 <_Watchdog_Insert+0xd8> ffc0d7bc: 48 00 00 d4 b ffc0d890 <_Watchdog_Insert+0x168> for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d7c0: 81 4b 00 00 lwz r10,0(r11) ffc0d7c4: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d7c8: 41 9e 00 44 beq- cr7,ffc0d80c <_Watchdog_Insert+0xe4> break; if ( delta_interval < after->delta_interval ) { ffc0d7cc: 81 4b 00 10 lwz r10,16(r11) ffc0d7d0: 7f 8a 48 40 cmplw cr7,r10,r9 ffc0d7d4: 41 9d 00 80 bgt- cr7,ffc0d854 <_Watchdog_Insert+0x12c> after->delta_interval -= delta_interval; break; } delta_interval -= after->delta_interval; ffc0d7d8: 7d 2a 48 50 subf r9,r10,r9 ffc0d7dc: 7d 40 00 a6 mfmsr r10 ffc0d7e0: 7d 00 01 24 mtmsr r8 ffc0d7e4: 7d 40 01 24 mtmsr r10 _ISR_Flash( level ); if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { ffc0d7e8: 81 44 00 08 lwz r10,8(r4) ffc0d7ec: 2f 8a 00 01 cmpwi cr7,r10,1 ffc0d7f0: 40 9e 00 4c bne- cr7,ffc0d83c <_Watchdog_Insert+0x114> <== NEVER TAKEN goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { ffc0d7f4: 81 47 00 00 lwz r10,0(r7) ffc0d7f8: 7f 80 50 40 cmplw cr7,r0,r10 ffc0d7fc: 41 9c 00 94 blt- cr7,ffc0d890 <_Watchdog_Insert+0x168> <== NEVER TAKEN for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d800: 2f 89 00 00 cmpwi cr7,r9,0 exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; _Watchdog_Sync_count--; _ISR_Enable( level ); } ffc0d804: 81 6b 00 00 lwz r11,0(r11) for ( after = _Watchdog_First( header ) ; ; after = _Watchdog_Next( after ) ) { if ( delta_interval == 0 || !_Watchdog_Next( after ) ) ffc0d808: 40 9e ff b8 bne+ cr7,ffc0d7c0 <_Watchdog_Insert+0x98> _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); ffc0d80c: 81 6b 00 04 lwz r11,4(r11) the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d810: 3c e0 00 00 lis r7,0 ffc0d814: 80 e7 28 40 lwz r7,10304(r7) RTEMS_INLINE_ROUTINE void _Watchdog_Activate( Watchdog_Control *the_watchdog ) { the_watchdog->state = WATCHDOG_ACTIVE; ffc0d818: 38 60 00 02 li r3,2 ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0d81c: 81 4b 00 00 lwz r10,0(r11) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0d820: 91 64 00 04 stw r11,4(r4) ffc0d824: 90 64 00 08 stw r3,8(r4) } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; ffc0d828: 91 24 00 10 stw r9,16(r4) before_node = after_node->next; after_node->next = the_node; ffc0d82c: 90 8b 00 00 stw r4,0(r11) the_node->next = before_node; before_node->previous = the_node; ffc0d830: 90 8a 00 04 stw r4,4(r10) Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; ffc0d834: 91 44 00 00 stw r10,0(r4) _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d838: 90 e4 00 14 stw r7,20(r4) exit_insert: _Watchdog_Sync_level = insert_isr_nest_level; ffc0d83c: 90 05 28 34 stw r0,10292(r5) _Watchdog_Sync_count--; ffc0d840: 81 26 28 3c lwz r9,10300(r6) ffc0d844: 38 09 ff ff addi r0,r9,-1 ffc0d848: 90 06 28 3c stw r0,10300(r6) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0d84c: 7d 00 01 24 mtmsr r8 ffc0d850: 4e 80 00 20 blr if ( delta_interval == 0 || !_Watchdog_Next( after ) ) break; if ( delta_interval < after->delta_interval ) { after->delta_interval -= delta_interval; ffc0d854: 7d 49 50 50 subf r10,r9,r10 ffc0d858: 91 4b 00 10 stw r10,16(r11) the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d85c: 3c e0 00 00 lis r7,0 ffc0d860: 38 60 00 02 li r3,2 _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); ffc0d864: 81 6b 00 04 lwz r11,4(r11) the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d868: 80 e7 28 40 lwz r7,10304(r7) ) { Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; ffc0d86c: 81 4b 00 00 lwz r10,0(r11) Chain_Node *the_node ) { Chain_Node *before_node; the_node->previous = after_node; ffc0d870: 91 64 00 04 stw r11,4(r4) ffc0d874: 90 64 00 08 stw r3,8(r4) } } _Watchdog_Activate( the_watchdog ); the_watchdog->delta_interval = delta_interval; ffc0d878: 91 24 00 10 stw r9,16(r4) before_node = after_node->next; after_node->next = the_node; ffc0d87c: 90 8b 00 00 stw r4,0(r11) the_node->next = before_node; before_node->previous = the_node; ffc0d880: 90 8a 00 04 stw r4,4(r10) Chain_Node *before_node; the_node->previous = after_node; before_node = after_node->next; after_node->next = the_node; the_node->next = before_node; ffc0d884: 91 44 00 00 stw r10,0(r4) _Chain_Insert_unprotected( after->Node.previous, &the_watchdog->Node ); the_watchdog->start_time = _Watchdog_Ticks_since_boot; ffc0d888: 90 e4 00 14 stw r7,20(r4) ffc0d88c: 4b ff ff b0 b ffc0d83c <_Watchdog_Insert+0x114> if ( the_watchdog->state != WATCHDOG_BEING_INSERTED ) { goto exit_insert; } if ( _Watchdog_Sync_level > insert_isr_nest_level ) { _Watchdog_Sync_level = insert_isr_nest_level; ffc0d890: 90 05 28 34 stw r0,10292(r5) goto restart; ffc0d894: 4b ff fe d4 b ffc0d768 <_Watchdog_Insert+0x40> =============================================================================== ffc0d8f0 <_Watchdog_Remove>: static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0d8f0: 7d 20 00 a6 mfmsr r9 ffc0d8f4: 7c 10 42 a6 mfsprg r0,0 ffc0d8f8: 7d 20 00 78 andc r0,r9,r0 ffc0d8fc: 7c 00 01 24 mtmsr r0 ISR_Level level; Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; ffc0d900: 80 03 00 08 lwz r0,8(r3) switch ( previous_state ) { ffc0d904: 2f 80 00 01 cmpwi cr7,r0,1 ffc0d908: 41 9e 00 98 beq- cr7,ffc0d9a0 <_Watchdog_Remove+0xb0> ffc0d90c: 2b 80 00 01 cmplwi cr7,r0,1 ffc0d910: 40 9c 00 1c bge- cr7,ffc0d92c <_Watchdog_Remove+0x3c> _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0d914: 3d 60 00 00 lis r11,0 ffc0d918: 81 6b 28 40 lwz r11,10304(r11) ffc0d91c: 91 63 00 18 stw r11,24(r3) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0d920: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d924: 7c 03 03 78 mr r3,r0 ffc0d928: 4e 80 00 20 blr Watchdog_States previous_state; Watchdog_Control *next_watchdog; _ISR_Disable( level ); previous_state = the_watchdog->state; switch ( previous_state ) { ffc0d92c: 2b 80 00 03 cmplwi cr7,r0,3 ffc0d930: 41 bd ff e4 bgt- cr7,ffc0d914 <_Watchdog_Remove+0x24> <== NEVER TAKEN break; case WATCHDOG_ACTIVE: case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; ffc0d934: 39 60 00 00 li r11,0 ffc0d938: 91 63 00 08 stw r11,8(r3) } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; _ISR_Enable( level ); return( previous_state ); } ffc0d93c: 81 63 00 00 lwz r11,0(r3) case WATCHDOG_REMOVE_IT: the_watchdog->state = WATCHDOG_INACTIVE; next_watchdog = _Watchdog_Next( the_watchdog ); if ( _Watchdog_Next(next_watchdog) ) ffc0d940: 81 4b 00 00 lwz r10,0(r11) ffc0d944: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d948: 41 9e 00 14 beq- cr7,ffc0d95c <_Watchdog_Remove+0x6c> next_watchdog->delta_interval += the_watchdog->delta_interval; ffc0d94c: 81 0b 00 10 lwz r8,16(r11) ffc0d950: 81 43 00 10 lwz r10,16(r3) ffc0d954: 7d 48 52 14 add r10,r8,r10 ffc0d958: 91 4b 00 10 stw r10,16(r11) if ( _Watchdog_Sync_count ) ffc0d95c: 3d 40 00 00 lis r10,0 ffc0d960: 81 4a 28 3c lwz r10,10300(r10) ffc0d964: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0d968: 41 9e 00 14 beq- cr7,ffc0d97c <_Watchdog_Remove+0x8c> _Watchdog_Sync_level = _ISR_Nest_level; ffc0d96c: 3d 40 00 00 lis r10,0 ffc0d970: 81 0a 31 4c lwz r8,12620(r10) ffc0d974: 3d 40 00 00 lis r10,0 ffc0d978: 91 0a 28 34 stw r8,10292(r10) { Chain_Node *next; Chain_Node *previous; next = the_node->next; previous = the_node->previous; ffc0d97c: 81 43 00 04 lwz r10,4(r3) next->previous = previous; ffc0d980: 91 4b 00 04 stw r10,4(r11) previous->next = next; ffc0d984: 91 6a 00 00 stw r11,0(r10) _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0d988: 3d 60 00 00 lis r11,0 ffc0d98c: 81 6b 28 40 lwz r11,10304(r11) ffc0d990: 91 63 00 18 stw r11,24(r3) ffc0d994: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d998: 7c 03 03 78 mr r3,r0 ffc0d99c: 4e 80 00 20 blr /* * 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; ffc0d9a0: 39 60 00 00 li r11,0 ffc0d9a4: 91 63 00 08 stw r11,8(r3) _Watchdog_Sync_level = _ISR_Nest_level; _Chain_Extract_unprotected( &the_watchdog->Node ); break; } the_watchdog->stop_time = _Watchdog_Ticks_since_boot; ffc0d9a8: 3d 60 00 00 lis r11,0 ffc0d9ac: 81 6b 28 40 lwz r11,10304(r11) ffc0d9b0: 91 63 00 18 stw r11,24(r3) ffc0d9b4: 7d 20 01 24 mtmsr r9 _ISR_Enable( level ); return( previous_state ); } ffc0d9b8: 7c 03 03 78 mr r3,r0 ffc0d9bc: 4e 80 00 20 blr =============================================================================== ffc0ece4 <_Watchdog_Report_chain>: void _Watchdog_Report_chain( const char *name, Chain_Control *header ) { ffc0ece4: 94 21 ff e8 stwu r1,-24(r1) ffc0ece8: 7c 08 02 a6 mflr r0 ffc0ecec: 93 c1 00 10 stw r30,16(r1) ffc0ecf0: 7c 7e 1b 78 mr r30,r3 ffc0ecf4: 93 e1 00 14 stw r31,20(r1) ffc0ecf8: 7c 9f 23 78 mr r31,r4 ffc0ecfc: 90 01 00 1c stw r0,28(r1) ffc0ed00: 93 81 00 08 stw r28,8(r1) ffc0ed04: 93 a1 00 0c stw r29,12(r1) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0ed08: 7f a0 00 a6 mfmsr r29 ffc0ed0c: 7c 10 42 a6 mfsprg r0,0 ffc0ed10: 7f a0 00 78 andc r0,r29,r0 ffc0ed14: 7c 00 01 24 mtmsr r0 ISR_Level level; Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); ffc0ed18: 3c 60 ff c2 lis r3,-62 ffc0ed1c: 7f e5 fb 78 mr r5,r31 ffc0ed20: 38 63 2c 84 addi r3,r3,11396 ffc0ed24: 7f c4 f3 78 mr r4,r30 ffc0ed28: 4c c6 31 82 crclr 4*cr1+eq ffc0ed2c: 4b ff 80 41 bl ffc06d6c */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0ed30: 83 9f 00 00 lwz r28,0(r31) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc0ed34: 3b ff 00 04 addi r31,r31,4 if ( !_Chain_Is_empty( header ) ) { ffc0ed38: 7f 9c f8 00 cmpw cr7,r28,r31 ffc0ed3c: 41 9e 00 54 beq- cr7,ffc0ed90 <_Watchdog_Report_chain+0xac> node != _Chain_Tail(header) ; node = node->next ) { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); ffc0ed40: 7f 84 e3 78 mr r4,r28 ffc0ed44: 38 60 00 00 li r3,0 ffc0ed48: 48 00 00 5d bl ffc0eda4 <_Watchdog_Report> _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; node != _Chain_Tail(header) ; node = node->next ) ffc0ed4c: 83 9c 00 00 lwz r28,0(r28) Chain_Node *node; _ISR_Disable( level ); printk( "Watchdog Chain: %s %p\n", name, header ); if ( !_Chain_Is_empty( header ) ) { for ( node = _Chain_First( header ) ; ffc0ed50: 7f 9c f8 00 cmpw cr7,r28,r31 ffc0ed54: 40 9e ff ec bne+ cr7,ffc0ed40 <_Watchdog_Report_chain+0x5c><== NEVER TAKEN { Watchdog_Control *watch = (Watchdog_Control *) node; _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); ffc0ed58: 3c 60 ff c2 lis r3,-62 ffc0ed5c: 38 63 2c 9c addi r3,r3,11420 ffc0ed60: 7f c4 f3 78 mr r4,r30 ffc0ed64: 4c c6 31 82 crclr 4*cr1+eq ffc0ed68: 4b ff 80 05 bl ffc06d6c return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0ed6c: 7f a0 01 24 mtmsr r29 } else { printk( "Chain is empty\n" ); } _ISR_Enable( level ); } ffc0ed70: 80 01 00 1c lwz r0,28(r1) ffc0ed74: 83 81 00 08 lwz r28,8(r1) ffc0ed78: 7c 08 03 a6 mtlr r0 ffc0ed7c: 83 a1 00 0c lwz r29,12(r1) ffc0ed80: 83 c1 00 10 lwz r30,16(r1) ffc0ed84: 83 e1 00 14 lwz r31,20(r1) ffc0ed88: 38 21 00 18 addi r1,r1,24 ffc0ed8c: 4e 80 00 20 blr _Watchdog_Report( NULL, watch ); } printk( "== end of %s \n", name ); } else { printk( "Chain is empty\n" ); ffc0ed90: 3c 60 ff c2 lis r3,-62 ffc0ed94: 38 63 2c ac addi r3,r3,11436 ffc0ed98: 4c c6 31 82 crclr 4*cr1+eq ffc0ed9c: 4b ff 7f d1 bl ffc06d6c ffc0eda0: 4b ff ff cc b ffc0ed6c <_Watchdog_Report_chain+0x88> =============================================================================== ffc08d0c : int adjtime( struct timeval *delta, struct timeval *olddelta ) { ffc08d0c: 94 21 ff d8 stwu r1,-40(r1) ffc08d10: 7d 80 00 26 mfcr r12 ffc08d14: 7c 08 02 a6 mflr r0 ffc08d18: 93 e1 00 24 stw r31,36(r1) long adjustment; /* * Simple validations */ if ( !delta ) ffc08d1c: 7c 7f 1b 79 mr. r31,r3 int adjtime( struct timeval *delta, struct timeval *olddelta ) { ffc08d20: 93 c1 00 20 stw r30,32(r1) ffc08d24: 7c 9e 23 78 mr r30,r4 ffc08d28: 90 01 00 2c stw r0,44(r1) ffc08d2c: 91 81 00 1c stw r12,28(r1) long adjustment; /* * Simple validations */ if ( !delta ) ffc08d30: 41 82 01 70 beq- ffc08ea0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) ffc08d34: 81 3f 00 04 lwz r9,4(r31) ffc08d38: 3c 00 00 0f lis r0,15 ffc08d3c: 60 00 42 3f ori r0,r0,16959 ffc08d40: 7f 89 00 40 cmplw cr7,r9,r0 ffc08d44: 41 9d 01 5c bgt- cr7,ffc08ea0 rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { ffc08d48: 2e 04 00 00 cmpwi cr4,r4,0 ffc08d4c: 41 92 00 14 beq- cr4,ffc08d60 olddelta->tv_sec = 0; ffc08d50: 38 00 00 00 li r0,0 olddelta->tv_usec = 0; ffc08d54: 90 04 00 04 stw r0,4(r4) if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( olddelta ) { olddelta->tv_sec = 0; ffc08d58: 90 04 00 00 stw r0,0(r4) olddelta->tv_usec = 0; ffc08d5c: 81 3f 00 04 lwz r9,4(r31) } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); ffc08d60: 80 1f 00 00 lwz r0,0(r31) adjustment += delta->tv_usec; /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) return 0; ffc08d64: 38 60 00 00 li r3,0 olddelta->tv_sec = 0; olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); ffc08d68: 54 0a 40 2e rlwinm r10,r0,8,0,23 ffc08d6c: 54 0b 18 38 rlwinm r11,r0,3,0,28 ffc08d70: 7d 6b 50 50 subf r11,r11,r10 ffc08d74: 55 6a 30 32 rlwinm r10,r11,6,0,25 ffc08d78: 7d 6b 50 50 subf r11,r11,r10 ffc08d7c: 7c 0b 02 14 add r0,r11,r0 adjustment += delta->tv_usec; /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) ffc08d80: 3d 60 00 00 lis r11,0 olddelta->tv_sec = 0; olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); ffc08d84: 54 00 30 32 rlwinm r0,r0,6,0,25 adjustment += delta->tv_usec; /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) ffc08d88: 81 4b 20 10 lwz r10,8208(r11) olddelta->tv_usec = 0; } /* convert delta to microseconds */ adjustment = (delta->tv_sec * TOD_MICROSECONDS_PER_SECOND); adjustment += delta->tv_usec; ffc08d8c: 7d 20 4a 14 add r9,r0,r9 /* too small to account for */ if ( adjustment < rtems_configuration_get_microseconds_per_tick() ) ffc08d90: 7f 89 50 40 cmplw cr7,r9,r10 ffc08d94: 40 9c 00 24 bge- cr7,ffc08db8 /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; } ffc08d98: 80 01 00 2c lwz r0,44(r1) ffc08d9c: 81 81 00 1c lwz r12,28(r1) ffc08da0: 7c 08 03 a6 mtlr r0 ffc08da4: 83 c1 00 20 lwz r30,32(r1) ffc08da8: 83 e1 00 24 lwz r31,36(r1) ffc08dac: 7d 80 81 20 mtcrf 8,r12 ffc08db0: 38 21 00 28 addi r1,r1,40 ffc08db4: 4e 80 00 20 blr * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08db8: 3d 20 00 00 lis r9,0 ffc08dbc: 81 69 29 28 lwz r11,10536(r9) ffc08dc0: 38 0b 00 01 addi r0,r11,1 ffc08dc4: 90 09 29 28 stw r0,10536(r9) return _Thread_Dispatch_disable_level; ffc08dc8: 80 09 29 28 lwz r0,10536(r9) * This prevents context switches while we are adjusting the TOD */ _Thread_Disable_dispatch(); _TOD_Get( &ts ); ffc08dcc: 38 61 00 08 addi r3,r1,8 ffc08dd0: 48 00 1f 49 bl ffc0ad18 <_TOD_Get> ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; ffc08dd4: 81 3f 00 04 lwz r9,4(r31) ffc08dd8: 80 01 00 0c lwz r0,12(r1) ffc08ddc: 1d 29 03 e8 mulli r9,r9,1000 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ffc08de0: 81 41 00 08 lwz r10,8(r1) ffc08de4: 81 7f 00 00 lwz r11,0(r31) ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; ffc08de8: 7d 29 02 14 add r9,r9,r0 /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08dec: 3c 00 3b 9a lis r0,15258 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; ffc08df0: 91 21 00 0c stw r9,12(r1) /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08df4: 60 00 c9 ff ori r0,r0,51711 ffc08df8: 7f 89 00 40 cmplw cr7,r9,r0 _Thread_Disable_dispatch(); _TOD_Get( &ts ); ts.tv_sec += delta->tv_sec; ffc08dfc: 7d 6a 5a 14 add r11,r10,r11 ffc08e00: 91 61 00 08 stw r11,8(r1) ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08e04: 40 9d 00 20 ble- cr7,ffc08e24 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ffc08e08: 3d 29 c4 65 addis r9,r9,-15259 ffc08e0c: 39 29 36 00 addi r9,r9,13824 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08e10: 7f 89 00 40 cmplw cr7,r9,r0 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; ffc08e14: 39 6b 00 01 addi r11,r11,1 ts.tv_sec += delta->tv_sec; ts.tv_nsec += delta->tv_usec * TOD_NANOSECONDS_PER_MICROSECOND; /* if adjustment is too much positive */ while ( ts.tv_nsec >= TOD_NANOSECONDS_PER_SECOND ) { ffc08e18: 41 9d ff f0 bgt+ cr7,ffc08e08 <== NEVER TAKEN ffc08e1c: 91 21 00 0c stw r9,12(r1) ffc08e20: 91 61 00 08 stw r11,8(r1) ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { ffc08e24: 3c 00 c4 65 lis r0,-15259 ffc08e28: 60 00 36 00 ori r0,r0,13824 ffc08e2c: 7f 89 00 40 cmplw cr7,r9,r0 ffc08e30: 41 9d 00 24 bgt- cr7,ffc08e54 <== NEVER TAKEN ffc08e34: 81 61 00 08 lwz r11,8(r1) ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ffc08e38: 3d 29 3b 9b addis r9,r9,15259 ffc08e3c: 39 29 ca 00 addi r9,r9,-13824 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { ffc08e40: 7f 89 00 40 cmplw cr7,r9,r0 ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; ffc08e44: 39 6b ff ff addi r11,r11,-1 ts.tv_nsec -= TOD_NANOSECONDS_PER_SECOND; ts.tv_sec++; } /* if adjustment is too much negative */ while ( ts.tv_nsec <= (-1 * TOD_NANOSECONDS_PER_SECOND) ) { ffc08e48: 40 9d ff f0 ble+ cr7,ffc08e38 ffc08e4c: 91 21 00 0c stw r9,12(r1) ffc08e50: 91 61 00 08 stw r11,8(r1) ts.tv_nsec += TOD_NANOSECONDS_PER_SECOND; ts.tv_sec--; } _TOD_Set( &ts ); ffc08e54: 38 61 00 08 addi r3,r1,8 ffc08e58: 48 00 1f 91 bl ffc0ade8 <_TOD_Set> _Thread_Enable_dispatch(); ffc08e5c: 48 00 3c a9 bl ffc0cb04 <_Thread_Enable_dispatch> /* set the user's output */ if ( olddelta ) ffc08e60: 41 92 00 38 beq- cr4,ffc08e98 *olddelta = *delta; return 0; } ffc08e64: 80 01 00 2c lwz r0,44(r1) /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; ffc08e68: 38 60 00 00 li r3,0 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08e6c: 81 5f 00 00 lwz r10,0(r31) return 0; } ffc08e70: 7c 08 03 a6 mtlr r0 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08e74: 81 7f 00 04 lwz r11,4(r31) return 0; } ffc08e78: 81 81 00 1c lwz r12,28(r1) _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08e7c: 91 5e 00 00 stw r10,0(r30) return 0; } ffc08e80: 7d 80 81 20 mtcrf 8,r12 _Thread_Enable_dispatch(); /* set the user's output */ if ( olddelta ) *olddelta = *delta; ffc08e84: 91 7e 00 04 stw r11,4(r30) return 0; } ffc08e88: 83 e1 00 24 lwz r31,36(r1) ffc08e8c: 83 c1 00 20 lwz r30,32(r1) ffc08e90: 38 21 00 28 addi r1,r1,40 ffc08e94: 4e 80 00 20 blr /* set the user's output */ if ( olddelta ) *olddelta = *delta; return 0; ffc08e98: 38 60 00 00 li r3,0 ffc08e9c: 4b ff fe fc b ffc08d98 */ if ( !delta ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( delta->tv_usec >= TOD_MICROSECONDS_PER_SECOND ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc08ea0: 48 00 b4 f1 bl ffc14390 <__errno> ffc08ea4: 38 00 00 16 li r0,22 ffc08ea8: 90 03 00 00 stw r0,0(r3) ffc08eac: 38 60 ff ff li r3,-1 ffc08eb0: 4b ff fe e8 b ffc08d98 =============================================================================== ffc09814 : * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc09814: 94 21 ff e8 stwu r1,-24(r1) ffc09818: 7c 08 02 a6 mflr r0 ffc0981c: 93 e1 00 14 stw r31,20(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc09820: 3f e0 00 00 lis r31,0 ffc09824: 3b ff 2c 70 addi r31,r31,11376 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc09828: 93 a1 00 0c stw r29,12(r1) ffc0982c: 7c 7d 1b 78 mr r29,r3 rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc09830: 7f e3 fb 78 mr r3,r31 * operation(s) cannot be canceled */ int aio_cancel(int fildes, struct aiocb *aiocbp) { ffc09834: 90 01 00 1c stw r0,28(r1) ffc09838: 93 c1 00 10 stw r30,16(r1) ffc0983c: 7c 9e 23 78 mr r30,r4 ffc09840: 93 81 00 08 stw r28,8(r1) rtems_aio_request_chain *r_chain; int result; pthread_mutex_lock (&aio_request_queue.mutex); ffc09844: 48 00 16 45 bl ffc0ae88 if (fcntl (fildes, F_GETFD) < 0) { ffc09848: 7f a3 eb 78 mr r3,r29 ffc0984c: 38 80 00 01 li r4,1 ffc09850: 4c c6 31 82 crclr 4*cr1+eq ffc09854: 48 00 8f 4d bl ffc127a0 ffc09858: 2f 83 00 00 cmpwi cr7,r3,0 ffc0985c: 41 9c 01 bc blt- cr7,ffc09a18 pthread_mutex_unlock(&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EBADF); } /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { ffc09860: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09864: 41 9e 01 08 beq- cr7,ffc0996c pthread_mutex_unlock (&aio_request_queue.mutex); return AIO_CANCELED; } else { AIO_printf ("Cancel request\n"); if (aiocbp->aio_fildes != fildes) { ffc09868: 83 9e 00 00 lwz r28,0(r30) ffc0986c: 7f 9c e8 00 cmpw cr7,r28,r29 ffc09870: 40 9e 00 e0 bne- cr7,ffc09950 pthread_mutex_unlock (&aio_request_queue.mutex); rtems_set_errno_and_return_minus_one (EINVAL); } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); ffc09874: 38 7f 00 48 addi r3,r31,72 ffc09878: 7f 84 e3 78 mr r4,r28 ffc0987c: 38 a0 00 00 li r5,0 ffc09880: 48 00 03 bd bl ffc09c3c if (r_chain == NULL) { ffc09884: 7c 7d 1b 79 mr. r29,r3 ffc09888: 41 82 00 54 beq- ffc098dc return AIO_ALLDONE; } } AIO_printf ("Request on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc0988c: 3b 9d 00 1c addi r28,r29,28 ffc09890: 7f 83 e3 78 mr r3,r28 ffc09894: 48 00 15 f5 bl ffc0ae88 result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc09898: 7f c4 f3 78 mr r4,r30 ffc0989c: 38 7d 00 08 addi r3,r29,8 ffc098a0: 48 00 09 19 bl ffc0a1b8 ffc098a4: 7c 7e 1b 78 mr r30,r3 pthread_mutex_unlock (&r_chain->mutex); ffc098a8: 7f 83 e3 78 mr r3,r28 ffc098ac: 48 00 16 a9 bl ffc0af54 pthread_mutex_unlock (&aio_request_queue.mutex); ffc098b0: 7f e3 fb 78 mr r3,r31 ffc098b4: 48 00 16 a1 bl ffc0af54 return result; } return AIO_ALLDONE; } ffc098b8: 80 01 00 1c lwz r0,28(r1) ffc098bc: 7f c3 f3 78 mr r3,r30 ffc098c0: 83 81 00 08 lwz r28,8(r1) ffc098c4: 7c 08 03 a6 mtlr r0 ffc098c8: 83 a1 00 0c lwz r29,12(r1) ffc098cc: 83 c1 00 10 lwz r30,16(r1) ffc098d0: 83 e1 00 14 lwz r31,20(r1) ffc098d4: 38 21 00 18 addi r1,r1,24 ffc098d8: 4e 80 00 20 blr rtems_set_errno_and_return_minus_one (EINVAL); } r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { ffc098dc: 81 3f 00 54 lwz r9,84(r31) ffc098e0: 38 1f 00 58 addi r0,r31,88 ffc098e4: 7f 89 00 00 cmpw cr7,r9,r0 ffc098e8: 41 9e 00 58 beq- cr7,ffc09940 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc098ec: 38 7f 00 54 addi r3,r31,84 ffc098f0: 7f 84 e3 78 mr r4,r28 ffc098f4: 38 a0 00 00 li r5,0 ffc098f8: 48 00 03 45 bl ffc09c3c if (r_chain == NULL) { ffc098fc: 2c 03 00 00 cmpwi r3,0 ffc09900: 41 82 00 50 beq- ffc09950 rtems_set_errno_and_return_minus_one (EINVAL); } AIO_printf ("Request on [IQ]\n"); result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); ffc09904: 7f c4 f3 78 mr r4,r30 ffc09908: 38 63 00 08 addi r3,r3,8 ffc0990c: 48 00 08 ad bl ffc0a1b8 ffc09910: 7c 7e 1b 78 mr r30,r3 pthread_mutex_unlock (&aio_request_queue.mutex); ffc09914: 7f e3 fb 78 mr r3,r31 ffc09918: 48 00 16 3d bl ffc0af54 pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } return AIO_ALLDONE; } ffc0991c: 80 01 00 1c lwz r0,28(r1) ffc09920: 7f c3 f3 78 mr r3,r30 ffc09924: 83 81 00 08 lwz r28,8(r1) ffc09928: 7c 08 03 a6 mtlr r0 ffc0992c: 83 a1 00 0c lwz r29,12(r1) ffc09930: 83 c1 00 10 lwz r30,16(r1) ffc09934: 83 e1 00 14 lwz r31,20(r1) ffc09938: 38 21 00 18 addi r1,r1,24 ffc0993c: 4e 80 00 20 blr result = rtems_aio_remove_req (&r_chain->perfd, aiocbp); pthread_mutex_unlock (&aio_request_queue.mutex); return result; } else { pthread_mutex_unlock (&aio_request_queue.mutex); ffc09940: 7f e3 fb 78 mr r3,r31 ffc09944: 48 00 16 11 bl ffc0af54 return AIO_ALLDONE; ffc09948: 3b c0 00 02 li r30,2 ffc0994c: 4b ff ff 6c b ffc098b8 r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); if (r_chain == NULL) { pthread_mutex_unlock (&aio_request_queue.mutex); ffc09950: 7f e3 fb 78 mr r3,r31 ffc09954: 48 00 16 01 bl ffc0af54 rtems_set_errno_and_return_minus_one (EINVAL); ffc09958: 3b c0 ff ff li r30,-1 ffc0995c: 48 00 d1 d5 bl ffc16b30 <__errno> ffc09960: 38 00 00 16 li r0,22 ffc09964: 90 03 00 00 stw r0,0(r3) ffc09968: 4b ff ff 50 b ffc098b8 /* if aiocbp is NULL remove all request for given file descriptor */ if (aiocbp == NULL) { AIO_printf ("Cancel all requests\n"); r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); ffc0996c: 38 7f 00 48 addi r3,r31,72 ffc09970: 7f a4 eb 78 mr r4,r29 ffc09974: 38 a0 00 00 li r5,0 ffc09978: 48 00 02 c5 bl ffc09c3c if (r_chain == NULL) { ffc0997c: 7c 7e 1b 79 mr. r30,r3 ffc09980: 41 82 00 38 beq- ffc099b8 return AIO_ALLDONE; } AIO_printf ("Request chain on [WQ]\n"); pthread_mutex_lock (&r_chain->mutex); ffc09984: 3b be 00 1c addi r29,r30,28 ffc09988: 7f a3 eb 78 mr r3,r29 ffc0998c: 48 00 14 fd bl ffc0ae88 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc09990: 7f c3 f3 78 mr r3,r30 ffc09994: 48 00 37 5d bl ffc0d0f0 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc09998: 7f c3 f3 78 mr r3,r30 ffc0999c: 48 00 07 95 bl ffc0a130 pthread_mutex_unlock (&r_chain->mutex); ffc099a0: 7f a3 eb 78 mr r3,r29 ffc099a4: 48 00 15 b1 bl ffc0af54 pthread_mutex_unlock (&aio_request_queue.mutex); ffc099a8: 7f e3 fb 78 mr r3,r31 ffc099ac: 48 00 15 a9 bl ffc0af54 return AIO_CANCELED; ffc099b0: 3b c0 00 00 li r30,0 ffc099b4: 4b ff ff 04 b ffc098b8 r_chain = rtems_aio_search_fd (&aio_request_queue.work_req, fildes, 0); if (r_chain == NULL) { AIO_printf ("Request chain not on [WQ]\n"); if (!rtems_chain_is_empty (&aio_request_queue.idle_req)) { ffc099b8: 81 3f 00 54 lwz r9,84(r31) ffc099bc: 38 1f 00 58 addi r0,r31,88 ffc099c0: 7f 89 00 00 cmpw cr7,r9,r0 ffc099c4: 41 be ff 7c beq- cr7,ffc09940 <== NEVER TAKEN r_chain = rtems_aio_search_fd (&aio_request_queue.idle_req, fildes, 0); ffc099c8: 38 7f 00 54 addi r3,r31,84 ffc099cc: 7f a4 eb 78 mr r4,r29 ffc099d0: 38 a0 00 00 li r5,0 ffc099d4: 48 00 02 69 bl ffc09c3c if (r_chain == NULL) { ffc099d8: 7c 7e 1b 79 mr. r30,r3 ffc099dc: 41 a2 ff 64 beq- ffc09940 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); ffc099e0: 3b be 00 1c addi r29,r30,28 ffc099e4: 48 00 37 0d bl ffc0d0f0 <_Chain_Extract> } AIO_printf ("Request chain on [IQ]\n"); rtems_chain_extract (&r_chain->next_fd); rtems_aio_remove_fd (r_chain); ffc099e8: 7f c3 f3 78 mr r3,r30 ffc099ec: 48 00 07 45 bl ffc0a130 pthread_mutex_destroy (&r_chain->mutex); ffc099f0: 7f a3 eb 78 mr r3,r29 ffc099f4: 48 00 11 49 bl ffc0ab3c pthread_cond_destroy (&r_chain->mutex); ffc099f8: 7f a3 eb 78 mr r3,r29 ffc099fc: 48 00 0c 89 bl ffc0a684 free (r_chain); ffc09a00: 7f c3 f3 78 mr r3,r30 ffc09a04: 4b ff bf 71 bl ffc05974 pthread_mutex_unlock (&aio_request_queue.mutex); ffc09a08: 7f e3 fb 78 mr r3,r31 ffc09a0c: 48 00 15 49 bl ffc0af54 return AIO_CANCELED; ffc09a10: 3b c0 00 00 li r30,0 ffc09a14: 4b ff fe a4 b ffc098b8 int result; pthread_mutex_lock (&aio_request_queue.mutex); if (fcntl (fildes, F_GETFD) < 0) { pthread_mutex_unlock(&aio_request_queue.mutex); ffc09a18: 7f e3 fb 78 mr r3,r31 ffc09a1c: 48 00 15 39 bl ffc0af54 rtems_set_errno_and_return_minus_one (EBADF); ffc09a20: 3b c0 ff ff li r30,-1 ffc09a24: 48 00 d1 0d bl ffc16b30 <__errno> ffc09a28: 38 00 00 09 li r0,9 ffc09a2c: 90 03 00 00 stw r0,0(r3) ffc09a30: 4b ff fe 88 b ffc098b8 =============================================================================== ffc09a3c : ) { rtems_aio_request *req; int mode; if (op != O_SYNC) ffc09a3c: 2f 83 20 00 cmpwi cr7,r3,8192 int aio_fsync( int op, struct aiocb *aiocbp ) { ffc09a40: 94 21 ff f0 stwu r1,-16(r1) ffc09a44: 7c 08 02 a6 mflr r0 ffc09a48: 93 c1 00 08 stw r30,8(r1) rtems_aio_request *req; int mode; if (op != O_SYNC) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc09a4c: 3b c0 00 16 li r30,22 int aio_fsync( int op, struct aiocb *aiocbp ) { ffc09a50: 93 e1 00 0c stw r31,12(r1) ffc09a54: 7c 9f 23 78 mr r31,r4 ffc09a58: 90 01 00 14 stw r0,20(r1) rtems_aio_request *req; int mode; if (op != O_SYNC) ffc09a5c: 40 9e 00 64 bne- cr7,ffc09ac0 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc09a60: 80 64 00 00 lwz r3,0(r4) ffc09a64: 38 80 00 03 li r4,3 ffc09a68: 4c c6 31 82 crclr 4*cr1+eq ffc09a6c: 48 00 8d 35 bl ffc127a0 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc09a70: 54 63 07 be clrlwi r3,r3,30 ffc09a74: 38 63 ff ff addi r3,r3,-1 ffc09a78: 2b 83 00 01 cmplwi cr7,r3,1 ffc09a7c: 41 9d 00 40 bgt- cr7,ffc09abc rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc09a80: 38 60 00 18 li r3,24 ffc09a84: 4b ff c6 95 bl ffc06118 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc09a88: 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) ffc09a8c: 7c 69 1b 79 mr. r9,r3 ffc09a90: 41 82 00 30 beq- ffc09ac0 <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc09a94: 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; ffc09a98: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_SYNC; ffc09a9c: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc09aa0: 48 00 07 ad bl ffc0a24c } ffc09aa4: 80 01 00 14 lwz r0,20(r1) ffc09aa8: 83 c1 00 08 lwz r30,8(r1) ffc09aac: 7c 08 03 a6 mtlr r0 ffc09ab0: 83 e1 00 0c lwz r31,12(r1) ffc09ab4: 38 21 00 10 addi r1,r1,16 ffc09ab8: 4e 80 00 20 blr if (op != O_SYNC) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); 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); ffc09abc: 3b c0 00 09 li r30,9 ffc09ac0: 38 00 ff ff li r0,-1 ffc09ac4: 93 df 00 34 stw r30,52(r31) ffc09ac8: 90 1f 00 38 stw r0,56(r31) ffc09acc: 48 00 d0 65 bl ffc16b30 <__errno> req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } ffc09ad0: 80 01 00 14 lwz r0,20(r1) if (op != O_SYNC) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); 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); ffc09ad4: 93 c3 00 00 stw r30,0(r3) ffc09ad8: 38 60 ff ff li r3,-1 req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_SYNC; return rtems_aio_enqueue (req); } ffc09adc: 7c 08 03 a6 mtlr r0 ffc09ae0: 83 c1 00 08 lwz r30,8(r1) ffc09ae4: 83 e1 00 0c lwz r31,12(r1) ffc09ae8: 38 21 00 10 addi r1,r1,16 ffc09aec: 4e 80 00 20 blr =============================================================================== ffc0a47c : * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a47c: 94 21 ff f0 stwu r1,-16(r1) ffc0a480: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a484: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a488: 90 01 00 14 stw r0,20(r1) ffc0a48c: 93 e1 00 0c stw r31,12(r1) ffc0a490: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a494: 80 63 00 00 lwz r3,0(r3) * 0 - otherwise */ int aio_read (struct aiocb *aiocbp) { ffc0a498: 93 c1 00 08 stw r30,8(r1) rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a49c: 4c c6 31 82 crclr 4*cr1+eq ffc0a4a0: 48 00 83 01 bl ffc127a0 if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc0a4a4: 70 63 00 03 andi. r3,r3,3 ffc0a4a8: 41 82 00 10 beq- ffc0a4b8 <== NEVER TAKEN ffc0a4ac: 2f 83 00 02 cmpwi cr7,r3,2 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); ffc0a4b0: 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))) ffc0a4b4: 40 9e 00 5c bne- cr7,ffc0a510 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc0a4b8: 80 1f 00 18 lwz r0,24(r31) ffc0a4bc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a4c0: 40 9e 00 4c bne- cr7,ffc0a50c rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) ffc0a4c4: 80 1f 00 08 lwz r0,8(r31) ffc0a4c8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a4cc: 41 9c 00 40 blt- cr7,ffc0a50c rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc0a4d0: 38 60 00 18 li r3,24 ffc0a4d4: 4b ff bc 45 bl ffc06118 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc0a4d8: 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) ffc0a4dc: 7c 69 1b 79 mr. r9,r3 ffc0a4e0: 41 82 00 30 beq- ffc0a510 <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_READ; ffc0a4e4: 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; ffc0a4e8: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_READ; ffc0a4ec: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc0a4f0: 4b ff fd 5d bl ffc0a24c } ffc0a4f4: 80 01 00 14 lwz r0,20(r1) ffc0a4f8: 83 c1 00 08 lwz r30,8(r1) ffc0a4fc: 7c 08 03 a6 mtlr r0 ffc0a500: 83 e1 00 0c lwz r31,12(r1) ffc0a504: 38 21 00 10 addi r1,r1,16 ffc0a508: 4e 80 00 20 blr mode = fcntl (aiocbp->aio_fildes, F_GETFL); if (!(((mode & O_ACCMODE) == O_RDONLY) || ((mode & O_ACCMODE) == O_RDWR))) rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc0a50c: 3b c0 00 16 li r30,22 ffc0a510: 38 00 ff ff li r0,-1 ffc0a514: 93 df 00 34 stw r30,52(r31) ffc0a518: 90 1f 00 38 stw r0,56(r31) ffc0a51c: 48 00 c6 15 bl ffc16b30 <__errno> ffc0a520: 93 c3 00 00 stw r30,0(r3) ffc0a524: 38 60 ff ff li r3,-1 ffc0a528: 4b ff ff cc b ffc0a4f4 =============================================================================== ffc0a534 : * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a534: 94 21 ff f0 stwu r1,-16(r1) ffc0a538: 7c 08 02 a6 mflr r0 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a53c: 38 80 00 03 li r4,3 * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a540: 90 01 00 14 stw r0,20(r1) ffc0a544: 93 e1 00 0c stw r31,12(r1) ffc0a548: 7c 7f 1b 78 mr r31,r3 rtems_aio_request *req; int mode; mode = fcntl (aiocbp->aio_fildes, F_GETFL); ffc0a54c: 80 63 00 00 lwz r3,0(r3) * 0 - otherwise */ int aio_write (struct aiocb *aiocbp) { ffc0a550: 93 c1 00 08 stw r30,8(r1) 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); ffc0a554: 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); ffc0a558: 4c c6 31 82 crclr 4*cr1+eq ffc0a55c: 48 00 82 45 bl ffc127a0 if (!(((mode & O_ACCMODE) == O_WRONLY) || ((mode & O_ACCMODE) == O_RDWR))) ffc0a560: 54 63 07 be clrlwi r3,r3,30 ffc0a564: 38 63 ff ff addi r3,r3,-1 ffc0a568: 2b 83 00 01 cmplwi cr7,r3,1 ffc0a56c: 41 9d 00 5c bgt- cr7,ffc0a5c8 rtems_aio_set_errno_return_minus_one (EBADF, aiocbp); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) ffc0a570: 80 1f 00 18 lwz r0,24(r31) ffc0a574: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a578: 40 9e 00 4c bne- cr7,ffc0a5c4 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); if (aiocbp->aio_offset < 0) ffc0a57c: 80 1f 00 08 lwz r0,8(r31) ffc0a580: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a584: 41 9c 00 40 blt- cr7,ffc0a5c4 rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); req = malloc (sizeof (rtems_aio_request)); ffc0a588: 38 60 00 18 li r3,24 ffc0a58c: 4b ff bb 8d bl ffc06118 if (req == NULL) rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); ffc0a590: 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) ffc0a594: 7c 69 1b 79 mr. r9,r3 ffc0a598: 41 82 00 30 beq- ffc0a5c8 <== NEVER TAKEN rtems_aio_set_errno_return_minus_one (EAGAIN, aiocbp); req->aiocbp = aiocbp; req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc0a59c: 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; ffc0a5a0: 93 e9 00 14 stw r31,20(r9) req->aiocbp->aio_lio_opcode = LIO_WRITE; ffc0a5a4: 90 1f 00 30 stw r0,48(r31) return rtems_aio_enqueue (req); ffc0a5a8: 4b ff fc a5 bl ffc0a24c } ffc0a5ac: 80 01 00 14 lwz r0,20(r1) ffc0a5b0: 83 c1 00 08 lwz r30,8(r1) ffc0a5b4: 7c 08 03 a6 mtlr r0 ffc0a5b8: 83 e1 00 0c lwz r31,12(r1) ffc0a5bc: 38 21 00 10 addi r1,r1,16 ffc0a5c0: 4e 80 00 20 blr 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); if (aiocbp->aio_reqprio < 0 || aiocbp->aio_reqprio > AIO_PRIO_DELTA_MAX) rtems_aio_set_errno_return_minus_one (EINVAL, aiocbp); ffc0a5c4: 3b c0 00 16 li r30,22 ffc0a5c8: 38 00 ff ff li r0,-1 ffc0a5cc: 93 df 00 34 stw r30,52(r31) ffc0a5d0: 90 1f 00 38 stw r0,56(r31) ffc0a5d4: 48 00 c5 5d bl ffc16b30 <__errno> ffc0a5d8: 93 c3 00 00 stw r30,0(r3) ffc0a5dc: 38 60 ff ff li r3,-1 ffc0a5e0: 4b ff ff cc b ffc0a5ac =============================================================================== ffc08b4c : int clock_gettime( clockid_t clock_id, struct timespec *tp ) { if ( !tp ) ffc08b4c: 2c 04 00 00 cmpwi r4,0 int clock_gettime( clockid_t clock_id, struct timespec *tp ) { ffc08b50: 94 21 ff f8 stwu r1,-8(r1) ffc08b54: 7c 08 02 a6 mflr r0 ffc08b58: 90 01 00 0c stw r0,12(r1) if ( !tp ) ffc08b5c: 41 82 00 24 beq- ffc08b80 rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc08b60: 2f 83 00 01 cmpwi cr7,r3,1 ffc08b64: 41 9e 00 78 beq- cr7,ffc08bdc _TOD_Get(tp); return 0; } #ifdef CLOCK_MONOTONIC if ( clock_id == CLOCK_MONOTONIC ) { ffc08b68: 2f 83 00 04 cmpwi cr7,r3,4 ffc08b6c: 41 9e 00 54 beq- cr7,ffc08bc0 <== NEVER TAKEN return 0; } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) { ffc08b70: 2f 83 00 02 cmpwi cr7,r3,2 ffc08b74: 41 9e 00 4c beq- cr7,ffc08bc0 return 0; } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) ffc08b78: 2f 83 00 03 cmpwi cr7,r3,3 ffc08b7c: 41 9e 00 24 beq- cr7,ffc08ba0 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif rtems_set_errno_and_return_minus_one( EINVAL ); ffc08b80: 48 00 bf 99 bl ffc14b18 <__errno> ffc08b84: 38 00 00 16 li r0,22 ffc08b88: 90 03 00 00 stw r0,0(r3) ffc08b8c: 38 60 ff ff li r3,-1 return 0; } ffc08b90: 80 01 00 0c lwz r0,12(r1) ffc08b94: 38 21 00 08 addi r1,r1,8 ffc08b98: 7c 08 03 a6 mtlr r0 ffc08b9c: 4e 80 00 20 blr } #endif #ifdef _POSIX_THREAD_CPUTIME if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) rtems_set_errno_and_return_minus_one( ENOSYS ); ffc08ba0: 48 00 bf 79 bl ffc14b18 <__errno> ffc08ba4: 38 00 00 58 li r0,88 ffc08ba8: 90 03 00 00 stw r0,0(r3) ffc08bac: 38 60 ff ff li r3,-1 #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08bb0: 80 01 00 0c lwz r0,12(r1) ffc08bb4: 38 21 00 08 addi r1,r1,8 ffc08bb8: 7c 08 03 a6 mtlr r0 ffc08bbc: 4e 80 00 20 blr } #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) { _TOD_Get_uptime_as_timespec( tp ); ffc08bc0: 7c 83 23 78 mr r3,r4 ffc08bc4: 48 00 29 21 bl ffc0b4e4 <_TOD_Get_uptime_as_timespec> #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08bc8: 80 01 00 0c lwz r0,12(r1) #endif #ifdef _POSIX_CPUTIME if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) { _TOD_Get_uptime_as_timespec( tp ); return 0; ffc08bcc: 38 60 00 00 li r3,0 #endif rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08bd0: 7c 08 03 a6 mtlr r0 ffc08bd4: 38 21 00 08 addi r1,r1,8 ffc08bd8: 4e 80 00 20 blr { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { _TOD_Get(tp); ffc08bdc: 7c 83 23 78 mr r3,r4 ffc08be0: 48 00 28 6d bl ffc0b44c <_TOD_Get> return 0; ffc08be4: 38 60 00 00 li r3,0 ffc08be8: 4b ff ff a8 b ffc08b90 =============================================================================== ffc08bec : int clock_settime( clockid_t clock_id, const struct timespec *tp ) { if ( !tp ) ffc08bec: 2c 04 00 00 cmpwi r4,0 int clock_settime( clockid_t clock_id, const struct timespec *tp ) { ffc08bf0: 94 21 ff f8 stwu r1,-8(r1) ffc08bf4: 7c 08 02 a6 mflr r0 ffc08bf8: 90 01 00 0c stw r0,12(r1) if ( !tp ) ffc08bfc: 41 82 00 1c beq- ffc08c18 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { ffc08c00: 2f 83 00 01 cmpwi cr7,r3,1 ffc08c04: 41 9e 00 34 beq- cr7,ffc08c38 _Thread_Disable_dispatch(); _TOD_Set( tp ); _Thread_Enable_dispatch(); } #ifdef _POSIX_CPUTIME else if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) ffc08c08: 2f 83 00 02 cmpwi cr7,r3,2 ffc08c0c: 41 9e 00 74 beq- cr7,ffc08c80 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) ffc08c10: 2f 83 00 03 cmpwi cr7,r3,3 ffc08c14: 41 9e 00 6c beq- cr7,ffc08c80 rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); ffc08c18: 48 00 bf 01 bl ffc14b18 <__errno> ffc08c1c: 38 00 00 16 li r0,22 ffc08c20: 90 03 00 00 stw r0,0(r3) ffc08c24: 38 60 ff ff li r3,-1 return 0; } ffc08c28: 80 01 00 0c lwz r0,12(r1) ffc08c2c: 38 21 00 08 addi r1,r1,8 ffc08c30: 7c 08 03 a6 mtlr r0 ffc08c34: 4e 80 00 20 blr { if ( !tp ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( clock_id == CLOCK_REALTIME ) { if ( tp->tv_sec < TOD_SECONDS_1970_THROUGH_1988 ) ffc08c38: 81 24 00 00 lwz r9,0(r4) ffc08c3c: 3c 00 21 da lis r0,8666 ffc08c40: 60 00 e4 ff ori r0,r0,58623 ffc08c44: 7f 89 00 40 cmplw cr7,r9,r0 ffc08c48: 40 bd ff d0 ble- cr7,ffc08c18 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08c4c: 3d 20 00 00 lis r9,0 ffc08c50: 81 69 28 78 lwz r11,10360(r9) ffc08c54: 38 0b 00 01 addi r0,r11,1 ffc08c58: 90 09 28 78 stw r0,10360(r9) return _Thread_Dispatch_disable_level; ffc08c5c: 80 09 28 78 lwz r0,10360(r9) rtems_set_errno_and_return_minus_one( EINVAL ); _Thread_Disable_dispatch(); _TOD_Set( tp ); ffc08c60: 7c 83 23 78 mr r3,r4 ffc08c64: 48 00 28 f9 bl ffc0b55c <_TOD_Set> _Thread_Enable_dispatch(); ffc08c68: 48 00 46 11 bl ffc0d278 <_Thread_Enable_dispatch> #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08c6c: 80 01 00 0c lwz r0,12(r1) rtems_set_errno_and_return_minus_one( ENOSYS ); #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; ffc08c70: 38 60 00 00 li r3,0 } ffc08c74: 7c 08 03 a6 mtlr r0 ffc08c78: 38 21 00 08 addi r1,r1,8 ffc08c7c: 4e 80 00 20 blr else if ( clock_id == CLOCK_PROCESS_CPUTIME_ID ) rtems_set_errno_and_return_minus_one( ENOSYS ); #endif #ifdef _POSIX_THREAD_CPUTIME else if ( clock_id == CLOCK_THREAD_CPUTIME_ID ) rtems_set_errno_and_return_minus_one( ENOSYS ); ffc08c80: 48 00 be 99 bl ffc14b18 <__errno> ffc08c84: 38 00 00 58 li r0,88 ffc08c88: 90 03 00 00 stw r0,0(r3) ffc08c8c: 38 60 ff ff li r3,-1 #endif else rtems_set_errno_and_return_minus_one( EINVAL ); return 0; } ffc08c90: 80 01 00 0c lwz r0,12(r1) ffc08c94: 38 21 00 08 addi r1,r1,8 ffc08c98: 7c 08 03 a6 mtlr r0 ffc08c9c: 4e 80 00 20 blr =============================================================================== ffc1ede0 : int killinfo( pid_t pid, int sig, const union sigval *value ) { ffc1ede0: 94 21 ff d0 stwu r1,-48(r1) ffc1ede4: 7c 08 02 a6 mflr r0 ffc1ede8: 93 61 00 1c stw r27,28(r1) ffc1edec: 7c bb 2b 78 mr r27,r5 ffc1edf0: 93 81 00 20 stw r28,32(r1) ffc1edf4: 7c 9c 23 78 mr r28,r4 ffc1edf8: 93 e1 00 2c stw r31,44(r1) ffc1edfc: 7c 7f 1b 78 mr r31,r3 ffc1ee00: 90 01 00 34 stw r0,52(r1) ffc1ee04: 93 41 00 18 stw r26,24(r1) ffc1ee08: 93 a1 00 24 stw r29,36(r1) ffc1ee0c: 93 c1 00 28 stw r30,40(r1) POSIX_signals_Siginfo_node *psiginfo; /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) ffc1ee10: 4b ff fa 2d bl ffc1e83c ffc1ee14: 7f 83 f8 00 cmpw cr7,r3,r31 ffc1ee18: 40 9e 02 98 bne- cr7,ffc1f0b0 rtems_set_errno_and_return_minus_one( ESRCH ); /* * Validate the signal passed. */ if ( !sig ) ffc1ee1c: 2f 9c 00 00 cmpwi cr7,r28,0 ffc1ee20: 41 9e 02 a4 beq- cr7,ffc1f0c4 static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc1ee24: 3b fc ff ff addi r31,r28,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc1ee28: 2b 9f 00 1f cmplwi cr7,r31,31 ffc1ee2c: 41 9d 02 98 bgt- cr7,ffc1f0c4 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 ) ffc1ee30: 1f dc 00 0c mulli r30,r28,12 ffc1ee34: 3f a0 00 00 lis r29,0 ffc1ee38: 3b bd 31 c0 addi r29,r29,12736 ffc1ee3c: 7d 3d f2 14 add r9,r29,r30 ffc1ee40: 80 09 00 08 lwz r0,8(r9) return 0; ffc1ee44: 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 ) ffc1ee48: 2f 80 00 01 cmpwi cr7,r0,1 ffc1ee4c: 41 9e 01 a8 beq- cr7,ffc1eff4 /* * 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 ) ) ffc1ee50: 2f 9c 00 08 cmpwi cr7,r28,8 ffc1ee54: 41 9e 01 c8 beq- cr7,ffc1f01c ffc1ee58: 2f 9c 00 04 cmpwi cr7,r28,4 ffc1ee5c: 41 9e 01 c0 beq- cr7,ffc1f01c ffc1ee60: 2f 9c 00 0b cmpwi cr7,r28,11 ffc1ee64: 41 9e 01 b8 beq- cr7,ffc1f01c * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { ffc1ee68: 2f 9b 00 00 cmpwi cr7,r27,0 /* * Build up a siginfo structure */ siginfo = &siginfo_struct; siginfo->si_signo = sig; ffc1ee6c: 93 81 00 08 stw r28,8(r1) static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); ffc1ee70: 38 00 00 01 li r0,1 ffc1ee74: 7c 1f f8 30 slw r31,r0,r31 siginfo->si_code = SI_USER; ffc1ee78: 90 01 00 0c stw r0,12(r1) if ( !value ) { ffc1ee7c: 41 9e 02 18 beq- cr7,ffc1f094 siginfo->si_value.sival_int = 0; } else { siginfo->si_value = *value; ffc1ee80: 80 1b 00 00 lwz r0,0(r27) ffc1ee84: 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++; ffc1ee88: 3d 20 00 00 lis r9,0 ffc1ee8c: 81 69 28 0c lwz r11,10252(r9) ffc1ee90: 38 0b 00 01 addi r0,r11,1 ffc1ee94: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc1ee98: 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; ffc1ee9c: 3d 20 00 00 lis r9,0 ffc1eea0: 80 69 31 50 lwz r3,12624(r9) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( _POSIX_signals_Is_interested( api, mask ) ) { ffc1eea4: 81 23 01 34 lwz r9,308(r3) ffc1eea8: 80 09 00 d0 lwz r0,208(r9) ffc1eeac: 7f e6 00 79 andc. r6,r31,r0 ffc1eeb0: 40 82 01 14 bne- ffc1efc4 */ RTEMS_INLINE_ROUTINE Chain_Node *_Chain_First( Chain_Control *the_chain ) { return _Chain_Head( the_chain )->next; ffc1eeb4: 3d 20 00 00 lis r9,0 ffc1eeb8: 39 69 33 4c addi r11,r9,13132 ffc1eebc: 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 ); ffc1eec0: 39 6b 00 04 addi r11,r11,4 ffc1eec4: 7f 83 58 00 cmpw cr7,r3,r11 ffc1eec8: 41 9e 00 4c beq- cr7,ffc1ef14 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc1eecc: 80 03 00 30 lwz r0,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 ]; ffc1eed0: 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) ffc1eed4: 7f ea 00 39 and. r10,r31,r0 ffc1eed8: 40 82 00 ec bne- ffc1efc4 /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) ffc1eedc: 80 09 00 d0 lwz r0,208(r9) ffc1eee0: 7f fa 00 79 andc. r26,r31,r0 ffc1eee4: 41 a2 00 24 beq+ ffc1ef08 ffc1eee8: 48 00 00 dc b ffc1efc4 #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc1eeec: 80 03 00 30 lwz r0,48(r3) <== NOT EXECUTED 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 ]; ffc1eef0: 81 23 01 34 lwz r9,308(r3) <== NOT EXECUTED #endif /* * Is this thread is actually blocked waiting for the signal? */ if (the_thread->Wait.option & mask) ffc1eef4: 7f fb 00 39 and. r27,r31,r0 <== NOT EXECUTED ffc1eef8: 40 82 00 cc bne- ffc1efc4 <== NOT EXECUTED /* * Is this thread is blocked waiting for another signal but has * not blocked this one? */ if (~api->signals_blocked & mask) ffc1eefc: 80 09 00 d0 lwz r0,208(r9) <== NOT EXECUTED ffc1ef00: 7f e6 00 79 andc. r6,r31,r0 <== NOT EXECUTED ffc1ef04: 40 82 00 c0 bne- ffc1efc4 <== NOT EXECUTED 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 ) { ffc1ef08: 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 ); ffc1ef0c: 7f 83 58 00 cmpw cr7,r3,r11 ffc1ef10: 40 9e ff dc bne+ cr7,ffc1eeec <== NEVER TAKEN * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; interested_priority = PRIORITY_MAXIMUM + 1; ffc1ef14: 3d 20 00 00 lis r9,0 ffc1ef18: 88 e9 27 24 lbz r7,10020(r9) ffc1ef1c: 3c a0 00 00 lis r5,0 ffc1ef20: 38 a5 2c 64 addi r5,r5,11364 ffc1ef24: 38 e7 00 01 addi r7,r7,1 */ #define _POSIX_signals_Is_interested( _api, _mask ) \ ( ~(_api)->signals_blocked & (_mask) ) int killinfo( ffc1ef28: 38 85 00 08 addi r4,r5,8 * * NOTES: * * + rtems internal threads do not receive signals. */ interested = NULL; ffc1ef2c: 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 ] ) ffc1ef30: 85 25 00 04 lwzu r9,4(r5) ffc1ef34: 2f 89 00 00 cmpwi cr7,r9,0 ffc1ef38: 41 9e 00 7c beq- cr7,ffc1efb4 <== NEVER TAKEN continue; the_info = _Objects_Information_table[ the_api ][ 1 ]; ffc1ef3c: 81 29 00 04 lwz r9,4(r9) */ if ( !the_info ) continue; #endif maximum = the_info->maximum; ffc1ef40: a1 09 00 10 lhz r8,16(r9) object_table = the_info->local_table; ffc1ef44: 81 49 00 1c lwz r10,28(r9) for ( index = 1 ; index <= maximum ; index++ ) { ffc1ef48: 2f 88 00 00 cmpwi cr7,r8,0 ffc1ef4c: 41 9e 00 68 beq- cr7,ffc1efb4 ffc1ef50: 39 60 00 01 li r11,1 the_thread = (Thread_Control *) object_table[ index ]; ffc1ef54: 85 2a 00 04 lwzu r9,4(r10) if ( !the_thread ) ffc1ef58: 2f 89 00 00 cmpwi cr7,r9,0 ffc1ef5c: 41 9e 00 4c beq- cr7,ffc1efa8 /* * If this thread is of lower priority than the interested thread, * go on to the next thread. */ if ( the_thread->current_priority > interested_priority ) ffc1ef60: 80 09 00 14 lwz r0,20(r9) ffc1ef64: 7f 80 38 40 cmplw cr7,r0,r7 ffc1ef68: 41 9d 00 40 bgt- cr7,ffc1efa8 #if defined(RTEMS_DEBUG) if ( !api ) continue; #endif if ( !_POSIX_signals_Is_interested( api, mask ) ) ffc1ef6c: 80 c9 01 34 lwz r6,308(r9) ffc1ef70: 80 c6 00 d0 lwz r6,208(r6) ffc1ef74: 7f fa 30 79 andc. r26,r31,r6 ffc1ef78: 41 82 00 30 beq- ffc1efa8 * * 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 ) { ffc1ef7c: 41 9c 00 24 blt- cr7,ffc1efa0 * and blocking interruptibutable by signal. * * If the interested thread is ready, don't think about changing. */ if ( interested && !_States_Is_ready( interested->current_state ) ) { ffc1ef80: 2f 83 00 00 cmpwi cr7,r3,0 ffc1ef84: 41 9e 00 24 beq- cr7,ffc1efa8 <== NEVER TAKEN ffc1ef88: 80 c3 00 10 lwz r6,16(r3) ffc1ef8c: 2f 86 00 00 cmpwi cr7,r6,0 ffc1ef90: 41 9e 00 18 beq- cr7,ffc1efa8 /* preferred ready over blocked */ DEBUG_STEP("5"); if ( _States_Is_ready( the_thread->current_state ) ) { ffc1ef94: 83 69 00 10 lwz r27,16(r9) ffc1ef98: 2f 9b 00 00 cmpwi cr7,r27,0 ffc1ef9c: 40 9e 01 00 bne- cr7,ffc1f09c ffc1efa0: 7c 07 03 78 mr r7,r0 ffc1efa4: 7d 23 4b 78 mr r3,r9 #endif maximum = the_info->maximum; object_table = the_info->local_table; for ( index = 1 ; index <= maximum ; index++ ) { ffc1efa8: 39 6b 00 01 addi r11,r11,1 ffc1efac: 7f 88 58 40 cmplw cr7,r8,r11 ffc1efb0: 40 9c ff a4 bge+ cr7,ffc1ef54 * + 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++) { ffc1efb4: 7f 85 20 00 cmpw cr7,r5,r4 ffc1efb8: 40 be ff 78 bne- cr7,ffc1ef30 } } } } if ( interested ) { ffc1efbc: 2f 83 00 00 cmpwi cr7,r3,0 ffc1efc0: 41 9e 00 18 beq- cr7,ffc1efd8 /* * 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 ) ) { ffc1efc4: 7f 84 e3 78 mr r4,r28 ffc1efc8: 38 a1 00 08 addi r5,r1,8 ffc1efcc: 48 00 01 4d bl ffc1f118 <_POSIX_signals_Unblock_thread> ffc1efd0: 2f 83 00 00 cmpwi cr7,r3,0 ffc1efd4: 40 9e 00 18 bne- cr7,ffc1efec /* * 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 ); ffc1efd8: 7f e3 fb 78 mr r3,r31 ffc1efdc: 48 00 01 15 bl ffc1f0f0 <_POSIX_signals_Set_process_signals> if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { ffc1efe0: 7c 1d f0 2e lwzx r0,r29,r30 ffc1efe4: 2f 80 00 02 cmpwi cr7,r0,2 ffc1efe8: 41 9e 00 68 beq- cr7,ffc1f050 _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); ffc1efec: 4b fe d4 29 bl ffc0c414 <_Thread_Enable_dispatch> return 0; ffc1eff0: 38 60 00 00 li r3,0 } ffc1eff4: 80 01 00 34 lwz r0,52(r1) ffc1eff8: 83 41 00 18 lwz r26,24(r1) ffc1effc: 7c 08 03 a6 mtlr r0 ffc1f000: 83 61 00 1c lwz r27,28(r1) ffc1f004: 83 81 00 20 lwz r28,32(r1) ffc1f008: 83 a1 00 24 lwz r29,36(r1) ffc1f00c: 83 c1 00 28 lwz r30,40(r1) ffc1f010: 83 e1 00 2c lwz r31,44(r1) ffc1f014: 38 21 00 30 addi r1,r1,48 ffc1f018: 4e 80 00 20 blr * P1003.1c/Draft 10, p. 33 says that certain signals should always * be directed to the executing thread such as those caused by hardware * faults. */ if ( (sig == SIGFPE) || (sig == SIGILL) || (sig == SIGSEGV ) ) return pthread_kill( pthread_self(), sig ); ffc1f01c: 48 00 03 69 bl ffc1f384 ffc1f020: 7f 84 e3 78 mr r4,r28 ffc1f024: 48 00 02 61 bl ffc1f284 } DEBUG_STEP("\n"); _Thread_Enable_dispatch(); return 0; } ffc1f028: 80 01 00 34 lwz r0,52(r1) ffc1f02c: 83 41 00 18 lwz r26,24(r1) ffc1f030: 7c 08 03 a6 mtlr r0 ffc1f034: 83 61 00 1c lwz r27,28(r1) ffc1f038: 83 81 00 20 lwz r28,32(r1) ffc1f03c: 83 a1 00 24 lwz r29,36(r1) ffc1f040: 83 c1 00 28 lwz r30,40(r1) ffc1f044: 83 e1 00 2c lwz r31,44(r1) ffc1f048: 38 21 00 30 addi r1,r1,48 ffc1f04c: 4e 80 00 20 blr */ _POSIX_signals_Set_process_signals( mask ); if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) ffc1f050: 3c 60 00 00 lis r3,0 ffc1f054: 38 63 33 40 addi r3,r3,13120 ffc1f058: 4b fe b1 51 bl ffc0a1a8 <_Chain_Get> _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { ffc1f05c: 7c 69 1b 79 mr. r9,r3 ffc1f060: 41 82 00 78 beq- ffc1f0d8 _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc1f064: 80 01 00 08 lwz r0,8(r1) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc1f068: 3c 60 00 00 lis r3,0 ffc1f06c: 38 63 33 b4 addi r3,r3,13236 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc1f070: 90 09 00 08 stw r0,8(r9) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc1f074: 7c 63 f2 14 add r3,r3,r30 ffc1f078: 7d 24 4b 78 mr r4,r9 if ( !psiginfo ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( EAGAIN ); } psiginfo->Info = *siginfo; ffc1f07c: 80 01 00 0c lwz r0,12(r1) ffc1f080: 90 09 00 0c stw r0,12(r9) ffc1f084: 80 01 00 10 lwz r0,16(r1) ffc1f088: 90 09 00 10 stw r0,16(r9) _Chain_Append( &_POSIX_signals_Siginfo[ sig ], &psiginfo->Node ); ffc1f08c: 4b fe b0 c5 bl ffc0a150 <_Chain_Append> ffc1f090: 4b ff ff 5c b ffc1efec */ siginfo = &siginfo_struct; siginfo->si_signo = sig; siginfo->si_code = SI_USER; if ( !value ) { siginfo->si_value.sival_int = 0; ffc1f094: 93 61 00 10 stw r27,16(r1) ffc1f098: 4b ff fd f0 b ffc1ee88 continue; } DEBUG_STEP("6"); /* prefer blocked/interruptible over blocked/not interruptible */ if ( !_States_Is_interruptible_by_signal(interested->current_state) ) { ffc1f09c: 74 da 10 00 andis. r26,r6,4096 ffc1f0a0: 40 a2 ff 08 bne- ffc1efa8 DEBUG_STEP("7"); if ( _States_Is_interruptible_by_signal(the_thread->current_state) ) { ffc1f0a4: 77 66 10 00 andis. r6,r27,4096 ffc1f0a8: 41 a2 ff 00 beq- ffc1efa8 ffc1f0ac: 4b ff fe f4 b ffc1efa0 /* * Only supported for the "calling process" (i.e. this node). */ if ( pid != getpid() ) rtems_set_errno_and_return_minus_one( ESRCH ); ffc1f0b0: 4b ff 4b 45 bl ffc13bf4 <__errno> ffc1f0b4: 38 00 00 03 li r0,3 ffc1f0b8: 90 03 00 00 stw r0,0(r3) ffc1f0bc: 38 60 ff ff li r3,-1 ffc1f0c0: 4b ff ff 34 b ffc1eff4 */ if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc1f0c4: 4b ff 4b 31 bl ffc13bf4 <__errno> ffc1f0c8: 38 00 00 16 li r0,22 ffc1f0cc: 90 03 00 00 stw r0,0(r3) ffc1f0d0: 38 60 ff ff li r3,-1 ffc1f0d4: 4b ff ff 20 b ffc1eff4 if ( _POSIX_signals_Vectors[ sig ].sa_flags == SA_SIGINFO ) { psiginfo = (POSIX_signals_Siginfo_node *) _Chain_Get( &_POSIX_signals_Inactive_siginfo ); if ( !psiginfo ) { _Thread_Enable_dispatch(); ffc1f0d8: 4b fe d3 3d bl ffc0c414 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc1f0dc: 4b ff 4b 19 bl ffc13bf4 <__errno> ffc1f0e0: 38 00 00 0b li r0,11 ffc1f0e4: 90 03 00 00 stw r0,0(r3) ffc1f0e8: 38 60 ff ff li r3,-1 ffc1f0ec: 4b ff ff 08 b ffc1eff4 =============================================================================== ffc0ec34 : * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc0ec34: 3d 20 00 00 lis r9,0 int oflag, ... /* mode_t mode, */ /* struct mq_attr attr */ ) { ffc0ec38: 94 21 ff b0 stwu r1,-80(r1) ffc0ec3c: 7c 08 02 a6 mflr r0 ffc0ec40: 81 69 2a 70 lwz r11,10864(r9) ffc0ec44: 7d 80 00 26 mfcr r12 ffc0ec48: 90 01 00 54 stw r0,84(r1) ffc0ec4c: 39 6b 00 01 addi r11,r11,1 ffc0ec50: 91 69 2a 70 stw r11,10864(r9) ffc0ec54: 93 81 00 40 stw r28,64(r1) ffc0ec58: 7c 7c 1b 78 mr r28,r3 ffc0ec5c: 93 c1 00 48 stw r30,72(r1) ffc0ec60: 7c 9e 23 78 mr r30,r4 ffc0ec64: 93 41 00 38 stw r26,56(r1) ffc0ec68: 93 61 00 3c stw r27,60(r1) ffc0ec6c: 93 a1 00 44 stw r29,68(r1) ffc0ec70: 93 e1 00 4c stw r31,76(r1) ffc0ec74: 91 81 00 34 stw r12,52(r1) ffc0ec78: 90 a1 00 28 stw r5,40(r1) ffc0ec7c: 90 c1 00 2c stw r6,44(r1) return _Thread_Dispatch_disable_level; ffc0ec80: 80 09 2a 70 lwz r0,10864(r9) POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0ec84: 54 80 bf fe rlwinm r0,r4,23,31,31 ffc0ec88: 2e 00 00 00 cmpwi cr4,r0,0 /* struct mq_attr attr */ ) { va_list arg; mode_t mode; struct mq_attr *attr = NULL; ffc0ec8c: 3b 40 00 00 li r26,0 POSIX_Message_queue_Control_fd *the_mq_fd; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0ec90: 40 92 01 0c bne- cr4,ffc0ed9c */ RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) ffc0ec94: 3f a0 00 00 lis r29,0 ffc0ec98: 3b bd 36 18 addi r29,r29,13848 ffc0ec9c: 7f a3 eb 78 mr r3,r29 ffc0eca0: 48 00 3d a1 bl ffc12a40 <_Objects_Allocate> attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { ffc0eca4: 7c 7f 1b 79 mr. r31,r3 ffc0eca8: 41 82 01 28 beq- ffc0edd0 <== NEVER TAKEN _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one( ENFILE ); } the_mq_fd->oflag = oflag; ffc0ecac: 93 df 00 14 stw r30,20(r31) status = _POSIX_Message_queue_Name_to_id( name, &the_mq_id ); ffc0ecb0: 7f 83 e3 78 mr r3,r28 ffc0ecb4: 38 81 00 10 addi r4,r1,16 ffc0ecb8: 48 00 91 bd bl ffc17e74 <_POSIX_Message_queue_Name_to_id> * If the name to id translation worked, then the message queue exists * and we can just return a pointer to the id. Otherwise we may * need to check to see if this is a "message queue does not exist" * or some other miscellaneous error on the name. */ if ( status ) { ffc0ecbc: 7c 7b 1b 79 mr. r27,r3 ffc0ecc0: 40 82 00 88 bne- ffc0ed48 } else { /* name -> ID translation succeeded */ /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { ffc0ecc4: 73 de 0a 00 andi. r30,r30,2560 ffc0ecc8: 2f 9e 0a 00 cmpwi cr7,r30,2560 ffc0eccc: 41 9e 01 48 beq- cr7,ffc0ee14 RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control *_POSIX_Message_queue_Get ( Objects_Id id, Objects_Locations *location ) { return (POSIX_Message_queue_Control *) ffc0ecd0: 80 81 00 10 lwz r4,16(r1) ffc0ecd4: 3c 60 00 00 lis r3,0 ffc0ecd8: 38 a1 00 08 addi r5,r1,8 ffc0ecdc: 38 63 34 8c addi r3,r3,13452 ffc0ece0: 48 00 43 51 bl ffc13030 <_Objects_Get> Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( ffc0ece4: a0 1f 00 0a lhz r0,10(r31) /* * In this case we need to do an ID->pointer conversion to * check the mode. */ the_mq = _POSIX_Message_queue_Get( the_mq_id, &location ); the_mq->open_count += 1; ffc0ece8: 81 63 00 18 lwz r11,24(r3) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0ecec: 81 3d 00 1c lwz r9,28(r29) ffc0ecf0: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0ecf4: 39 6b 00 01 addi r11,r11,1 /* * In this case we need to do an ID->pointer conversion to * check the mode. */ the_mq = _POSIX_Message_queue_Get( the_mq_id, &location ); ffc0ecf8: 90 61 00 0c stw r3,12(r1) the_mq->open_count += 1; ffc0ecfc: 91 63 00 18 stw r11,24(r3) the_mq_fd->Queue = the_mq; ffc0ed00: 90 7f 00 10 stw r3,16(r31) ffc0ed04: 7f e9 01 2e stwx r31,r9,r0 the_object ); #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) /* ASSERT: information->is_string */ the_object->name.name_p = name; ffc0ed08: 93 7f 00 0c stw r27,12(r31) _Objects_Open_string( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); ffc0ed0c: 48 00 54 b1 bl ffc141bc <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); ffc0ed10: 48 00 54 ad bl ffc141bc <_Thread_Enable_dispatch> return (mqd_t)the_mq_fd->Object.id; ffc0ed14: 80 7f 00 08 lwz r3,8(r31) ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ed18: 80 01 00 54 lwz r0,84(r1) ffc0ed1c: 81 81 00 34 lwz r12,52(r1) ffc0ed20: 7c 08 03 a6 mtlr r0 ffc0ed24: 83 41 00 38 lwz r26,56(r1) ffc0ed28: 83 61 00 3c lwz r27,60(r1) ffc0ed2c: 7d 80 81 20 mtcrf 8,r12 ffc0ed30: 83 81 00 40 lwz r28,64(r1) ffc0ed34: 83 a1 00 44 lwz r29,68(r1) ffc0ed38: 83 c1 00 48 lwz r30,72(r1) ffc0ed3c: 83 e1 00 4c lwz r31,76(r1) ffc0ed40: 38 21 00 50 addi r1,r1,80 ffc0ed44: 4e 80 00 20 blr if ( status ) { /* * Unless provided a valid name that did not already exist * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { ffc0ed48: 2f 9b 00 02 cmpwi cr7,r27,2 ffc0ed4c: 41 9e 01 18 beq- cr7,ffc0ee64 RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free_fd ( POSIX_Message_queue_Control_fd *the_mq_fd ) { _Objects_Free( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); ffc0ed50: 7f a3 eb 78 mr r3,r29 ffc0ed54: 7f e4 fb 78 mr r4,r31 ffc0ed58: 48 00 40 e5 bl ffc12e3c <_Objects_Free> _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); ffc0ed5c: 48 00 54 61 bl ffc141bc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); ffc0ed60: 48 00 d5 55 bl ffc1c2b4 <__errno> ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ed64: 80 01 00 54 lwz r0,84(r1) ffc0ed68: 81 81 00 34 lwz r12,52(r1) ffc0ed6c: 7c 08 03 a6 mtlr r0 * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); ffc0ed70: 93 63 00 00 stw r27,0(r3) ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ed74: 7d 80 81 20 mtcrf 8,r12 * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( status, mqd_t ); ffc0ed78: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ed7c: 83 41 00 38 lwz r26,56(r1) ffc0ed80: 83 61 00 3c lwz r27,60(r1) ffc0ed84: 83 81 00 40 lwz r28,64(r1) ffc0ed88: 83 a1 00 44 lwz r29,68(r1) ffc0ed8c: 83 c1 00 48 lwz r30,72(r1) ffc0ed90: 83 e1 00 4c lwz r31,76(r1) ffc0ed94: 38 21 00 50 addi r1,r1,80 ffc0ed98: 4e 80 00 20 blr Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0ed9c: 38 01 00 58 addi r0,r1,88 mode = (mode_t) va_arg( arg, unsigned int ); attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); ffc0eda0: 83 41 00 2c lwz r26,44(r1) */ RTEMS_INLINE_ROUTINE POSIX_Message_queue_Control_fd * _POSIX_Message_queue_Allocate_fd( void ) { return (POSIX_Message_queue_Control_fd *) ffc0eda4: 3f a0 00 00 lis r29,0 Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0eda8: 90 01 00 18 stw r0,24(r1) ffc0edac: 3b bd 36 18 addi r29,r29,13848 ffc0edb0: 38 01 00 20 addi r0,r1,32 ffc0edb4: 90 01 00 1c stw r0,28(r1) ffc0edb8: 7f a3 eb 78 mr r3,r29 mode = (mode_t) va_arg( arg, unsigned int ); attr = (struct mq_attr *) va_arg( arg, struct mq_attr * ); ffc0edbc: 38 00 00 04 li r0,4 ffc0edc0: 98 01 00 14 stb r0,20(r1) ffc0edc4: 48 00 3c 7d bl ffc12a40 <_Objects_Allocate> va_end(arg); } the_mq_fd = _POSIX_Message_queue_Allocate_fd(); if ( !the_mq_fd ) { ffc0edc8: 7c 7f 1b 79 mr. r31,r3 ffc0edcc: 40 82 fe e0 bne+ ffc0ecac _Thread_Enable_dispatch(); ffc0edd0: 48 00 53 ed bl ffc141bc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( ENFILE ); ffc0edd4: 48 00 d4 e1 bl ffc1c2b4 <__errno> ffc0edd8: 38 00 00 17 li r0,23 ffc0eddc: 90 03 00 00 stw r0,0(r3) ffc0ede0: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ede4: 80 01 00 54 lwz r0,84(r1) ffc0ede8: 81 81 00 34 lwz r12,52(r1) ffc0edec: 7c 08 03 a6 mtlr r0 ffc0edf0: 83 41 00 38 lwz r26,56(r1) ffc0edf4: 83 61 00 3c lwz r27,60(r1) ffc0edf8: 7d 80 81 20 mtcrf 8,r12 ffc0edfc: 83 81 00 40 lwz r28,64(r1) ffc0ee00: 83 a1 00 44 lwz r29,68(r1) ffc0ee04: 83 c1 00 48 lwz r30,72(r1) ffc0ee08: 83 e1 00 4c lwz r31,76(r1) ffc0ee0c: 38 21 00 50 addi r1,r1,80 ffc0ee10: 4e 80 00 20 blr RTEMS_INLINE_ROUTINE void _POSIX_Message_queue_Free_fd ( POSIX_Message_queue_Control_fd *the_mq_fd ) { _Objects_Free( &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object ); ffc0ee14: 7f a3 eb 78 mr r3,r29 ffc0ee18: 7f e4 fb 78 mr r4,r31 ffc0ee1c: 48 00 40 21 bl ffc12e3c <_Objects_Free> /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); ffc0ee20: 48 00 53 9d bl ffc141bc <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, mqd_t ); ffc0ee24: 48 00 d4 91 bl ffc1c2b4 <__errno> ffc0ee28: 38 00 00 11 li r0,17 ffc0ee2c: 90 03 00 00 stw r0,0(r3) ffc0ee30: 38 60 ff ff li r3,-1 ); _Thread_Enable_dispatch(); return (mqd_t) the_mq_fd->Object.id; } ffc0ee34: 80 01 00 54 lwz r0,84(r1) ffc0ee38: 81 81 00 34 lwz r12,52(r1) ffc0ee3c: 7c 08 03 a6 mtlr r0 ffc0ee40: 83 41 00 38 lwz r26,56(r1) ffc0ee44: 83 61 00 3c lwz r27,60(r1) ffc0ee48: 7d 80 81 20 mtcrf 8,r12 ffc0ee4c: 83 81 00 40 lwz r28,64(r1) ffc0ee50: 83 a1 00 44 lwz r29,68(r1) ffc0ee54: 83 c1 00 48 lwz r30,72(r1) ffc0ee58: 83 e1 00 4c lwz r31,76(r1) ffc0ee5c: 38 21 00 50 addi r1,r1,80 ffc0ee60: 4e 80 00 20 blr if ( status ) { /* * Unless provided a valid name that did not already exist * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { ffc0ee64: 41 92 fe ec beq+ cr4,ffc0ed50 /* * At this point, the message queue does not exist and everything has been * checked. We should go ahead and create a message queue. */ status = _POSIX_Message_queue_Create_support( ffc0ee68: 7f 83 e3 78 mr r3,r28 ffc0ee6c: 38 80 00 01 li r4,1 ffc0ee70: 7f 45 d3 78 mr r5,r26 ffc0ee74: 38 c1 00 0c addi r6,r1,12 ffc0ee78: 48 00 8e 31 bl ffc17ca8 <_POSIX_Message_queue_Create_support> ); /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { ffc0ee7c: 2f 83 ff ff cmpwi cr7,r3,-1 ffc0ee80: 41 9e 00 30 beq- cr7,ffc0eeb0 Objects_Information *information, Objects_Control *the_object, const char *name ) { _Objects_Set_local_object( ffc0ee84: a0 1f 00 0a lhz r0,10(r31) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc0ee88: 81 3d 00 1c lwz r9,28(r29) _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); return (mqd_t) -1; } the_mq_fd->Queue = the_mq; ffc0ee8c: 81 61 00 0c lwz r11,12(r1) ffc0ee90: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0ee94: 91 7f 00 10 stw r11,16(r31) ffc0ee98: 7f e9 01 2e stwx r31,r9,r0 the_object ); #if defined(RTEMS_SCORE_OBJECT_ENABLE_STRING_NAMES) /* ASSERT: information->is_string */ the_object->name.name_p = name; ffc0ee9c: 38 00 00 00 li r0,0 ffc0eea0: 90 1f 00 0c stw r0,12(r31) &_POSIX_Message_queue_Information_fds, &the_mq_fd->Object, NULL ); _Thread_Enable_dispatch(); ffc0eea4: 48 00 53 19 bl ffc141bc <_Thread_Enable_dispatch> return (mqd_t) the_mq_fd->Object.id; ffc0eea8: 80 7f 00 08 lwz r3,8(r31) ffc0eeac: 4b ff fe 6c b ffc0ed18 ffc0eeb0: 7f a3 eb 78 mr r3,r29 ffc0eeb4: 7f e4 fb 78 mr r4,r31 ffc0eeb8: 48 00 3f 85 bl ffc12e3c <_Objects_Free> /* * errno was set by Create_support, so don't set it again. */ if ( status == -1 ) { _POSIX_Message_queue_Free_fd( the_mq_fd ); _Thread_Enable_dispatch(); ffc0eebc: 48 00 53 01 bl ffc141bc <_Thread_Enable_dispatch> return (mqd_t) -1; ffc0eec0: 38 60 ff ff li r3,-1 ffc0eec4: 4b ff fe 54 b ffc0ed18 =============================================================================== ffc0e9b8 : int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0e9b8: 7c 69 1b 79 mr. r9,r3 return EINVAL; ffc0e9bc: 38 60 00 16 li r3,22 int pthread_attr_setschedpolicy( pthread_attr_t *attr, int policy ) { if ( !attr || !attr->is_initialized ) ffc0e9c0: 4d 82 00 20 beqlr ffc0e9c4: 80 09 00 00 lwz r0,0(r9) ffc0e9c8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e9cc: 4d be 00 20 beqlr+ cr7 return EINVAL; switch ( policy ) { ffc0e9d0: 2b 84 00 04 cmplwi cr7,r4,4 ffc0e9d4: 41 9d 00 20 bgt- cr7,ffc0e9f4 ffc0e9d8: 38 00 00 01 li r0,1 ffc0e9dc: 7c 00 20 30 slw r0,r0,r4 ffc0e9e0: 70 0b 00 17 andi. r11,r0,23 ffc0e9e4: 41 82 00 10 beq- ffc0e9f4 <== NEVER TAKEN case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: case SCHED_SPORADIC: attr->schedpolicy = policy; ffc0e9e8: 90 89 00 14 stw r4,20(r9) return 0; ffc0e9ec: 38 60 00 00 li r3,0 ffc0e9f0: 4e 80 00 20 blr default: return ENOTSUP; ffc0e9f4: 38 60 00 86 li r3,134 } } ffc0e9f8: 4e 80 00 20 blr =============================================================================== ffc091a0 : int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc091a0: 94 21 ff d0 stwu r1,-48(r1) ffc091a4: 7c 08 02 a6 mflr r0 ffc091a8: 93 e1 00 2c stw r31,44(r1) const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc091ac: 7c 7f 1b 79 mr. r31,r3 return EINVAL; ffc091b0: 38 60 00 16 li r3,22 int pthread_barrier_init( pthread_barrier_t *barrier, const pthread_barrierattr_t *attr, unsigned int count ) { ffc091b4: 90 01 00 34 stw r0,52(r1) ffc091b8: 93 81 00 20 stw r28,32(r1) ffc091bc: 93 a1 00 24 stw r29,36(r1) ffc091c0: 93 c1 00 28 stw r30,40(r1) const pthread_barrierattr_t *the_attr; /* * Error check parameters */ if ( !barrier ) ffc091c4: 41 82 00 0c beq- ffc091d0 return EINVAL; if ( count == 0 ) ffc091c8: 2f 85 00 00 cmpwi cr7,r5,0 ffc091cc: 40 9e 00 24 bne- cr7,ffc091f0 * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; _Thread_Enable_dispatch(); return 0; } ffc091d0: 80 01 00 34 lwz r0,52(r1) ffc091d4: 83 81 00 20 lwz r28,32(r1) ffc091d8: 7c 08 03 a6 mtlr r0 ffc091dc: 83 a1 00 24 lwz r29,36(r1) ffc091e0: 83 c1 00 28 lwz r30,40(r1) ffc091e4: 83 e1 00 2c lwz r31,44(r1) ffc091e8: 38 21 00 30 addi r1,r1,48 ffc091ec: 4e 80 00 20 blr return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc091f0: 2f 84 00 00 cmpwi cr7,r4,0 ffc091f4: 41 9e 00 84 beq- cr7,ffc09278 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc091f8: 80 04 00 00 lwz r0,0(r4) return EINVAL; ffc091fc: 38 60 00 16 li r3,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc09200: 2f 80 00 00 cmpwi cr7,r0,0 ffc09204: 41 9e ff cc beq+ cr7,ffc091d0 return EINVAL; switch ( the_attr->process_shared ) { ffc09208: 83 c4 00 04 lwz r30,4(r4) ffc0920c: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09210: 40 be ff c0 bne- cr7,ffc091d0 <== NEVER TAKEN * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc09214: 3d 20 00 00 lis r9,0 } /* * Convert from POSIX attributes to Core Barrier attributes */ the_attributes.discipline = CORE_BARRIER_AUTOMATIC_RELEASE; ffc09218: 93 c1 00 10 stw r30,16(r1) ffc0921c: 81 69 28 34 lwz r11,10292(r9) the_attributes.maximum_count = count; ffc09220: 90 a1 00 14 stw r5,20(r1) ffc09224: 38 0b 00 01 addi r0,r11,1 ffc09228: 90 09 28 34 stw r0,10292(r9) return _Thread_Dispatch_disable_level; ffc0922c: 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 *) ffc09230: 3f 80 00 00 lis r28,0 ffc09234: 3b 9c 2f ac addi r28,r28,12204 ffc09238: 7f 83 e3 78 mr r3,r28 ffc0923c: 48 00 2a ed bl ffc0bd28 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { ffc09240: 7c 7d 1b 79 mr. r29,r3 ffc09244: 41 82 00 4c beq- ffc09290 _Thread_Enable_dispatch(); return EAGAIN; } _CORE_barrier_Initialize( &the_barrier->Barrier, &the_attributes ); ffc09248: 38 7d 00 10 addi r3,r29,16 ffc0924c: 38 81 00 10 addi r4,r1,16 ffc09250: 48 00 1e 89 bl ffc0b0d8 <_CORE_barrier_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc09254: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc09258: 81 7c 00 1c lwz r11,28(r28) ffc0925c: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc09260: 7f ab 49 2e stwx r29,r11,r9 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc09264: 93 dd 00 0c stw r30,12(r29) ); /* * Exit the critical section and return the user an operational barrier */ *barrier = the_barrier->Object.id; ffc09268: 90 1f 00 00 stw r0,0(r31) _Thread_Enable_dispatch(); ffc0926c: 48 00 41 79 bl ffc0d3e4 <_Thread_Enable_dispatch> return 0; ffc09270: 38 60 00 00 li r3,0 ffc09274: 4b ff ff 5c b ffc091d0 * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_barrierattr_init( &my_attr ); ffc09278: 38 61 00 08 addi r3,r1,8 ffc0927c: 90 a1 00 18 stw r5,24(r1) ffc09280: 4b ff fe 2d bl ffc090ac the_attr = &my_attr; ffc09284: 38 81 00 08 addi r4,r1,8 ffc09288: 80 a1 00 18 lwz r5,24(r1) ffc0928c: 4b ff ff 6c b ffc091f8 _Thread_Disable_dispatch(); /* prevents deletion */ the_barrier = _POSIX_Barrier_Allocate(); if ( !the_barrier ) { _Thread_Enable_dispatch(); ffc09290: 48 00 41 55 bl ffc0d3e4 <_Thread_Enable_dispatch> return EAGAIN; ffc09294: 38 60 00 0b li r3,11 ffc09298: 4b ff ff 38 b ffc091d0 =============================================================================== ffc08970 : void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc08970: 94 21 ff f0 stwu r1,-16(r1) ffc08974: 7c 08 02 a6 mflr r0 ffc08978: 93 c1 00 08 stw 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 ) ffc0897c: 7c 7e 1b 79 mr. r30,r3 void pthread_cleanup_push( void (*routine)( void * ), void *arg ) { ffc08980: 93 e1 00 0c stw r31,12(r1) ffc08984: 7c 9f 23 78 mr r31,r4 ffc08988: 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 ) ffc0898c: 41 82 00 4c beq- ffc089d8 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08990: 3d 20 00 00 lis r9,0 ffc08994: 81 69 28 0c lwz r11,10252(r9) ffc08998: 38 0b 00 01 addi r0,r11,1 ffc0899c: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc089a0: 80 09 28 0c lwz r0,10252(r9) return; _Thread_Disable_dispatch(); handler = _Workspace_Allocate( sizeof( POSIX_Cancel_Handler_control ) ); ffc089a4: 38 60 00 10 li r3,16 ffc089a8: 48 00 5a 8d bl ffc0e434 <_Workspace_Allocate> if ( handler ) { ffc089ac: 7c 69 1b 79 mr. r9,r3 ffc089b0: 41 82 00 24 beq- ffc089d4 <== NEVER TAKEN thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc089b4: 3d 60 00 00 lis r11,0 ffc089b8: 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 ); ffc089bc: 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; ffc089c0: 80 6b 01 34 lwz r3,308(r11) handler->routine = routine; ffc089c4: 93 c9 00 08 stw r30,8(r9) handler->arg = arg; _Chain_Append( handler_stack, &handler->Node ); ffc089c8: 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; ffc089cc: 93 e9 00 0c stw r31,12(r9) _Chain_Append( handler_stack, &handler->Node ); ffc089d0: 48 00 1f b5 bl ffc0a984 <_Chain_Append> } _Thread_Enable_dispatch(); ffc089d4: 48 00 42 75 bl ffc0cc48 <_Thread_Enable_dispatch> } ffc089d8: 80 01 00 14 lwz r0,20(r1) ffc089dc: 83 c1 00 08 lwz r30,8(r1) ffc089e0: 7c 08 03 a6 mtlr r0 ffc089e4: 83 e1 00 0c lwz r31,12(r1) ffc089e8: 38 21 00 10 addi r1,r1,16 ffc089ec: 4e 80 00 20 blr =============================================================================== ffc09b28 : int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc09b28: 94 21 ff e8 stwu r1,-24(r1) ffc09b2c: 7c 08 02 a6 mflr r0 ffc09b30: 93 81 00 08 stw r28,8(r1) POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; ffc09b34: 7c 9c 23 79 mr. r28,r4 int pthread_cond_init( pthread_cond_t *cond, const pthread_condattr_t *attr ) { ffc09b38: 93 e1 00 14 stw r31,20(r1) ffc09b3c: 7c 7f 1b 78 mr r31,r3 ffc09b40: 90 01 00 1c stw r0,28(r1) ffc09b44: 93 a1 00 0c stw r29,12(r1) ffc09b48: 93 c1 00 10 stw r30,16(r1) POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; ffc09b4c: 41 82 00 b8 beq- ffc09c04 else the_attr = &_POSIX_Condition_variables_Default_attributes; /* * Be careful about attributes when global!!! */ if ( the_attr->process_shared == PTHREAD_PROCESS_SHARED ) ffc09b50: 80 1c 00 04 lwz r0,4(r28) return EINVAL; ffc09b54: 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 ) ffc09b58: 2f 80 00 01 cmpwi cr7,r0,1 ffc09b5c: 41 9e 00 10 beq- cr7,ffc09b6c <== NEVER TAKEN return EINVAL; if ( !the_attr->is_initialized ) ffc09b60: 80 1c 00 00 lwz r0,0(r28) ffc09b64: 2f 80 00 00 cmpwi cr7,r0,0 ffc09b68: 40 9e 00 24 bne- cr7,ffc09b8c *cond = the_cond->Object.id; _Thread_Enable_dispatch(); return 0; } ffc09b6c: 80 01 00 1c lwz r0,28(r1) ffc09b70: 83 81 00 08 lwz r28,8(r1) ffc09b74: 7c 08 03 a6 mtlr r0 ffc09b78: 83 a1 00 0c lwz r29,12(r1) ffc09b7c: 83 c1 00 10 lwz r30,16(r1) ffc09b80: 83 e1 00 14 lwz r31,20(r1) ffc09b84: 38 21 00 18 addi r1,r1,24 ffc09b88: 4e 80 00 20 blr * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc09b8c: 3d 20 00 00 lis r9,0 ffc09b90: 81 69 28 40 lwz r11,10304(r9) ffc09b94: 38 0b 00 01 addi r0,r11,1 ffc09b98: 90 09 28 40 stw r0,10304(r9) return _Thread_Dispatch_disable_level; ffc09b9c: 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 *) ffc09ba0: 3f a0 00 00 lis r29,0 ffc09ba4: 3b bd 30 64 addi r29,r29,12388 ffc09ba8: 7f a3 eb 78 mr r3,r29 ffc09bac: 48 00 32 ad bl ffc0ce58 <_Objects_Allocate> _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { ffc09bb0: 7c 7e 1b 79 mr. r30,r3 ffc09bb4: 41 82 00 5c beq- ffc09c10 _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; ffc09bb8: 80 1c 00 04 lwz r0,4(r28) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; ffc09bbc: 3b 80 00 00 li r28,0 ffc09bc0: 93 9e 00 14 stw r28,20(r30) _Thread_queue_Initialize( ffc09bc4: 3c a0 10 00 lis r5,4096 ffc09bc8: 38 7e 00 18 addi r3,r30,24 if ( !the_cond ) { _Thread_Enable_dispatch(); return ENOMEM; } the_cond->process_shared = the_attr->process_shared; ffc09bcc: 90 1e 00 10 stw r0,16(r30) the_cond->Mutex = POSIX_CONDITION_VARIABLES_NO_MUTEX; _Thread_queue_Initialize( ffc09bd0: 38 80 00 00 li r4,0 ffc09bd4: 60 a5 08 00 ori r5,r5,2048 ffc09bd8: 38 c0 00 74 li r6,116 ffc09bdc: 48 00 53 39 bl ffc0ef14 <_Thread_queue_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc09be0: 80 1e 00 08 lwz r0,8(r30) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc09be4: 81 7d 00 1c lwz r11,28(r29) ffc09be8: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc09bec: 7f cb 49 2e stwx r30,r11,r9 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc09bf0: 93 9e 00 0c stw r28,12(r30) &_POSIX_Condition_variables_Information, &the_cond->Object, 0 ); *cond = the_cond->Object.id; ffc09bf4: 90 1f 00 00 stw r0,0(r31) _Thread_Enable_dispatch(); ffc09bf8: 48 00 49 1d bl ffc0e514 <_Thread_Enable_dispatch> return 0; ffc09bfc: 38 60 00 00 li r3,0 ffc09c00: 4b ff ff 6c b ffc09b6c { POSIX_Condition_variables_Control *the_cond; const pthread_condattr_t *the_attr; if ( attr ) the_attr = attr; else the_attr = &_POSIX_Condition_variables_Default_attributes; ffc09c04: 3f 80 00 00 lis r28,0 ffc09c08: 3b 9c 27 88 addi r28,r28,10120 ffc09c0c: 4b ff ff 44 b ffc09b50 _Thread_Disable_dispatch(); the_cond = _POSIX_Condition_variables_Allocate(); if ( !the_cond ) { _Thread_Enable_dispatch(); ffc09c10: 48 00 49 05 bl ffc0e514 <_Thread_Enable_dispatch> return ENOMEM; ffc09c14: 38 60 00 0c li r3,12 ffc09c18: 4b ff ff 54 b ffc09b6c =============================================================================== ffc08e68 : pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08e68: 94 21 ff 80 stwu r1,-128(r1) ffc08e6c: 7c 08 02 a6 mflr r0 ffc08e70: 93 61 00 6c stw r27,108(r1) int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc08e74: 7c bb 2b 79 mr. r27,r5 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08e78: 93 81 00 70 stw r28,112(r1) ffc08e7c: 7c dc 33 78 mr r28,r6 ffc08e80: 93 a1 00 74 stw r29,116(r1) ffc08e84: 7c 7d 1b 78 mr r29,r3 ffc08e88: 93 e1 00 7c stw r31,124(r1) struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) return EFAULT; ffc08e8c: 3b e0 00 0e li r31,14 pthread_t *thread, const pthread_attr_t *attr, void *(*start_routine)( void * ), void *arg ) { ffc08e90: 90 01 00 84 stw r0,132(r1) ffc08e94: 92 81 00 50 stw r20,80(r1) ffc08e98: 92 a1 00 54 stw r21,84(r1) ffc08e9c: 92 c1 00 58 stw r22,88(r1) ffc08ea0: 92 e1 00 5c stw r23,92(r1) ffc08ea4: 93 01 00 60 stw r24,96(r1) ffc08ea8: 93 21 00 64 stw r25,100(r1) ffc08eac: 93 41 00 68 stw r26,104(r1) ffc08eb0: 93 c1 00 78 stw r30,120(r1) int schedpolicy = SCHED_RR; struct sched_param schedparam; Objects_Name name; int rc; if ( !start_routine ) ffc08eb4: 41 82 00 20 beq- ffc08ed4 return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; ffc08eb8: 2f 84 00 00 cmpwi cr7,r4,0 ffc08ebc: 7c 9e 23 78 mr r30,r4 ffc08ec0: 41 9e 01 bc beq- cr7,ffc0907c if ( !the_attr->is_initialized ) ffc08ec4: 80 1e 00 00 lwz r0,0(r30) return EINVAL; ffc08ec8: 3b e0 00 16 li r31,22 if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; if ( !the_attr->is_initialized ) ffc08ecc: 2f 80 00 00 cmpwi cr7,r0,0 ffc08ed0: 40 9e 00 48 bne- cr7,ffc08f18 */ *thread = the_thread->Object.id; _RTEMS_Unlock_allocator(); return 0; } ffc08ed4: 80 01 00 84 lwz r0,132(r1) ffc08ed8: 7f e3 fb 78 mr r3,r31 ffc08edc: 82 81 00 50 lwz r20,80(r1) ffc08ee0: 7c 08 03 a6 mtlr r0 ffc08ee4: 82 a1 00 54 lwz r21,84(r1) ffc08ee8: 82 c1 00 58 lwz r22,88(r1) ffc08eec: 82 e1 00 5c lwz r23,92(r1) ffc08ef0: 83 01 00 60 lwz r24,96(r1) ffc08ef4: 83 21 00 64 lwz r25,100(r1) ffc08ef8: 83 41 00 68 lwz r26,104(r1) ffc08efc: 83 61 00 6c lwz r27,108(r1) ffc08f00: 83 81 00 70 lwz r28,112(r1) ffc08f04: 83 a1 00 74 lwz r29,116(r1) ffc08f08: 83 c1 00 78 lwz r30,120(r1) ffc08f0c: 83 e1 00 7c lwz r31,124(r1) ffc08f10: 38 21 00 80 addi r1,r1,128 ffc08f14: 4e 80 00 20 blr * 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) ) ffc08f18: 80 1e 00 04 lwz r0,4(r30) ffc08f1c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f20: 41 9e 00 18 beq- cr7,ffc08f38 ffc08f24: 3d 60 00 00 lis r11,0 ffc08f28: 81 3e 00 08 lwz r9,8(r30) ffc08f2c: 80 0b 27 28 lwz r0,10024(r11) ffc08f30: 7f 89 00 40 cmplw cr7,r9,r0 ffc08f34: 41 9c ff a0 blt+ cr7,ffc08ed4 * 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 ) { ffc08f38: 80 1e 00 10 lwz r0,16(r30) ffc08f3c: 2f 80 00 01 cmpwi cr7,r0,1 ffc08f40: 41 9e 01 48 beq- cr7,ffc09088 ffc08f44: 2f 80 00 02 cmpwi cr7,r0,2 schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; break; default: return EINVAL; ffc08f48: 3b e0 00 16 li r31,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 ) { ffc08f4c: 40 9e ff 88 bne+ cr7,ffc08ed4 schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; schedparam = the_attr->schedparam; ffc08f50: 80 de 00 18 lwz r6,24(r30) ffc08f54: 80 fe 00 1c lwz r7,28(r30) ffc08f58: 81 1e 00 20 lwz r8,32(r30) ffc08f5c: 81 5e 00 24 lwz r10,36(r30) ffc08f60: 81 7e 00 28 lwz r11,40(r30) ffc08f64: 81 3e 00 2c lwz r9,44(r30) ffc08f68: 80 1e 00 30 lwz r0,48(r30) schedpolicy = api->schedpolicy; schedparam = api->schedparam; break; case PTHREAD_EXPLICIT_SCHED: schedpolicy = the_attr->schedpolicy; ffc08f6c: 83 5e 00 14 lwz r26,20(r30) schedparam = the_attr->schedparam; ffc08f70: 90 c1 00 20 stw r6,32(r1) ffc08f74: 90 e1 00 24 stw r7,36(r1) ffc08f78: 91 01 00 28 stw r8,40(r1) ffc08f7c: 91 41 00 2c stw r10,44(r1) ffc08f80: 91 61 00 30 stw r11,48(r1) ffc08f84: 91 21 00 34 stw r9,52(r1) ffc08f88: 90 01 00 38 stw r0,56(r1) /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) ffc08f8c: 80 1e 00 0c lwz r0,12(r30) return ENOTSUP; ffc08f90: 3b e0 00 86 li r31,134 /* * Check the contentionscope since rtems only supports PROCESS wide * contention (i.e. no system wide contention). */ if ( the_attr->contentionscope != PTHREAD_SCOPE_PROCESS ) ffc08f94: 2f 80 00 00 cmpwi cr7,r0,0 ffc08f98: 40 9e ff 3c bne+ cr7,ffc08ed4 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc08f9c: 80 61 00 20 lwz r3,32(r1) return EINVAL; ffc08fa0: 3b e0 00 16 li r31,22 return ENOTSUP; /* * Interpret the scheduling parameters. */ if ( !_POSIX_Priority_Is_valid( schedparam.sched_priority ) ) ffc08fa4: 48 00 82 45 bl ffc111e8 <_POSIX_Priority_Is_valid> ffc08fa8: 2f 83 00 00 cmpwi cr7,r3,0 ffc08fac: 41 9e ff 28 beq+ cr7,ffc08ed4 <== NEVER TAKEN return EINVAL; core_priority = _POSIX_Priority_To_core( schedparam.sched_priority ); ffc08fb0: 7c 24 0b 78 mr r4,r1 ffc08fb4: 86 c4 00 20 lwzu r22,32(r4) RTEMS_INLINE_ROUTINE Priority_Control _POSIX_Priority_To_core( int priority ) { return (Priority_Control) (POSIX_SCHEDULER_MAXIMUM_PRIORITY - priority + 1); ffc08fb8: 3d 20 00 00 lis r9,0 /* * Set the core scheduling policy information. */ rc = _POSIX_Thread_Translate_sched_param( ffc08fbc: 7f 43 d3 78 mr r3,r26 ffc08fc0: 8a a9 27 24 lbz r21,10020(r9) ffc08fc4: 38 a1 00 1c addi r5,r1,28 ffc08fc8: 38 c1 00 18 addi r6,r1,24 ffc08fcc: 48 00 82 41 bl ffc1120c <_POSIX_Thread_Translate_sched_param> schedpolicy, &schedparam, &budget_algorithm, &budget_callout ); if ( rc ) ffc08fd0: 7c 7f 1b 79 mr. r31,r3 ffc08fd4: 40 82 ff 00 bne+ ffc08ed4 #endif /* * Lock the allocator mutex for protection */ _RTEMS_Lock_allocator(); ffc08fd8: 3f 00 00 00 lis r24,0 ffc08fdc: 80 78 28 34 lwz r3,10292(r24) * _POSIX_Threads_Allocate */ RTEMS_INLINE_ROUTINE Thread_Control *_POSIX_Threads_Allocate( void ) { return (Thread_Control *) _Objects_Allocate( &_POSIX_Threads_Information ); ffc08fe0: 3e e0 00 00 lis r23,0 ffc08fe4: 3a f7 2e 0c addi r23,r23,11788 ffc08fe8: 48 00 1f f9 bl ffc0afe0 <_API_Mutex_Lock> ffc08fec: 7e e3 bb 78 mr r3,r23 ffc08ff0: 48 00 2c bd bl ffc0bcac <_Objects_Allocate> ffc08ff4: 7e f4 bb 78 mr r20,r23 * Allocate the thread control block. * * NOTE: Global threads are not currently supported. */ the_thread = _POSIX_Threads_Allocate(); if ( !the_thread ) { ffc08ff8: 7c 79 1b 79 mr. r25,r3 ffc08ffc: 41 82 00 70 beq- ffc0906c static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc09000: 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( ffc09004: 80 1e 00 08 lwz r0,8(r30) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc09008: 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( ffc0900c: 93 e1 00 48 stw r31,72(r1) static inline size_t _POSIX_Threads_Ensure_minimum_stack ( size_t size ) { if ( size >= PTHREAD_MINIMUM_STACK_SIZE ) ffc09010: 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( ffc09014: 7f 86 00 40 cmplw cr7,r6,r0 ffc09018: 80 be 00 04 lwz r5,4(r30) ffc0901c: 40 9c 00 08 bge- cr7,ffc09024 ffc09020: 7c 06 03 78 mr r6,r0 ffc09024: 80 01 00 18 lwz r0,24(r1) ffc09028: 7e 83 a3 78 mr r3,r20 ffc0902c: 81 41 00 1c lwz r10,28(r1) ffc09030: 7f 24 cb 78 mr r4,r25 ffc09034: 90 01 00 08 stw r0,8(r1) ffc09038: 38 00 00 00 li r0,0 ffc0903c: 38 e0 00 01 li r7,1 ffc09040: 90 01 00 0c stw r0,12(r1) ffc09044: 7d 16 a8 50 subf r8,r22,r21 ffc09048: 38 01 00 48 addi r0,r1,72 ffc0904c: 39 20 00 01 li r9,1 ffc09050: 90 01 00 10 stw r0,16(r1) ffc09054: 48 00 44 21 bl ffc0d474 <_Thread_Initialize> budget_callout, 0, /* isr level */ name /* posix threads don't have a name */ ); if ( !status ) { ffc09058: 2f 83 00 00 cmpwi cr7,r3,0 ffc0905c: 40 9e 00 78 bne- cr7,ffc090d4 RTEMS_INLINE_ROUTINE void _POSIX_Threads_Free ( Thread_Control *the_pthread ) { _Objects_Free( &_POSIX_Threads_Information, &the_pthread->Object ); ffc09060: 7e e3 bb 78 mr r3,r23 ffc09064: 7f 24 cb 78 mr r4,r25 ffc09068: 48 00 30 41 bl ffc0c0a8 <_Objects_Free> _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); ffc0906c: 80 78 28 34 lwz r3,10292(r24) return EAGAIN; ffc09070: 3b e0 00 0b li r31,11 name /* posix threads don't have a name */ ); if ( !status ) { _POSIX_Threads_Free( the_thread ); _RTEMS_Unlock_allocator(); ffc09074: 48 00 1f ed bl ffc0b060 <_API_Mutex_Unlock> return EAGAIN; ffc09078: 4b ff fe 5c b ffc08ed4 int rc; if ( !start_routine ) return EFAULT; the_attr = (attr) ? attr : &_POSIX_Threads_Default_attributes; ffc0907c: 3f c0 ff c2 lis r30,-62 ffc09080: 3b de 22 68 addi r30,r30,8808 ffc09084: 4b ff fe 40 b ffc08ec4 * PTHREAD_EXPLICIT_SCHED, then scheduling parameters come from the * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc09088: 3d 20 00 00 lis r9,0 ffc0908c: 81 29 31 10 lwz r9,12560(r9) ffc09090: 81 29 01 34 lwz r9,308(r9) schedpolicy = api->schedpolicy; schedparam = api->schedparam; ffc09094: 80 a9 00 88 lwz r5,136(r9) ffc09098: 80 c9 00 8c lwz r6,140(r9) ffc0909c: 80 e9 00 90 lwz r7,144(r9) ffc090a0: 81 09 00 94 lwz r8,148(r9) ffc090a4: 81 49 00 98 lwz r10,152(r9) ffc090a8: 81 69 00 9c lwz r11,156(r9) ffc090ac: 80 09 00 a0 lwz r0,160(r9) * attributes structure. */ switch ( the_attr->inheritsched ) { case PTHREAD_INHERIT_SCHED: api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; schedpolicy = api->schedpolicy; ffc090b0: 83 49 00 84 lwz r26,132(r9) schedparam = api->schedparam; ffc090b4: 90 a1 00 20 stw r5,32(r1) ffc090b8: 90 c1 00 24 stw r6,36(r1) ffc090bc: 90 e1 00 28 stw r7,40(r1) ffc090c0: 91 01 00 2c stw r8,44(r1) ffc090c4: 91 41 00 30 stw r10,48(r1) ffc090c8: 91 61 00 34 stw r11,52(r1) ffc090cc: 90 01 00 38 stw r0,56(r1) break; ffc090d0: 4b ff fe bc b ffc08f8c } /* * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc090d4: 82 f9 01 34 lwz r23,308(r25) api->Attributes = *the_attr; ffc090d8: 7f c4 f3 78 mr r4,r30 ffc090dc: 38 a0 00 40 li r5,64 ffc090e0: 7e e3 bb 78 mr r3,r23 ffc090e4: 48 00 c0 cd bl ffc151b0 api->detachstate = the_attr->detachstate; ffc090e8: 80 1e 00 3c lwz r0,60(r30) api->schedpolicy = schedpolicy; ffc090ec: 93 57 00 84 stw r26,132(r23) api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc090f0: 7f 23 cb 78 mr r3,r25 ffc090f4: 38 80 00 01 li r4,1 * finish initializing the per API structure */ api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; ffc090f8: 90 17 00 40 stw r0,64(r23) api->schedparam = schedparam; /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc090fc: 7f 65 db 78 mr r5,r27 ffc09100: 7f 86 e3 78 mr r6,r28 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; ffc09104: 80 01 00 20 lwz r0,32(r1) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc09108: 38 e0 00 00 li r7,0 api = the_thread->API_Extensions[ THREAD_API_POSIX ]; api->Attributes = *the_attr; api->detachstate = the_attr->detachstate; api->schedpolicy = schedpolicy; api->schedparam = schedparam; ffc0910c: 90 17 00 88 stw r0,136(r23) ffc09110: 80 01 00 24 lwz r0,36(r1) ffc09114: 90 17 00 8c stw r0,140(r23) ffc09118: 80 01 00 28 lwz r0,40(r1) ffc0911c: 90 17 00 90 stw r0,144(r23) ffc09120: 80 01 00 2c lwz r0,44(r1) ffc09124: 90 17 00 94 stw r0,148(r23) ffc09128: 80 01 00 30 lwz r0,48(r1) ffc0912c: 90 17 00 98 stw r0,152(r23) ffc09130: 80 01 00 34 lwz r0,52(r1) ffc09134: 90 17 00 9c stw r0,156(r23) ffc09138: 80 01 00 38 lwz r0,56(r1) ffc0913c: 90 17 00 a0 stw r0,160(r23) /* * POSIX threads are allocated and started in one operation. */ status = _Thread_Start( ffc09140: 48 00 4f 6d bl ffc0e0ac <_Thread_Start> _RTEMS_Unlock_allocator(); return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { ffc09144: 2f 9a 00 04 cmpwi cr7,r26,4 ffc09148: 41 9e 00 18 beq- cr7,ffc09160 } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc0914c: 80 19 00 08 lwz r0,8(r25) _RTEMS_Unlock_allocator(); ffc09150: 80 78 28 34 lwz r3,10292(r24) } /* * Return the id and indicate we successfully created the thread */ *thread = the_thread->Object.id; ffc09154: 90 1d 00 00 stw r0,0(r29) _RTEMS_Unlock_allocator(); ffc09158: 48 00 1f 09 bl ffc0b060 <_API_Mutex_Unlock> return 0; ffc0915c: 4b ff fd 78 b ffc08ed4 return EINVAL; } #endif if ( schedpolicy == SCHED_SPORADIC ) { _Watchdog_Insert_ticks( ffc09160: 38 77 00 90 addi r3,r23,144 ffc09164: 48 00 50 a1 bl ffc0e204 <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc09168: 38 97 00 a8 addi r4,r23,168 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0916c: 90 77 00 b4 stw r3,180(r23) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc09170: 3c 60 00 00 lis r3,0 ffc09174: 38 63 2d 28 addi r3,r3,11560 ffc09178: 48 00 56 35 bl ffc0e7ac <_Watchdog_Insert> ffc0917c: 4b ff ff d0 b ffc0914c =============================================================================== ffc1f284 : int pthread_kill( pthread_t thread, int sig ) { ffc1f284: 94 21 ff d8 stwu r1,-40(r1) ffc1f288: 7c 08 02 a6 mflr r0 ffc1f28c: 93 a1 00 1c stw r29,28(r1) POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) ffc1f290: 7c 9d 23 79 mr. r29,r4 int pthread_kill( pthread_t thread, int sig ) { ffc1f294: 90 01 00 2c stw r0,44(r1) ffc1f298: 93 81 00 18 stw r28,24(r1) ffc1f29c: 93 c1 00 20 stw r30,32(r1) ffc1f2a0: 93 e1 00 24 stw r31,36(r1) POSIX_API_Control *api; Thread_Control *the_thread; Objects_Locations location; if ( !sig ) ffc1f2a4: 41 82 00 b8 beq- ffc1f35c static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc1f2a8: 3b 9d ff ff addi r28,r29,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc1f2ac: 2b 9c 00 1f cmplwi cr7,r28,31 ffc1f2b0: 41 9d 00 ac bgt- cr7,ffc1f35c rtems_set_errno_and_return_minus_one( EINVAL ); the_thread = _Thread_Get( thread, &location ); ffc1f2b4: 38 81 00 08 addi r4,r1,8 ffc1f2b8: 4b fe d1 99 bl ffc0c450 <_Thread_Get> switch ( location ) { ffc1f2bc: 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 ); ffc1f2c0: 7c 7f 1b 78 mr r31,r3 switch ( location ) { ffc1f2c4: 2f 80 00 00 cmpwi cr7,r0,0 ffc1f2c8: 40 9e 00 a8 bne- cr7,ffc1f370 <== NEVER TAKEN api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { ffc1f2cc: 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 ]; ffc1f2d0: 81 23 01 34 lwz r9,308(r3) if ( sig ) { if ( _POSIX_signals_Vectors[ sig ].sa_handler == SIG_IGN ) { ffc1f2d4: 3d 60 00 00 lis r11,0 ffc1f2d8: 39 6b 31 c0 addi r11,r11,12736 ffc1f2dc: 7d 6b 02 14 add r11,r11,r0 ffc1f2e0: 80 0b 00 08 lwz r0,8(r11) ffc1f2e4: 2f 80 00 01 cmpwi cr7,r0,1 ffc1f2e8: 41 9e 00 44 beq- cr7,ffc1f32c return 0; } /* XXX critical section */ api->signals_pending |= signo_to_mask( sig ); ffc1f2ec: 80 09 00 d4 lwz r0,212(r9) static inline sigset_t signo_to_mask( uint32_t sig ) { return 1u << (sig - 1); ffc1f2f0: 3b c0 00 01 li r30,1 ffc1f2f4: 7f dc e0 30 slw r28,r30,r28 ffc1f2f8: 7c 1c e3 78 or r28,r0,r28 ffc1f2fc: 93 89 00 d4 stw r28,212(r9) (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); ffc1f300: 7f a4 eb 78 mr r4,r29 ffc1f304: 38 a0 00 00 li r5,0 ffc1f308: 4b ff fe 11 bl ffc1f118 <_POSIX_signals_Unblock_thread> if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc1f30c: 3d 20 00 00 lis r9,0 ffc1f310: 39 29 31 44 addi r9,r9,12612 ffc1f314: 80 09 00 08 lwz r0,8(r9) ffc1f318: 2f 80 00 00 cmpwi cr7,r0,0 ffc1f31c: 41 9e 00 10 beq- cr7,ffc1f32c ffc1f320: 80 09 00 0c lwz r0,12(r9) ffc1f324: 7f 9f 00 00 cmpw cr7,r31,r0 ffc1f328: 41 9e 00 2c beq- cr7,ffc1f354 _Thread_Dispatch_necessary = true; } _Thread_Enable_dispatch(); ffc1f32c: 4b fe d0 e9 bl ffc0c414 <_Thread_Enable_dispatch> return 0; ffc1f330: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); } ffc1f334: 80 01 00 2c lwz r0,44(r1) ffc1f338: 83 81 00 18 lwz r28,24(r1) ffc1f33c: 7c 08 03 a6 mtlr r0 ffc1f340: 83 a1 00 1c lwz r29,28(r1) ffc1f344: 83 c1 00 20 lwz r30,32(r1) ffc1f348: 83 e1 00 24 lwz r31,36(r1) ffc1f34c: 38 21 00 28 addi r1,r1,40 ffc1f350: 4e 80 00 20 blr api->signals_pending |= signo_to_mask( sig ); (void) _POSIX_signals_Unblock_thread( the_thread, sig, NULL ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; ffc1f354: 9b c9 00 18 stb r30,24(r9) ffc1f358: 4b ff ff d4 b ffc1f32c if ( !sig ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc1f35c: 4b ff 48 99 bl ffc13bf4 <__errno> ffc1f360: 38 00 00 16 li r0,22 ffc1f364: 90 03 00 00 stw r0,0(r3) ffc1f368: 38 60 ff ff li r3,-1 ffc1f36c: 4b ff ff c8 b ffc1f334 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( ESRCH ); ffc1f370: 4b ff 48 85 bl ffc13bf4 <__errno> <== NOT EXECUTED ffc1f374: 38 00 00 03 li r0,3 <== NOT EXECUTED ffc1f378: 90 03 00 00 stw r0,0(r3) <== NOT EXECUTED ffc1f37c: 38 60 ff ff li r3,-1 <== NOT EXECUTED ffc1f380: 4b ff ff b4 b ffc1f334 <== NOT EXECUTED =============================================================================== ffc0b300 : int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0b300: 94 21 ff e0 stwu r1,-32(r1) ffc0b304: 7c 08 02 a6 mflr r0 ffc0b308: 93 c1 00 18 stw r30,24(r1) ffc0b30c: 7c 7e 1b 78 mr r30,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 ); ffc0b310: 7c 83 23 78 mr r3,r4 ffc0b314: 38 81 00 08 addi r4,r1,8 int pthread_mutex_timedlock( pthread_mutex_t *mutex, const struct timespec *abstime ) { ffc0b318: 93 e1 00 1c stw r31,28(r1) ffc0b31c: 90 01 00 24 stw r0,36(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 ); ffc0b320: 48 00 01 25 bl ffc0b444 <_POSIX_Absolute_timeout_to_ticks> ffc0b324: 7c 7f 1b 78 mr r31,r3 if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0b328: 2f 9f 00 03 cmpwi cr7,r31,3 do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); ffc0b32c: 80 a1 00 08 lwz r5,8(r1) ffc0b330: 7f c3 f3 78 mr r3,r30 * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0b334: 41 9e 00 2c beq- cr7,ffc0b360 do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); ffc0b338: 38 80 00 00 li r4,0 ffc0b33c: 4b ff fe 65 bl ffc0b1a0 <_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) ) { ffc0b340: 2f 83 00 10 cmpwi cr7,r3,16 ffc0b344: 41 9e 00 3c beq- cr7,ffc0b380 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } ffc0b348: 80 01 00 24 lwz r0,36(r1) ffc0b34c: 83 c1 00 18 lwz r30,24(r1) ffc0b350: 7c 08 03 a6 mtlr r0 ffc0b354: 83 e1 00 1c lwz r31,28(r1) ffc0b358: 38 21 00 20 addi r1,r1,32 ffc0b35c: 4e 80 00 20 blr */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Mutex_Lock_support( mutex, do_wait, ticks ); ffc0b360: 38 80 00 01 li r4,1 ffc0b364: 4b ff fe 3d bl ffc0b1a0 <_POSIX_Mutex_Lock_support> status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return lock_status; } ffc0b368: 80 01 00 24 lwz r0,36(r1) ffc0b36c: 83 c1 00 18 lwz r30,24(r1) ffc0b370: 7c 08 03 a6 mtlr r0 ffc0b374: 83 e1 00 1c lwz r31,28(r1) ffc0b378: 38 21 00 20 addi r1,r1,32 ffc0b37c: 4e 80 00 20 blr * 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) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) ffc0b380: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0b384: 40 9e 00 0c bne- cr7,ffc0b390 <== ALWAYS TAKEN return EINVAL; ffc0b388: 38 60 00 16 li r3,22 <== NOT EXECUTED ffc0b38c: 4b ff ff bc b ffc0b348 <== NOT EXECUTED if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0b390: 3b ff ff ff addi r31,r31,-1 ffc0b394: 2b 9f 00 01 cmplwi cr7,r31,1 ffc0b398: 41 9d ff b0 bgt+ cr7,ffc0b348 <== NEVER TAKEN status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0b39c: 38 60 00 74 li r3,116 ffc0b3a0: 4b ff ff a8 b ffc0b348 =============================================================================== ffc0972c : int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc0972c: 94 21 ff e0 stwu r1,-32(r1) ffc09730: 7c 08 02 a6 mflr r0 ffc09734: 93 e1 00 1c stw r31,28(r1) if ( !once_control || !init_routine ) ffc09738: 7c 7f 1b 79 mr. r31,r3 return EINVAL; ffc0973c: 38 60 00 16 li r3,22 int pthread_once( pthread_once_t *once_control, void (*init_routine)(void) ) { ffc09740: 93 c1 00 18 stw r30,24(r1) ffc09744: 7c 9e 23 78 mr r30,r4 ffc09748: 90 01 00 24 stw r0,36(r1) if ( !once_control || !init_routine ) ffc0974c: 41 82 00 1c beq- ffc09768 ffc09750: 2f 84 00 00 cmpwi cr7,r4,0 ffc09754: 41 9e 00 14 beq- cr7,ffc09768 return EINVAL; if ( !once_control->init_executed ) { ffc09758: 80 1f 00 04 lwz r0,4(r31) once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; ffc0975c: 38 60 00 00 li r3,0 ) { if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { ffc09760: 2f 80 00 00 cmpwi cr7,r0,0 ffc09764: 41 9e 00 1c beq- cr7,ffc09780 (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; } ffc09768: 80 01 00 24 lwz r0,36(r1) ffc0976c: 83 c1 00 18 lwz r30,24(r1) ffc09770: 7c 08 03 a6 mtlr r0 ffc09774: 83 e1 00 1c lwz r31,28(r1) ffc09778: 38 21 00 20 addi r1,r1,32 ffc0977c: 4e 80 00 20 blr if ( !once_control || !init_routine ) return EINVAL; if ( !once_control->init_executed ) { rtems_mode saveMode; rtems_task_mode(RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &saveMode); ffc09780: 38 60 01 00 li r3,256 ffc09784: 38 80 01 00 li r4,256 ffc09788: 38 a1 00 08 addi r5,r1,8 ffc0978c: 48 00 0e f1 bl ffc0a67c if ( !once_control->init_executed ) { ffc09790: 80 1f 00 04 lwz r0,4(r31) ffc09794: 2f 80 00 00 cmpwi cr7,r0,0 ffc09798: 41 9e 00 30 beq- cr7,ffc097c8 <== ALWAYS TAKEN once_control->is_initialized = true; once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); ffc0979c: 80 61 00 08 lwz r3,8(r1) ffc097a0: 38 a1 00 08 addi r5,r1,8 ffc097a4: 38 80 01 00 li r4,256 ffc097a8: 48 00 0e d5 bl ffc0a67c } return 0; } ffc097ac: 80 01 00 24 lwz r0,36(r1) once_control->init_executed = true; (*init_routine)(); } rtems_task_mode(saveMode, RTEMS_PREEMPT_MASK, &saveMode); } return 0; ffc097b0: 38 60 00 00 li r3,0 } ffc097b4: 83 c1 00 18 lwz r30,24(r1) ffc097b8: 7c 08 03 a6 mtlr r0 ffc097bc: 83 e1 00 1c lwz r31,28(r1) ffc097c0: 38 21 00 20 addi r1,r1,32 ffc097c4: 4e 80 00 20 blr 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; ffc097c8: 38 00 00 01 li r0,1 once_control->init_executed = true; (*init_routine)(); ffc097cc: 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; ffc097d0: 90 1f 00 00 stw r0,0(r31) once_control->init_executed = true; ffc097d4: 90 1f 00 04 stw r0,4(r31) (*init_routine)(); ffc097d8: 4e 80 04 21 bctrl ffc097dc: 4b ff ff c0 b ffc0979c =============================================================================== ffc09f10 : int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc09f10: 94 21 ff d8 stwu r1,-40(r1) ffc09f14: 7c 08 02 a6 mflr r0 ffc09f18: 93 e1 00 24 stw r31,36(r1) const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc09f1c: 7c 7f 1b 79 mr. r31,r3 return EINVAL; ffc09f20: 38 60 00 16 li r3,22 int pthread_rwlock_init( pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr ) { ffc09f24: 90 01 00 2c stw r0,44(r1) ffc09f28: 93 81 00 18 stw r28,24(r1) ffc09f2c: 93 a1 00 1c stw r29,28(r1) ffc09f30: 93 c1 00 20 stw r30,32(r1) const pthread_rwlockattr_t *the_attr; /* * Error check parameters */ if ( !rwlock ) ffc09f34: 41 82 00 1c beq- ffc09f50 return EINVAL; /* * If the user passed in NULL, use the default attributes */ if ( attr ) { ffc09f38: 2f 84 00 00 cmpwi cr7,r4,0 ffc09f3c: 41 9e 00 a0 beq- cr7,ffc09fdc } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc09f40: 80 04 00 00 lwz r0,0(r4) return EINVAL; ffc09f44: 38 60 00 16 li r3,22 } /* * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) ffc09f48: 2f 80 00 00 cmpwi cr7,r0,0 ffc09f4c: 40 9e 00 24 bne- cr7,ffc09f70 <== ALWAYS TAKEN *rwlock = the_rwlock->Object.id; _Thread_Enable_dispatch(); return 0; } ffc09f50: 80 01 00 2c lwz r0,44(r1) ffc09f54: 83 81 00 18 lwz r28,24(r1) ffc09f58: 7c 08 03 a6 mtlr r0 ffc09f5c: 83 a1 00 1c lwz r29,28(r1) ffc09f60: 83 c1 00 20 lwz r30,32(r1) ffc09f64: 83 e1 00 24 lwz r31,36(r1) ffc09f68: 38 21 00 28 addi r1,r1,40 ffc09f6c: 4e 80 00 20 blr * Now start error checking the attributes that we are going to use */ if ( !the_attr->is_initialized ) return EINVAL; switch ( the_attr->process_shared ) { ffc09f70: 83 c4 00 04 lwz r30,4(r4) ffc09f74: 2f 9e 00 00 cmpwi cr7,r30,0 ffc09f78: 40 be ff d8 bne- cr7,ffc09f50 <== NEVER TAKEN * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc09f7c: 3d 20 00 00 lis r9,0 */ RTEMS_INLINE_ROUTINE void _CORE_RWLock_Initialize_attributes( CORE_RWLock_Attributes *the_attributes ) { the_attributes->XXX = 0; ffc09f80: 93 c1 00 08 stw r30,8(r1) ffc09f84: 81 69 28 34 lwz r11,10292(r9) ffc09f88: 38 0b 00 01 addi r0,r11,1 ffc09f8c: 90 09 28 34 stw r0,10292(r9) return _Thread_Dispatch_disable_level; ffc09f90: 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 *) ffc09f94: 3f 80 00 00 lis r28,0 ffc09f98: 3b 9c 2d ec addi r28,r28,11756 ffc09f9c: 7f 83 e3 78 mr r3,r28 ffc09fa0: 48 00 32 81 bl ffc0d220 <_Objects_Allocate> */ _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { ffc09fa4: 7c 7d 1b 79 mr. r29,r3 ffc09fa8: 41 82 00 44 beq- ffc09fec _Thread_Enable_dispatch(); return EAGAIN; } _CORE_RWLock_Initialize( &the_rwlock->RWLock, &the_attributes ); ffc09fac: 38 7d 00 10 addi r3,r29,16 ffc09fb0: 38 81 00 08 addi r4,r1,8 ffc09fb4: 48 00 27 45 bl ffc0c6f8 <_CORE_RWLock_Initialize> uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc09fb8: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc09fbc: 81 7c 00 1c lwz r11,28(r28) ffc09fc0: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc09fc4: 7f ab 49 2e stwx r29,r11,r9 _Objects_Get_index( the_object->id ), the_object ); /* ASSERT: information->is_string == false */ the_object->name.name_u32 = name; ffc09fc8: 93 dd 00 0c stw r30,12(r29) &_POSIX_RWLock_Information, &the_rwlock->Object, 0 ); *rwlock = the_rwlock->Object.id; ffc09fcc: 90 1f 00 00 stw r0,0(r31) _Thread_Enable_dispatch(); ffc09fd0: 48 00 49 0d bl ffc0e8dc <_Thread_Enable_dispatch> return 0; ffc09fd4: 38 60 00 00 li r3,0 ffc09fd8: 4b ff ff 78 b ffc09f50 * If the user passed in NULL, use the default attributes */ if ( attr ) { the_attr = attr; } else { (void) pthread_rwlockattr_init( &default_attr ); ffc09fdc: 38 61 00 0c addi r3,r1,12 ffc09fe0: 48 00 0c 3d bl ffc0ac1c the_attr = &default_attr; ffc09fe4: 38 81 00 0c addi r4,r1,12 ffc09fe8: 4b ff ff 58 b ffc09f40 _Thread_Disable_dispatch(); /* prevents deletion */ the_rwlock = _POSIX_RWLock_Allocate(); if ( !the_rwlock ) { _Thread_Enable_dispatch(); ffc09fec: 48 00 48 f1 bl ffc0e8dc <_Thread_Enable_dispatch> return EAGAIN; ffc09ff0: 38 60 00 0b li r3,11 ffc09ff4: 4b ff ff 5c b ffc09f50 =============================================================================== ffc0a084 : int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a084: 94 21 ff d8 stwu r1,-40(r1) ffc0a088: 7c 08 02 a6 mflr r0 ffc0a08c: 93 81 00 18 stw r28,24(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc0a090: 7c 7c 1b 79 mr. r28,r3 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a094: 7c 83 23 78 mr r3,r4 ffc0a098: 93 e1 00 24 stw r31,36(r1) Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; ffc0a09c: 3b e0 00 16 li r31,22 int pthread_rwlock_timedrdlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a0a0: 90 01 00 2c stw r0,44(r1) ffc0a0a4: 93 a1 00 1c stw r29,28(r1) ffc0a0a8: 93 c1 00 20 stw r30,32(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc0a0ac: 41 82 00 7c beq- ffc0a128 * * 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 ); ffc0a0b0: 38 81 00 08 addi r4,r1,8 ffc0a0b4: 48 00 85 e1 bl ffc12694 <_POSIX_Absolute_timeout_to_ticks> ffc0a0b8: 80 9c 00 00 lwz r4,0(r28) ffc0a0bc: 7c 7e 1b 78 mr r30,r3 ffc0a0c0: 3c 60 00 00 lis r3,0 ffc0a0c4: 38 63 2d ec addi r3,r3,11756 ffc0a0c8: 38 a1 00 0c addi r5,r1,12 ffc0a0cc: 48 00 37 45 bl ffc0d810 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc0a0d0: 80 01 00 0c lwz r0,12(r1) ffc0a0d4: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a0d8: 40 9e 00 50 bne- cr7,ffc0a128 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, ffc0a0dc: 6b dd 00 03 xori r29,r30,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_reading( ffc0a0e0: 80 9c 00 00 lwz r4,0(r28) ffc0a0e4: 7f bd 00 34 cntlzw r29,r29 ffc0a0e8: 80 c1 00 08 lwz r6,8(r1) ffc0a0ec: 57 bd d9 7e rlwinm r29,r29,27,5,31 ffc0a0f0: 38 63 00 10 addi r3,r3,16 ffc0a0f4: 7f a5 eb 78 mr r5,r29 ffc0a0f8: 38 e0 00 00 li r7,0 ffc0a0fc: 48 00 26 3d bl ffc0c738 <_CORE_RWLock_Obtain_for_reading> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc0a100: 48 00 47 dd bl ffc0e8dc <_Thread_Enable_dispatch> if ( !do_wait ) { ffc0a104: 2f 9d 00 00 cmpwi cr7,r29,0 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { ffc0a108: 3d 20 00 00 lis r9,0 ffc0a10c: 81 29 31 30 lwz r9,12592(r9) ffc0a110: 80 69 00 34 lwz r3,52(r9) ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait ) { ffc0a114: 40 9e 00 0c bne- cr7,ffc0a120 if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { ffc0a118: 2f 83 00 02 cmpwi cr7,r3,2 ffc0a11c: 41 9e 00 30 beq- cr7,ffc0a14c status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc0a120: 48 00 01 2d bl ffc0a24c <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc0a124: 7c 7f 1b 78 mr r31,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc0a128: 80 01 00 2c lwz r0,44(r1) ffc0a12c: 7f e3 fb 78 mr r3,r31 ffc0a130: 83 81 00 18 lwz r28,24(r1) ffc0a134: 7c 08 03 a6 mtlr r0 ffc0a138: 83 a1 00 1c lwz r29,28(r1) ffc0a13c: 83 c1 00 20 lwz r30,32(r1) ffc0a140: 83 e1 00 24 lwz r31,36(r1) ffc0a144: 38 21 00 28 addi r1,r1,40 ffc0a148: 4e 80 00 20 blr ); _Thread_Enable_dispatch(); if ( !do_wait ) { if ( _Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) ffc0a14c: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a150: 41 9e ff d8 beq+ cr7,ffc0a128 <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0a154: 3b de ff ff addi r30,r30,-1 ffc0a158: 2b 9e 00 01 cmplwi cr7,r30,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0a15c: 3b e0 00 74 li r31,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 || ffc0a160: 41 9d ff c0 bgt+ cr7,ffc0a120 <== NEVER TAKEN ffc0a164: 4b ff ff c4 b ffc0a128 =============================================================================== ffc0a168 : int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a168: 94 21 ff d8 stwu r1,-40(r1) ffc0a16c: 7c 08 02 a6 mflr r0 ffc0a170: 93 81 00 18 stw r28,24(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc0a174: 7c 7c 1b 79 mr. r28,r3 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a178: 7c 83 23 78 mr r3,r4 ffc0a17c: 93 e1 00 24 stw r31,36(r1) Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) return EINVAL; ffc0a180: 3b e0 00 16 li r31,22 int pthread_rwlock_timedwrlock( pthread_rwlock_t *rwlock, const struct timespec *abstime ) { ffc0a184: 90 01 00 2c stw r0,44(r1) ffc0a188: 93 a1 00 1c stw r29,28(r1) ffc0a18c: 93 c1 00 20 stw r30,32(r1) Objects_Locations location; Watchdog_Interval ticks; bool do_wait = true; POSIX_Absolute_timeout_conversion_results_t status; if ( !rwlock ) ffc0a190: 41 82 00 7c beq- ffc0a20c * * 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 ); ffc0a194: 38 81 00 08 addi r4,r1,8 ffc0a198: 48 00 84 fd bl ffc12694 <_POSIX_Absolute_timeout_to_ticks> ffc0a19c: 80 9c 00 00 lwz r4,0(r28) ffc0a1a0: 7c 7e 1b 78 mr r30,r3 ffc0a1a4: 3c 60 00 00 lis r3,0 ffc0a1a8: 38 63 2d ec addi r3,r3,11756 ffc0a1ac: 38 a1 00 0c addi r5,r1,12 ffc0a1b0: 48 00 36 61 bl ffc0d810 <_Objects_Get> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; the_rwlock = _POSIX_RWLock_Get( rwlock, &location ); switch ( location ) { ffc0a1b4: 80 01 00 0c lwz r0,12(r1) ffc0a1b8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a1bc: 40 9e 00 50 bne- cr7,ffc0a20c (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, ffc0a1c0: 6b dd 00 03 xori r29,r30,3 case OBJECTS_LOCAL: _CORE_RWLock_Obtain_for_writing( ffc0a1c4: 80 9c 00 00 lwz r4,0(r28) ffc0a1c8: 7f bd 00 34 cntlzw r29,r29 ffc0a1cc: 80 c1 00 08 lwz r6,8(r1) ffc0a1d0: 57 bd d9 7e rlwinm r29,r29,27,5,31 ffc0a1d4: 38 63 00 10 addi r3,r3,16 ffc0a1d8: 7f a5 eb 78 mr r5,r29 ffc0a1dc: 38 e0 00 00 li r7,0 ffc0a1e0: 48 00 26 8d bl ffc0c86c <_CORE_RWLock_Obtain_for_writing> do_wait, ticks, NULL ); _Thread_Enable_dispatch(); ffc0a1e4: 48 00 46 f9 bl ffc0e8dc <_Thread_Enable_dispatch> if ( !do_wait && ffc0a1e8: 2f 9d 00 00 cmpwi cr7,r29,0 (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { ffc0a1ec: 3d 20 00 00 lis r9,0 ffc0a1f0: 81 29 31 30 lwz r9,12592(r9) ffc0a1f4: 80 69 00 34 lwz r3,52(r9) ticks, NULL ); _Thread_Enable_dispatch(); if ( !do_wait && ffc0a1f8: 40 9e 00 0c bne- cr7,ffc0a204 ffc0a1fc: 2f 83 00 02 cmpwi cr7,r3,2 ffc0a200: 41 9e 00 30 beq- cr7,ffc0a230 if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; } return _POSIX_RWLock_Translate_core_RWLock_return_code( ffc0a204: 48 00 00 49 bl ffc0a24c <_POSIX_RWLock_Translate_core_RWLock_return_code> ffc0a208: 7c 7f 1b 78 mr r31,r3 case OBJECTS_ERROR: break; } return EINVAL; } ffc0a20c: 80 01 00 2c lwz r0,44(r1) ffc0a210: 7f e3 fb 78 mr r3,r31 ffc0a214: 83 81 00 18 lwz r28,24(r1) ffc0a218: 7c 08 03 a6 mtlr r0 ffc0a21c: 83 a1 00 1c lwz r29,28(r1) ffc0a220: 83 c1 00 20 lwz r30,32(r1) ffc0a224: 83 e1 00 24 lwz r31,36(r1) ffc0a228: 38 21 00 28 addi r1,r1,40 ffc0a22c: 4e 80 00 20 blr ); _Thread_Enable_dispatch(); if ( !do_wait && (_Thread_Executing->Wait.return_code == CORE_RWLOCK_UNAVAILABLE) ) { if ( status == POSIX_ABSOLUTE_TIMEOUT_INVALID ) ffc0a230: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a234: 41 9e ff d8 beq+ cr7,ffc0a20c <== NEVER TAKEN return EINVAL; if ( status == POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST || ffc0a238: 3b de ff ff addi r30,r30,-1 ffc0a23c: 2b 9e 00 01 cmplwi cr7,r30,1 status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) return ETIMEDOUT; ffc0a240: 3b e0 00 74 li r31,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 || ffc0a244: 41 9d ff c0 bgt+ cr7,ffc0a204 <== NEVER TAKEN ffc0a248: 4b ff ff c4 b ffc0a20c =============================================================================== ffc0be9c : int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0be9c: 94 21 ff d0 stwu r1,-48(r1) ffc0bea0: 7c 08 02 a6 mflr r0 ffc0bea4: 93 e1 00 2c stw r31,44(r1) int rc; /* * Check all the parameters */ if ( !param ) ffc0bea8: 7c bf 2b 79 mr. r31,r5 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0beac: 93 81 00 20 stw r28,32(r1) /* * Check all the parameters */ if ( !param ) return EINVAL; ffc0beb0: 3b 80 00 16 li r28,22 int pthread_setschedparam( pthread_t thread, int policy, struct sched_param *param ) { ffc0beb4: 93 a1 00 24 stw r29,36(r1) ffc0beb8: 7c 7d 1b 78 mr r29,r3 ffc0bebc: 93 c1 00 28 stw r30,40(r1) ffc0bec0: 7c 9e 23 78 mr r30,r4 ffc0bec4: 90 01 00 34 stw r0,52(r1) ffc0bec8: 93 61 00 1c stw r27,28(r1) int rc; /* * Check all the parameters */ if ( !param ) ffc0becc: 41 82 00 20 beq- ffc0beec return EINVAL; rc = _POSIX_Thread_Translate_sched_param( ffc0bed0: 7c 83 23 78 mr r3,r4 ffc0bed4: 38 a1 00 10 addi r5,r1,16 ffc0bed8: 7f e4 fb 78 mr r4,r31 ffc0bedc: 38 c1 00 0c addi r6,r1,12 ffc0bee0: 48 00 7a 29 bl ffc13908 <_POSIX_Thread_Translate_sched_param> policy, param, &budget_algorithm, &budget_callout ); if ( rc ) ffc0bee4: 7c 7c 1b 79 mr. r28,r3 ffc0bee8: 41 82 00 2c beq- ffc0bf14 case OBJECTS_ERROR: break; } return ESRCH; } ffc0beec: 80 01 00 34 lwz r0,52(r1) ffc0bef0: 7f 83 e3 78 mr r3,r28 ffc0bef4: 83 61 00 1c lwz r27,28(r1) ffc0bef8: 7c 08 03 a6 mtlr r0 ffc0befc: 83 81 00 20 lwz r28,32(r1) ffc0bf00: 83 a1 00 24 lwz r29,36(r1) ffc0bf04: 83 c1 00 28 lwz r30,40(r1) ffc0bf08: 83 e1 00 2c lwz r31,44(r1) ffc0bf0c: 38 21 00 30 addi r1,r1,48 ffc0bf10: 4e 80 00 20 blr return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); ffc0bf14: 7f a3 eb 78 mr r3,r29 ffc0bf18: 38 81 00 08 addi r4,r1,8 ffc0bf1c: 48 00 3a 61 bl ffc0f97c <_Thread_Get> switch ( location ) { ffc0bf20: 80 01 00 08 lwz r0,8(r1) return rc; /* * Actually change the scheduling policy and parameters */ the_thread = _Thread_Get( thread, &location ); ffc0bf24: 7c 7b 1b 78 mr r27,r3 switch ( location ) { ffc0bf28: 2f 80 00 00 cmpwi cr7,r0,0 ffc0bf2c: 40 9e 00 98 bne- cr7,ffc0bfc4 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc0bf30: 83 a3 01 34 lwz r29,308(r3) if ( api->schedpolicy == SCHED_SPORADIC ) ffc0bf34: 80 1d 00 84 lwz r0,132(r29) ffc0bf38: 2f 80 00 04 cmpwi cr7,r0,4 ffc0bf3c: 41 9e 00 e4 beq- cr7,ffc0c020 (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; ffc0bf40: 93 dd 00 84 stw r30,132(r29) api->schedparam = *param; the_thread->budget_algorithm = budget_algorithm; the_thread->budget_callout = budget_callout; switch ( api->schedpolicy ) { ffc0bf44: 2f 9e 00 00 cmpwi cr7,r30,0 if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; ffc0bf48: 81 5f 00 04 lwz r10,4(r31) ffc0bf4c: 81 7f 00 08 lwz r11,8(r31) ffc0bf50: 81 3f 00 0c lwz r9,12(r31) ffc0bf54: 80 1f 00 00 lwz r0,0(r31) ffc0bf58: 91 5d 00 8c stw r10,140(r29) ffc0bf5c: 90 1d 00 88 stw r0,136(r29) ffc0bf60: 91 7d 00 90 stw r11,144(r29) ffc0bf64: 91 3d 00 94 stw r9,148(r29) ffc0bf68: 81 3f 00 18 lwz r9,24(r31) ffc0bf6c: 81 5f 00 10 lwz r10,16(r31) ffc0bf70: 81 7f 00 14 lwz r11,20(r31) ffc0bf74: 91 3d 00 a0 stw r9,160(r29) the_thread->budget_algorithm = budget_algorithm; ffc0bf78: 81 21 00 10 lwz r9,16(r1) if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); api->schedpolicy = policy; api->schedparam = *param; ffc0bf7c: 91 5d 00 98 stw r10,152(r29) ffc0bf80: 91 7d 00 9c stw r11,156(r29) the_thread->budget_algorithm = budget_algorithm; ffc0bf84: 91 3b 00 7c stw r9,124(r27) the_thread->budget_callout = budget_callout; ffc0bf88: 81 21 00 0c lwz r9,12(r1) ffc0bf8c: 91 3b 00 80 stw r9,128(r27) switch ( api->schedpolicy ) { ffc0bf90: 41 9c 00 2c blt- cr7,ffc0bfbc <== NEVER TAKEN ffc0bf94: 2f 9e 00 02 cmpwi cr7,r30,2 ffc0bf98: 40 9d 00 58 ble- cr7,ffc0bff0 ffc0bf9c: 2f 9e 00 04 cmpwi cr7,r30,4 ffc0bfa0: 40 be 00 1c bne+ cr7,ffc0bfbc <== NEVER TAKEN true ); break; case SCHED_SPORADIC: api->ss_high_priority = api->schedparam.sched_priority; ffc0bfa4: 90 1d 00 a4 stw r0,164(r29) _Watchdog_Remove( &api->Sporadic_timer ); ffc0bfa8: 38 7d 00 a8 addi r3,r29,168 ffc0bfac: 48 00 50 e9 bl ffc11094 <_Watchdog_Remove> _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); ffc0bfb0: 38 60 00 00 li r3,0 ffc0bfb4: 7f 64 db 78 mr r4,r27 ffc0bfb8: 4b ff fd 3d bl ffc0bcf4 <_POSIX_Threads_Sporadic_budget_TSR> break; } _Thread_Enable_dispatch(); ffc0bfbc: 48 00 39 85 bl ffc0f940 <_Thread_Enable_dispatch> return 0; ffc0bfc0: 4b ff ff 2c b ffc0beec case OBJECTS_ERROR: break; } return ESRCH; } ffc0bfc4: 80 01 00 34 lwz r0,52(r1) #endif case OBJECTS_ERROR: break; } return ESRCH; ffc0bfc8: 3b 80 00 03 li r28,3 } ffc0bfcc: 7f 83 e3 78 mr r3,r28 ffc0bfd0: 83 61 00 1c lwz r27,28(r1) ffc0bfd4: 7c 08 03 a6 mtlr r0 ffc0bfd8: 83 81 00 20 lwz r28,32(r1) ffc0bfdc: 83 a1 00 24 lwz r29,36(r1) ffc0bfe0: 83 c1 00 28 lwz r30,40(r1) ffc0bfe4: 83 e1 00 2c lwz r31,44(r1) ffc0bfe8: 38 21 00 30 addi r1,r1,48 ffc0bfec: 4e 80 00 20 blr ffc0bff0: 3d 20 00 00 lis r9,0 ffc0bff4: 88 89 27 64 lbz r4,10084(r9) switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0bff8: 3d 20 00 00 lis r9,0 ffc0bffc: 81 29 28 84 lwz r9,10372(r9) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c000: 7f 63 db 78 mr r3,r27 ffc0c004: 7c 80 20 50 subf r4,r0,r4 switch ( api->schedpolicy ) { case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc0c008: 91 3b 00 78 stw r9,120(r27) the_thread->real_priority = _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c00c: 38 a0 00 01 li r5,1 case SCHED_OTHER: case SCHED_FIFO: case SCHED_RR: the_thread->cpu_time_budget = _Thread_Ticks_per_timeslice; the_thread->real_priority = ffc0c010: 90 9b 00 18 stw r4,24(r27) _POSIX_Priority_To_core( api->schedparam.sched_priority ); _Thread_Change_priority( ffc0c014: 48 00 33 11 bl ffc0f324 <_Thread_Change_priority> _Watchdog_Remove( &api->Sporadic_timer ); _POSIX_Threads_Sporadic_budget_TSR( 0, the_thread ); break; } _Thread_Enable_dispatch(); ffc0c018: 48 00 39 29 bl ffc0f940 <_Thread_Enable_dispatch> ffc0c01c: 4b ff fe d0 b ffc0beec case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_POSIX ]; if ( api->schedpolicy == SCHED_SPORADIC ) (void) _Watchdog_Remove( &api->Sporadic_timer ); ffc0c020: 38 7d 00 a8 addi r3,r29,168 ffc0c024: 48 00 50 71 bl ffc11094 <_Watchdog_Remove> ffc0c028: 4b ff ff 18 b ffc0bf40 =============================================================================== ffc11710 : sigset_t *oset ) { POSIX_API_Control *api; if ( !set && !oset ) ffc11710: 2c 04 00 00 cmpwi r4,0 int pthread_sigmask( int how, const sigset_t *set, sigset_t *oset ) { ffc11714: 94 21 ff f0 stwu r1,-16(r1) ffc11718: 7c 08 02 a6 mflr r0 POSIX_API_Control *api; if ( !set && !oset ) ffc1171c: 2f 85 00 00 cmpwi cr7,r5,0 int pthread_sigmask( int how, const sigset_t *set, sigset_t *oset ) { ffc11720: 90 01 00 14 stw r0,20(r1) POSIX_API_Control *api; if ( !set && !oset ) ffc11724: 41 82 00 c0 beq- ffc117e4 rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc11728: 3d 20 00 00 lis r9,0 ffc1172c: 81 29 31 90 lwz r9,12688(r9) ffc11730: 81 29 01 34 lwz r9,308(r9) if ( oset ) ffc11734: 41 9e 00 10 beq- cr7,ffc11744 *oset = api->signals_blocked; ffc11738: 80 09 00 d0 lwz r0,208(r9) ffc1173c: 90 05 00 00 stw r0,0(r5) if ( !set ) ffc11740: 41 82 00 c0 beq- ffc11800 <== NEVER TAKEN return 0; switch ( how ) { ffc11744: 2f 83 00 01 cmpwi cr7,r3,1 ffc11748: 41 9e 00 88 beq- cr7,ffc117d0 ffc1174c: 2f 83 00 02 cmpwi cr7,r3,2 ffc11750: 41 9e 00 4c beq- cr7,ffc1179c ffc11754: 2f 83 00 00 cmpwi cr7,r3,0 ffc11758: 40 9e 00 58 bne- cr7,ffc117b0 break; case SIG_UNBLOCK: api->signals_blocked &= ~*set; break; case SIG_SETMASK: api->signals_blocked = *set; ffc1175c: 80 04 00 00 lwz r0,0(r4) ffc11760: 90 09 00 d0 stw r0,208(r9) /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending) ) { ffc11764: 3d 60 00 00 lis r11,0 ffc11768: 81 29 00 d4 lwz r9,212(r9) ffc1176c: 81 6b 28 bc lwz r11,10428(r11) _Thread_Dispatch(); } return 0; ffc11770: 38 60 00 00 li r3,0 /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & (api->signals_pending | _POSIX_signals_Pending) ) { ffc11774: 7d 69 4b 78 or r9,r11,r9 /* XXX are there critical section problems here? */ /* XXX evaluate the new set */ if ( ~api->signals_blocked & ffc11778: 7d 2b 00 79 andc. r11,r9,r0 ffc1177c: 41 a2 00 10 beq+ ffc1178c (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); ffc11780: 90 61 00 08 stw r3,8(r1) ffc11784: 4b ff b9 3d bl ffc0d0c0 <_Thread_Dispatch> ffc11788: 80 61 00 08 lwz r3,8(r1) } return 0; } ffc1178c: 80 01 00 14 lwz r0,20(r1) ffc11790: 38 21 00 10 addi r1,r1,16 ffc11794: 7c 08 03 a6 mtlr r0 ffc11798: 4e 80 00 20 blr switch ( how ) { case SIG_BLOCK: api->signals_blocked |= *set; break; case SIG_UNBLOCK: api->signals_blocked &= ~*set; ffc1179c: 81 64 00 00 lwz r11,0(r4) ffc117a0: 80 09 00 d0 lwz r0,208(r9) ffc117a4: 7c 00 58 78 andc r0,r0,r11 ffc117a8: 90 09 00 d0 stw r0,208(r9) break; ffc117ac: 4b ff ff b8 b ffc11764 case SIG_SETMASK: api->signals_blocked = *set; break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc117b0: 48 00 33 69 bl ffc14b18 <__errno> ffc117b4: 38 00 00 16 li r0,22 ffc117b8: 90 03 00 00 stw r0,0(r3) ffc117bc: 38 60 ff ff li r3,-1 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc117c0: 80 01 00 14 lwz r0,20(r1) ffc117c4: 38 21 00 10 addi r1,r1,16 ffc117c8: 7c 08 03 a6 mtlr r0 ffc117cc: 4e 80 00 20 blr if ( !set ) return 0; switch ( how ) { case SIG_BLOCK: api->signals_blocked |= *set; ffc117d0: 80 09 00 d0 lwz r0,208(r9) ffc117d4: 81 64 00 00 lwz r11,0(r4) ffc117d8: 7c 00 5b 78 or r0,r0,r11 ffc117dc: 90 09 00 d0 stw r0,208(r9) break; ffc117e0: 4b ff ff 84 b ffc11764 sigset_t *oset ) { POSIX_API_Control *api; if ( !set && !oset ) ffc117e4: 41 be ff cc beq- cr7,ffc117b0 rtems_set_errno_and_return_minus_one( EINVAL ); api = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc117e8: 3d 20 00 00 lis r9,0 ffc117ec: 81 29 31 90 lwz r9,12688(r9) ffc117f0: 81 29 01 34 lwz r9,308(r9) if ( oset ) *oset = api->signals_blocked; ffc117f4: 80 09 00 d0 lwz r0,208(r9) ffc117f8: 90 05 00 00 stw r0,0(r5) if ( !set ) ffc117fc: 40 82 ff 48 bne+ ffc11744 <== NEVER TAKEN (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc11800: 80 01 00 14 lwz r0,20(r1) if ( oset ) *oset = api->signals_blocked; if ( !set ) return 0; ffc11804: 38 60 00 00 li r3,0 (api->signals_pending | _POSIX_signals_Pending) ) { _Thread_Dispatch(); } return 0; } ffc11808: 38 21 00 10 addi r1,r1,16 ffc1180c: 7c 08 03 a6 mtlr r0 ffc11810: 4e 80 00 20 blr =============================================================================== ffc093d8 : /* * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc093d8: 94 21 ff f0 stwu r1,-16(r1) ffc093dc: 7c 08 02 a6 mflr r0 ffc093e0: 93 e1 00 0c stw r31,12(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() ) ffc093e4: 3f e0 00 00 lis r31,0 ffc093e8: 3b ff 31 04 addi r31,r31,12548 /* * 18.2.2 Setting Cancelability State, P1003.1c/Draft 10, p. 183 */ void pthread_testcancel( void ) { ffc093ec: 90 01 00 14 stw r0,20(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() ) ffc093f0: 80 1f 00 08 lwz r0,8(r31) ffc093f4: 2f 80 00 00 cmpwi cr7,r0,0 ffc093f8: 40 9e 00 48 bne- cr7,ffc09440 <== NEVER TAKEN * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc093fc: 3d 20 00 00 lis r9,0 return; thread_support = _Thread_Executing->API_Extensions[ THREAD_API_POSIX ]; ffc09400: 81 7f 00 0c lwz r11,12(r31) ffc09404: 81 49 28 0c lwz r10,10252(r9) ffc09408: 81 6b 01 34 lwz r11,308(r11) ffc0940c: 38 0a 00 01 addi r0,r10,1 ffc09410: 90 09 28 0c stw r0,10252(r9) return _Thread_Dispatch_disable_level; ffc09414: 80 09 28 0c lwz r0,10252(r9) _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && ffc09418: 80 0b 00 d8 lwz r0,216(r11) ffc0941c: 2f 80 00 00 cmpwi cr7,r0,0 ffc09420: 40 9e 00 34 bne- cr7,ffc09454 <== NEVER TAKEN ffc09424: 80 0b 00 e0 lwz r0,224(r11) ffc09428: 2f 80 00 00 cmpwi cr7,r0,0 ffc0942c: 41 9e 00 28 beq- cr7,ffc09454 thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); ffc09430: 48 00 38 19 bl ffc0cc48 <_Thread_Enable_dispatch> if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); ffc09434: 80 7f 00 0c lwz r3,12(r31) ffc09438: 38 80 ff ff li r4,-1 ffc0943c: 48 00 78 e1 bl ffc10d1c <_POSIX_Thread_Exit> } ffc09440: 80 01 00 14 lwz r0,20(r1) <== NOT EXECUTED ffc09444: 83 e1 00 0c lwz r31,12(r1) <== NOT EXECUTED ffc09448: 38 21 00 10 addi r1,r1,16 <== NOT EXECUTED ffc0944c: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc09450: 4e 80 00 20 blr <== NOT EXECUTED _Thread_Disable_dispatch(); if ( thread_support->cancelability_state == PTHREAD_CANCEL_ENABLE && thread_support->cancelation_requested ) cancel = true; _Thread_Enable_dispatch(); ffc09454: 48 00 37 f5 bl ffc0cc48 <_Thread_Enable_dispatch> if ( cancel ) _POSIX_Thread_Exit( _Thread_Executing, PTHREAD_CANCELED ); } ffc09458: 80 01 00 14 lwz r0,20(r1) ffc0945c: 83 e1 00 0c lwz r31,12(r1) ffc09460: 38 21 00 10 addi r1,r1,16 ffc09464: 7c 08 03 a6 mtlr r0 ffc09468: 4e 80 00 20 blr =============================================================================== ffc0a24c : * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a24c: 94 21 ff b0 stwu r1,-80(r1) ffc0a250: 7c 08 02 a6 mflr r0 ffc0a254: 93 e1 00 4c stw r31,76(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); ffc0a258: 3f e0 00 00 lis r31,0 ffc0a25c: 3b ff 2c 70 addi r31,r31,11376 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a260: 93 a1 00 44 stw r29,68(r1) ffc0a264: 7c 7d 1b 78 mr r29,r3 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); ffc0a268: 7f e3 fb 78 mr r3,r31 * errno - otherwise */ int rtems_aio_enqueue (rtems_aio_request *req) { ffc0a26c: 93 c1 00 48 stw r30,72(r1) ffc0a270: 90 01 00 54 stw r0,84(r1) ffc0a274: 93 61 00 3c stw r27,60(r1) ffc0a278: 93 81 00 40 stw r28,64(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); ffc0a27c: 48 00 0c 0d bl ffc0ae88 if (result != 0) { ffc0a280: 7c 7e 1b 79 mr. r30,r3 ffc0a284: 40 82 00 d4 bne- ffc0a358 <== NEVER TAKEN return result; } /* _POSIX_PRIORITIZED_IO and _POSIX_PRIORITY_SCHEDULING are defined, we can use aio_reqprio to lower the priority of the request */ pthread_getschedparam (pthread_self(), &policy, ¶m); ffc0a288: 48 00 17 61 bl ffc0b9e8 ffc0a28c: 38 81 00 08 addi r4,r1,8 ffc0a290: 38 a1 00 10 addi r5,r1,16 ffc0a294: 48 00 11 91 bl ffc0b424 req->caller_thread = pthread_self (); ffc0a298: 48 00 17 51 bl ffc0b9e8 req->priority = param.sched_priority - req->aiocbp->aio_reqprio; req->policy = policy; req->aiocbp->error_code = EINPROGRESS; req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && ffc0a29c: 80 1f 00 68 lwz r0,104(r31) /* _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; ffc0a2a0: 81 3d 00 14 lwz r9,20(r29) req->policy = policy; req->aiocbp->error_code = EINPROGRESS; req->aiocbp->return_value = 0; if ((aio_request_queue.idle_threads == 0) && ffc0a2a4: 2f 80 00 00 cmpwi cr7,r0,0 /* _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; ffc0a2a8: 81 61 00 10 lwz r11,16(r1) ffc0a2ac: 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 (); ffc0a2b0: 90 7d 00 10 stw r3,16(r29) req->priority = param.sched_priority - req->aiocbp->aio_reqprio; ffc0a2b4: 7c 00 58 50 subf r0,r0,r11 ffc0a2b8: 90 1d 00 0c stw r0,12(r29) req->policy = policy; ffc0a2bc: 80 01 00 08 lwz r0,8(r1) ffc0a2c0: 90 1d 00 08 stw r0,8(r29) req->aiocbp->error_code = EINPROGRESS; ffc0a2c4: 38 00 00 77 li r0,119 ffc0a2c8: 90 09 00 34 stw r0,52(r9) req->aiocbp->return_value = 0; ffc0a2cc: 93 c9 00 38 stw r30,56(r9) if ((aio_request_queue.idle_threads == 0) && ffc0a2d0: 40 9e 00 10 bne- cr7,ffc0a2e0 <== NEVER TAKEN ffc0a2d4: 80 1f 00 64 lwz r0,100(r31) ffc0a2d8: 2f 80 00 04 cmpwi cr7,r0,4 ffc0a2dc: 40 9d 00 ac ble- cr7,ffc0a388 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, ffc0a2e0: 3f 60 00 00 lis r27,0 ffc0a2e4: 80 89 00 00 lwz r4,0(r9) ffc0a2e8: 3b 7b 2c b8 addi r27,r27,11448 ffc0a2ec: 7f 63 db 78 mr r3,r27 ffc0a2f0: 38 a0 00 00 li r5,0 ffc0a2f4: 4b ff f9 49 bl ffc09c3c req->aiocbp->aio_fildes, 0); if (r_chain != NULL) ffc0a2f8: 7c 7c 1b 79 mr. r28,r3 ffc0a2fc: 41 82 01 04 beq- ffc0a400 { pthread_mutex_lock (&r_chain->mutex); ffc0a300: 3b 7c 00 1c addi r27,r28,28 ffc0a304: 7f 63 db 78 mr r3,r27 ffc0a308: 48 00 0b 81 bl ffc0ae88 rtems_aio_insert_prio (&r_chain->perfd, req); ffc0a30c: 38 7c 00 08 addi r3,r28,8 ffc0a310: 7f a4 eb 78 mr r4,r29 ffc0a314: 4b ff fd a9 bl ffc0a0bc pthread_cond_signal (&r_chain->cond); ffc0a318: 38 7c 00 20 addi r3,r28,32 ffc0a31c: 48 00 05 6d bl ffc0a888 pthread_mutex_unlock (&r_chain->mutex); ffc0a320: 7f 63 db 78 mr r3,r27 ffc0a324: 48 00 0c 31 bl ffc0af54 if (aio_request_queue.idle_threads > 0) pthread_cond_signal (&aio_request_queue.new_req); } } pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a328: 7f e3 fb 78 mr r3,r31 ffc0a32c: 48 00 0c 29 bl ffc0af54 return 0; } ffc0a330: 80 01 00 54 lwz r0,84(r1) ffc0a334: 7f c3 f3 78 mr r3,r30 ffc0a338: 83 61 00 3c lwz r27,60(r1) ffc0a33c: 7c 08 03 a6 mtlr r0 ffc0a340: 83 81 00 40 lwz r28,64(r1) ffc0a344: 83 a1 00 44 lwz r29,68(r1) ffc0a348: 83 c1 00 48 lwz r30,72(r1) ffc0a34c: 83 e1 00 4c lwz r31,76(r1) ffc0a350: 38 21 00 50 addi r1,r1,80 ffc0a354: 4e 80 00 20 blr /* The queue should be initialized */ AIO_assert (aio_request_queue.initialized == AIO_QUEUE_INITIALIZED); result = pthread_mutex_lock (&aio_request_queue.mutex); if (result != 0) { free (req); ffc0a358: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc0a35c: 4b ff b6 19 bl ffc05974 <== NOT EXECUTED } } pthread_mutex_unlock (&aio_request_queue.mutex); return 0; } ffc0a360: 80 01 00 54 lwz r0,84(r1) <== NOT EXECUTED ffc0a364: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc0a368: 83 61 00 3c lwz r27,60(r1) <== NOT EXECUTED ffc0a36c: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0a370: 83 81 00 40 lwz r28,64(r1) <== NOT EXECUTED ffc0a374: 83 a1 00 44 lwz r29,68(r1) <== NOT EXECUTED ffc0a378: 83 c1 00 48 lwz r30,72(r1) <== NOT EXECUTED ffc0a37c: 83 e1 00 4c lwz r31,76(r1) <== NOT EXECUTED ffc0a380: 38 21 00 50 addi r1,r1,80 <== NOT EXECUTED ffc0a384: 4e 80 00 20 blr <== NOT EXECUTED if ((aio_request_queue.idle_threads == 0) && aio_request_queue.active_threads < AIO_MAX_THREADS) /* we still have empty places on the active_threads chain */ { chain = &aio_request_queue.work_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); ffc0a388: 80 89 00 00 lwz r4,0(r9) ffc0a38c: 38 7f 00 48 addi r3,r31,72 ffc0a390: 38 a0 00 01 li r5,1 ffc0a394: 4b ff f8 a9 bl ffc09c3c if (r_chain->new_fd == 1) { ffc0a398: 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); ffc0a39c: 7c 7c 1b 78 mr r28,r3 if (r_chain->new_fd == 1) { ffc0a3a0: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a3a4: 40 9e ff 5c bne+ cr7,ffc0a300 RTEMS_INLINE_ROUTINE void _Chain_Prepend( Chain_Control *the_chain, Chain_Node *the_node ) { _Chain_Insert(_Chain_Head(the_chain), the_node); ffc0a3a8: 7f a4 eb 78 mr r4,r29 ffc0a3ac: 38 63 00 08 addi r3,r3,8 ffc0a3b0: 48 00 2d a9 bl ffc0d158 <_Chain_Insert> rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; ffc0a3b4: 93 dc 00 18 stw r30,24(r28) pthread_mutex_init (&r_chain->mutex, NULL); ffc0a3b8: 38 80 00 00 li r4,0 ffc0a3bc: 38 7c 00 1c addi r3,r28,28 ffc0a3c0: 48 00 09 41 bl ffc0ad00 pthread_cond_init (&r_chain->cond, NULL); ffc0a3c4: 38 80 00 00 li r4,0 ffc0a3c8: 38 7c 00 20 addi r3,r28,32 ffc0a3cc: 48 00 03 c9 bl ffc0a794 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, ffc0a3d0: 3c a0 ff c1 lis r5,-63 ffc0a3d4: 38 61 00 0c addi r3,r1,12 ffc0a3d8: 38 9f 00 08 addi r4,r31,8 ffc0a3dc: 38 a5 9e 08 addi r5,r5,-25080 ffc0a3e0: 7f 86 e3 78 mr r6,r28 ffc0a3e4: 48 00 0d 29 bl ffc0b10c rtems_aio_handle, (void *) r_chain); if (result != 0) { ffc0a3e8: 7c 7d 1b 79 mr. r29,r3 ffc0a3ec: 40 82 00 80 bne- ffc0a46c <== NEVER TAKEN pthread_mutex_unlock (&aio_request_queue.mutex); return result; } ++aio_request_queue.active_threads; ffc0a3f0: 81 3f 00 64 lwz r9,100(r31) ffc0a3f4: 38 09 00 01 addi r0,r9,1 ffc0a3f8: 90 1f 00 64 stw r0,100(r31) ffc0a3fc: 4b ff ff 2c b ffc0a328 } else { /* or to the idle chain */ chain = &aio_request_queue.idle_req; r_chain = rtems_aio_search_fd (chain, req->aiocbp->aio_fildes, 1); ffc0a400: 81 3d 00 14 lwz r9,20(r29) ffc0a404: 38 7b 00 0c addi r3,r27,12 ffc0a408: 38 a0 00 01 li r5,1 ffc0a40c: 80 89 00 00 lwz r4,0(r9) ffc0a410: 4b ff f8 2d bl ffc09c3c ffc0a414: 7f a4 eb 78 mr r4,r29 if (r_chain->new_fd == 1) { ffc0a418: 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); ffc0a41c: 7c 7b 1b 78 mr r27,r3 ffc0a420: 38 63 00 08 addi r3,r3,8 if (r_chain->new_fd == 1) { ffc0a424: 2f 80 00 01 cmpwi cr7,r0,1 ffc0a428: 41 9e 00 20 beq- cr7,ffc0a448 r_chain->new_fd = 0; pthread_mutex_init (&r_chain->mutex, NULL); pthread_cond_init (&r_chain->cond, NULL); } else /* just insert the request in the existing fd chain */ rtems_aio_insert_prio (&r_chain->perfd, req); ffc0a42c: 4b ff fc 91 bl ffc0a0bc if (aio_request_queue.idle_threads > 0) ffc0a430: 80 1f 00 68 lwz r0,104(r31) ffc0a434: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a438: 40 bd fe f0 ble- cr7,ffc0a328 <== ALWAYS TAKEN pthread_cond_signal (&aio_request_queue.new_req); ffc0a43c: 38 7f 00 04 addi r3,r31,4 <== NOT EXECUTED ffc0a440: 48 00 04 49 bl ffc0a888 <== NOT EXECUTED ffc0a444: 4b ff fe e4 b ffc0a328 <== NOT EXECUTED ffc0a448: 48 00 2d 11 bl ffc0d158 <_Chain_Insert> if (r_chain->new_fd == 1) { /* If this is a new fd chain we signal the idle threads that might be waiting for requests */ AIO_printf (" New chain on waiting queue \n "); rtems_chain_prepend (&r_chain->perfd, &req->next_prio); r_chain->new_fd = 0; ffc0a44c: 93 9b 00 18 stw r28,24(r27) pthread_mutex_init (&r_chain->mutex, NULL); ffc0a450: 38 7b 00 1c addi r3,r27,28 ffc0a454: 38 80 00 00 li r4,0 ffc0a458: 48 00 08 a9 bl ffc0ad00 pthread_cond_init (&r_chain->cond, NULL); ffc0a45c: 38 7b 00 20 addi r3,r27,32 ffc0a460: 38 80 00 00 li r4,0 ffc0a464: 48 00 03 31 bl ffc0a794 ffc0a468: 4b ff ff c8 b ffc0a430 AIO_printf ("New thread \n"); result = pthread_create (&thid, &aio_request_queue.attr, rtems_aio_handle, (void *) r_chain); if (result != 0) { pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a46c: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc0a470: 48 00 0a e5 bl ffc0af54 <== NOT EXECUTED return result; ffc0a474: 7f be eb 78 mr r30,r29 <== NOT EXECUTED ffc0a478: 4b ff fe b8 b ffc0a330 <== NOT EXECUTED =============================================================================== ffc09e08 : * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e08: 94 21 ff a0 stwu r1,-96(r1) ffc09e0c: 7c 08 02 a6 mflr r0 ffc09e10: 93 41 00 48 stw r26,72(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); ffc09e14: 3f 40 00 00 lis r26,0 ffc09e18: 3b 5a 2c 70 addi r26,r26,11376 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e1c: 90 01 00 64 stw r0,100(r1) ffc09e20: 92 c1 00 38 stw r22,56(r1) ffc09e24: 93 e1 00 5c stw r31,92(r1) ffc09e28: 92 e1 00 3c stw r23,60(r1) --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, ffc09e2c: 3a fa 00 04 addi r23,r26,4 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e30: 93 01 00 40 stw r24,64(r1) 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)) { ffc09e34: 3b 1a 00 58 addi r24,r26,88 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e38: 93 21 00 44 stw r25,68(r1) default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; ffc09e3c: 3b 20 ff ff li r25,-1 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e40: 93 61 00 4c stw r27,76(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); ffc09e44: 7f 5b d3 78 mr r27,r26 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e48: 93 81 00 50 stw r28,80(r1) if (result == -1) { req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; req->aiocbp->error_code = 0; ffc09e4c: 3b 80 00 00 li r28,0 * NULL - if error */ static void * rtems_aio_handle (void *arg) { ffc09e50: 93 a1 00 54 stw r29,84(r1) ffc09e54: 3b a3 00 1c addi r29,r3,28 ffc09e58: 93 c1 00 58 stw r30,88(r1) ffc09e5c: 7c 7e 1b 78 mr r30,r3 /* 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); ffc09e60: 7f a3 eb 78 mr r3,r29 ffc09e64: 48 00 10 25 bl ffc0ae88 if (result != 0) ffc09e68: 7c 76 1b 79 mr. r22,r3 ffc09e6c: 40 82 00 8c bne- ffc09ef8 <== NEVER TAKEN */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc09e70: 83 fe 00 08 lwz r31,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 ); ffc09e74: 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)) { ffc09e78: 7f 9f 00 00 cmpw cr7,r31,r0 ffc09e7c: 41 9e 01 10 beq- cr7,ffc09f8c 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); ffc09e80: 48 00 1b 69 bl ffc0b9e8 ffc09e84: 38 81 00 08 addi r4,r1,8 ffc09e88: 38 a1 00 14 addi r5,r1,20 ffc09e8c: 48 00 15 99 bl ffc0b424 param.sched_priority = req->priority; ffc09e90: 80 1f 00 0c lwz r0,12(r31) ffc09e94: 90 01 00 14 stw r0,20(r1) pthread_setschedparam (pthread_self(), req->policy, ¶m); ffc09e98: 48 00 1b 51 bl ffc0b9e8 ffc09e9c: 38 a1 00 14 addi r5,r1,20 ffc09ea0: 80 9f 00 08 lwz r4,8(r31) ffc09ea4: 48 00 1b 55 bl ffc0b9f8 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc09ea8: 7f e3 fb 78 mr r3,r31 ffc09eac: 48 00 32 45 bl ffc0d0f0 <_Chain_Extract> rtems_chain_extract (node); pthread_mutex_unlock (&r_chain->mutex); ffc09eb0: 7f a3 eb 78 mr r3,r29 ffc09eb4: 48 00 10 a1 bl ffc0af54 switch (req->aiocbp->aio_lio_opcode) { ffc09eb8: 82 df 00 14 lwz r22,20(r31) ffc09ebc: 80 16 00 30 lwz r0,48(r22) ffc09ec0: 2f 80 00 02 cmpwi cr7,r0,2 ffc09ec4: 41 9e 00 ac beq- cr7,ffc09f70 ffc09ec8: 2f 80 00 03 cmpwi cr7,r0,3 ffc09ecc: 41 9e 00 98 beq- cr7,ffc09f64 <== NEVER TAKEN ffc09ed0: 2f 80 00 01 cmpwi cr7,r0,1 ffc09ed4: 41 9e 00 60 beq- cr7,ffc09f34 <== ALWAYS TAKEN default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; ffc09ed8: 93 36 00 38 stw r25,56(r22) <== NOT EXECUTED req->aiocbp->error_code = errno; ffc09edc: 48 00 cc 55 bl ffc16b30 <__errno> <== NOT EXECUTED ffc09ee0: 80 03 00 00 lwz r0,0(r3) <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); ffc09ee4: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED default: result = -1; } if (result == -1) { req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; ffc09ee8: 90 16 00 34 stw r0,52(r22) <== NOT EXECUTED /* acquire the mutex of the current fd chain. we don't need to lock the queue mutex since we can add requests to idle fd chains or even active ones if the working request has been extracted from the chain */ result = pthread_mutex_lock (&r_chain->mutex); ffc09eec: 48 00 0f 9d bl ffc0ae88 <== NOT EXECUTED if (result != 0) ffc09ef0: 7c 76 1b 79 mr. r22,r3 <== NOT EXECUTED ffc09ef4: 41 82 ff 7c beq+ ffc09e70 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } ffc09ef8: 80 01 00 64 lwz r0,100(r1) ffc09efc: 38 60 00 00 li r3,0 ffc09f00: 82 c1 00 38 lwz r22,56(r1) ffc09f04: 7c 08 03 a6 mtlr r0 ffc09f08: 82 e1 00 3c lwz r23,60(r1) ffc09f0c: 83 01 00 40 lwz r24,64(r1) ffc09f10: 83 21 00 44 lwz r25,68(r1) ffc09f14: 83 41 00 48 lwz r26,72(r1) ffc09f18: 83 61 00 4c lwz r27,76(r1) ffc09f1c: 83 81 00 50 lwz r28,80(r1) ffc09f20: 83 a1 00 54 lwz r29,84(r1) ffc09f24: 83 c1 00 58 lwz r30,88(r1) ffc09f28: 83 e1 00 5c lwz r31,92(r1) ffc09f2c: 38 21 00 60 addi r1,r1,96 ffc09f30: 4e 80 00 20 blr pthread_mutex_unlock (&r_chain->mutex); switch (req->aiocbp->aio_lio_opcode) { case LIO_READ: AIO_printf ("read\n"); result = pread (req->aiocbp->aio_fildes, ffc09f34: 80 76 00 00 lwz r3,0(r22) ffc09f38: 80 96 00 10 lwz r4,16(r22) ffc09f3c: 80 b6 00 14 lwz r5,20(r22) ffc09f40: 80 f6 00 08 lwz r7,8(r22) ffc09f44: 81 16 00 0c lwz r8,12(r22) ffc09f48: 48 00 db 1d bl ffc17a64 break; default: result = -1; } if (result == -1) { ffc09f4c: 2f 83 ff ff cmpwi cr7,r3,-1 ffc09f50: 41 9e 01 4c beq- cr7,ffc0a09c <== NEVER TAKEN req->aiocbp->return_value = -1; req->aiocbp->error_code = errno; } else { req->aiocbp->return_value = result; ffc09f54: 81 3f 00 14 lwz r9,20(r31) ffc09f58: 90 69 00 38 stw r3,56(r9) req->aiocbp->error_code = 0; ffc09f5c: 93 89 00 34 stw r28,52(r9) ffc09f60: 4b ff ff 00 b ffc09e60 req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_SYNC: AIO_printf ("sync\n"); result = fsync (req->aiocbp->aio_fildes); ffc09f64: 80 76 00 00 lwz r3,0(r22) <== NOT EXECUTED ffc09f68: 48 00 8a e1 bl ffc12a48 <== NOT EXECUTED break; ffc09f6c: 4b ff ff e0 b ffc09f4c <== NOT EXECUTED req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; case LIO_WRITE: AIO_printf ("write\n"); result = pwrite (req->aiocbp->aio_fildes, ffc09f70: 80 76 00 00 lwz r3,0(r22) ffc09f74: 80 96 00 10 lwz r4,16(r22) ffc09f78: 80 b6 00 14 lwz r5,20(r22) ffc09f7c: 80 f6 00 08 lwz r7,8(r22) ffc09f80: 81 16 00 0c lwz r8,12(r22) ffc09f84: 48 00 dc 1d bl ffc17ba0 (void *) req->aiocbp->aio_buf, req->aiocbp->aio_nbytes, req->aiocbp->aio_offset); break; ffc09f88: 4b ff ff c4 b ffc09f4c struct timespec timeout; AIO_printf ("Chain is empty [WQ], wait for work\n"); pthread_mutex_unlock (&r_chain->mutex); ffc09f8c: 7f a3 eb 78 mr r3,r29 ffc09f90: 48 00 0f c5 bl ffc0af54 pthread_mutex_lock (&aio_request_queue.mutex); ffc09f94: 7f 63 db 78 mr r3,r27 ffc09f98: 48 00 0e f1 bl ffc0ae88 if (rtems_chain_is_empty (chain)) ffc09f9c: 80 1e 00 08 lwz r0,8(r30) ffc09fa0: 7f 9f 00 00 cmpw cr7,r31,r0 ffc09fa4: 41 9e 00 10 beq- cr7,ffc09fb4 <== ALWAYS TAKEN } } /* 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); ffc09fa8: 7f 63 db 78 mr r3,r27 ffc09fac: 48 00 0f a9 bl ffc0af54 ffc09fb0: 4b ff fe b0 b ffc09e60 pthread_mutex_unlock (&r_chain->mutex); pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); ffc09fb4: 38 81 00 0c addi r4,r1,12 ffc09fb8: 38 60 00 01 li r3,1 ffc09fbc: 48 00 06 29 bl ffc0a5e4 timeout.tv_sec += 3; ffc09fc0: 81 21 00 0c lwz r9,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc09fc4: 3b fe 00 20 addi r31,r30,32 if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; ffc09fc8: 92 c1 00 10 stw r22,16(r1) pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; ffc09fcc: 38 09 00 03 addi r0,r9,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc09fd0: 7f e3 fb 78 mr r3,r31 pthread_mutex_lock (&aio_request_queue.mutex); if (rtems_chain_is_empty (chain)) { clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; ffc09fd4: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&r_chain->cond, ffc09fd8: 7f 64 db 78 mr r4,r27 ffc09fdc: 38 a1 00 0c addi r5,r1,12 ffc09fe0: 48 00 09 85 bl ffc0a964 &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) { ffc09fe4: 2f 83 00 74 cmpwi cr7,r3,116 ffc09fe8: 40 9e ff c0 bne+ cr7,ffc09fa8 <== NEVER TAKEN ffc09fec: 7f c3 f3 78 mr r3,r30 ffc09ff0: 48 00 31 01 bl ffc0d0f0 <_Chain_Extract> rtems_chain_extract (&r_chain->next_fd); pthread_mutex_destroy (&r_chain->mutex); ffc09ff4: 7f a3 eb 78 mr r3,r29 ffc09ff8: 48 00 0b 45 bl ffc0ab3c pthread_cond_destroy (&r_chain->cond); ffc09ffc: 7f e3 fb 78 mr r3,r31 ffc0a000: 48 00 06 85 bl ffc0a684 free (r_chain); ffc0a004: 7f c3 f3 78 mr r3,r30 ffc0a008: 4b ff b9 6d bl ffc05974 */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0a00c: 83 db 00 54 lwz r30,84(r27) /* 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)) { ffc0a010: 7f 9e c0 00 cmpw cr7,r30,r24 ffc0a014: 41 9e 00 34 beq- cr7,ffc0a048 } } /* 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; ffc0a018: 81 3a 00 68 lwz r9,104(r26) ffc0a01c: 7f c3 f3 78 mr r3,r30 ++aio_request_queue.active_threads; ffc0a020: 81 7a 00 64 lwz r11,100(r26) ffc0a024: 3b be 00 1c addi r29,r30,28 } } /* 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; ffc0a028: 39 29 ff ff addi r9,r9,-1 ++aio_request_queue.active_threads; ffc0a02c: 38 0b 00 01 addi r0,r11,1 } } /* 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; ffc0a030: 91 3a 00 68 stw r9,104(r26) ++aio_request_queue.active_threads; ffc0a034: 90 1a 00 64 stw r0,100(r26) ffc0a038: 48 00 30 b9 bl ffc0d0f0 <_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); ffc0a03c: 7f c3 f3 78 mr r3,r30 ffc0a040: 4b ff fd 39 bl ffc09d78 ffc0a044: 4b ff ff 64 b ffc09fa8 /* 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; ffc0a048: 81 3b 00 68 lwz r9,104(r27) --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); ffc0a04c: 38 81 00 0c addi r4,r1,12 signal. The thread now becomes idle. */ if (rtems_chain_is_empty (&aio_request_queue.idle_req)) { AIO_printf ("Chain is empty [IQ], wait for work\n"); ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; ffc0a050: 80 1b 00 64 lwz r0,100(r27) clock_gettime (CLOCK_REALTIME, &timeout); ffc0a054: 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; ffc0a058: 39 29 00 01 addi r9,r9,1 --aio_request_queue.active_threads; ffc0a05c: 30 00 ff ff addic r0,r0,-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; ffc0a060: 91 3b 00 68 stw r9,104(r27) --aio_request_queue.active_threads; ffc0a064: 90 1b 00 64 stw r0,100(r27) clock_gettime (CLOCK_REALTIME, &timeout); ffc0a068: 48 00 05 7d bl ffc0a5e4 timeout.tv_sec += 3; ffc0a06c: 80 01 00 0c lwz r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a070: 7e e3 bb 78 mr r3,r23 ++aio_request_queue.idle_threads; --aio_request_queue.active_threads; clock_gettime (CLOCK_REALTIME, &timeout); timeout.tv_sec += 3; timeout.tv_nsec = 0; ffc0a074: 92 c1 00 10 stw r22,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; ffc0a078: 30 00 00 03 addic r0,r0,3 timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a07c: 7f 64 db 78 mr r4,r27 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; ffc0a080: 90 01 00 0c stw r0,12(r1) timeout.tv_nsec = 0; result = pthread_cond_timedwait (&aio_request_queue.new_req, ffc0a084: 38 a1 00 0c addi r5,r1,12 ffc0a088: 48 00 08 dd bl ffc0a964 &aio_request_queue.mutex, &timeout); /* If no new fd chain was added in the idle requests then this thread is finished */ if (result == ETIMEDOUT) { ffc0a08c: 2f 83 00 74 cmpwi cr7,r3,116 ffc0a090: 41 9e 00 14 beq- cr7,ffc0a0a4 <== ALWAYS TAKEN ffc0a094: 83 db 00 54 lwz r30,84(r27) <== NOT EXECUTED ffc0a098: 4b ff ff 80 b ffc0a018 <== NOT EXECUTED break; default: result = -1; } if (result == -1) { ffc0a09c: 82 df 00 14 lwz r22,20(r31) <== NOT EXECUTED ffc0a0a0: 4b ff fe 38 b ffc09ed8 <== NOT EXECUTED /* 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; ffc0a0a4: 80 1b 00 68 lwz r0,104(r27) pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a0a8: 7f 63 db 78 mr r3,r27 /* 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; ffc0a0ac: 30 00 ff ff addic r0,r0,-1 ffc0a0b0: 90 1b 00 68 stw r0,104(r27) pthread_mutex_unlock (&aio_request_queue.mutex); ffc0a0b4: 48 00 0e a1 bl ffc0af54 return NULL; ffc0a0b8: 4b ff fe 40 b ffc09ef8 =============================================================================== ffc09af0 : * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc09af0: 94 21 ff e8 stwu r1,-24(r1) ffc09af4: 7c 08 02 a6 mflr r0 ffc09af8: 93 c1 00 10 stw r30,16(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc09afc: 3f c0 00 00 lis r30,0 ffc09b00: 3b de 2c 78 addi r30,r30,11384 ffc09b04: 7f c3 f3 78 mr r3,r30 * 0 - if initialization succeeded */ int rtems_aio_init (void) { ffc09b08: 93 a1 00 0c stw r29,12(r1) ffc09b0c: 90 01 00 1c stw r0,28(r1) ffc09b10: 93 e1 00 14 stw r31,20(r1) int result = 0; result = pthread_attr_init (&aio_request_queue.attr); ffc09b14: 48 00 15 8d bl ffc0b0a0 if (result != 0) ffc09b18: 7c 7d 1b 79 mr. r29,r3 ffc09b1c: 41 82 00 24 beq- ffc09b40 <== ALWAYS TAKEN aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; return result; } ffc09b20: 80 01 00 1c lwz r0,28(r1) <== NOT EXECUTED ffc09b24: 7f a3 eb 78 mr r3,r29 <== NOT EXECUTED ffc09b28: 83 c1 00 10 lwz r30,16(r1) <== NOT EXECUTED ffc09b2c: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc09b30: 83 a1 00 0c lwz r29,12(r1) <== NOT EXECUTED ffc09b34: 83 e1 00 14 lwz r31,20(r1) <== NOT EXECUTED ffc09b38: 38 21 00 18 addi r1,r1,24 <== NOT EXECUTED ffc09b3c: 4e 80 00 20 blr <== NOT EXECUTED result = pthread_attr_init (&aio_request_queue.attr); if (result != 0) return result; result = ffc09b40: 7f c3 f3 78 mr r3,r30 ffc09b44: 38 80 00 00 li r4,0 ffc09b48: 48 00 15 99 bl ffc0b0e0 pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) ffc09b4c: 2f 83 00 00 cmpwi cr7,r3,0 ffc09b50: 40 9e 00 94 bne- cr7,ffc09be4 <== NEVER TAKEN pthread_attr_destroy (&aio_request_queue.attr); result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09b54: 3f e0 00 00 lis r31,0 ffc09b58: 3b ff 2c 70 addi r31,r31,11376 ffc09b5c: 7f e3 fb 78 mr r3,r31 ffc09b60: 38 80 00 00 li r4,0 ffc09b64: 48 00 11 9d bl ffc0ad00 if (result != 0) ffc09b68: 2f 83 00 00 cmpwi cr7,r3,0 ffc09b6c: 40 9e 00 9c bne- cr7,ffc09c08 <== NEVER TAKEN pthread_attr_destroy (&aio_request_queue.attr); result = pthread_cond_init (&aio_request_queue.new_req, NULL); ffc09b70: 3c 60 00 00 lis r3,0 ffc09b74: 38 63 2c 74 addi r3,r3,11380 ffc09b78: 38 80 00 00 li r4,0 ffc09b7c: 48 00 0c 19 bl ffc0a794 if (result != 0) { ffc09b80: 7c 7d 1b 79 mr. r29,r3 ffc09b84: 40 82 00 a4 bne- ffc09c28 <== NEVER TAKEN { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; ffc09b88: 38 00 00 00 li r0,0 aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; return result; } ffc09b8c: 83 c1 00 10 lwz r30,16(r1) ffc09b90: 90 1f 00 4c stw r0,76(r31) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc09b94: 39 1f 00 4c addi r8,r31,76 head->previous = NULL; tail->previous = head; ffc09b98: 39 5f 00 48 addi r10,r31,72 { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; head->previous = NULL; ffc09b9c: 90 1f 00 58 stw r0,88(r31) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc09ba0: 39 7f 00 58 addi r11,r31,88 head->previous = NULL; tail->previous = head; ffc09ba4: 39 3f 00 54 addi r9,r31,84 } rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; ffc09ba8: 90 1f 00 64 stw r0,100(r31) aio_request_queue.idle_threads = 0; aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; return result; } ffc09bac: 7f a3 eb 78 mr r3,r29 rtems_chain_initialize_empty (&aio_request_queue.work_req); rtems_chain_initialize_empty (&aio_request_queue.idle_req); aio_request_queue.active_threads = 0; aio_request_queue.idle_threads = 0; ffc09bb0: 90 1f 00 68 stw r0,104(r31) aio_request_queue.initialized = AIO_QUEUE_INITIALIZED; ffc09bb4: 60 00 b0 0b ori r0,r0,45067 ffc09bb8: 90 1f 00 60 stw r0,96(r31) return result; } ffc09bbc: 80 01 00 1c lwz r0,28(r1) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc09bc0: 91 1f 00 48 stw r8,72(r31) ffc09bc4: 7c 08 03 a6 mtlr r0 head->previous = NULL; tail->previous = head; ffc09bc8: 91 5f 00 50 stw r10,80(r31) ) { Chain_Node *head = _Chain_Head( the_chain ); Chain_Node *tail = _Chain_Tail( the_chain ); head->next = tail; ffc09bcc: 91 7f 00 54 stw r11,84(r31) head->previous = NULL; tail->previous = head; ffc09bd0: 91 3f 00 5c stw r9,92(r31) ffc09bd4: 83 a1 00 0c lwz r29,12(r1) ffc09bd8: 83 e1 00 14 lwz r31,20(r1) ffc09bdc: 38 21 00 18 addi r1,r1,24 ffc09be0: 4e 80 00 20 blr PTHREAD_CREATE_DETACHED); if (result != 0) pthread_attr_destroy (&aio_request_queue.attr); result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09be4: 3f e0 00 00 lis r31,0 <== NOT EXECUTED result = pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) pthread_attr_destroy (&aio_request_queue.attr); ffc09be8: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09bec: 3b ff 2c 70 addi r31,r31,11376 <== NOT EXECUTED result = pthread_attr_setdetachstate (&aio_request_queue.attr, PTHREAD_CREATE_DETACHED); if (result != 0) pthread_attr_destroy (&aio_request_queue.attr); ffc09bf0: 48 00 14 89 bl ffc0b078 <== NOT EXECUTED result = pthread_mutex_init (&aio_request_queue.mutex, NULL); ffc09bf4: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc09bf8: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc09bfc: 48 00 11 05 bl ffc0ad00 <== NOT EXECUTED if (result != 0) ffc09c00: 2f 83 00 00 cmpwi cr7,r3,0 <== NOT EXECUTED ffc09c04: 41 9e ff 6c beq+ cr7,ffc09b70 <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); ffc09c08: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc09c0c: 48 00 14 6d bl ffc0b078 <== NOT EXECUTED result = pthread_cond_init (&aio_request_queue.new_req, NULL); ffc09c10: 3c 60 00 00 lis r3,0 <== NOT EXECUTED ffc09c14: 38 63 2c 74 addi r3,r3,11380 <== NOT EXECUTED ffc09c18: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc09c1c: 48 00 0b 79 bl ffc0a794 <== NOT EXECUTED if (result != 0) { ffc09c20: 7c 7d 1b 79 mr. r29,r3 <== NOT EXECUTED ffc09c24: 41 82 ff 64 beq+ ffc09b88 <== NOT EXECUTED pthread_mutex_destroy (&aio_request_queue.mutex); ffc09c28: 7f e3 fb 78 mr r3,r31 <== NOT EXECUTED ffc09c2c: 48 00 0f 11 bl ffc0ab3c <== NOT EXECUTED pthread_attr_destroy (&aio_request_queue.attr); ffc09c30: 7f c3 f3 78 mr r3,r30 <== NOT EXECUTED ffc09c34: 48 00 14 45 bl ffc0b078 <== NOT EXECUTED ffc09c38: 4b ff ff 50 b ffc09b88 <== NOT EXECUTED =============================================================================== ffc0a0bc : * NONE */ void rtems_aio_insert_prio (rtems_chain_control *chain, rtems_aio_request *req) { ffc0a0bc: 7c 08 02 a6 mflr r0 ffc0a0c0: 94 21 ff f8 stwu r1,-8(r1) ffc0a0c4: 7c 8b 23 78 mr r11,r4 ffc0a0c8: 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 ); ffc0a0cc: 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; ffc0a0d0: 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)) { ffc0a0d4: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a0d8: 41 9e 00 44 beq- cr7,ffc0a11c <== NEVER TAKEN 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 && ffc0a0dc: 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; ffc0a0e0: 81 49 00 14 lwz r10,20(r9) while (req->aiocbp->aio_reqprio > prio && ffc0a0e4: 81 08 00 18 lwz r8,24(r8) ffc0a0e8: 81 4a 00 18 lwz r10,24(r10) ffc0a0ec: 7f 8a 40 00 cmpw cr7,r10,r8 ffc0a0f0: 41 bc 00 0c blt+ cr7,ffc0a0fc <== NEVER TAKEN ffc0a0f4: 48 00 00 20 b ffc0a114 ffc0a0f8: 41 9a 00 1c beq- cr6,ffc0a114 <== NOT EXECUTED } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a0fc: 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; ffc0a100: 81 49 00 14 lwz r10,20(r9) <== 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 && ffc0a104: 7f 09 00 00 cmpw cr6,r9,r0 <== NOT EXECUTED ffc0a108: 81 4a 00 18 lwz r10,24(r10) <== NOT EXECUTED ffc0a10c: 7f 8a 40 00 cmpw cr7,r10,r8 <== NOT EXECUTED ffc0a110: 41 9c ff e8 blt+ cr7,ffc0a0f8 <== 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 ); ffc0a114: 80 69 00 04 lwz r3,4(r9) ffc0a118: 7d 64 5b 78 mr r4,r11 ffc0a11c: 48 00 30 3d bl ffc0d158 <_Chain_Insert> } rtems_chain_insert (node->previous, &req->next_prio); } } ffc0a120: 80 01 00 0c lwz r0,12(r1) ffc0a124: 38 21 00 08 addi r1,r1,8 ffc0a128: 7c 08 03 a6 mtlr r0 ffc0a12c: 4e 80 00 20 blr =============================================================================== ffc09d78 : * NONE */ void rtems_aio_move_to_work (rtems_aio_request_chain *r_chain) { ffc09d78: 7c 08 02 a6 mflr r0 ffc09d7c: 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; ffc09d80: 3d 60 00 00 lis r11,0 ffc09d84: 90 01 00 0c stw r0,12(r1) ffc09d88: 39 6b 2c 70 addi r11,r11,11376 ffc09d8c: 7c 64 1b 78 mr r4,r3 ffc09d90: 81 2b 00 48 lwz r9,72(r11) 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 && ffc09d94: 81 03 00 14 lwz r8,20(r3) ffc09d98: 80 09 00 14 lwz r0,20(r9) ffc09d9c: 7d 2a 4b 78 mr r10,r9 ffc09da0: 7f 80 40 00 cmpw cr7,r0,r8 ffc09da4: 40 9c 00 30 bge- cr7,ffc09dd4 <== NEVER TAKEN ffc09da8: 39 6b 00 4c addi r11,r11,76 ffc09dac: 7f 89 58 00 cmpw cr7,r9,r11 ffc09db0: 40 be 00 0c bne+ cr7,ffc09dbc <== ALWAYS TAKEN ffc09db4: 48 00 00 20 b ffc09dd4 <== NOT EXECUTED ffc09db8: 41 9a 00 34 beq- cr6,ffc09dec <== NEVER TAKEN } } AIO_printf ("Thread finished\n"); return NULL; } ffc09dbc: 81 49 00 00 lwz r10,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 && ffc09dc0: 80 0a 00 14 lwz r0,20(r10) ffc09dc4: 7f 0a 58 00 cmpw cr6,r10,r11 ffc09dc8: 7d 49 53 78 mr r9,r10 ffc09dcc: 7f 80 40 00 cmpw cr7,r0,r8 ffc09dd0: 41 9c ff e8 blt+ cr7,ffc09db8 ffc09dd4: 80 6a 00 04 lwz r3,4(r10) ffc09dd8: 48 00 33 81 bl ffc0d158 <_Chain_Insert> node = rtems_chain_next (node); temp = (rtems_aio_request_chain *) node; } rtems_chain_insert (rtems_chain_previous (node), &r_chain->next_fd); } ffc09ddc: 80 01 00 0c lwz r0,12(r1) ffc09de0: 38 21 00 08 addi r1,r1,8 ffc09de4: 7c 08 03 a6 mtlr r0 ffc09de8: 4e 80 00 20 blr 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 && ffc09dec: 7d 6a 5b 78 mr r10,r11 <== NOT EXECUTED ffc09df0: 80 6a 00 04 lwz r3,4(r10) <== NOT EXECUTED ffc09df4: 48 00 33 65 bl ffc0d158 <_Chain_Insert> <== NOT EXECUTED node = rtems_chain_next (node); temp = (rtems_aio_request_chain *) node; } rtems_chain_insert (rtems_chain_previous (node), &r_chain->next_fd); } ffc09df8: 80 01 00 0c lwz r0,12(r1) <== NOT EXECUTED ffc09dfc: 38 21 00 08 addi r1,r1,8 <== NOT EXECUTED ffc09e00: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc09e04: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc0a130 : * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { ffc0a130: 94 21 ff e0 stwu r1,-32(r1) ffc0a134: 7c 08 02 a6 mflr r0 ffc0a138: 90 01 00 24 stw r0,36(r1) ffc0a13c: 93 e1 00 1c stw r31,28(r1) ffc0a140: 83 e3 00 08 lwz r31,8(r3) ffc0a144: 93 a1 00 14 stw r29,20(r1) RTEMS_INLINE_ROUTINE bool _Chain_Is_tail( Chain_Control *the_chain, const Chain_Node *the_node ) { return (the_node == _Chain_Tail(the_chain)); ffc0a148: 3b a3 00 0c addi r29,r3,12 rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) ffc0a14c: 7f 9f e8 00 cmpw cr7,r31,r29 * Output parameters: * NONE */ void rtems_aio_remove_fd (rtems_aio_request_chain *r_chain) { ffc0a150: 93 61 00 0c stw r27,12(r1) ffc0a154: 93 81 00 10 stw r28,16(r1) ffc0a158: 93 c1 00 18 stw r30,24(r1) rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) ffc0a15c: 41 9e 00 38 beq- cr7,ffc0a194 <== NEVER TAKEN { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; ffc0a160: 3b 60 00 8c li r27,140 req->aiocbp->return_value = -1; ffc0a164: 3b 80 ff ff li r28,-1 */ RTEMS_INLINE_ROUTINE void rtems_chain_extract( rtems_chain_node *the_node ) { _Chain_Extract( the_node ); ffc0a168: 7f e3 fb 78 mr r3,r31 ffc0a16c: 48 00 2f 85 bl ffc0d0f0 <_Chain_Extract> while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; ffc0a170: 81 3f 00 14 lwz r9,20(r31) } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a174: 83 df 00 00 lwz r30,0(r31) rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); ffc0a178: 7f e3 fb 78 mr r3,r31 while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; ffc0a17c: 93 69 00 34 stw r27,52(r9) while (!rtems_chain_is_tail (chain, node)) { rtems_chain_extract (node); rtems_aio_request *req = (rtems_aio_request *) node; node = rtems_chain_next (node); ffc0a180: 7f df f3 78 mr r31,r30 req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; ffc0a184: 93 89 00 38 stw r28,56(r9) free (req); ffc0a188: 4b ff b7 ed bl ffc05974 rtems_chain_control *chain; rtems_chain_node *node; chain = &r_chain->perfd; node = rtems_chain_first (chain); while (!rtems_chain_is_tail (chain, node)) ffc0a18c: 7f 9e e8 00 cmpw cr7,r30,r29 ffc0a190: 40 9e ff d8 bne+ cr7,ffc0a168 node = rtems_chain_next (node); req->aiocbp->error_code = ECANCELED; req->aiocbp->return_value = -1; free (req); } } ffc0a194: 80 01 00 24 lwz r0,36(r1) ffc0a198: 83 61 00 0c lwz r27,12(r1) ffc0a19c: 7c 08 03 a6 mtlr r0 ffc0a1a0: 83 81 00 10 lwz r28,16(r1) ffc0a1a4: 83 a1 00 14 lwz r29,20(r1) ffc0a1a8: 83 c1 00 18 lwz r30,24(r1) ffc0a1ac: 83 e1 00 1c lwz r31,28(r1) ffc0a1b0: 38 21 00 20 addi r1,r1,32 ffc0a1b4: 4e 80 00 20 blr =============================================================================== ffc0a1b8 : * 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) { ffc0a1b8: 94 21 ff f0 stwu r1,-16(r1) ffc0a1bc: 7c 08 02 a6 mflr r0 ffc0a1c0: 90 01 00 14 stw r0,20(r1) RTEMS_INLINE_ROUTINE bool _Chain_Is_empty( const Chain_Control *the_chain ) { return _Chain_Immutable_first( the_chain ) == _Chain_Immutable_tail( the_chain ); ffc0a1c4: 38 03 00 04 addi r0,r3,4 ffc0a1c8: 93 e1 00 0c stw r31,12(r1) */ RTEMS_INLINE_ROUTINE const Chain_Node *_Chain_Immutable_first( const Chain_Control *the_chain ) { return _Chain_Immutable_head( the_chain )->next; ffc0a1cc: 83 e3 00 00 lwz r31,0(r3) if (rtems_chain_is_empty (chain)) return AIO_ALLDONE; ffc0a1d0: 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)) ffc0a1d4: 7f 9f 00 00 cmpw cr7,r31,r0 ffc0a1d8: 40 be 00 14 bne+ cr7,ffc0a1ec ffc0a1dc: 48 00 00 44 b ffc0a220 } } AIO_printf ("Thread finished\n"); return NULL; } ffc0a1e0: 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) { ffc0a1e4: 7f 9f 00 00 cmpw cr7,r31,r0 <== NOT EXECUTED ffc0a1e8: 41 9e 00 4c beq- cr7,ffc0a234 <== NOT EXECUTED ffc0a1ec: 81 3f 00 14 lwz r9,20(r31) ffc0a1f0: 7f 89 20 00 cmpw cr7,r9,r4 ffc0a1f4: 40 9e ff ec bne+ cr7,ffc0a1e0 <== NEVER TAKEN ffc0a1f8: 7f e3 fb 78 mr r3,r31 ffc0a1fc: 48 00 2e f5 bl ffc0d0f0 <_Chain_Extract> if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; else { rtems_chain_extract (node); current->aiocbp->error_code = ECANCELED; ffc0a200: 81 3f 00 14 lwz r9,20(r31) ffc0a204: 38 00 00 8c li r0,140 ffc0a208: 90 09 00 34 stw r0,52(r9) current->aiocbp->return_value = -1; ffc0a20c: 38 00 ff ff li r0,-1 free (current); ffc0a210: 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; ffc0a214: 90 09 00 38 stw r0,56(r9) free (current); ffc0a218: 4b ff b7 5d bl ffc05974 } return AIO_CANCELED; ffc0a21c: 38 60 00 00 li r3,0 } ffc0a220: 80 01 00 14 lwz r0,20(r1) ffc0a224: 83 e1 00 0c lwz r31,12(r1) ffc0a228: 38 21 00 10 addi r1,r1,16 ffc0a22c: 7c 08 03 a6 mtlr r0 ffc0a230: 4e 80 00 20 blr ffc0a234: 80 01 00 14 lwz r0,20(r1) <== NOT EXECUTED node = rtems_chain_next (node); current = (rtems_aio_request *) node; } if (rtems_chain_is_tail (chain, node)) return AIO_NOTCANCELED; ffc0a238: 38 60 00 01 li r3,1 <== NOT EXECUTED current->aiocbp->return_value = -1; free (current); } return AIO_CANCELED; } ffc0a23c: 83 e1 00 0c lwz r31,12(r1) <== NOT EXECUTED ffc0a240: 38 21 00 10 addi r1,r1,16 <== NOT EXECUTED ffc0a244: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0a248: 4e 80 00 20 blr <== NOT EXECUTED =============================================================================== ffc09da4 : rtems_chain_control *chain, rtems_event_set events, rtems_interval timeout, rtems_chain_node **node_ptr ) { ffc09da4: 94 21 ff d0 stwu r1,-48(r1) ffc09da8: 7c 08 02 a6 mflr r0 ffc09dac: 93 e1 00 2c stw r31,44(r1) ffc09db0: 90 01 00 34 stw r0,52(r1) ffc09db4: 93 61 00 1c stw r27,28(r1) ffc09db8: 7c db 33 78 mr r27,r6 ffc09dbc: 93 81 00 20 stw r28,32(r1) ffc09dc0: 7c 7c 1b 78 mr r28,r3 ffc09dc4: 93 a1 00 24 stw r29,36(r1) ffc09dc8: 7c 9d 23 78 mr r29,r4 ffc09dcc: 93 c1 00 28 stw r30,40(r1) ffc09dd0: 7c be 2b 78 mr r30,r5 */ RTEMS_INLINE_ROUTINE rtems_chain_node *rtems_chain_get( rtems_chain_control *the_chain ) { return _Chain_Get( the_chain ); ffc09dd4: 7f 83 e3 78 mr r3,r28 ffc09dd8: 48 00 07 e5 bl ffc0a5bc <_Chain_Get> while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ) { rtems_event_set out; sc = rtems_event_receive( ffc09ddc: 38 80 00 00 li r4,0 rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ffc09de0: 7c 7f 1b 79 mr. r31,r3 ) { rtems_event_set out; sc = rtems_event_receive( ffc09de4: 7f c5 f3 78 mr r5,r30 ffc09de8: 38 c1 00 08 addi r6,r1,8 ffc09dec: 7f a3 eb 78 mr r3,r29 rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ffc09df0: 40 82 00 38 bne- ffc09e28 ) { rtems_event_set out; sc = rtems_event_receive( ffc09df4: 4b ff ef f9 bl ffc08dec ) { rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( ffc09df8: 2c 03 00 00 cmpwi r3,0 ffc09dfc: 41 82 ff d8 beq+ ffc09dd4 <== NEVER TAKEN } *node_ptr = node; return sc; } ffc09e00: 80 01 00 34 lwz r0,52(r1) timeout, &out ); } *node_ptr = node; ffc09e04: 93 fb 00 00 stw r31,0(r27) return sc; } ffc09e08: 7c 08 03 a6 mtlr r0 ffc09e0c: 83 61 00 1c lwz r27,28(r1) ffc09e10: 83 81 00 20 lwz r28,32(r1) ffc09e14: 83 a1 00 24 lwz r29,36(r1) ffc09e18: 83 c1 00 28 lwz r30,40(r1) ffc09e1c: 83 e1 00 2c lwz r31,44(r1) ffc09e20: 38 21 00 30 addi r1,r1,48 ffc09e24: 4e 80 00 20 blr ffc09e28: 80 01 00 34 lwz r0,52(r1) rtems_status_code sc = RTEMS_SUCCESSFUL; rtems_chain_node *node = NULL; while ( sc == RTEMS_SUCCESSFUL && (node = rtems_chain_get( chain )) == NULL ffc09e2c: 38 60 00 00 li r3,0 timeout, &out ); } *node_ptr = node; ffc09e30: 93 fb 00 00 stw r31,0(r27) return sc; } ffc09e34: 7c 08 03 a6 mtlr r0 ffc09e38: 83 61 00 1c lwz r27,28(r1) ffc09e3c: 83 81 00 20 lwz r28,32(r1) ffc09e40: 83 a1 00 24 lwz r29,36(r1) ffc09e44: 83 c1 00 28 lwz r30,40(r1) ffc09e48: 83 e1 00 2c lwz r31,44(r1) ffc09e4c: 38 21 00 30 addi r1,r1,48 ffc09e50: 4e 80 00 20 blr =============================================================================== ffc0aba4 : rtems_status_code rtems_io_register_driver( rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { ffc0aba4: 94 21 ff f0 stwu r1,-16(r1) ffc0aba8: 7c 08 02 a6 mflr r0 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0abac: 3d 20 00 00 lis r9,0 rtems_status_code rtems_io_register_driver( rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { ffc0abb0: 90 01 00 14 stw r0,20(r1) rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0abb4: 80 09 31 ec lwz r0,12780(r9) rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; ffc0abb8: 3d 20 00 00 lis r9,0 rtems_status_code rtems_io_register_driver( rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { ffc0abbc: 93 e1 00 0c stw r31,12(r1) ffc0abc0: 7c 7f 1b 78 mr r31,r3 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) ffc0abc4: 2f 80 00 00 cmpwi cr7,r0,0 return RTEMS_CALLED_FROM_ISR; ffc0abc8: 38 60 00 12 li r3,18 rtems_device_major_number major, const rtems_driver_address_table *driver_table, rtems_device_major_number *registered_major ) { rtems_device_major_number major_limit = _IO_Number_of_drivers; ffc0abcc: 80 09 28 50 lwz r0,10320(r9) if ( rtems_interrupt_is_in_progress() ) ffc0abd0: 41 9e 00 18 beq- cr7,ffc0abe8 _IO_Driver_address_table [major] = *driver_table; _Thread_Enable_dispatch(); return rtems_io_initialize( major, 0, NULL ); } ffc0abd4: 80 01 00 14 lwz r0,20(r1) ffc0abd8: 83 e1 00 0c lwz r31,12(r1) ffc0abdc: 38 21 00 10 addi r1,r1,16 ffc0abe0: 7c 08 03 a6 mtlr r0 ffc0abe4: 4e 80 00 20 blr rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) ffc0abe8: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc0abec: 38 60 00 09 li r3,9 rtems_device_major_number major_limit = _IO_Number_of_drivers; if ( rtems_interrupt_is_in_progress() ) return RTEMS_CALLED_FROM_ISR; if ( registered_major == NULL ) ffc0abf0: 41 be ff e4 beq- cr7,ffc0abd4 return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; if ( driver_table == NULL ) ffc0abf4: 2f 84 00 00 cmpwi cr7,r4,0 if ( registered_major == NULL ) return RTEMS_INVALID_ADDRESS; /* Set it to an invalid value */ *registered_major = major_limit; ffc0abf8: 90 05 00 00 stw r0,0(r5) if ( driver_table == NULL ) ffc0abfc: 41 be ff d8 beq- cr7,ffc0abd4 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ac00: 81 64 00 00 lwz r11,0(r4) ffc0ac04: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0ac08: 41 9e 00 f4 beq- cr7,ffc0acfc return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) ffc0ac0c: 7f 80 f8 40 cmplw cr7,r0,r31 return RTEMS_INVALID_NUMBER; ffc0ac10: 38 60 00 0a li r3,10 return RTEMS_INVALID_ADDRESS; if ( rtems_io_is_empty_table( driver_table ) ) return RTEMS_INVALID_ADDRESS; if ( major >= major_limit ) ffc0ac14: 40 9d ff c0 ble+ cr7,ffc0abd4 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc0ac18: 3d 60 00 00 lis r11,0 ffc0ac1c: 81 4b 28 04 lwz r10,10244(r11) ffc0ac20: 38 0a 00 01 addi r0,r10,1 ffc0ac24: 90 0b 28 04 stw r0,10244(r11) return _Thread_Dispatch_disable_level; ffc0ac28: 80 0b 28 04 lwz r0,10244(r11) return RTEMS_INVALID_NUMBER; _Thread_Disable_dispatch(); if ( major == 0 ) { ffc0ac2c: 2f 9f 00 00 cmpwi cr7,r31,0 ffc0ac30: 40 9e 00 a4 bne- cr7,ffc0acd4 static rtems_status_code rtems_io_obtain_major_number( rtems_device_major_number *major ) { rtems_device_major_number n = _IO_Number_of_drivers; ffc0ac34: 81 49 28 50 lwz r10,10320(r9) rtems_device_major_number m = 0; /* major is error checked by caller */ for ( m = 0; m < n; ++m ) { ffc0ac38: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0ac3c: 41 9e 00 d0 beq- cr7,ffc0ad0c <== NEVER TAKEN ffc0ac40: 3d 60 00 00 lis r11,0 ffc0ac44: 7d 49 03 a6 mtctr r10 ffc0ac48: 81 2b 28 54 lwz r9,10324(r11) ffc0ac4c: 48 00 00 10 b ffc0ac5c ffc0ac50: 3b ff 00 01 addi r31,r31,1 ffc0ac54: 39 29 00 18 addi r9,r9,24 ffc0ac58: 42 40 00 b4 bdz- ffc0ad0c static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ac5c: 80 09 00 00 lwz r0,0(r9) ffc0ac60: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ac64: 40 9e ff ec bne+ cr7,ffc0ac50 ffc0ac68: 80 09 00 04 lwz r0,4(r9) ffc0ac6c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0ac70: 40 9e ff e0 bne+ cr7,ffc0ac50 } /* Assigns invalid value in case of failure */ *major = m; if ( m != n ) ffc0ac74: 7f 8a f8 00 cmpw cr7,r10,r31 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; ffc0ac78: 93 e5 00 00 stw r31,0(r5) ffc0ac7c: 1c 1f 00 18 mulli r0,r31,24 if ( m != n ) ffc0ac80: 41 9e 00 90 beq- cr7,ffc0ad10 <== NEVER TAKEN } *registered_major = major; } _IO_Driver_address_table [major] = *driver_table; ffc0ac84: 81 6b 28 54 lwz r11,10324(r11) ffc0ac88: 80 c4 00 00 lwz r6,0(r4) ffc0ac8c: 80 e4 00 04 lwz r7,4(r4) ffc0ac90: 7d 2b 02 14 add r9,r11,r0 ffc0ac94: 81 04 00 08 lwz r8,8(r4) ffc0ac98: 81 44 00 0c lwz r10,12(r4) ffc0ac9c: 7c cb 01 2e stwx r6,r11,r0 ffc0aca0: 90 e9 00 04 stw r7,4(r9) ffc0aca4: 91 09 00 08 stw r8,8(r9) ffc0aca8: 91 49 00 0c stw r10,12(r9) ffc0acac: 81 64 00 10 lwz r11,16(r4) ffc0acb0: 80 04 00 14 lwz r0,20(r4) ffc0acb4: 91 69 00 10 stw r11,16(r9) ffc0acb8: 90 09 00 14 stw r0,20(r9) _Thread_Enable_dispatch(); ffc0acbc: 48 00 27 21 bl ffc0d3dc <_Thread_Enable_dispatch> return rtems_io_initialize( major, 0, NULL ); ffc0acc0: 7f e3 fb 78 mr r3,r31 ffc0acc4: 38 80 00 00 li r4,0 ffc0acc8: 38 a0 00 00 li r5,0 ffc0accc: 48 00 a7 0d bl ffc153d8 ffc0acd0: 4b ff ff 04 b ffc0abd4 _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; ffc0acd4: 3d 60 00 00 lis r11,0 ffc0acd8: 1c 1f 00 18 mulli r0,r31,24 ffc0acdc: 81 2b 28 54 lwz r9,10324(r11) static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ace0: 7d 49 00 2e lwzx r10,r9,r0 _Thread_Enable_dispatch(); return sc; } major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; ffc0ace4: 7d 29 02 14 add r9,r9,r0 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ace8: 2f 8a 00 00 cmpwi cr7,r10,0 ffc0acec: 41 9e 00 30 beq- cr7,ffc0ad1c major = *registered_major; } else { rtems_driver_address_table *const table = _IO_Driver_address_table + major; if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); ffc0acf0: 48 00 26 ed bl ffc0d3dc <_Thread_Enable_dispatch> return RTEMS_RESOURCE_IN_USE; ffc0acf4: 38 60 00 0c li r3,12 ffc0acf8: 4b ff fe dc b ffc0abd4 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0acfc: 81 64 00 04 lwz r11,4(r4) ffc0ad00: 2f 8b 00 00 cmpwi cr7,r11,0 ffc0ad04: 40 9e ff 08 bne+ cr7,ffc0ac0c ffc0ad08: 4b ff fe cc b ffc0abd4 if ( rtems_io_is_empty_table( table ) ) break; } /* Assigns invalid value in case of failure */ *major = m; ffc0ad0c: 93 e5 00 00 stw r31,0(r5) if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); ffc0ad10: 48 00 26 cd bl ffc0d3dc <_Thread_Enable_dispatch> *major = m; if ( m != n ) return RTEMS_SUCCESSFUL; return RTEMS_TOO_MANY; ffc0ad14: 38 60 00 05 li r3,5 if ( major == 0 ) { rtems_status_code sc = rtems_io_obtain_major_number( registered_major ); if ( sc != RTEMS_SUCCESSFUL ) { _Thread_Enable_dispatch(); return sc; ffc0ad18: 4b ff fe bc b ffc0abd4 static inline bool rtems_io_is_empty_table( const rtems_driver_address_table *table ) { return table->initialization_entry == NULL && table->open_entry == NULL; ffc0ad1c: 81 29 00 04 lwz r9,4(r9) ffc0ad20: 2f 89 00 00 cmpwi cr7,r9,0 ffc0ad24: 40 9e ff cc bne+ cr7,ffc0acf0 if ( !rtems_io_is_empty_table( table ) ) { _Thread_Enable_dispatch(); return RTEMS_RESOURCE_IN_USE; } *registered_major = major; ffc0ad28: 93 e5 00 00 stw r31,0(r5) ffc0ad2c: 4b ff ff 58 b ffc0ac84 =============================================================================== ffc0c85c : #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { ffc0c85c: 94 21 ff e0 stwu r1,-32(r1) ffc0c860: 7c 08 02 a6 mflr r0 ffc0c864: 90 01 00 24 stw r0,36(r1) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0c868: 7c 60 1b 79 mr. r0,r3 #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) { ffc0c86c: 93 81 00 10 stw r28,16(r1) ffc0c870: 93 a1 00 14 stw r29,20(r1) ffc0c874: 93 c1 00 18 stw r30,24(r1) ffc0c878: 93 e1 00 1c stw r31,28(r1) uint32_t i; uint32_t api_index; Thread_Control *the_thread; Objects_Information *information; if ( !routine ) ffc0c87c: 90 01 00 08 stw r0,8(r1) ffc0c880: 41 82 00 6c beq- ffc0c8ec <== NEVER TAKEN ffc0c884: 3f a0 00 00 lis r29,0 ffc0c888: 3b bd 30 80 addi r29,r29,12416 #endif #include #include void rtems_iterate_over_all_threads(rtems_per_thread_routine routine) ffc0c88c: 3b 9d 00 0c addi r28,r29,12 #if !defined(RTEMS_POSIX_API) || defined(RTEMS_DEBUG) if ( !_Objects_Information_table[ api_index ] ) continue; #endif information = _Objects_Information_table[ api_index ][ 1 ]; ffc0c890: 85 3d 00 04 lwzu r9,4(r29) ffc0c894: 83 c9 00 04 lwz r30,4(r9) if ( !information ) ffc0c898: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0c89c: 41 9e 00 48 beq- cr7,ffc0c8e4 continue; for ( i=1 ; i <= information->maximum ; i++ ) { ffc0c8a0: a0 1e 00 10 lhz r0,16(r30) ffc0c8a4: 70 09 ff ff andi. r9,r0,65535 ffc0c8a8: 41 82 00 3c beq- ffc0c8e4 ffc0c8ac: 3b e0 00 01 li r31,1 the_thread = (Thread_Control *)information->local_table[ i ]; ffc0c8b0: 81 7e 00 1c lwz r11,28(r30) ffc0c8b4: 57 e9 10 3a rlwinm r9,r31,2,0,29 information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { ffc0c8b8: 3b ff 00 01 addi r31,r31,1 the_thread = (Thread_Control *)information->local_table[ i ]; ffc0c8bc: 7c 6b 48 2e lwzx r3,r11,r9 if ( !the_thread ) ffc0c8c0: 2f 83 00 00 cmpwi cr7,r3,0 ffc0c8c4: 41 9e 00 14 beq- cr7,ffc0c8d8 continue; (*routine)(the_thread); ffc0c8c8: 80 01 00 08 lwz r0,8(r1) ffc0c8cc: 7c 09 03 a6 mtctr r0 ffc0c8d0: 4e 80 04 21 bctrl ffc0c8d4: a0 1e 00 10 lhz r0,16(r30) information = _Objects_Information_table[ api_index ][ 1 ]; if ( !information ) continue; for ( i=1 ; i <= information->maximum ; i++ ) { ffc0c8d8: 54 09 04 3e clrlwi r9,r0,16 ffc0c8dc: 7f 89 f8 40 cmplw cr7,r9,r31 ffc0c8e0: 40 9c ff d0 bge+ cr7,ffc0c8b0 Objects_Information *information; if ( !routine ) return; for ( api_index = 1 ; api_index <= OBJECTS_APIS_LAST ; api_index++ ) { ffc0c8e4: 7f 9d e0 00 cmpw cr7,r29,r28 ffc0c8e8: 40 9e ff a8 bne+ cr7,ffc0c890 (*routine)(the_thread); } } } ffc0c8ec: 80 01 00 24 lwz r0,36(r1) ffc0c8f0: 83 81 00 10 lwz r28,16(r1) ffc0c8f4: 7c 08 03 a6 mtlr r0 ffc0c8f8: 83 a1 00 14 lwz r29,20(r1) ffc0c8fc: 83 c1 00 18 lwz r30,24(r1) ffc0c900: 83 e1 00 1c lwz r31,28(r1) ffc0c904: 38 21 00 20 addi r1,r1,32 ffc0c908: 4e 80 00 20 blr =============================================================================== ffc0afc0 : rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { ffc0afc0: 94 21 ff f0 stwu r1,-16(r1) ffc0afc4: 7c 08 02 a6 mflr r0 ffc0afc8: 93 e1 00 0c stw r31,12(r1) int i; /* * Validate parameters and look up information structure. */ if ( !info ) ffc0afcc: 7c bf 2b 79 mr. r31,r5 rtems_status_code rtems_object_get_class_information( int the_api, int the_class, rtems_object_api_class_information *info ) { ffc0afd0: 90 01 00 14 stw r0,20(r1) /* * Validate parameters and look up information structure. */ if ( !info ) return RTEMS_INVALID_ADDRESS; ffc0afd4: 38 00 00 09 li r0,9 int i; /* * Validate parameters and look up information structure. */ if ( !info ) ffc0afd8: 41 82 00 7c beq- ffc0b054 return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); ffc0afdc: 54 84 04 3e clrlwi r4,r4,16 ffc0afe0: 48 00 24 81 bl ffc0d460 <_Objects_Get_information> if ( !obj_info ) return RTEMS_INVALID_NUMBER; ffc0afe4: 38 00 00 0a li r0,10 */ if ( !info ) return RTEMS_INVALID_ADDRESS; obj_info = _Objects_Get_information( the_api, the_class ); if ( !obj_info ) ffc0afe8: 2c 03 00 00 cmpwi r3,0 ffc0afec: 41 82 00 68 beq- ffc0b054 * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; ffc0aff0: a1 03 00 10 lhz r8,16(r3) return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; ffc0aff4: 80 03 00 08 lwz r0,8(r3) info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) ffc0aff8: 2f 88 00 00 cmpwi cr7,r8,0 /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; ffc0affc: 81 63 00 0c lwz r11,12(r3) info->auto_extend = obj_info->auto_extend; ffc0b000: 89 23 00 12 lbz r9,18(r3) return RTEMS_INVALID_NUMBER; /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; ffc0b004: 90 1f 00 00 stw r0,0(r31) info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) ffc0b008: 38 00 00 00 li r0,0 /* * Return information about this object class to the user. */ info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; ffc0b00c: 91 7f 00 04 stw r11,4(r31) info->auto_extend = obj_info->auto_extend; ffc0b010: 99 3f 00 0c stb r9,12(r31) info->maximum = obj_info->maximum; ffc0b014: 91 1f 00 08 stw r8,8(r31) for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) ffc0b018: 41 9e 00 34 beq- cr7,ffc0b04c <== NEVER TAKEN ffc0b01c: 80 e3 00 1c lwz r7,28(r3) ffc0b020: 39 60 00 01 li r11,1 ffc0b024: 39 20 00 01 li r9,1 ffc0b028: 39 29 00 01 addi r9,r9,1 ffc0b02c: 7f 88 48 40 cmplw cr7,r8,r9 if ( !obj_info->local_table[i] ) ffc0b030: 55 6b 10 3a rlwinm r11,r11,2,0,29 ffc0b034: 7d 47 58 2e lwzx r10,r7,r11 info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) ffc0b038: 7d 2b 4b 78 mr r11,r9 if ( !obj_info->local_table[i] ) unallocated++; ffc0b03c: 20 ca 00 00 subfic r6,r10,0 ffc0b040: 7c c0 01 94 addze r6,r0 ffc0b044: 7c c0 33 78 mr r0,r6 info->minimum_id = obj_info->minimum_id; info->maximum_id = obj_info->maximum_id; info->auto_extend = obj_info->auto_extend; info->maximum = obj_info->maximum; for ( unallocated=0, i=1 ; i <= info->maximum ; i++ ) ffc0b048: 40 9c ff e0 bge+ cr7,ffc0b028 if ( !obj_info->local_table[i] ) unallocated++; info->unallocated = unallocated; ffc0b04c: 90 1f 00 10 stw r0,16(r31) return RTEMS_SUCCESSFUL; ffc0b050: 38 00 00 00 li r0,0 } ffc0b054: 7c 03 03 78 mr r3,r0 ffc0b058: 80 01 00 14 lwz r0,20(r1) ffc0b05c: 83 e1 00 0c lwz r31,12(r1) ffc0b060: 38 21 00 10 addi r1,r1,16 ffc0b064: 7c 08 03 a6 mtlr r0 ffc0b068: 4e 80 00 20 blr =============================================================================== ffc19084 : uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc19084: 94 21 ff d0 stwu r1,-48(r1) ffc19088: 7c 08 02 a6 mflr r0 ffc1908c: 93 e1 00 2c stw r31,44(r1) register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc19090: 7c 7f 1b 79 mr. r31,r3 return RTEMS_INVALID_NAME; ffc19094: 38 60 00 03 li r3,3 uint32_t length, uint32_t buffer_size, rtems_attribute attribute_set, rtems_id *id ) { ffc19098: 93 c1 00 28 stw r30,40(r1) ffc1909c: 7c be 2b 78 mr r30,r5 ffc190a0: 90 01 00 34 stw r0,52(r1) ffc190a4: 93 61 00 1c stw r27,28(r1) ffc190a8: 93 81 00 20 stw r28,32(r1) ffc190ac: 93 a1 00 24 stw r29,36(r1) register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) ffc190b0: 40 82 00 28 bne- ffc190d8 ); #endif _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } ffc190b4: 80 01 00 34 lwz r0,52(r1) ffc190b8: 83 61 00 1c lwz r27,28(r1) ffc190bc: 7c 08 03 a6 mtlr r0 ffc190c0: 83 81 00 20 lwz r28,32(r1) ffc190c4: 83 a1 00 24 lwz r29,36(r1) ffc190c8: 83 c1 00 28 lwz r30,40(r1) ffc190cc: 83 e1 00 2c lwz r31,44(r1) ffc190d0: 38 21 00 30 addi r1,r1,48 ffc190d4: 4e 80 00 20 blr register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !starting_address ) ffc190d8: 2f 84 00 00 cmpwi cr7,r4,0 return RTEMS_INVALID_ADDRESS; ffc190dc: 38 60 00 09 li r3,9 register Partition_Control *the_partition; if ( !rtems_is_name_valid( name ) ) return RTEMS_INVALID_NAME; if ( !starting_address ) ffc190e0: 41 be ff d4 beq- cr7,ffc190b4 return RTEMS_INVALID_ADDRESS; if ( !id ) ffc190e4: 2f 88 00 00 cmpwi cr7,r8,0 ffc190e8: 41 be ff cc beq- cr7,ffc190b4 <== NEVER TAKEN return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || ffc190ec: 2f 85 00 00 cmpwi cr7,r5,0 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; ffc190f0: 38 60 00 08 li r3,8 return RTEMS_INVALID_ADDRESS; if ( !id ) return RTEMS_INVALID_ADDRESS; if ( length == 0 || buffer_size == 0 || length < buffer_size || ffc190f4: 41 9e ff c0 beq+ cr7,ffc190b4 ffc190f8: 2f 86 00 00 cmpwi cr7,r6,0 ffc190fc: 41 9e ff b8 beq+ cr7,ffc190b4 ffc19100: 7f 85 30 40 cmplw cr7,r5,r6 ffc19104: 41 9c ff b0 blt+ cr7,ffc190b4 ffc19108: 70 c0 00 07 andi. r0,r6,7 ffc1910c: 40 82 ff a8 bne+ ffc190b4 !_Partition_Is_buffer_size_aligned( buffer_size ) ) return RTEMS_INVALID_SIZE; if ( !_Addresses_Is_aligned( starting_address ) ) ffc19110: 70 9b 00 07 andi. r27,r4,7 return RTEMS_INVALID_ADDRESS; ffc19114: 38 60 00 09 li r3,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 ) ) ffc19118: 40 82 ff 9c bne+ ffc190b4 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc1911c: 3d 20 00 00 lis r9,0 ffc19120: 80 09 28 e0 lwz r0,10464(r9) ffc19124: 30 00 00 01 addic r0,r0,1 ffc19128: 90 09 28 e0 stw r0,10464(r9) return _Thread_Dispatch_disable_level; ffc1912c: 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 ); ffc19130: 3f 80 00 00 lis r28,0 ffc19134: 90 81 00 08 stw r4,8(r1) ffc19138: 3b 9c 6f 20 addi r28,r28,28448 ffc1913c: 7f 83 e3 78 mr r3,r28 ffc19140: 90 c1 00 0c stw r6,12(r1) ffc19144: 90 e1 00 10 stw r7,16(r1) ffc19148: 91 01 00 14 stw r8,20(r1) ffc1914c: 48 00 60 0d bl ffc1f158 <_Objects_Allocate> _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { ffc19150: 7c 7d 1b 79 mr. r29,r3 ffc19154: 80 81 00 08 lwz r4,8(r1) ffc19158: 80 c1 00 0c lwz r6,12(r1) ffc1915c: 80 e1 00 10 lwz r7,16(r1) ffc19160: 81 01 00 14 lwz r8,20(r1) ffc19164: 41 82 00 50 beq- ffc191b4 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, ffc19168: 7c be 33 96 divwu r5,r30,r6 _Thread_Enable_dispatch(); return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; ffc1916c: 90 9d 00 10 stw r4,16(r29) the_partition->length = length; the_partition->buffer_size = buffer_size; ffc19170: 90 dd 00 18 stw r6,24(r29) the_partition->attribute_set = attribute_set; ffc19174: 90 fd 00 1c stw r7,28(r29) return RTEMS_TOO_MANY; } #endif the_partition->starting_address = starting_address; the_partition->length = length; ffc19178: 93 dd 00 14 stw r30,20(r29) the_partition->buffer_size = buffer_size; the_partition->attribute_set = attribute_set; the_partition->number_of_used_blocks = 0; ffc1917c: 93 7d 00 20 stw r27,32(r29) _Chain_Initialize( &the_partition->Memory, starting_address, ffc19180: 91 01 00 14 stw r8,20(r1) ffc19184: 38 7d 00 24 addi r3,r29,36 ffc19188: 48 00 41 c9 bl ffc1d350 <_Chain_Initialize> Objects_Name name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc1918c: 80 1d 00 08 lwz r0,8(r29) #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc19190: 81 7c 00 1c lwz r11,28(r28) ffc19194: 54 09 13 ba rlwinm r9,r0,2,14,29 ffc19198: 7f ab 49 2e stwx r29,r11,r9 information, _Objects_Get_index( the_object->id ), the_object ); the_object->name = name; ffc1919c: 93 fd 00 0c stw r31,12(r29) &_Partition_Information, &the_partition->Object, (Objects_Name) name ); *id = the_partition->Object.id; ffc191a0: 81 01 00 14 lwz r8,20(r1) ffc191a4: 90 08 00 00 stw r0,0(r8) name, 0 /* Not used */ ); #endif _Thread_Enable_dispatch(); ffc191a8: 48 00 76 ad bl ffc20854 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc191ac: 38 60 00 00 li r3,0 ffc191b0: 4b ff ff 04 b ffc190b4 _Thread_Disable_dispatch(); /* prevents deletion */ the_partition = _Partition_Allocate(); if ( !the_partition ) { _Thread_Enable_dispatch(); ffc191b4: 48 00 76 a1 bl ffc20854 <_Thread_Enable_dispatch> return RTEMS_TOO_MANY; ffc191b8: 38 60 00 05 li r3,5 ffc191bc: 4b ff fe f8 b ffc190b4 =============================================================================== ffc1934c : rtems_status_code rtems_partition_return_buffer( rtems_id id, void *buffer ) { ffc1934c: 94 21 ff e0 stwu r1,-32(r1) ffc19350: 7c 08 02 a6 mflr r0 ffc19354: 90 01 00 24 stw r0,36(r1) ffc19358: 7c 60 1b 78 mr r0,r3 RTEMS_INLINE_ROUTINE Partition_Control *_Partition_Get ( Objects_Id id, Objects_Locations *location ) { return (Partition_Control *) ffc1935c: 3c 60 00 00 lis r3,0 ffc19360: 93 e1 00 1c stw r31,28(r1) ffc19364: 38 63 6f 20 addi r3,r3,28448 ffc19368: 7c 9f 23 78 mr r31,r4 ffc1936c: 38 a1 00 08 addi r5,r1,8 ffc19370: 93 c1 00 18 stw r30,24(r1) ffc19374: 7c 04 03 78 mr r4,r0 ffc19378: 48 00 64 11 bl ffc1f788 <_Objects_Get> register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc1937c: 80 01 00 08 lwz r0,8(r1) ffc19380: 7c 7e 1b 78 mr r30,r3 ffc19384: 2f 80 00 00 cmpwi cr7,r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc19388: 38 60 00 04 li r3,4 { register Partition_Control *the_partition; Objects_Locations location; the_partition = _Partition_Get( id, &location ); switch ( location ) { ffc1938c: 40 9e 00 58 bne- cr7,ffc193e4 ) { void *starting; void *ending; starting = the_partition->starting_address; ffc19390: 80 1e 00 10 lwz r0,16(r30) ending = _Addresses_Add_offset( starting, the_partition->length ); ffc19394: 81 3e 00 14 lwz r9,20(r30) const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc19398: 7f 9f 00 40 cmplw cr7,r31,r0 ffc1939c: 41 9c 00 60 blt- cr7,ffc193fc RTEMS_INLINE_ROUTINE void *_Addresses_Add_offset ( const void *base, uintptr_t offset ) { return (void *)((uintptr_t)base + offset); ffc193a0: 7d 20 4a 14 add r9,r0,r9 const void *address, const void *base, const void *limit ) { return (address >= base && address <= limit); ffc193a4: 7f 9f 48 40 cmplw cr7,r31,r9 ffc193a8: 41 9d 00 54 bgt- cr7,ffc193fc <== NEVER TAKEN offset = (uint32_t) _Addresses_Subtract( the_buffer, the_partition->starting_address ); return ((offset % the_partition->buffer_size) == 0); ffc193ac: 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); ffc193b0: 7c 00 f8 50 subf r0,r0,r31 ffc193b4: 7d 60 4b 96 divwu r11,r0,r9 ffc193b8: 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 ) && ffc193bc: 7f 80 48 00 cmpw cr7,r0,r9 ffc193c0: 40 9e 00 3c bne- cr7,ffc193fc RTEMS_INLINE_ROUTINE void _Partition_Free_buffer ( Partition_Control *the_partition, Chain_Node *the_buffer ) { _Chain_Append( &the_partition->Memory, the_buffer ); ffc193c4: 38 7e 00 24 addi r3,r30,36 ffc193c8: 7f e4 fb 78 mr r4,r31 ffc193cc: 48 00 3e ed bl ffc1d2b8 <_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; ffc193d0: 81 3e 00 20 lwz r9,32(r30) ffc193d4: 38 09 ff ff addi r0,r9,-1 ffc193d8: 90 1e 00 20 stw r0,32(r30) _Thread_Enable_dispatch(); ffc193dc: 48 00 74 79 bl ffc20854 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc193e0: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc193e4: 80 01 00 24 lwz r0,36(r1) ffc193e8: 83 c1 00 18 lwz r30,24(r1) ffc193ec: 7c 08 03 a6 mtlr r0 ffc193f0: 83 e1 00 1c lwz r31,28(r1) ffc193f4: 38 21 00 20 addi r1,r1,32 ffc193f8: 4e 80 00 20 blr _Partition_Free_buffer( the_partition, buffer ); the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); ffc193fc: 48 00 74 59 bl ffc20854 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc19400: 80 01 00 24 lwz r0,36(r1) the_partition->number_of_used_blocks -= 1; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); return RTEMS_INVALID_ADDRESS; ffc19404: 38 60 00 09 li r3,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc19408: 83 c1 00 18 lwz r30,24(r1) ffc1940c: 7c 08 03 a6 mtlr r0 ffc19410: 83 e1 00 1c lwz r31,28(r1) ffc19414: 38 21 00 20 addi r1,r1,32 ffc19418: 4e 80 00 20 blr =============================================================================== ffc0a21c : rtems_status_code rtems_rate_monotonic_period( rtems_id id, rtems_interval length ) { ffc0a21c: 94 21 ff d0 stwu r1,-48(r1) ffc0a220: 7c 08 02 a6 mflr r0 ffc0a224: 93 e1 00 2c stw r31,44(r1) ffc0a228: 7c 7f 1b 78 mr r31,r3 RTEMS_INLINE_ROUTINE Rate_monotonic_Control *_Rate_monotonic_Get ( Objects_Id id, Objects_Locations *location ) { return (Rate_monotonic_Control *) ffc0a22c: 3c 60 00 00 lis r3,0 ffc0a230: 93 c1 00 28 stw r30,40(r1) ffc0a234: 38 63 2c 78 addi r3,r3,11384 ffc0a238: 7c 9e 23 78 mr r30,r4 ffc0a23c: 38 a1 00 08 addi r5,r1,8 ffc0a240: 90 01 00 34 stw r0,52(r1) ffc0a244: 7f e4 fb 78 mr r4,r31 ffc0a248: 93 a1 00 24 stw r29,36(r1) ffc0a24c: 93 61 00 1c stw r27,28(r1) ffc0a250: 93 81 00 20 stw r28,32(r1) ffc0a254: 48 00 2d 8d bl ffc0cfe0 <_Objects_Get> ffc0a258: 7c 7d 1b 78 mr r29,r3 rtems_rate_monotonic_period_states local_state; ISR_Level level; the_period = _Rate_monotonic_Get( id, &location ); switch ( location ) { ffc0a25c: 80 01 00 08 lwz r0,8(r1) ffc0a260: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a264: 40 9e 00 4c bne- cr7,ffc0a2b0 RTEMS_INLINE_ROUTINE bool _Thread_Is_executing ( const Thread_Control *the_thread ) { return ( the_thread == _Thread_Executing ); ffc0a268: 3f 80 00 00 lis r28,0 case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { ffc0a26c: 81 23 00 40 lwz r9,64(r3) ffc0a270: 3b 9c 32 24 addi r28,r28,12836 ffc0a274: 80 1c 00 0c lwz r0,12(r28) ffc0a278: 7f 89 00 00 cmpw cr7,r9,r0 ffc0a27c: 41 9e 00 60 beq- cr7,ffc0a2dc _Thread_Enable_dispatch(); ffc0a280: 48 00 3e 2d bl ffc0e0ac <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a284: 80 01 00 34 lwz r0,52(r1) switch ( location ) { case OBJECTS_LOCAL: if ( !_Thread_Is_executing( the_period->owner ) ) { _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; ffc0a288: 3b e0 00 17 li r31,23 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a28c: 83 61 00 1c lwz r27,28(r1) ffc0a290: 7c 08 03 a6 mtlr r0 ffc0a294: 7f e3 fb 78 mr r3,r31 ffc0a298: 83 81 00 20 lwz r28,32(r1) ffc0a29c: 83 a1 00 24 lwz r29,36(r1) ffc0a2a0: 83 c1 00 28 lwz r30,40(r1) ffc0a2a4: 83 e1 00 2c lwz r31,44(r1) ffc0a2a8: 38 21 00 30 addi r1,r1,48 ffc0a2ac: 4e 80 00 20 blr #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a2b0: 3b e0 00 04 li r31,4 } ffc0a2b4: 80 01 00 34 lwz r0,52(r1) ffc0a2b8: 7f e3 fb 78 mr r3,r31 ffc0a2bc: 83 61 00 1c lwz r27,28(r1) ffc0a2c0: 7c 08 03 a6 mtlr r0 ffc0a2c4: 83 81 00 20 lwz r28,32(r1) ffc0a2c8: 83 a1 00 24 lwz r29,36(r1) ffc0a2cc: 83 c1 00 28 lwz r30,40(r1) ffc0a2d0: 83 e1 00 2c lwz r31,44(r1) ffc0a2d4: 38 21 00 30 addi r1,r1,48 ffc0a2d8: 4e 80 00 20 blr if ( !_Thread_Is_executing( the_period->owner ) ) { _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { ffc0a2dc: 2f 9e 00 00 cmpwi cr7,r30,0 ffc0a2e0: 41 9e 00 68 beq- cr7,ffc0a348 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a2e4: 7f 60 00 a6 mfmsr r27 ffc0a2e8: 7c 10 42 a6 mfsprg r0,0 ffc0a2ec: 7f 60 00 78 andc r0,r27,r0 ffc0a2f0: 7c 00 01 24 mtmsr r0 _Thread_Enable_dispatch(); return( return_value ); } _ISR_Disable( level ); if ( the_period->state == RATE_MONOTONIC_INACTIVE ) { ffc0a2f4: 80 03 00 38 lwz r0,56(r3) ffc0a2f8: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a2fc: 41 9e 00 74 beq- cr7,ffc0a370 _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { ffc0a300: 2f 80 00 02 cmpwi cr7,r0,2 ffc0a304: 41 9e 00 bc beq- cr7,ffc0a3c0 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc0a308: 2f 80 00 04 cmpwi cr7,r0,4 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a30c: 3b e0 00 04 li r31,4 _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } if ( the_period->state == RATE_MONOTONIC_EXPIRED ) { ffc0a310: 40 9e ff a4 bne+ cr7,ffc0a2b4 <== NEVER TAKEN /* * Update statistics from the concluding period */ _Rate_monotonic_Update_statistics( the_period ); ffc0a314: 4b ff fd e1 bl ffc0a0f4 <_Rate_monotonic_Update_statistics> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a318: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a31c: 38 00 00 02 li r0,2 the_period->next_length = length; ffc0a320: 93 dd 00 3c stw r30,60(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a324: 3c 60 00 00 lis r3,0 */ _Rate_monotonic_Update_statistics( the_period ); _ISR_Enable( level ); the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a328: 90 1d 00 38 stw r0,56(r29) ffc0a32c: 38 63 2e 48 addi r3,r3,11848 ffc0a330: 38 9d 00 10 addi r4,r29,16 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a334: 93 dd 00 1c stw r30,28(r29) the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_TIMEOUT; ffc0a338: 3b e0 00 06 li r31,6 _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a33c: 48 00 51 9d bl ffc0f4d8 <_Watchdog_Insert> the_period->state = RATE_MONOTONIC_ACTIVE; the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); ffc0a340: 48 00 3d 6d bl ffc0e0ac <_Thread_Enable_dispatch> return RTEMS_TIMEOUT; ffc0a344: 4b ff ff 70 b ffc0a2b4 _Thread_Enable_dispatch(); return RTEMS_NOT_OWNER_OF_RESOURCE; } if ( length == RTEMS_PERIOD_STATUS ) { switch ( the_period->state ) { ffc0a348: 80 03 00 38 lwz r0,56(r3) ffc0a34c: 3b e0 00 00 li r31,0 ffc0a350: 2b 80 00 04 cmplwi cr7,r0,4 ffc0a354: 41 9d 00 14 bgt- cr7,ffc0a368 <== NEVER TAKEN ffc0a358: 3d 20 ff c2 lis r9,-62 ffc0a35c: 54 00 10 3a rlwinm r0,r0,2,0,29 ffc0a360: 39 29 2a ac addi r9,r9,10924 ffc0a364: 7f e9 00 2e lwzx r31,r9,r0 case RATE_MONOTONIC_ACTIVE: default: /* unreached -- only to remove warnings */ return_value = RTEMS_SUCCESSFUL; break; } _Thread_Enable_dispatch(); ffc0a368: 48 00 3d 45 bl ffc0e0ac <_Thread_Enable_dispatch> return( return_value ); ffc0a36c: 4b ff ff 48 b ffc0a2b4 ffc0a370: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); /* * Baseline statistics information for the beginning of a period. */ _Rate_monotonic_Initiate_statistics( the_period ); ffc0a374: 4b ff fc dd bl ffc0a050 <_Rate_monotonic_Initiate_statistics> the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a378: 39 20 00 02 li r9,2 ffc0a37c: 91 3d 00 38 stw r9,56(r29) Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc0a380: 3d 20 ff c1 lis r9,-63 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0a384: 38 00 00 00 li r0,0 the_watchdog->routine = routine; ffc0a388: 39 29 a7 e4 addi r9,r9,-22556 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc0a38c: 90 1d 00 18 stw r0,24(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a390: 3c 60 00 00 lis r3,0 Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc0a394: 91 3d 00 2c stw r9,44(r29) ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a398: 38 63 2e 48 addi r3,r3,11848 ffc0a39c: 38 9d 00 10 addi r4,r29,16 void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; the_watchdog->id = id; ffc0a3a0: 93 fd 00 30 stw r31,48(r29) the_period->next_length = length; _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; ffc0a3a4: 3b e0 00 00 li r31,0 the_watchdog->user_data = user_data; ffc0a3a8: 90 1d 00 34 stw r0,52(r29) _Rate_monotonic_Timeout, id, NULL ); the_period->next_length = length; ffc0a3ac: 93 dd 00 3c stw r30,60(r29) Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc0a3b0: 93 dd 00 1c stw r30,28(r29) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc0a3b4: 48 00 51 25 bl ffc0f4d8 <_Watchdog_Insert> _Watchdog_Insert_ticks( &the_period->Timer, length ); _Thread_Enable_dispatch(); ffc0a3b8: 48 00 3c f5 bl ffc0e0ac <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a3bc: 4b ff fe f8 b ffc0a2b4 if ( the_period->state == RATE_MONOTONIC_ACTIVE ) { /* * Update statistics from the concluding period. */ _Rate_monotonic_Update_statistics( the_period ); ffc0a3c0: 4b ff fd 35 bl ffc0a0f4 <_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; ffc0a3c4: 38 00 00 01 li r0,1 ffc0a3c8: 90 1d 00 38 stw r0,56(r29) the_period->next_length = length; ffc0a3cc: 93 dd 00 3c stw r30,60(r29) ffc0a3d0: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; ffc0a3d4: 81 3c 00 0c lwz r9,12(r28) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a3d8: 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; ffc0a3dc: 80 1d 00 08 lwz r0,8(r29) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a3e0: 7d 23 4b 78 mr r3,r9 the_period->state = RATE_MONOTONIC_OWNER_IS_BLOCKING; the_period->next_length = length; _ISR_Enable( level ); _Thread_Executing->Wait.id = the_period->Object.id; ffc0a3e4: 90 09 00 20 stw r0,32(r9) _Thread_Set_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a3e8: 48 00 47 c5 bl ffc0ebac <_Thread_Set_state> static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc0a3ec: 7d 20 00 a6 mfmsr r9 ffc0a3f0: 7c 10 42 a6 mfsprg r0,0 ffc0a3f4: 7d 20 00 78 andc r0,r9,r0 ffc0a3f8: 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; ffc0a3fc: 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; ffc0a400: 80 1d 00 38 lwz r0,56(r29) the_period->state = RATE_MONOTONIC_ACTIVE; ffc0a404: 91 7d 00 38 stw r11,56(r29) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc0a408: 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 ) ffc0a40c: 2f 80 00 03 cmpwi cr7,r0,3 ffc0a410: 41 9e 00 10 beq- cr7,ffc0a420 <== NEVER TAKEN _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); _Thread_Enable_dispatch(); ffc0a414: 48 00 3c 99 bl ffc0e0ac <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a418: 3b e0 00 00 li r31,0 ffc0a41c: 4b ff fe 98 b ffc0a2b4 /* * If it did, then we want to unblock ourself and continue as * if nothing happen. The period was reset in the timeout routine. */ if ( local_state == RATE_MONOTONIC_EXPIRED_WHILE_BLOCKING ) _Thread_Clear_state( _Thread_Executing, STATES_WAITING_FOR_PERIOD ); ffc0a420: 80 7c 00 0c lwz r3,12(r28) <== NOT EXECUTED ffc0a424: 38 80 40 00 li r4,16384 <== NOT EXECUTED ffc0a428: 48 00 38 05 bl ffc0dc2c <_Thread_Clear_state> <== NOT EXECUTED ffc0a42c: 4b ff ff e8 b ffc0a414 <== NOT EXECUTED =============================================================================== ffc0a430 : */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0a430: 94 21 ff 70 stwu r1,-144(r1) ffc0a434: 7c 08 02 a6 mflr r0 ffc0a438: 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 ) ffc0a43c: 7c 80 23 79 mr. r0,r4 */ void rtems_rate_monotonic_report_statistics_with_plugin( void *context, rtems_printk_plugin_t print ) { ffc0a440: 93 a1 00 84 stw r29,132(r1) ffc0a444: 7c 7d 1b 78 mr r29,r3 ffc0a448: 93 01 00 70 stw r24,112(r1) ffc0a44c: 93 21 00 74 stw r25,116(r1) ffc0a450: 93 41 00 78 stw r26,120(r1) ffc0a454: 93 61 00 7c stw r27,124(r1) ffc0a458: 93 81 00 80 stw r28,128(r1) ffc0a45c: 93 c1 00 88 stw r30,136(r1) ffc0a460: 93 e1 00 8c stw r31,140(r1) rtems_id id; rtems_rate_monotonic_period_statistics the_stats; rtems_rate_monotonic_period_status the_status; char name[5]; if ( !print ) ffc0a464: 90 01 00 68 stw r0,104(r1) ffc0a468: 41 82 01 70 beq- ffc0a5d8 <== NEVER TAKEN return; (*print)( context, "Period information by period\n" ); ffc0a46c: 3c 80 ff c2 lis r4,-62 ffc0a470: 7c 09 03 a6 mtctr r0 ffc0a474: 38 84 2a c0 addi r4,r4,10944 /* * 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 ; ffc0a478: 3f c0 00 00 lis r30,0 ffc0a47c: 3b de 2c 78 addi r30,r30,11384 char name[5]; if ( !print ) return; (*print)( context, "Period information by period\n" ); ffc0a480: 4c c6 31 82 crclr 4*cr1+eq ffc0a484: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ (*print)( context, "--- CPU times are in seconds ---\n" ); ffc0a488: 80 01 00 68 lwz r0,104(r1) ffc0a48c: 3c 80 ff c2 lis r4,-62 ffc0a490: 7c 09 03 a6 mtctr r0 ffc0a494: 38 84 2a e0 addi r4,r4,10976 ffc0a498: 7f a3 eb 78 mr r3,r29 ffc0a49c: 4c c6 31 82 crclr 4*cr1+eq ffc0a4a0: 4e 80 04 21 bctrl (*print)( context, "--- Wall times are in seconds ---\n" ); ffc0a4a4: 80 01 00 68 lwz r0,104(r1) ffc0a4a8: 3c 80 ff c2 lis r4,-62 ffc0a4ac: 7c 09 03 a6 mtctr r0 ffc0a4b0: 38 84 2b 04 addi r4,r4,11012 ffc0a4b4: 7f a3 eb 78 mr r3,r29 ffc0a4b8: 4c c6 31 82 crclr 4*cr1+eq ffc0a4bc: 4e 80 04 21 bctrl Be sure to test the various cases. (*print)( context,"\ 1234567890123456789012345678901234567890123456789012345678901234567890123456789\ \n"); */ (*print)( context, " ID OWNER COUNT MISSED " ffc0a4c0: 80 01 00 68 lwz r0,104(r1) ffc0a4c4: 3c 80 ff c2 lis r4,-62 ffc0a4c8: 7c 09 03 a6 mtctr r0 ffc0a4cc: 38 84 2b 28 addi r4,r4,11048 ffc0a4d0: 7f a3 eb 78 mr r3,r29 ffc0a4d4: 4c c6 31 82 crclr 4*cr1+eq ffc0a4d8: 4e 80 04 21 bctrl #ifndef __RTEMS_USE_TICKS_FOR_STATISTICS__ " " #endif " WALL TIME\n" ); (*print)( context, " " ffc0a4dc: 80 01 00 68 lwz r0,104(r1) ffc0a4e0: 3c 80 ff c2 lis r4,-62 ffc0a4e4: 7c 09 03 a6 mtctr r0 ffc0a4e8: 7f a3 eb 78 mr r3,r29 ffc0a4ec: 38 84 2b 74 addi r4,r4,11124 ffc0a4f0: 4c c6 31 82 crclr 4*cr1+eq ffc0a4f4: 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 ; ffc0a4f8: 83 fe 00 08 lwz r31,8(r30) ffc0a4fc: 80 1e 00 0c lwz r0,12(r30) ffc0a500: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0a504: 41 9d 00 d4 bgt- cr7,ffc0a5d8 <== NEVER TAKEN rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0a508: 3f 40 ff c2 lis r26,-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, ffc0a50c: 3f 00 ff c2 lis r24,-62 ffc0a510: 3f 80 10 62 lis r28,4194 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, ffc0a514: 3f 20 ff c2 lis r25,-62 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a518: 3f 60 ff c2 lis r27,-62 rtems_object_get_name( the_status.owner, sizeof(name), name ); /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0a51c: 3b 5a 2b c0 addi r26,r26,11200 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, ffc0a520: 3b 18 2b d8 addi r24,r24,11224 ffc0a524: 63 9c 4d d3 ori r28,r28,19923 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, ffc0a528: 3b 39 2b f8 addi r25,r25,11256 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a52c: 3b 7b 17 20 addi r27,r27,5920 ffc0a530: 48 00 00 14 b ffc0a544 /* * 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 ; ffc0a534: 80 1e 00 0c lwz r0,12(r30) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { ffc0a538: 3b ff 00 01 addi r31,r31,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 ; ffc0a53c: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a540: 41 9c 00 98 blt- cr7,ffc0a5d8 id <= _Rate_monotonic_Information.maximum_id ; id++ ) { status = rtems_rate_monotonic_get_statistics( id, &the_stats ); ffc0a544: 7f e3 fb 78 mr r3,r31 ffc0a548: 38 81 00 30 addi r4,r1,48 ffc0a54c: 48 00 80 19 bl ffc12564 if ( status != RTEMS_SUCCESSFUL ) ffc0a550: 2f 83 00 00 cmpwi cr7,r3,0 ffc0a554: 40 9e ff e0 bne+ cr7,ffc0a534 #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 ); ffc0a558: 38 81 00 18 addi r4,r1,24 ffc0a55c: 7f e3 fb 78 mr r3,r31 ffc0a560: 48 00 81 15 bl ffc12674 #endif rtems_object_get_name( the_status.owner, sizeof(name), name ); ffc0a564: 80 61 00 18 lwz r3,24(r1) ffc0a568: 38 a1 00 08 addi r5,r1,8 ffc0a56c: 38 80 00 05 li r4,5 ffc0a570: 48 00 03 41 bl ffc0a8b0 /* * Print part of report line that is not dependent on granularity */ (*print)( context, ffc0a574: 80 01 00 68 lwz r0,104(r1) ffc0a578: 7f 44 d3 78 mr r4,r26 ffc0a57c: 80 e1 00 30 lwz r7,48(r1) ffc0a580: 7f e5 fb 78 mr r5,r31 ffc0a584: 7c 09 03 a6 mtctr r0 ffc0a588: 7f a3 eb 78 mr r3,r29 ffc0a58c: 81 01 00 34 lwz r8,52(r1) ffc0a590: 38 c1 00 08 addi r6,r1,8 ffc0a594: 4c c6 31 82 crclr 4*cr1+eq ffc0a598: 4e 80 04 21 bctrl ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a59c: 80 01 00 30 lwz r0,48(r1) 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 ); ffc0a5a0: 38 61 00 48 addi r3,r1,72 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a5a4: 2f 80 00 00 cmpwi cr7,r0,0 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 ); ffc0a5a8: 38 a1 00 10 addi r5,r1,16 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a5ac: 7f 64 db 78 mr r4,r27 ); /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { ffc0a5b0: 40 9e 00 58 bne- cr7,ffc0a608 (*print)( context, "\n" ); ffc0a5b4: 80 01 00 68 lwz r0,104(r1) ffc0a5b8: 7f a3 eb 78 mr r3,r29 * 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++ ) { ffc0a5bc: 3b ff 00 01 addi r31,r31,1 /* * If the count is zero, don't print statistics */ if (the_stats.count == 0) { (*print)( context, "\n" ); ffc0a5c0: 7c 09 03 a6 mtctr r0 ffc0a5c4: 4c c6 31 82 crclr 4*cr1+eq ffc0a5c8: 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 ; ffc0a5cc: 80 1e 00 0c lwz r0,12(r30) ffc0a5d0: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a5d4: 40 9c ff 70 bge+ cr7,ffc0a544 <== ALWAYS TAKEN the_stats.min_wall_time, the_stats.max_wall_time, ival_wall, fval_wall ); #endif } } } ffc0a5d8: 80 01 00 94 lwz r0,148(r1) ffc0a5dc: 83 01 00 70 lwz r24,112(r1) ffc0a5e0: 7c 08 03 a6 mtlr r0 ffc0a5e4: 83 21 00 74 lwz r25,116(r1) ffc0a5e8: 83 41 00 78 lwz r26,120(r1) ffc0a5ec: 83 61 00 7c lwz r27,124(r1) ffc0a5f0: 83 81 00 80 lwz r28,128(r1) ffc0a5f4: 83 a1 00 84 lwz r29,132(r1) ffc0a5f8: 83 c1 00 88 lwz r30,136(r1) ffc0a5fc: 83 e1 00 8c lwz r31,140(r1) ffc0a600: 38 21 00 90 addi r1,r1,144 ffc0a604: 4e 80 00 20 blr 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 ); ffc0a608: 7c 04 03 78 mr r4,r0 ffc0a60c: 48 00 48 a5 bl ffc0eeb0 <_Timespec_Divide_by_integer> (*print)( context, ffc0a610: 80 01 00 14 lwz r0,20(r1) ffc0a614: 80 81 00 3c lwz r4,60(r1) ffc0a618: 7f a3 eb 78 mr r3,r29 ffc0a61c: 81 61 00 44 lwz r11,68(r1) ffc0a620: 7d 40 e0 96 mulhw r10,r0,r28 ffc0a624: 80 e1 00 40 lwz r7,64(r1) ffc0a628: 7c c4 e0 96 mulhw r6,r4,r28 ffc0a62c: 81 21 00 10 lwz r9,16(r1) ffc0a630: 80 a1 00 38 lwz r5,56(r1) ffc0a634: 7d 0b e0 96 mulhw r8,r11,r28 ffc0a638: 7c 00 fe 70 srawi r0,r0,31 ffc0a63c: 7d 4a 36 70 srawi r10,r10,6 ffc0a640: 7d 40 50 50 subf r10,r0,r10 ffc0a644: 80 01 00 68 lwz r0,104(r1) ffc0a648: 7d 6b fe 70 srawi r11,r11,31 ffc0a64c: 7c 84 fe 70 srawi r4,r4,31 ffc0a650: 7c 09 03 a6 mtctr r0 ffc0a654: 7c c6 36 70 srawi r6,r6,6 ffc0a658: 7d 08 36 70 srawi r8,r8,6 ffc0a65c: 7c c4 30 50 subf r6,r4,r6 ffc0a660: 7d 0b 40 50 subf r8,r11,r8 ffc0a664: 7f 04 c3 78 mr r4,r24 ffc0a668: 4c c6 31 82 crclr 4*cr1+eq ffc0a66c: 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); ffc0a670: 80 81 00 30 lwz r4,48(r1) ffc0a674: 38 61 00 60 addi r3,r1,96 ffc0a678: 38 a1 00 10 addi r5,r1,16 ffc0a67c: 48 00 48 35 bl ffc0eeb0 <_Timespec_Divide_by_integer> (*print)( context, ffc0a680: 80 01 00 14 lwz r0,20(r1) ffc0a684: 80 c1 00 54 lwz r6,84(r1) ffc0a688: 7f a3 eb 78 mr r3,r29 ffc0a68c: 81 61 00 5c lwz r11,92(r1) ffc0a690: 7d 40 e0 96 mulhw r10,r0,r28 ffc0a694: 80 a1 00 50 lwz r5,80(r1) ffc0a698: 7d 86 e0 96 mulhw r12,r6,r28 ffc0a69c: 80 e1 00 58 lwz r7,88(r1) ffc0a6a0: 81 21 00 10 lwz r9,16(r1) ffc0a6a4: 7d 0b e0 96 mulhw r8,r11,r28 ffc0a6a8: 7c 00 fe 70 srawi r0,r0,31 ffc0a6ac: 7d 4a 36 70 srawi r10,r10,6 ffc0a6b0: 7d 40 50 50 subf r10,r0,r10 ffc0a6b4: 80 01 00 68 lwz r0,104(r1) ffc0a6b8: 7d 8c 36 70 srawi r12,r12,6 ffc0a6bc: 7d 6b fe 70 srawi r11,r11,31 ffc0a6c0: 7c 09 03 a6 mtctr r0 ffc0a6c4: 7c c6 fe 70 srawi r6,r6,31 ffc0a6c8: 7d 08 36 70 srawi r8,r8,6 ffc0a6cc: 7f 24 cb 78 mr r4,r25 ffc0a6d0: 7c c6 60 50 subf r6,r6,r12 ffc0a6d4: 7d 0b 40 50 subf r8,r11,r8 ffc0a6d8: 4c c6 31 82 crclr 4*cr1+eq ffc0a6dc: 4e 80 04 21 bctrl ffc0a6e0: 4b ff fe 54 b ffc0a534 =============================================================================== ffc0a6f4 : * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc0a6f4: 3d 20 00 00 lis r9,0 /* * rtems_rate_monotonic_reset_all_statistics */ void rtems_rate_monotonic_reset_all_statistics( void ) { ffc0a6f8: 94 21 ff f0 stwu r1,-16(r1) ffc0a6fc: 7c 08 02 a6 mflr r0 ffc0a700: 81 69 28 4c lwz r11,10316(r9) ffc0a704: 90 01 00 14 stw r0,20(r1) ffc0a708: 38 0b 00 01 addi r0,r11,1 ffc0a70c: 90 09 28 4c stw r0,10316(r9) ffc0a710: 93 c1 00 08 stw r30,8(r1) ffc0a714: 93 e1 00 0c stw r31,12(r1) return _Thread_Dispatch_disable_level; ffc0a718: 80 09 28 4c lwz r0,10316(r9) /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; ffc0a71c: 3f c0 00 00 lis r30,0 ffc0a720: 3b de 2c 78 addi r30,r30,11384 ffc0a724: 83 fe 00 08 lwz r31,8(r30) ffc0a728: 80 1e 00 0c lwz r0,12(r30) ffc0a72c: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0a730: 41 9d 00 1c bgt- cr7,ffc0a74c <== NEVER TAKEN id <= _Rate_monotonic_Information.maximum_id ; id++ ) { (void) rtems_rate_monotonic_reset_statistics( id ); ffc0a734: 7f e3 fb 78 mr r3,r31 ffc0a738: 48 00 00 31 bl ffc0a768 /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; ffc0a73c: 80 1e 00 0c lwz r0,12(r30) id <= _Rate_monotonic_Information.maximum_id ; id++ ) { ffc0a740: 3b ff 00 01 addi r31,r31,1 /* * Cycle through all possible ids and try to reset each one. If it * is a period that is inactive, we just get an error back. No big deal. */ for ( id=_Rate_monotonic_Information.minimum_id ; ffc0a744: 7f 80 f8 40 cmplw cr7,r0,r31 ffc0a748: 40 9c ff ec bge+ cr7,ffc0a734 } /* * Done so exit thread dispatching disabled critical section. */ _Thread_Enable_dispatch(); ffc0a74c: 48 00 39 61 bl ffc0e0ac <_Thread_Enable_dispatch> } ffc0a750: 80 01 00 14 lwz r0,20(r1) ffc0a754: 83 c1 00 08 lwz r30,8(r1) ffc0a758: 7c 08 03 a6 mtlr r0 ffc0a75c: 83 e1 00 0c lwz r31,12(r1) ffc0a760: 38 21 00 10 addi r1,r1,16 ffc0a764: 4e 80 00 20 blr =============================================================================== ffc1ad24 : rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc1ad24: 94 21 ff e0 stwu r1,-32(r1) ffc1ad28: 7c 08 02 a6 mflr r0 ffc1ad2c: 93 e1 00 1c stw r31,28(r1) register Thread_Control *the_thread; Objects_Locations location; RTEMS_API_Control *api; ASR_Information *asr; if ( !signal_set ) ffc1ad30: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_signal_send( rtems_id id, rtems_signal_set signal_set ) { ffc1ad34: 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; ffc1ad38: 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 ) ffc1ad3c: 40 82 00 1c bne- ffc1ad58 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1ad40: 7c 03 03 78 mr r3,r0 ffc1ad44: 80 01 00 24 lwz r0,36(r1) ffc1ad48: 83 e1 00 1c lwz r31,28(r1) ffc1ad4c: 38 21 00 20 addi r1,r1,32 ffc1ad50: 7c 08 03 a6 mtlr r0 ffc1ad54: 4e 80 00 20 blr ASR_Information *asr; if ( !signal_set ) return RTEMS_INVALID_NUMBER; the_thread = _Thread_Get( id, &location ); ffc1ad58: 38 81 00 08 addi r4,r1,8 ffc1ad5c: 48 00 5b 35 bl ffc20890 <_Thread_Get> switch ( location ) { ffc1ad60: 80 01 00 08 lwz r0,8(r1) ffc1ad64: 2f 80 00 00 cmpwi cr7,r0,0 ffc1ad68: 40 9e 00 6c bne- cr7,ffc1add4 case OBJECTS_LOCAL: api = the_thread->API_Extensions[ THREAD_API_RTEMS ]; ffc1ad6c: 81 23 01 30 lwz r9,304(r3) asr = &api->Signal; if ( ! _ASR_Is_null_handler( asr->handler ) ) { ffc1ad70: 80 09 00 0c lwz r0,12(r9) ffc1ad74: 2f 80 00 00 cmpwi cr7,r0,0 ffc1ad78: 41 9e 00 78 beq- cr7,ffc1adf0 if ( asr->is_enabled ) { ffc1ad7c: 88 09 00 08 lbz r0,8(r9) ffc1ad80: 2f 80 00 00 cmpwi cr7,r0,0 static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc1ad84: 7c 00 00 a6 mfmsr r0 ffc1ad88: 7d 70 42 a6 mfsprg r11,0 ffc1ad8c: 7c 0b 58 78 andc r11,r0,r11 ffc1ad90: 7d 60 01 24 mtmsr r11 ffc1ad94: 41 9e 00 68 beq- cr7,ffc1adfc ) { ISR_Level _level; _ISR_Disable( _level ); *signal_set |= signals; ffc1ad98: 81 69 00 14 lwz r11,20(r9) ffc1ad9c: 7d 7f fb 78 or r31,r11,r31 ffc1ada0: 93 e9 00 14 stw r31,20(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc1ada4: 7c 00 01 24 mtmsr r0 _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) ffc1ada8: 3d 20 00 00 lis r9,0 ffc1adac: 39 29 75 44 addi r9,r9,30020 ffc1adb0: 80 09 00 08 lwz r0,8(r9) ffc1adb4: 2f 80 00 00 cmpwi cr7,r0,0 ffc1adb8: 41 9e 00 10 beq- cr7,ffc1adc8 ffc1adbc: 80 09 00 0c lwz r0,12(r9) ffc1adc0: 7f 83 00 00 cmpw cr7,r3,r0 ffc1adc4: 41 9e 00 4c beq- cr7,ffc1ae10 <== ALWAYS TAKEN _Thread_Dispatch_necessary = true; } else { _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); ffc1adc8: 48 00 5a 8d bl ffc20854 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc1adcc: 38 00 00 00 li r0,0 ffc1add0: 4b ff ff 70 b ffc1ad40 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1add4: 38 00 00 04 li r0,4 } ffc1add8: 83 e1 00 1c lwz r31,28(r1) ffc1addc: 7c 03 03 78 mr r3,r0 ffc1ade0: 80 01 00 24 lwz r0,36(r1) ffc1ade4: 38 21 00 20 addi r1,r1,32 ffc1ade8: 7c 08 03 a6 mtlr r0 ffc1adec: 4e 80 00 20 blr _ASR_Post_signals( signal_set, &asr->signals_pending ); } _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } _Thread_Enable_dispatch(); ffc1adf0: 48 00 5a 65 bl ffc20854 <_Thread_Enable_dispatch> return RTEMS_NOT_DEFINED; ffc1adf4: 38 00 00 0b li r0,11 ffc1adf8: 4b ff ff 48 b ffc1ad40 ffc1adfc: 81 69 00 18 lwz r11,24(r9) ffc1ae00: 7d 7f fb 78 or r31,r11,r31 ffc1ae04: 93 e9 00 18 stw r31,24(r9) ffc1ae08: 7c 00 01 24 mtmsr r0 ffc1ae0c: 4b ff ff bc b ffc1adc8 if ( ! _ASR_Is_null_handler( asr->handler ) ) { if ( asr->is_enabled ) { _ASR_Post_signals( signal_set, &asr->signals_posted ); if ( _ISR_Is_in_progress() && _Thread_Is_executing( the_thread ) ) _Thread_Dispatch_necessary = true; ffc1ae10: 38 00 00 01 li r0,1 ffc1ae14: 98 09 00 18 stb r0,24(r9) ffc1ae18: 4b ff ff b0 b ffc1adc8 =============================================================================== ffc1351c : ASR_Information *asr; bool is_asr_enabled = false; bool needs_asr_dispatching = false; rtems_mode old_mode; if ( !previous_mode_set ) ffc1351c: 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 ) { ffc13520: 7c 08 02 a6 mflr r0 ffc13524: 94 21 ff f8 stwu r1,-8(r1) ffc13528: 90 01 00 0c stw r0,12(r1) ffc1352c: 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; ffc13530: 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 ) ffc13534: 41 82 01 34 beq- ffc13668 return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; ffc13538: 3c c0 00 00 lis r6,0 ffc1353c: 38 c6 31 44 addi r6,r6,12612 ffc13540: 81 26 00 0c lwz r9,12(r6) 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 ) ffc13544: 81 69 00 7c lwz r11,124(r9) executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; ffc13548: 89 09 00 74 lbz r8,116(r9) if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc1354c: 2f 8b 00 00 cmpwi cr7,r11,0 if ( !previous_mode_set ) return RTEMS_INVALID_ADDRESS; executing = _Thread_Executing; api = executing->API_Extensions[ THREAD_API_RTEMS ]; ffc13550: 81 69 01 30 lwz r11,304(r9) asr = &api->Signal; old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; ffc13554: 7d 08 00 34 cntlzw r8,r8 ffc13558: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc1355c: 55 07 40 2e rlwinm r7,r8,8,0,23 if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) ffc13560: 40 9e 01 18 bne- cr7,ffc13678 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc13564: 89 0b 00 08 lbz r8,8(r11) #ifndef ASM static inline uint32_t _CPU_ISR_Get_level( void ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc13568: 39 40 00 00 li r10,0 ffc1356c: 7d 08 00 34 cntlzw r8,r8 ffc13570: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc13574: 55 08 50 2a rlwinm r8,r8,10,0,21 ffc13578: 7d 07 3b 78 or r7,r8,r7 ffc1357c: 7d 40 00 a6 mfmsr r10 if (msr & MSR_EE) return 0; ffc13580: 55 48 8f fe rlwinm r8,r10,17,31,31 ffc13584: 2f 88 00 00 cmpwi cr7,r8,0 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc13588: 70 8a 01 00 andi. r10,r4,256 ffc1358c: 7d 40 00 26 mfcr r10 ffc13590: 55 4a ff fe rlwinm r10,r10,31,31,31 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; old_mode |= _ISR_Get_level(); ffc13594: 7c e7 53 78 or r7,r7,r10 *previous_mode_set = old_mode; ffc13598: 90 e5 00 00 stw r7,0(r5) /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc1359c: 41 82 00 14 beq- ffc135b0 executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; ffc135a0: 70 08 01 00 andi. r8,r0,256 ffc135a4: 7d 40 00 26 mfcr r10 ffc135a8: 55 4a 1f fe rlwinm r10,r10,3,31,31 ffc135ac: 99 49 00 74 stb r10,116(r9) if ( mask & RTEMS_TIMESLICE_MASK ) { ffc135b0: 70 8a 02 00 andi. r10,r4,512 ffc135b4: 41 82 00 20 beq- ffc135d4 if ( _Modes_Is_timeslice(mode_set) ) { ffc135b8: 70 0a 02 00 andi. r10,r0,512 ffc135bc: 41 82 01 44 beq- ffc13700 executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc135c0: 3d 40 00 00 lis r10,0 ffc135c4: 81 4a 28 08 lwz r10,10248(r10) if ( mask & RTEMS_PREEMPT_MASK ) executing->is_preemptible = _Modes_Is_preempt(mode_set) ? true : false; if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; ffc135c8: 39 00 00 01 li r8,1 ffc135cc: 91 09 00 7c stw r8,124(r9) executing->cpu_time_budget = _Thread_Ticks_per_timeslice; ffc135d0: 91 49 00 78 stw r10,120(r9) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc135d4: 70 88 00 01 andi. r8,r4,1 ffc135d8: 41 82 00 20 beq- ffc135f8 } static inline void _CPU_ISR_Set_level( uint32_t level ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc135dc: 39 20 00 00 li r9,0 ffc135e0: 7d 20 00 a6 mfmsr r9 if (!(level & CPU_MODES_INTERRUPT_MASK)) { ffc135e4: 70 0a 00 01 andi. r10,r0,1 static inline uint32_t ppc_interrupt_get_disable_mask( void ) { uint32_t mask; __asm__ volatile ( ffc135e8: 7d 50 42 a6 mfsprg r10,0 ffc135ec: 40 82 01 24 bne- ffc13710 msr |= ppc_interrupt_get_disable_mask(); ffc135f0: 7d 49 4b 78 or r9,r10,r9 } else { msr &= ~ppc_interrupt_get_disable_mask(); } _CPU_MSR_SET(msr); ffc135f4: 7d 20 01 24 mtmsr r9 * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; if ( mask & RTEMS_ASR_MASK ) { ffc135f8: 70 88 04 00 andi. r8,r4,1024 /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc135fc: 39 40 00 00 li r10,0 if ( mask & RTEMS_ASR_MASK ) { ffc13600: 41 82 00 54 beq- ffc13654 * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( ffc13604: 70 09 04 00 andi. r9,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 ) { ffc13608: 89 2b 00 08 lbz r9,8(r11) * Output: * *previous_mode_set - previous mode set * always return RTEMS_SUCCESSFUL; */ rtems_status_code rtems_task_mode( ffc1360c: 7c 00 00 26 mfcr r0 ffc13610: 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 ) { ffc13614: 7f 89 00 00 cmpw cr7,r9,r0 ffc13618: 41 9e 00 3c beq- cr7,ffc13654 asr->is_enabled = is_asr_enabled; ffc1361c: 98 0b 00 08 stb r0,8(r11) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc13620: 7c 00 00 a6 mfmsr r0 ffc13624: 7d 30 42 a6 mfsprg r9,0 ffc13628: 7c 09 48 78 andc r9,r0,r9 ffc1362c: 7d 20 01 24 mtmsr r9 { rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; ffc13630: 81 4b 00 18 lwz r10,24(r11) information->signals_pending = information->signals_posted; ffc13634: 81 2b 00 14 lwz r9,20(r11) information->signals_posted = _signals; ffc13638: 91 4b 00 14 stw r10,20(r11) rtems_signal_set _signals; ISR_Level _level; _ISR_Disable( _level ); _signals = information->signals_pending; information->signals_pending = information->signals_posted; ffc1363c: 91 2b 00 18 stw r9,24(r11) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc13640: 7c 00 01 24 mtmsr r0 _ASR_Swap_signals( asr ); if ( _ASR_Are_signals_pending( asr ) ) { ffc13644: 80 0b 00 14 lwz r0,20(r11) needs_asr_dispatching = true; ffc13648: 39 40 00 01 li r10,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 ) ) { ffc1364c: 2f 80 00 00 cmpwi cr7,r0,0 ffc13650: 41 9e 00 cc beq- cr7,ffc1371c needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc13654: 3d 20 00 00 lis r9,0 ffc13658: 80 09 28 48 lwz r0,10312(r9) if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; ffc1365c: 38 60 00 00 li r3,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc13660: 2f 80 00 03 cmpwi cr7,r0,3 ffc13664: 41 9e 00 58 beq- cr7,ffc136bc if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; } ffc13668: 80 01 00 0c lwz r0,12(r1) ffc1366c: 38 21 00 08 addi r1,r1,8 ffc13670: 7c 08 03 a6 mtlr r0 ffc13674: 4e 80 00 20 blr if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc13678: 89 0b 00 08 lbz r8,8(r11) old_mode = (executing->is_preemptible) ? RTEMS_PREEMPT : RTEMS_NO_PREEMPT; if ( executing->budget_algorithm == THREAD_CPU_BUDGET_ALGORITHM_NONE ) old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; ffc1367c: 60 e7 02 00 ori r7,r7,512 #ifndef ASM static inline uint32_t _CPU_ISR_Get_level( void ) { register unsigned int msr; _CPU_MSR_GET(msr); ffc13680: 39 40 00 00 li r10,0 old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; ffc13684: 7d 08 00 34 cntlzw r8,r8 ffc13688: 55 08 d9 7e rlwinm r8,r8,27,5,31 ffc1368c: 55 08 50 2a rlwinm r8,r8,10,0,21 ffc13690: 7d 07 3b 78 or r7,r8,r7 ffc13694: 7d 40 00 a6 mfmsr r10 if (msr & MSR_EE) return 0; ffc13698: 55 48 8f fe rlwinm r8,r10,17,31,31 ffc1369c: 2f 88 00 00 cmpwi cr7,r8,0 *previous_mode_set = old_mode; /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc136a0: 70 8a 01 00 andi. r10,r4,256 ffc136a4: 7d 40 00 26 mfcr r10 ffc136a8: 55 4a ff fe rlwinm r10,r10,31,31,31 old_mode |= RTEMS_NO_TIMESLICE; else old_mode |= RTEMS_TIMESLICE; old_mode |= (asr->is_enabled) ? RTEMS_ASR : RTEMS_NO_ASR; old_mode |= _ISR_Get_level(); ffc136ac: 7c e7 53 78 or r7,r7,r10 *previous_mode_set = old_mode; ffc136b0: 90 e5 00 00 stw r7,0(r5) /* * These are generic thread scheduling characteristics. */ if ( mask & RTEMS_PREEMPT_MASK ) ffc136b4: 41 a2 fe fc beq- ffc135b0 ffc136b8: 4b ff fe e8 b ffc135a0 { Thread_Control *executing; executing = _Thread_Executing; if ( are_signals_pending || ffc136bc: 2f 8a 00 00 cmpwi cr7,r10,0 bool are_signals_pending ) { Thread_Control *executing; executing = _Thread_Executing; ffc136c0: 81 26 00 0c lwz r9,12(r6) if ( are_signals_pending || ffc136c4: 40 9e 00 1c bne- cr7,ffc136e0 ffc136c8: 80 06 00 10 lwz r0,16(r6) ffc136cc: 7f 89 00 00 cmpw cr7,r9,r0 ffc136d0: 41 be ff 98 beq- cr7,ffc13668 (!_Thread_Is_heir( executing ) && executing->is_preemptible) ) { ffc136d4: 88 09 00 74 lbz r0,116(r9) ffc136d8: 2f 80 00 00 cmpwi cr7,r0,0 ffc136dc: 41 be ff 8c beq- cr7,ffc13668 <== NEVER TAKEN _Thread_Dispatch_necessary = true; ffc136e0: 38 00 00 01 li r0,1 ffc136e4: 98 06 00 18 stb r0,24(r6) } } if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); ffc136e8: 4b ff 8b 75 bl ffc0c25c <_Thread_Dispatch> } return RTEMS_SUCCESSFUL; } ffc136ec: 80 01 00 0c lwz r0,12(r1) if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; ffc136f0: 38 60 00 00 li r3,0 } ffc136f4: 7c 08 03 a6 mtlr r0 ffc136f8: 38 21 00 08 addi r1,r1,8 ffc136fc: 4e 80 00 20 blr } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc13700: 70 88 00 01 andi. r8,r4,1 if ( mask & RTEMS_TIMESLICE_MASK ) { if ( _Modes_Is_timeslice(mode_set) ) { executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_RESET_TIMESLICE; executing->cpu_time_budget = _Thread_Ticks_per_timeslice; } else executing->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_NONE; ffc13704: 91 49 00 7c stw r10,124(r9) } /* * Set the new interrupt level */ if ( mask & RTEMS_INTERRUPT_MASK ) ffc13708: 41 a2 fe f0 beq- ffc135f8 ffc1370c: 4b ff fe d0 b ffc135dc _CPU_MSR_GET(msr); if (!(level & CPU_MODES_INTERRUPT_MASK)) { msr |= ppc_interrupt_get_disable_mask(); } else { msr &= ~ppc_interrupt_get_disable_mask(); ffc13710: 7d 29 50 78 andc r9,r9,r10 } _CPU_MSR_SET(msr); ffc13714: 7d 20 01 24 mtmsr r9 */ RTEMS_INLINE_ROUTINE void _Modes_Set_interrupt_level ( Modes_Control mode_set ) { _ISR_Set_level( _Modes_Get_interrupt_level( mode_set ) ); ffc13718: 4b ff fe e0 b ffc135f8 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc1371c: 3d 20 00 00 lis r9,0 ffc13720: 80 09 28 48 lwz r0,10312(r9) /* * This is specific to the RTEMS API */ is_asr_enabled = false; needs_asr_dispatching = false; ffc13724: 39 40 00 00 li r10,0 if ( _System_state_Is_up( _System_state_Get() ) ) { if (_Thread_Evaluate_is_dispatch_needed( needs_asr_dispatching ) ) _Thread_Dispatch(); } return RTEMS_SUCCESSFUL; ffc13728: 38 60 00 00 li r3,0 needs_asr_dispatching = true; } } } if ( _System_state_Is_up( _System_state_Get() ) ) { ffc1372c: 2f 80 00 03 cmpwi cr7,r0,3 ffc13730: 40 9e ff 38 bne+ cr7,ffc13668 <== NEVER TAKEN ffc13734: 4b ff ff 88 b ffc136bc =============================================================================== ffc0e8a8 : rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { ffc0e8a8: 7d 80 00 26 mfcr r12 register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0e8ac: 2e 04 00 00 cmpwi cr4,r4,0 rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { ffc0e8b0: 94 21 ff d8 stwu r1,-40(r1) ffc0e8b4: 7c 08 02 a6 mflr r0 ffc0e8b8: 93 e1 00 24 stw r31,36(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0e8bc: 7c 9f 23 78 mr r31,r4 rtems_status_code rtems_task_set_priority( rtems_id id, rtems_task_priority new_priority, rtems_task_priority *old_priority ) { ffc0e8c0: 90 01 00 2c stw r0,44(r1) ffc0e8c4: 91 81 00 20 stw r12,32(r1) register Thread_Control *the_thread; Objects_Locations location; if ( new_priority != RTEMS_CURRENT_PRIORITY && ffc0e8c8: 41 92 00 18 beq- cr4,ffc0e8e0 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 ) ); ffc0e8cc: 3d 20 00 00 lis r9,0 ffc0e8d0: 89 29 27 44 lbz r9,10052(r9) !_RTEMS_tasks_Priority_is_valid( new_priority ) ) return RTEMS_INVALID_PRIORITY; ffc0e8d4: 38 00 00 13 li r0,19 */ RTEMS_INLINE_ROUTINE bool _RTEMS_tasks_Priority_is_valid ( rtems_task_priority the_priority ) { return ( ( the_priority >= RTEMS_MINIMUM_PRIORITY ) && ffc0e8d8: 7f 84 48 40 cmplw cr7,r4,r9 ffc0e8dc: 41 9d 00 68 bgt- cr7,ffc0e944 if ( !old_priority ) ffc0e8e0: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc0e8e4: 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 ) ffc0e8e8: 41 9e 00 5c beq- cr7,ffc0e944 return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get( id, &location ); ffc0e8ec: 38 81 00 08 addi r4,r1,8 ffc0e8f0: 90 a1 00 18 stw r5,24(r1) ffc0e8f4: 48 00 2e 2d bl ffc11720 <_Thread_Get> switch ( location ) { ffc0e8f8: 80 01 00 08 lwz r0,8(r1) ffc0e8fc: 80 a1 00 18 lwz r5,24(r1) ffc0e900: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e904: 40 9e 00 60 bne- cr7,ffc0e964 case OBJECTS_LOCAL: /* XXX need helper to "convert" from core priority */ *old_priority = the_thread->current_priority; ffc0e908: 80 03 00 14 lwz r0,20(r3) ffc0e90c: 90 05 00 00 stw r0,0(r5) if ( new_priority != RTEMS_CURRENT_PRIORITY ) { ffc0e910: 41 92 00 2c beq- cr4,ffc0e93c the_thread->real_priority = new_priority; if ( the_thread->resource_count == 0 || ffc0e914: 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; ffc0e918: 93 e3 00 18 stw r31,24(r3) if ( the_thread->resource_count == 0 || ffc0e91c: 2f 80 00 00 cmpwi cr7,r0,0 ffc0e920: 41 9e 00 10 beq- cr7,ffc0e930 ffc0e924: 80 03 00 14 lwz r0,20(r3) ffc0e928: 7f 9f 00 40 cmplw cr7,r31,r0 ffc0e92c: 40 9c 00 10 bge- cr7,ffc0e93c <== ALWAYS TAKEN the_thread->current_priority > new_priority ) _Thread_Change_priority( the_thread, new_priority, false ); ffc0e930: 7f e4 fb 78 mr r4,r31 ffc0e934: 38 a0 00 00 li r5,0 ffc0e938: 48 00 27 91 bl ffc110c8 <_Thread_Change_priority> } _Thread_Enable_dispatch(); ffc0e93c: 48 00 2d a9 bl ffc116e4 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0e940: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0e944: 7c 03 03 78 mr r3,r0 ffc0e948: 80 01 00 2c lwz r0,44(r1) ffc0e94c: 81 81 00 20 lwz r12,32(r1) ffc0e950: 7c 08 03 a6 mtlr r0 ffc0e954: 83 e1 00 24 lwz r31,36(r1) ffc0e958: 7d 80 81 20 mtcrf 8,r12 ffc0e95c: 38 21 00 28 addi r1,r1,40 ffc0e960: 4e 80 00 20 blr case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0e964: 38 00 00 04 li r0,4 } ffc0e968: 81 81 00 20 lwz r12,32(r1) ffc0e96c: 7c 03 03 78 mr r3,r0 ffc0e970: 80 01 00 2c lwz r0,44(r1) ffc0e974: 83 e1 00 24 lwz r31,36(r1) ffc0e978: 7d 80 81 20 mtcrf 8,r12 ffc0e97c: 7c 08 03 a6 mtlr r0 ffc0e980: 38 21 00 28 addi r1,r1,40 ffc0e984: 4e 80 00 20 blr =============================================================================== ffc0a4d8 : rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { ffc0a4d8: 94 21 ff e0 stwu r1,-32(r1) ffc0a4dc: 7c 08 02 a6 mflr r0 ffc0a4e0: 93 e1 00 1c stw r31,28(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) ffc0a4e4: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_task_variable_delete( rtems_id tid, void **ptr ) { ffc0a4e8: 90 01 00 24 stw r0,36(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) return RTEMS_INVALID_ADDRESS; ffc0a4ec: 38 00 00 09 li r0,9 { Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp, *prev; if ( !ptr ) ffc0a4f0: 41 82 00 58 beq- ffc0a548 return RTEMS_INVALID_ADDRESS; prev = NULL; the_thread = _Thread_Get (tid, &location); ffc0a4f4: 38 81 00 08 addi r4,r1,8 ffc0a4f8: 48 00 2b c1 bl ffc0d0b8 <_Thread_Get> switch (location) { ffc0a4fc: 80 01 00 08 lwz r0,8(r1) ffc0a500: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a504: 40 9e 00 5c bne- cr7,ffc0a560 case OBJECTS_LOCAL: tvp = the_thread->task_variables; ffc0a508: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc0a50c: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a510: 41 9e 00 30 beq- cr7,ffc0a540 if (tvp->ptr == ptr) { ffc0a514: 80 09 00 04 lwz r0,4(r9) ffc0a518: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a51c: 40 be 00 18 bne+ cr7,ffc0a534 ffc0a520: 48 00 00 74 b ffc0a594 ffc0a524: 80 04 00 04 lwz r0,4(r4) ffc0a528: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a52c: 41 9e 00 50 beq- cr7,ffc0a57c ffc0a530: 7c 89 23 78 mr r9,r4 _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; ffc0a534: 80 89 00 00 lwz r4,0(r9) the_thread = _Thread_Get (tid, &location); switch (location) { case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { ffc0a538: 2f 84 00 00 cmpwi cr7,r4,0 ffc0a53c: 40 9e ff e8 bne+ cr7,ffc0a524 <== ALWAYS TAKEN return RTEMS_SUCCESSFUL; } prev = tvp; tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); ffc0a540: 48 00 2b 3d bl ffc0d07c <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; ffc0a544: 38 00 00 09 li r0,9 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a548: 7c 03 03 78 mr r3,r0 ffc0a54c: 80 01 00 24 lwz r0,36(r1) ffc0a550: 83 e1 00 1c lwz r31,28(r1) ffc0a554: 38 21 00 20 addi r1,r1,32 ffc0a558: 7c 08 03 a6 mtlr r0 ffc0a55c: 4e 80 00 20 blr case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a560: 38 00 00 04 li r0,4 } ffc0a564: 83 e1 00 1c lwz r31,28(r1) ffc0a568: 7c 03 03 78 mr r3,r0 ffc0a56c: 80 01 00 24 lwz r0,36(r1) ffc0a570: 38 21 00 20 addi r1,r1,32 ffc0a574: 7c 08 03 a6 mtlr r0 ffc0a578: 4e 80 00 20 blr case OBJECTS_LOCAL: tvp = the_thread->task_variables; while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; ffc0a57c: 80 04 00 00 lwz r0,0(r4) ffc0a580: 90 09 00 00 stw r0,0(r9) else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; _RTEMS_Tasks_Invoke_task_variable_dtor( the_thread, tvp ); ffc0a584: 48 00 00 d9 bl ffc0a65c <_RTEMS_Tasks_Invoke_task_variable_dtor> _Thread_Enable_dispatch(); ffc0a588: 48 00 2a f5 bl ffc0d07c <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a58c: 38 00 00 00 li r0,0 ffc0a590: 4b ff ff b8 b ffc0a548 while (tvp) { if (tvp->ptr == ptr) { if (prev) prev->next = tvp->next; else the_thread->task_variables = (rtems_task_variable_t *)tvp->next; ffc0a594: 80 09 00 00 lwz r0,0(r9) ffc0a598: 7d 24 4b 78 mr r4,r9 ffc0a59c: 90 03 01 3c stw r0,316(r3) ffc0a5a0: 4b ff ff e4 b ffc0a584 =============================================================================== ffc0a5a4 : rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a5a4: 94 21 ff d8 stwu r1,-40(r1) ffc0a5a8: 7c 08 02 a6 mflr r0 ffc0a5ac: 93 e1 00 24 stw r31,36(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) ffc0a5b0: 7c 9f 23 79 mr. r31,r4 rtems_status_code rtems_task_variable_get( rtems_id tid, void **ptr, void **result ) { ffc0a5b4: 90 01 00 2c stw r0,44(r1) Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) return RTEMS_INVALID_ADDRESS; ffc0a5b8: 38 00 00 09 li r0,9 { Thread_Control *the_thread; Objects_Locations location; rtems_task_variable_t *tvp; if ( !ptr ) ffc0a5bc: 41 82 00 60 beq- ffc0a61c return RTEMS_INVALID_ADDRESS; if ( !result ) ffc0a5c0: 2f 85 00 00 cmpwi cr7,r5,0 ffc0a5c4: 41 9e 00 58 beq- cr7,ffc0a61c return RTEMS_INVALID_ADDRESS; the_thread = _Thread_Get (tid, &location); ffc0a5c8: 38 81 00 08 addi r4,r1,8 ffc0a5cc: 90 a1 00 18 stw r5,24(r1) ffc0a5d0: 48 00 2a e9 bl ffc0d0b8 <_Thread_Get> switch (location) { ffc0a5d4: 80 01 00 08 lwz r0,8(r1) ffc0a5d8: 80 a1 00 18 lwz r5,24(r1) ffc0a5dc: 2f 80 00 00 cmpwi cr7,r0,0 ffc0a5e0: 40 9e 00 54 bne- cr7,ffc0a634 case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; ffc0a5e4: 81 23 01 3c lwz r9,316(r3) while (tvp) { ffc0a5e8: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a5ec: 40 be 00 14 bne+ cr7,ffc0a600 ffc0a5f0: 48 00 00 60 b ffc0a650 */ *result = tvp->tval; _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; ffc0a5f4: 81 29 00 00 lwz r9,0(r9) case OBJECTS_LOCAL: /* * Figure out if the variable is in this task's list. */ tvp = the_thread->task_variables; while (tvp) { ffc0a5f8: 2f 89 00 00 cmpwi cr7,r9,0 ffc0a5fc: 41 9e 00 54 beq- cr7,ffc0a650 <== NEVER TAKEN if (tvp->ptr == ptr) { ffc0a600: 80 09 00 04 lwz r0,4(r9) ffc0a604: 7f 80 f8 00 cmpw cr7,r0,r31 ffc0a608: 40 9e ff ec bne+ cr7,ffc0a5f4 /* * Should this return the current (i.e not the * saved) value if `tid' is the current task? */ *result = tvp->tval; ffc0a60c: 80 09 00 0c lwz r0,12(r9) ffc0a610: 90 05 00 00 stw r0,0(r5) _Thread_Enable_dispatch(); ffc0a614: 48 00 2a 69 bl ffc0d07c <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc0a618: 38 00 00 00 li r0,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc0a61c: 7c 03 03 78 mr r3,r0 ffc0a620: 80 01 00 2c lwz r0,44(r1) ffc0a624: 83 e1 00 24 lwz r31,36(r1) ffc0a628: 38 21 00 28 addi r1,r1,40 ffc0a62c: 7c 08 03 a6 mtlr r0 ffc0a630: 4e 80 00 20 blr #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc0a634: 38 00 00 04 li r0,4 } ffc0a638: 83 e1 00 24 lwz r31,36(r1) ffc0a63c: 7c 03 03 78 mr r3,r0 ffc0a640: 80 01 00 2c lwz r0,44(r1) ffc0a644: 38 21 00 28 addi r1,r1,40 ffc0a648: 7c 08 03 a6 mtlr r0 ffc0a64c: 4e 80 00 20 blr _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; } tvp = (rtems_task_variable_t *)tvp->next; } _Thread_Enable_dispatch(); ffc0a650: 48 00 2a 2d bl ffc0d07c <_Thread_Enable_dispatch> return RTEMS_INVALID_ADDRESS; ffc0a654: 38 00 00 09 li r0,9 ffc0a658: 4b ff ff c4 b ffc0a61c =============================================================================== ffc1ba64 : */ rtems_status_code rtems_timer_cancel( rtems_id id ) { ffc1ba64: 94 21 ff e8 stwu r1,-24(r1) ffc1ba68: 7c 08 02 a6 mflr r0 ffc1ba6c: 7c 64 1b 78 mr r4,r3 RTEMS_INLINE_ROUTINE Timer_Control *_Timer_Get ( Objects_Id id, Objects_Locations *location ) { return (Timer_Control *) ffc1ba70: 3c 60 00 00 lis r3,0 ffc1ba74: 90 01 00 1c stw r0,28(r1) ffc1ba78: 38 63 79 9c addi r3,r3,31132 ffc1ba7c: 38 a1 00 08 addi r5,r1,8 ffc1ba80: 48 00 3d 09 bl ffc1f788 <_Objects_Get> Timer_Control *the_timer; Objects_Locations location; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc1ba84: 80 01 00 08 lwz r0,8(r1) ffc1ba88: 2f 80 00 00 cmpwi cr7,r0,0 ffc1ba8c: 40 9e 00 30 bne- cr7,ffc1babc case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) ffc1ba90: 80 03 00 38 lwz r0,56(r3) ffc1ba94: 2f 80 00 04 cmpwi cr7,r0,4 ffc1ba98: 41 9e 00 0c beq- cr7,ffc1baa4 <== NEVER TAKEN (void) _Watchdog_Remove( &the_timer->Ticker ); ffc1ba9c: 38 63 00 10 addi r3,r3,16 ffc1baa0: 48 00 66 15 bl ffc220b4 <_Watchdog_Remove> _Thread_Enable_dispatch(); ffc1baa4: 48 00 4d b1 bl ffc20854 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1baa8: 80 01 00 1c lwz r0,28(r1) case OBJECTS_LOCAL: if ( !_Timer_Is_dormant_class( the_timer->the_class ) ) (void) _Watchdog_Remove( &the_timer->Ticker ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; ffc1baac: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1bab0: 7c 08 03 a6 mtlr r0 ffc1bab4: 38 21 00 18 addi r1,r1,24 ffc1bab8: 4e 80 00 20 blr ffc1babc: 80 01 00 1c lwz r0,28(r1) #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1bac0: 38 60 00 04 li r3,4 } ffc1bac4: 38 21 00 18 addi r1,r1,24 ffc1bac8: 7c 08 03 a6 mtlr r0 ffc1bacc: 4e 80 00 20 blr =============================================================================== ffc1c120 : rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc1c120: 94 21 ff c0 stwu r1,-64(r1) Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; ffc1c124: 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 ) { ffc1c128: 7c 08 02 a6 mflr r0 ffc1c12c: 93 e1 00 3c stw r31,60(r1) Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; ffc1c130: 83 e9 29 34 lwz r31,10548(r9) rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc1c134: 93 41 00 28 stw r26,40(r1) Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; ffc1c138: 3b 40 00 0e li r26,14 Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) ffc1c13c: 2f 9f 00 00 cmpwi cr7,r31,0 rtems_id id, rtems_time_of_day *wall_time, rtems_timer_service_routine_entry routine, void *user_data ) { ffc1c140: 93 a1 00 34 stw r29,52(r1) ffc1c144: 7c 7d 1b 78 mr r29,r3 ffc1c148: 93 c1 00 38 stw r30,56(r1) ffc1c14c: 7c be 2b 78 mr r30,r5 ffc1c150: 90 01 00 44 stw r0,68(r1) ffc1c154: 93 21 00 24 stw r25,36(r1) ffc1c158: 93 61 00 2c stw r27,44(r1) ffc1c15c: 93 81 00 30 stw r28,48(r1) Timer_Control *the_timer; Objects_Locations location; rtems_interval seconds; Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) ffc1c160: 41 9e 00 18 beq- cr7,ffc1c178 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) ffc1c164: 3d 20 00 00 lis r9,0 ffc1c168: 88 09 28 e4 lbz r0,10468(r9) return RTEMS_NOT_DEFINED; ffc1c16c: 3b 40 00 0b li r26,11 Timer_server_Control *timer_server = _Timer_server; if ( !timer_server ) return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) ffc1c170: 2f 80 00 00 cmpwi cr7,r0,0 ffc1c174: 40 9e 00 34 bne- cr7,ffc1c1a8 <== ALWAYS TAKEN case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; } ffc1c178: 80 01 00 44 lwz r0,68(r1) ffc1c17c: 7f 43 d3 78 mr r3,r26 ffc1c180: 83 21 00 24 lwz r25,36(r1) ffc1c184: 7c 08 03 a6 mtlr r0 ffc1c188: 83 41 00 28 lwz r26,40(r1) ffc1c18c: 83 61 00 2c lwz r27,44(r1) ffc1c190: 83 81 00 30 lwz r28,48(r1) ffc1c194: 83 a1 00 34 lwz r29,52(r1) ffc1c198: 83 c1 00 38 lwz r30,56(r1) ffc1c19c: 83 e1 00 3c lwz r31,60(r1) ffc1c1a0: 38 21 00 40 addi r1,r1,64 ffc1c1a4: 4e 80 00 20 blr return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) ffc1c1a8: 2f 85 00 00 cmpwi cr7,r5,0 return RTEMS_INVALID_ADDRESS; ffc1c1ac: 3b 40 00 09 li r26,9 return RTEMS_INCORRECT_STATE; if ( !_TOD_Is_set ) return RTEMS_NOT_DEFINED; if ( !routine ) ffc1c1b0: 41 be ff c8 beq- cr7,ffc1c178 return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc1c1b4: 7c 83 23 78 mr r3,r4 ffc1c1b8: 90 81 00 18 stw r4,24(r1) return RTEMS_INVALID_CLOCK; ffc1c1bc: 3b 40 00 14 li r26,20 return RTEMS_NOT_DEFINED; if ( !routine ) return RTEMS_INVALID_ADDRESS; if ( !_TOD_Validate( wall_time ) ) ffc1c1c0: 90 c1 00 1c stw r6,28(r1) ffc1c1c4: 4b ff c0 c1 bl ffc18284 <_TOD_Validate> ffc1c1c8: 2f 83 00 00 cmpwi cr7,r3,0 ffc1c1cc: 80 81 00 18 lwz r4,24(r1) ffc1c1d0: 41 9e ff a8 beq+ cr7,ffc1c178 return RTEMS_INVALID_CLOCK; seconds = _TOD_To_seconds( wall_time ); ffc1c1d4: 7c 83 23 78 mr r3,r4 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1c1d8: 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 ); ffc1c1dc: 4b ff c0 0d bl ffc181e8 <_TOD_To_seconds> if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1c1e0: 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 ); ffc1c1e4: 7c 7c 1b 78 mr r28,r3 if ( seconds <= _TOD_Seconds_since_epoch() ) ffc1c1e8: 7f 83 00 40 cmplw cr7,r3,r0 ffc1c1ec: 40 9d ff 8c ble+ cr7,ffc1c178 ffc1c1f0: 3c 60 00 00 lis r3,0 ffc1c1f4: 38 63 79 9c addi r3,r3,31132 ffc1c1f8: 7f a4 eb 78 mr r4,r29 ffc1c1fc: 38 a1 00 08 addi r5,r1,8 ffc1c200: 48 00 35 89 bl ffc1f788 <_Objects_Get> return RTEMS_INVALID_CLOCK; the_timer = _Timer_Get( id, &location ); switch ( location ) { ffc1c204: 83 21 00 08 lwz r25,8(r1) ffc1c208: 7c 7a 1b 78 mr r26,r3 ffc1c20c: 2f 99 00 00 cmpwi cr7,r25,0 ffc1c210: 40 9e 00 54 bne- cr7,ffc1c264 case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); ffc1c214: 38 63 00 10 addi r3,r3,16 ffc1c218: 48 00 5e 9d bl ffc220b4 <_Watchdog_Remove> 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(); ffc1c21c: 80 1b 28 f8 lwz r0,10488(r27) ffc1c220: 80 c1 00 1c lwz r6,28(r1) the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; ffc1c224: 39 20 00 03 li r9,3 _Watchdog_Initialize( &the_timer->Ticker, routine, id, user_data ); the_timer->Ticker.initial = seconds - _TOD_Seconds_since_epoch(); ffc1c228: 7f 80 e0 50 subf r28,r0,r28 (*timer_server->schedule_operation)( timer_server, the_timer ); ffc1c22c: 80 1f 00 04 lwz r0,4(r31) ffc1c230: 7f 44 d3 78 mr r4,r26 the_timer = _Timer_Get( id, &location ); switch ( location ) { case OBJECTS_LOCAL: (void) _Watchdog_Remove( &the_timer->Ticker ); the_timer->the_class = TIMER_TIME_OF_DAY_ON_TASK; ffc1c234: 91 3a 00 38 stw r9,56(r26) _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 ); ffc1c238: 7f e3 fb 78 mr r3,r31 ffc1c23c: 7c 09 03 a6 mtctr r0 ffc1c240: 90 da 00 34 stw r6,52(r26) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc1c244: 93 3a 00 18 stw r25,24(r26) the_watchdog->routine = routine; ffc1c248: 93 da 00 2c stw r30,44(r26) the_watchdog->id = id; ffc1c24c: 93 ba 00 30 stw r29,48(r26) 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(); ffc1c250: 93 9a 00 1c stw r28,28(r26) (*timer_server->schedule_operation)( timer_server, the_timer ); _Thread_Enable_dispatch(); return RTEMS_SUCCESSFUL; ffc1c254: 3b 40 00 00 li r26,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 ); ffc1c258: 4e 80 04 21 bctrl _Thread_Enable_dispatch(); ffc1c25c: 48 00 45 f9 bl ffc20854 <_Thread_Enable_dispatch> return RTEMS_SUCCESSFUL; ffc1c260: 4b ff ff 18 b ffc1c178 #endif case OBJECTS_ERROR: break; } return RTEMS_INVALID_ID; ffc1c264: 3b 40 00 04 li r26,4 ffc1c268: 4b ff ff 10 b ffc1c178 =============================================================================== ffc097f0 : int sched_get_priority_max( int policy ) { switch ( policy ) { ffc097f0: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_max( int policy ) { ffc097f4: 94 21 ff f8 stwu r1,-8(r1) ffc097f8: 7c 08 02 a6 mflr r0 ffc097fc: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc09800: 40 9d 00 24 ble- cr7,ffc09824 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc09804: 48 00 ad 81 bl ffc14584 <__errno> ffc09808: 38 00 00 16 li r0,22 ffc0980c: 90 03 00 00 stw r0,0(r3) ffc09810: 38 60 ff ff li r3,-1 } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; } ffc09814: 80 01 00 0c lwz r0,12(r1) ffc09818: 38 21 00 08 addi r1,r1,8 ffc0981c: 7c 08 03 a6 mtlr r0 ffc09820: 4e 80 00 20 blr int sched_get_priority_max( int policy ) { switch ( policy ) { ffc09824: 38 00 00 01 li r0,1 ffc09828: 7c 03 18 30 slw r3,r0,r3 ffc0982c: 70 60 00 17 andi. r0,r3,23 ffc09830: 41 a2 ff d4 beq- ffc09804 <== NEVER TAKEN default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; } ffc09834: 80 01 00 0c lwz r0,12(r1) default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; ffc09838: 3d 20 00 00 lis r9,0 ffc0983c: 88 69 27 24 lbz r3,10020(r9) } ffc09840: 38 21 00 08 addi r1,r1,8 ffc09844: 7c 08 03 a6 mtlr r0 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MAXIMUM_PRIORITY; ffc09848: 38 63 ff ff addi r3,r3,-1 } ffc0984c: 4e 80 00 20 blr =============================================================================== ffc09850 : int sched_get_priority_min( int policy ) { switch ( policy ) { ffc09850: 2b 83 00 04 cmplwi cr7,r3,4 #include int sched_get_priority_min( int policy ) { ffc09854: 94 21 ff f8 stwu r1,-8(r1) ffc09858: 7c 08 02 a6 mflr r0 ffc0985c: 90 01 00 0c stw r0,12(r1) switch ( policy ) { ffc09860: 40 9d 00 24 ble- cr7,ffc09884 case SCHED_RR: case SCHED_SPORADIC: break; default: rtems_set_errno_and_return_minus_one( EINVAL ); ffc09864: 48 00 ad 21 bl ffc14584 <__errno> ffc09868: 38 00 00 16 li r0,22 ffc0986c: 90 03 00 00 stw r0,0(r3) ffc09870: 38 60 ff ff li r3,-1 } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } ffc09874: 80 01 00 0c lwz r0,12(r1) ffc09878: 38 21 00 08 addi r1,r1,8 ffc0987c: 7c 08 03 a6 mtlr r0 ffc09880: 4e 80 00 20 blr int sched_get_priority_min( int policy ) { switch ( policy ) { ffc09884: 38 00 00 01 li r0,1 ffc09888: 7c 03 18 30 slw r3,r0,r3 ffc0988c: 70 60 00 17 andi. r0,r3,23 default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; ffc09890: 38 60 00 01 li r3,1 int sched_get_priority_min( int policy ) { switch ( policy ) { ffc09894: 41 a2 ff d0 beq- ffc09864 <== NEVER TAKEN default: rtems_set_errno_and_return_minus_one( EINVAL ); } return POSIX_SCHEDULER_MINIMUM_PRIORITY; } ffc09898: 80 01 00 0c lwz r0,12(r1) ffc0989c: 38 21 00 08 addi r1,r1,8 ffc098a0: 7c 08 03 a6 mtlr r0 ffc098a4: 4e 80 00 20 blr =============================================================================== ffc098a8 : int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc098a8: 94 21 ff e8 stwu r1,-24(r1) ffc098ac: 7c 08 02 a6 mflr r0 ffc098b0: 93 e1 00 14 stw r31,20(r1) /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc098b4: 7c 7f 1b 79 mr. r31,r3 int sched_rr_get_interval( pid_t pid, struct timespec *interval ) { ffc098b8: 90 01 00 1c stw r0,28(r1) /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc098bc: 40 82 00 30 bne- ffc098ec <== ALWAYS TAKEN rtems_set_errno_and_return_minus_one( ESRCH ); if ( !interval ) ffc098c0: 2f 84 00 00 cmpwi cr7,r4,0 ffc098c4: 41 9e 00 50 beq- cr7,ffc09914 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_From_ticks( _Thread_Ticks_per_timeslice, interval ); ffc098c8: 3d 20 00 00 lis r9,0 ffc098cc: 80 69 28 0c lwz r3,10252(r9) ffc098d0: 48 00 48 9d bl ffc0e16c <_Timespec_From_ticks> return 0; ffc098d4: 38 60 00 00 li r3,0 } ffc098d8: 80 01 00 1c lwz r0,28(r1) ffc098dc: 83 e1 00 14 lwz r31,20(r1) ffc098e0: 38 21 00 18 addi r1,r1,24 ffc098e4: 7c 08 03 a6 mtlr r0 ffc098e8: 4e 80 00 20 blr { /* * Only supported for the "calling process" (i.e. this node). */ if ( pid && pid != getpid() ) ffc098ec: 90 81 00 08 stw r4,8(r1) ffc098f0: 4b ff bb ed bl ffc054dc ffc098f4: 7f 83 f8 00 cmpw cr7,r3,r31 ffc098f8: 80 81 00 08 lwz r4,8(r1) ffc098fc: 41 9e ff c4 beq+ cr7,ffc098c0 rtems_set_errno_and_return_minus_one( ESRCH ); ffc09900: 48 00 ac 85 bl ffc14584 <__errno> ffc09904: 38 00 00 03 li r0,3 ffc09908: 90 03 00 00 stw r0,0(r3) ffc0990c: 38 60 ff ff li r3,-1 ffc09910: 4b ff ff c8 b ffc098d8 if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc09914: 48 00 ac 71 bl ffc14584 <__errno> ffc09918: 38 00 00 16 li r0,22 ffc0991c: 90 03 00 00 stw r0,0(r3) ffc09920: 38 60 ff ff li r3,-1 ffc09924: 4b ff ff b4 b ffc098d8 =============================================================================== ffc0c470 : * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc0c470: 3d 20 00 00 lis r9,0 int oflag, ... /* mode_t mode, */ /* unsigned int value */ ) { ffc0c474: 94 21 ff b8 stwu r1,-72(r1) ffc0c478: 7c 08 02 a6 mflr r0 ffc0c47c: 81 69 28 08 lwz r11,10248(r9) ffc0c480: 7d 80 00 26 mfcr r12 ffc0c484: 90 01 00 4c stw r0,76(r1) ffc0c488: 39 6b 00 01 addi r11,r11,1 ffc0c48c: 91 69 28 08 stw r11,10248(r9) ffc0c490: 93 c1 00 40 stw r30,64(r1) ffc0c494: 7c 7e 1b 78 mr r30,r3 ffc0c498: 93 e1 00 44 stw r31,68(r1) ffc0c49c: 7c 9f 23 78 mr r31,r4 ffc0c4a0: 93 81 00 38 stw r28,56(r1) ffc0c4a4: 93 a1 00 3c stw r29,60(r1) ffc0c4a8: 91 81 00 34 stw r12,52(r1) ffc0c4ac: 90 a1 00 28 stw r5,40(r1) ffc0c4b0: 90 c1 00 2c stw r6,44(r1) return _Thread_Dispatch_disable_level; ffc0c4b4: 80 09 28 08 lwz r0,10248(r9) POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0c4b8: 54 80 bf fe rlwinm r0,r4,23,31,31 ffc0c4bc: 2e 00 00 00 cmpwi cr4,r0,0 /* unsigned int value */ ) { va_list arg; mode_t mode; unsigned int value = 0; ffc0c4c0: 3b a0 00 00 li r29,0 POSIX_Semaphore_Control *the_semaphore; Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { ffc0c4c4: 40 92 00 c4 bne- cr4,ffc0c588 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); va_end(arg); } status = _POSIX_Semaphore_Name_to_id( name, &the_semaphore_id ); ffc0c4c8: 7f c3 f3 78 mr r3,r30 ffc0c4cc: 38 81 00 10 addi r4,r1,16 ffc0c4d0: 48 00 83 15 bl ffc147e4 <_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 ) { ffc0c4d4: 7c 7c 1b 79 mr. r28,r3 ffc0c4d8: 41 82 00 48 beq- ffc0c520 /* * 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) ) ) { ffc0c4dc: 2f 9c 00 02 cmpwi cr7,r28,2 ffc0c4e0: 40 9e 00 08 bne- cr7,ffc0c4e8 <== NEVER TAKEN ffc0c4e4: 40 92 00 c4 bne- cr4,ffc0c5a8 _Thread_Enable_dispatch(); ffc0c4e8: 48 00 3c 4d bl ffc10134 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); ffc0c4ec: 48 00 bf 09 bl ffc183f4 <__errno> id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c4f0: 80 01 00 4c lwz r0,76(r1) ffc0c4f4: 81 81 00 34 lwz r12,52(r1) ffc0c4f8: 7c 08 03 a6 mtlr r0 * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); ffc0c4fc: 93 83 00 00 stw r28,0(r3) id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c500: 7d 80 81 20 mtcrf 8,r12 * and we are willing to create then it is an error. */ if ( !( status == ENOENT && (oflag & O_CREAT) ) ) { _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( status, sem_t * ); ffc0c504: 38 60 ff ff li r3,-1 id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; } ffc0c508: 83 81 00 38 lwz r28,56(r1) ffc0c50c: 83 a1 00 3c lwz r29,60(r1) ffc0c510: 83 c1 00 40 lwz r30,64(r1) ffc0c514: 83 e1 00 44 lwz r31,68(r1) ffc0c518: 38 21 00 48 addi r1,r1,72 ffc0c51c: 4e 80 00 20 blr /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { ffc0c520: 73 ff 0a 00 andi. r31,r31,2560 ffc0c524: 2f 9f 0a 00 cmpwi cr7,r31,2560 ffc0c528: 41 9e 00 ac beq- cr7,ffc0c5d4 ffc0c52c: 80 81 00 10 lwz r4,16(r1) ffc0c530: 3c 60 00 00 lis r3,0 ffc0c534: 38 a1 00 08 addi r5,r1,8 ffc0c538: 38 63 30 ac addi r3,r3,12460 ffc0c53c: 48 00 2a 6d bl ffc0efa8 <_Objects_Get> _Thread_Enable_dispatch(); rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); } the_semaphore = _POSIX_Semaphore_Get( &the_semaphore_id, &location ); the_semaphore->open_count += 1; ffc0c540: 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 ); ffc0c544: 90 61 00 0c stw r3,12(r1) the_semaphore->open_count += 1; ffc0c548: 38 09 00 01 addi r0,r9,1 ffc0c54c: 90 03 00 18 stw r0,24(r3) _Thread_Enable_dispatch(); ffc0c550: 48 00 3b e5 bl ffc10134 <_Thread_Enable_dispatch> _Thread_Enable_dispatch(); ffc0c554: 48 00 3b e1 bl ffc10134 <_Thread_Enable_dispatch> the_semaphore->Semaphore_id = the_semaphore->Object.id; id = &the_semaphore->Semaphore_id; #else id = (sem_t *)&the_semaphore->Object.id; #endif return id; ffc0c558: 80 61 00 0c lwz r3,12(r1) ffc0c55c: 38 63 00 08 addi r3,r3,8 } ffc0c560: 80 01 00 4c lwz r0,76(r1) ffc0c564: 81 81 00 34 lwz r12,52(r1) ffc0c568: 7c 08 03 a6 mtlr r0 ffc0c56c: 83 81 00 38 lwz r28,56(r1) ffc0c570: 83 a1 00 3c lwz r29,60(r1) ffc0c574: 7d 80 81 20 mtcrf 8,r12 ffc0c578: 83 c1 00 40 lwz r30,64(r1) ffc0c57c: 83 e1 00 44 lwz r31,68(r1) ffc0c580: 38 21 00 48 addi r1,r1,72 ffc0c584: 4e 80 00 20 blr Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0c588: 38 01 00 50 addi r0,r1,80 mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0c58c: 83 a1 00 2c lwz r29,44(r1) Objects_Locations location; _Thread_Disable_dispatch(); if ( oflag & O_CREAT ) { va_start(arg, oflag); ffc0c590: 90 01 00 18 stw r0,24(r1) ffc0c594: 38 01 00 20 addi r0,r1,32 ffc0c598: 90 01 00 1c stw r0,28(r1) mode = (mode_t) va_arg( arg, unsigned int ); value = va_arg( arg, unsigned int ); ffc0c59c: 38 00 00 04 li r0,4 ffc0c5a0: 98 01 00 14 stb r0,20(r1) ffc0c5a4: 4b ff ff 24 b ffc0c4c8 /* * 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( ffc0c5a8: 38 80 00 00 li r4,0 ffc0c5ac: 7f a5 eb 78 mr r5,r29 ffc0c5b0: 38 c1 00 0c addi r6,r1,12 ffc0c5b4: 7f c3 f3 78 mr r3,r30 ffc0c5b8: 48 00 80 41 bl ffc145f8 <_POSIX_Semaphore_Create_support> ffc0c5bc: 7c 7f 1b 78 mr r31,r3 /* * errno was set by Create_support, so don't set it again. */ _Thread_Enable_dispatch(); ffc0c5c0: 48 00 3b 75 bl ffc10134 <_Thread_Enable_dispatch> if ( status == -1 ) ffc0c5c4: 2f 9f ff ff cmpwi cr7,r31,-1 return SEM_FAILED; ffc0c5c8: 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 ) ffc0c5cc: 40 9e ff 8c bne+ cr7,ffc0c558 ffc0c5d0: 4b ff ff 90 b ffc0c560 /* * Check for existence with creation. */ if ( (oflag & (O_CREAT | O_EXCL)) == (O_CREAT | O_EXCL) ) { _Thread_Enable_dispatch(); ffc0c5d4: 48 00 3b 61 bl ffc10134 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one_cast( EEXIST, sem_t * ); ffc0c5d8: 48 00 be 1d bl ffc183f4 <__errno> ffc0c5dc: 38 00 00 11 li r0,17 ffc0c5e0: 90 03 00 00 stw r0,0(r3) ffc0c5e4: 38 60 ff ff li r3,-1 ffc0c5e8: 4b ff ff 78 b ffc0c560 =============================================================================== ffc0c660 : int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { ffc0c660: 94 21 ff e0 stwu r1,-32(r1) ffc0c664: 7c 08 02 a6 mflr r0 ffc0c668: 93 e1 00 1c stw r31,28(r1) ffc0c66c: 7c 7f 1b 78 mr r31,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 ); ffc0c670: 7c 83 23 78 mr r3,r4 ffc0c674: 38 81 00 08 addi r4,r1,8 int sem_timedwait( sem_t *sem, const struct timespec *abstime ) { ffc0c678: 90 01 00 24 stw r0,36(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 ); ffc0c67c: 48 00 73 d5 bl ffc13a50 <_POSIX_Absolute_timeout_to_ticks> if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0c680: 2f 83 00 03 cmpwi cr7,r3,3 do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); ffc0c684: 80 a1 00 08 lwz r5,8(r1) ffc0c688: 7f e3 fb 78 mr r3,r31 * If the status is POSIX_ABSOLUTE_TIMEOUT_INVALID, * POSIX_ABSOLUTE_TIMEOUT_IS_IN_PAST, or POSIX_ABSOLUTE_TIMEOUT_IS_NOW, * then we should not wait. */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) ffc0c68c: 41 9e 00 20 beq- cr7,ffc0c6ac <== ALWAYS TAKEN do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); ffc0c690: 38 80 00 00 li r4,0 <== NOT EXECUTED ffc0c694: 48 00 82 05 bl ffc14898 <_POSIX_Semaphore_Wait_support><== NOT EXECUTED lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } ffc0c698: 80 01 00 24 lwz r0,36(r1) <== NOT EXECUTED ffc0c69c: 83 e1 00 1c lwz r31,28(r1) <== NOT EXECUTED ffc0c6a0: 38 21 00 20 addi r1,r1,32 <== NOT EXECUTED ffc0c6a4: 7c 08 03 a6 mtlr r0 <== NOT EXECUTED ffc0c6a8: 4e 80 00 20 blr <== NOT EXECUTED */ status = _POSIX_Absolute_timeout_to_ticks( abstime, &ticks ); if ( status != POSIX_ABSOLUTE_TIMEOUT_IS_IN_FUTURE ) do_wait = false; lock_status = _POSIX_Semaphore_Wait_support( sem, do_wait, ticks ); ffc0c6ac: 38 80 00 01 li r4,1 ffc0c6b0: 48 00 81 e9 bl ffc14898 <_POSIX_Semaphore_Wait_support> lock_status == POSIX_ABSOLUTE_TIMEOUT_IS_NOW ) rtems_set_errno_and_return_minus_one( ETIMEDOUT ); } return lock_status; } ffc0c6b4: 80 01 00 24 lwz r0,36(r1) ffc0c6b8: 83 e1 00 1c lwz r31,28(r1) ffc0c6bc: 38 21 00 20 addi r1,r1,32 ffc0c6c0: 7c 08 03 a6 mtlr r0 ffc0c6c4: 4e 80 00 20 blr =============================================================================== ffc0972c : struct sigaction *oact ) { ISR_Level level; if ( oact ) ffc0972c: 2c 05 00 00 cmpwi r5,0 int sigaction( int sig, const struct sigaction *act, struct sigaction *oact ) { ffc09730: 94 21 ff e8 stwu r1,-24(r1) ffc09734: 7c 08 02 a6 mflr r0 ffc09738: 93 c1 00 10 stw r30,16(r1) ffc0973c: 7c 9e 23 78 mr r30,r4 ffc09740: 93 e1 00 14 stw r31,20(r1) ffc09744: 7c 7f 1b 78 mr r31,r3 ffc09748: 90 01 00 1c stw r0,28(r1) ffc0974c: 93 a1 00 0c stw r29,12(r1) ISR_Level level; if ( oact ) ffc09750: 41 82 00 2c beq- ffc0977c *oact = _POSIX_signals_Vectors[ sig ]; ffc09754: 1c 03 00 0c mulli r0,r3,12 ffc09758: 3d 60 00 00 lis r11,0 ffc0975c: 39 6b 32 00 addi r11,r11,12800 ffc09760: 7d 2b 02 14 add r9,r11,r0 ffc09764: 7d 4b 00 2e lwzx r10,r11,r0 ffc09768: 81 69 00 04 lwz r11,4(r9) ffc0976c: 80 09 00 08 lwz r0,8(r9) ffc09770: 91 45 00 00 stw r10,0(r5) ffc09774: 91 65 00 04 stw r11,4(r5) ffc09778: 90 05 00 08 stw r0,8(r5) if ( !sig ) ffc0977c: 2f 9f 00 00 cmpwi cr7,r31,0 ffc09780: 41 9e 00 cc beq- cr7,ffc0984c static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc09784: 38 1f ff ff addi r0,r31,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(sig) ) ffc09788: 2b 80 00 1f cmplwi cr7,r0,31 ffc0978c: 41 9d 00 c0 bgt- cr7,ffc0984c * * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) ffc09790: 2f 9f 00 09 cmpwi cr7,r31,9 ffc09794: 41 9e 00 b8 beq- cr7,ffc0984c /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc09798: 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; ffc0979c: 38 60 00 00 li r3,0 /* * Evaluate the new action structure and set the global signal vector * appropriately. */ if ( act ) { ffc097a0: 41 9e 00 58 beq- cr7,ffc097f8 <== NEVER TAKEN static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc097a4: 7f a0 00 a6 mfmsr r29 ffc097a8: 7c 10 42 a6 mfsprg r0,0 ffc097ac: 7f a0 00 78 andc r0,r29,r0 ffc097b0: 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 ) { ffc097b4: 80 1e 00 08 lwz r0,8(r30) ffc097b8: 2f 80 00 00 cmpwi cr7,r0,0 ffc097bc: 41 9e 00 58 beq- cr7,ffc09814 _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; } else { _POSIX_signals_Clear_process_signals( sig ); ffc097c0: 7f e3 fb 78 mr r3,r31 ffc097c4: 48 00 78 19 bl ffc10fdc <_POSIX_signals_Clear_process_signals> _POSIX_signals_Vectors[ sig ] = *act; ffc097c8: 1f ff 00 0c mulli r31,r31,12 ffc097cc: 81 1e 00 00 lwz r8,0(r30) ffc097d0: 3d 60 00 00 lis r11,0 ffc097d4: 81 5e 00 04 lwz r10,4(r30) ffc097d8: 80 1e 00 08 lwz r0,8(r30) ffc097dc: 39 6b 32 00 addi r11,r11,12800 ffc097e0: 7d 2b fa 14 add r9,r11,r31 ffc097e4: 7d 0b f9 2e stwx r8,r11,r31 ffc097e8: 91 49 00 04 stw r10,4(r9) ffc097ec: 90 09 00 08 stw r0,8(r9) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc097f0: 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; ffc097f4: 38 60 00 00 li r3,0 } ffc097f8: 80 01 00 1c lwz r0,28(r1) ffc097fc: 83 a1 00 0c lwz r29,12(r1) ffc09800: 7c 08 03 a6 mtlr r0 ffc09804: 83 c1 00 10 lwz r30,16(r1) ffc09808: 83 e1 00 14 lwz r31,20(r1) ffc0980c: 38 21 00 18 addi r1,r1,24 ffc09810: 4e 80 00 20 blr * we can just copy the provided sigaction structure into the vectors. */ _ISR_Disable( level ); if ( act->sa_handler == SIG_DFL ) { _POSIX_signals_Vectors[ sig ] = _POSIX_signals_Default_vectors[ sig ]; ffc09814: 1f ff 00 0c mulli r31,r31,12 ffc09818: 3d 40 ff c2 lis r10,-62 ffc0981c: 39 4a e6 74 addi r10,r10,-6540 ffc09820: 7d 2a fa 14 add r9,r10,r31 ffc09824: 7d 0a f8 2e lwzx r8,r10,r31 ffc09828: 3d 60 00 00 lis r11,0 ffc0982c: 81 49 00 04 lwz r10,4(r9) ffc09830: 39 6b 32 00 addi r11,r11,12800 ffc09834: 80 09 00 08 lwz r0,8(r9) ffc09838: 7d 2b fa 14 add r9,r11,r31 ffc0983c: 7d 0b f9 2e stwx r8,r11,r31 ffc09840: 91 49 00 04 stw r10,4(r9) ffc09844: 90 09 00 08 stw r0,8(r9) ffc09848: 4b ff ff a8 b ffc097f0 * NOTE: Solaris documentation claims to "silently enforce" this which * contradicts the POSIX specification. */ if ( sig == SIGKILL ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc0984c: 48 00 b2 cd bl ffc14b18 <__errno> ffc09850: 38 00 00 16 li r0,22 ffc09854: 90 03 00 00 stw r0,0(r3) ffc09858: 38 60 ff ff li r3,-1 ffc0985c: 4b ff ff 9c b ffc097f8 =============================================================================== ffc09ccc : int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc09ccc: 94 21 ff d0 stwu r1,-48(r1) ffc09cd0: 7c 08 02 a6 mflr r0 ffc09cd4: 93 a1 00 24 stw r29,36(r1) ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc09cd8: 7c 7d 1b 79 mr. r29,r3 int sigtimedwait( const sigset_t *set, siginfo_t *info, const struct timespec *timeout ) { ffc09cdc: 93 c1 00 28 stw r30,40(r1) ffc09ce0: 7c be 2b 78 mr r30,r5 ffc09ce4: 93 e1 00 2c stw r31,44(r1) ffc09ce8: 7c 9f 23 78 mr r31,r4 ffc09cec: 90 01 00 34 stw r0,52(r1) ffc09cf0: 93 41 00 18 stw r26,24(r1) ffc09cf4: 93 61 00 1c stw r27,28(r1) ffc09cf8: 93 81 00 20 stw r28,32(r1) ISR_Level level; /* * Error check parameters before disabling interrupts. */ if ( !set ) ffc09cfc: 41 82 02 4c beq- ffc09f48 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; if ( timeout ) { ffc09d00: 2f 85 00 00 cmpwi cr7,r5,0 ffc09d04: 41 9e 01 a0 beq- cr7,ffc09ea4 if ( !_Timespec_Is_valid( timeout ) ) ffc09d08: 7c a3 2b 78 mr r3,r5 ffc09d0c: 48 00 49 61 bl ffc0e66c <_Timespec_Is_valid> ffc09d10: 2f 83 00 00 cmpwi cr7,r3,0 ffc09d14: 41 9e 02 34 beq- cr7,ffc09f48 rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); ffc09d18: 7f c3 f3 78 mr r3,r30 ffc09d1c: 48 00 49 d9 bl ffc0e6f4 <_Timespec_To_ticks> if ( !interval ) ffc09d20: 7c 64 1b 79 mr. r4,r3 ffc09d24: 41 82 02 24 beq- ffc09f48 <== NEVER TAKEN /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09d28: 2f 9f 00 00 cmpwi cr7,r31,0 ffc09d2c: 41 9e 01 84 beq- cr7,ffc09eb0 <== NEVER TAKEN the_thread = _Thread_Executing; ffc09d30: 3f 80 00 00 lis r28,0 ffc09d34: 3b 9c 31 84 addi r28,r28,12676 ffc09d38: 81 3c 00 0c lwz r9,12(r28) api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc09d3c: 83 49 01 34 lwz r26,308(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc09d40: 7f 60 00 a6 mfmsr r27 ffc09d44: 7c 10 42 a6 mfsprg r0,0 ffc09d48: 7f 60 00 78 andc r0,r27,r0 ffc09d4c: 7c 00 01 24 mtmsr r0 */ /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { ffc09d50: 80 1d 00 00 lwz r0,0(r29) ffc09d54: 80 7a 00 d4 lwz r3,212(r26) ffc09d58: 7c 0b 18 39 and. r11,r0,r3 ffc09d5c: 40 82 01 88 bne- ffc09ee4 return the_info->si_signo; } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { ffc09d60: 3d 60 00 00 lis r11,0 ffc09d64: 80 6b 28 bc lwz r3,10428(r11) ffc09d68: 7c 0b 18 39 and. r11,r0,r3 ffc09d6c: 40 82 00 d4 bne- ffc09e40 * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc09d70: 3d 60 00 00 lis r11,0 ffc09d74: 81 4b 28 78 lwz r10,10360(r11) ffc09d78: 38 0a 00 01 addi r0,r10,1 the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; return signo; } the_info->si_signo = -1; ffc09d7c: 39 40 ff ff li r10,-1 ffc09d80: 91 5f 00 00 stw r10,0(r31) ffc09d84: 90 0b 28 78 stw r0,10360(r11) return _Thread_Dispatch_disable_level; ffc09d88: 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; ffc09d8c: 38 00 00 04 li r0,4 ffc09d90: 90 09 00 34 stw r0,52(r9) } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc09d94: 3d 60 00 00 lis r11,0 ffc09d98: 39 6b 33 8c addi r11,r11,13196 the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; ffc09d9c: 80 1d 00 00 lwz r0,0(r29) the_thread->Wait.return_argument = the_info; ffc09da0: 93 e9 00 28 stw r31,40(r9) the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; ffc09da4: 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; ffc09da8: 38 00 00 01 li r0,1 } the_info->si_signo = -1; _Thread_Disable_dispatch(); the_thread->Wait.queue = &_POSIX_signals_Wait_queue; ffc09dac: 91 69 00 44 stw r11,68(r9) ffc09db0: 90 0b 00 30 stw r0,48(r11) return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc09db4: 7f 60 01 24 mtmsr r27 the_thread->Wait.return_code = EINTR; the_thread->Wait.option = *set; the_thread->Wait.return_argument = the_info; _Thread_queue_Enter_critical_section( &_POSIX_signals_Wait_queue ); _ISR_Enable( level ); _Thread_queue_Enqueue( &_POSIX_signals_Wait_queue, interval ); ffc09db8: 3c a0 ff c1 lis r5,-63 ffc09dbc: 3c 60 00 00 lis r3,0 ffc09dc0: 38 a5 e2 f0 addi r5,r5,-7440 ffc09dc4: 38 63 33 8c addi r3,r3,13196 ffc09dc8: 48 00 40 b9 bl ffc0de80 <_Thread_queue_Enqueue_with_handler> _Thread_Enable_dispatch(); ffc09dcc: 48 00 3a 9d bl ffc0d868 <_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 ); ffc09dd0: 80 9f 00 00 lwz r4,0(r31) ffc09dd4: 7f 43 d3 78 mr r3,r26 ffc09dd8: 7f e5 fb 78 mr r5,r31 ffc09ddc: 38 c0 00 00 li r6,0 ffc09de0: 38 e0 00 00 li r7,0 ffc09de4: 48 00 7b 1d bl ffc11900 <_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) ffc09de8: 81 3c 00 0c lwz r9,12(r28) ffc09dec: 80 09 00 34 lwz r0,52(r9) ffc09df0: 2f 80 00 04 cmpwi cr7,r0,4 ffc09df4: 40 9e 01 68 bne- cr7,ffc09f5c || !(*set & signo_to_mask( the_info->si_signo )) ) { ffc09df8: 83 df 00 00 lwz r30,0(r31) ffc09dfc: 39 60 00 01 li r11,1 ffc09e00: 80 1d 00 00 lwz r0,0(r29) ffc09e04: 39 3e ff ff addi r9,r30,-1 ffc09e08: 7d 69 48 30 slw r9,r11,r9 ffc09e0c: 7d 2b 00 39 and. r11,r9,r0 ffc09e10: 41 82 01 4c beq- ffc09f5c errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09e14: 80 01 00 34 lwz r0,52(r1) ffc09e18: 7f c3 f3 78 mr r3,r30 ffc09e1c: 83 41 00 18 lwz r26,24(r1) ffc09e20: 7c 08 03 a6 mtlr r0 ffc09e24: 83 61 00 1c lwz r27,28(r1) ffc09e28: 83 81 00 20 lwz r28,32(r1) ffc09e2c: 83 a1 00 24 lwz r29,36(r1) ffc09e30: 83 c1 00 28 lwz r30,40(r1) ffc09e34: 83 e1 00 2c lwz r31,44(r1) ffc09e38: 38 21 00 30 addi r1,r1,48 ffc09e3c: 4e 80 00 20 blr } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc09e40: 4b ff fe 31 bl ffc09c70 <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc09e44: 7f e5 fb 78 mr r5,r31 } /* Process pending signals? */ if ( *set & _POSIX_signals_Pending ) { signo = _POSIX_signals_Get_lowest( _POSIX_signals_Pending ); ffc09e48: 7c 7e 1b 78 mr r30,r3 _POSIX_signals_Clear_signals( api, signo, the_info, true, false ); ffc09e4c: 7f c4 f3 78 mr r4,r30 ffc09e50: 7f 43 d3 78 mr r3,r26 ffc09e54: 38 c0 00 01 li r6,1 ffc09e58: 38 e0 00 00 li r7,0 ffc09e5c: 48 00 7a a5 bl ffc11900 <_POSIX_signals_Clear_signals> ffc09e60: 7f 60 01 24 mtmsr r27 _ISR_Enable( level ); the_info->si_signo = signo; the_info->si_code = SI_USER; ffc09e64: 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; ffc09e68: 93 df 00 00 stw r30,0(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09e6c: 7f c3 f3 78 mr r3,r30 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; the_info->si_code = SI_USER; ffc09e70: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc09e74: 38 00 00 00 li r0,0 ffc09e78: 90 1f 00 08 stw r0,8(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09e7c: 80 01 00 34 lwz r0,52(r1) ffc09e80: 83 41 00 18 lwz r26,24(r1) ffc09e84: 7c 08 03 a6 mtlr r0 ffc09e88: 83 61 00 1c lwz r27,28(r1) ffc09e8c: 83 81 00 20 lwz r28,32(r1) ffc09e90: 83 a1 00 24 lwz r29,36(r1) ffc09e94: 83 c1 00 28 lwz r30,40(r1) ffc09e98: 83 e1 00 2c lwz r31,44(r1) ffc09e9c: 38 21 00 30 addi r1,r1,48 ffc09ea0: 4e 80 00 20 blr /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09ea4: 2f 9f 00 00 cmpwi cr7,r31,0 /* NOTE: This is very specifically a RELATIVE not ABSOLUTE time * in the Open Group specification. */ interval = 0; ffc09ea8: 38 80 00 00 li r4,0 /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09eac: 40 9e fe 84 bne+ cr7,ffc09d30 the_thread = _Thread_Executing; ffc09eb0: 3f 80 00 00 lis r28,0 ffc09eb4: 3b 9c 31 84 addi r28,r28,12676 ffc09eb8: 81 3c 00 0c lwz r9,12(r28) /* * Initialize local variables. */ the_info = ( info ) ? info : &signal_information; ffc09ebc: 3b e1 00 08 addi r31,r1,8 the_thread = _Thread_Executing; api = the_thread->API_Extensions[ THREAD_API_POSIX ]; ffc09ec0: 83 49 01 34 lwz r26,308(r9) static inline uint32_t ppc_interrupt_disable( void ) { uint32_t level; uint32_t mask; __asm__ volatile ( ffc09ec4: 7f 60 00 a6 mfmsr r27 ffc09ec8: 7c 10 42 a6 mfsprg r0,0 ffc09ecc: 7f 60 00 78 andc r0,r27,r0 ffc09ed0: 7c 00 01 24 mtmsr r0 */ /* API signals pending? */ _ISR_Disable( level ); if ( *set & api->signals_pending ) { ffc09ed4: 80 1d 00 00 lwz r0,0(r29) ffc09ed8: 80 7a 00 d4 lwz r3,212(r26) ffc09edc: 7c 0b 18 39 and. r11,r0,r3 ffc09ee0: 41 82 fe 80 beq+ ffc09d60 /* XXX real info later */ the_info->si_signo = _POSIX_signals_Get_lowest( api->signals_pending ); ffc09ee4: 4b ff fd 8d bl ffc09c70 <_POSIX_signals_Get_lowest> _POSIX_signals_Clear_signals( ffc09ee8: 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 ); ffc09eec: 90 7f 00 00 stw r3,0(r31) ffc09ef0: 7c 64 1b 78 mr r4,r3 _POSIX_signals_Clear_signals( ffc09ef4: 38 c0 00 00 li r6,0 ffc09ef8: 7f 43 d3 78 mr r3,r26 ffc09efc: 38 e0 00 00 li r7,0 ffc09f00: 48 00 7a 01 bl ffc11900 <_POSIX_signals_Clear_signals> return level; } static inline void ppc_interrupt_enable( uint32_t level ) { __asm__ volatile ( ffc09f04: 7f 60 01 24 mtmsr r27 false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc09f08: 38 00 00 01 li r0,1 the_info->si_value.sival_int = 0; return the_info->si_signo; ffc09f0c: 83 df 00 00 lwz r30,0(r31) false, false ); _ISR_Enable( level ); the_info->si_code = SI_USER; ffc09f10: 90 1f 00 04 stw r0,4(r31) the_info->si_value.sival_int = 0; ffc09f14: 38 00 00 00 li r0,0 errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09f18: 7f c3 f3 78 mr r3,r30 false ); _ISR_Enable( level ); the_info->si_code = SI_USER; the_info->si_value.sival_int = 0; ffc09f1c: 90 1f 00 08 stw r0,8(r31) errno = _Thread_Executing->Wait.return_code; return -1; } return the_info->si_signo; } ffc09f20: 80 01 00 34 lwz r0,52(r1) ffc09f24: 83 41 00 18 lwz r26,24(r1) ffc09f28: 7c 08 03 a6 mtlr r0 ffc09f2c: 83 61 00 1c lwz r27,28(r1) ffc09f30: 83 81 00 20 lwz r28,32(r1) ffc09f34: 83 a1 00 24 lwz r29,36(r1) ffc09f38: 83 c1 00 28 lwz r30,40(r1) ffc09f3c: 83 e1 00 2c lwz r31,44(r1) ffc09f40: 38 21 00 30 addi r1,r1,48 ffc09f44: 4e 80 00 20 blr rtems_set_errno_and_return_minus_one( EINVAL ); interval = _Timespec_To_ticks( timeout ); if ( !interval ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc09f48: 48 00 b4 01 bl ffc15348 <__errno> ffc09f4c: 38 00 00 16 li r0,22 ffc09f50: 90 03 00 00 stw r0,0(r3) ffc09f54: 3b c0 ff ff li r30,-1 ffc09f58: 4b ff fe bc b ffc09e14 * was not in our set. */ if ( (_Thread_Executing->Wait.return_code != EINTR) || !(*set & signo_to_mask( the_info->si_signo )) ) { errno = _Thread_Executing->Wait.return_code; ffc09f5c: 48 00 b3 ed bl ffc15348 <__errno> ffc09f60: 81 3c 00 0c lwz r9,12(r28) return -1; ffc09f64: 3b c0 ff ff li r30,-1 * was not in our set. */ if ( (_Thread_Executing->Wait.return_code != EINTR) || !(*set & signo_to_mask( the_info->si_signo )) ) { errno = _Thread_Executing->Wait.return_code; ffc09f68: 80 09 00 34 lwz r0,52(r9) ffc09f6c: 90 03 00 00 stw r0,0(r3) return -1; ffc09f70: 4b ff fe a4 b ffc09e14 =============================================================================== ffc0bfac : int sigwait( const sigset_t *set, int *sig ) { ffc0bfac: 94 21 ff f0 stwu r1,-16(r1) ffc0bfb0: 7c 08 02 a6 mflr r0 int status; status = sigtimedwait( set, NULL, NULL ); ffc0bfb4: 38 a0 00 00 li r5,0 int sigwait( const sigset_t *set, int *sig ) { ffc0bfb8: 93 e1 00 0c stw r31,12(r1) ffc0bfbc: 7c 9f 23 78 mr r31,r4 int status; status = sigtimedwait( set, NULL, NULL ); ffc0bfc0: 38 80 00 00 li r4,0 int sigwait( const sigset_t *set, int *sig ) { ffc0bfc4: 90 01 00 14 stw r0,20(r1) int status; status = sigtimedwait( set, NULL, NULL ); ffc0bfc8: 4b ff fd 19 bl ffc0bce0 if ( status != -1 ) { ffc0bfcc: 2f 83 ff ff cmpwi cr7,r3,-1 int *sig ) { int status; status = sigtimedwait( set, NULL, NULL ); ffc0bfd0: 7c 60 1b 78 mr r0,r3 if ( status != -1 ) { ffc0bfd4: 41 9e 00 28 beq- cr7,ffc0bffc if ( sig ) ffc0bfd8: 2f 9f 00 00 cmpwi cr7,r31,0 *sig = status; return 0; ffc0bfdc: 38 60 00 00 li r3,0 int status; status = sigtimedwait( set, NULL, NULL ); if ( status != -1 ) { if ( sig ) ffc0bfe0: 41 9e 00 08 beq- cr7,ffc0bfe8 <== NEVER TAKEN *sig = status; ffc0bfe4: 90 1f 00 00 stw r0,0(r31) return 0; } return errno; } ffc0bfe8: 80 01 00 14 lwz r0,20(r1) ffc0bfec: 83 e1 00 0c lwz r31,12(r1) ffc0bff0: 38 21 00 10 addi r1,r1,16 ffc0bff4: 7c 08 03 a6 mtlr r0 ffc0bff8: 4e 80 00 20 blr if ( sig ) *sig = status; return 0; } return errno; ffc0bffc: 48 00 b0 45 bl ffc17040 <__errno> } ffc0c000: 80 01 00 14 lwz r0,20(r1) if ( sig ) *sig = status; return 0; } return errno; ffc0c004: 80 63 00 00 lwz r3,0(r3) } ffc0c008: 7c 08 03 a6 mtlr r0 ffc0c00c: 83 e1 00 0c lwz r31,12(r1) ffc0c010: 38 21 00 10 addi r1,r1,16 ffc0c014: 4e 80 00 20 blr =============================================================================== ffc08c44 : int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { ffc08c44: 7d 80 00 26 mfcr r12 POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc08c48: 2f 83 00 01 cmpwi cr7,r3,1 int timer_create( clockid_t clock_id, struct sigevent *evp, timer_t *timerid ) { ffc08c4c: 94 21 ff e8 stwu r1,-24(r1) ffc08c50: 7c 08 02 a6 mflr r0 ffc08c54: 93 c1 00 10 stw r30,16(r1) ffc08c58: 7c be 2b 78 mr r30,r5 ffc08c5c: 93 e1 00 14 stw r31,20(r1) ffc08c60: 7c 9f 23 78 mr r31,r4 ffc08c64: 90 01 00 1c stw r0,28(r1) ffc08c68: 93 a1 00 0c stw r29,12(r1) ffc08c6c: 91 81 00 08 stw r12,8(r1) POSIX_Timer_Control *ptimer; if ( clock_id != CLOCK_REALTIME ) ffc08c70: 40 9e 01 08 bne- cr7,ffc08d78 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !timerid ) ffc08c74: 2f 85 00 00 cmpwi cr7,r5,0 ffc08c78: 41 9e 01 00 beq- cr7,ffc08d78 /* * The data of the structure evp are checked in order to verify if they * are coherent. */ if (evp != NULL) { ffc08c7c: 2e 04 00 00 cmpwi cr4,r4,0 ffc08c80: 41 92 00 2c beq- cr4,ffc08cac /* The structure has data */ if ( ( evp->sigev_notify != SIGEV_NONE ) && ffc08c84: 81 24 00 00 lwz r9,0(r4) ffc08c88: 38 09 ff ff addi r0,r9,-1 ffc08c8c: 2b 80 00 01 cmplwi cr7,r0,1 ffc08c90: 41 9d 00 e8 bgt- cr7,ffc08d78 <== 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 ) ffc08c94: 81 24 00 04 lwz r9,4(r4) ffc08c98: 2f 89 00 00 cmpwi cr7,r9,0 ffc08c9c: 41 9e 00 dc beq- cr7,ffc08d78 <== NEVER TAKEN static inline bool is_valid_signo( int signo ) { return ((signo) >= 1 && (signo) <= 32 ); ffc08ca0: 39 29 ff ff addi r9,r9,-1 rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) ffc08ca4: 2b 89 00 1f cmplwi cr7,r9,31 ffc08ca8: 41 9d 00 d0 bgt- cr7,ffc08d78 <== NEVER TAKEN * * This rountine increments the thread dispatch level */ RTEMS_INLINE_ROUTINE uint32_t _Thread_Dispatch_increment_disable_level(void) { _Thread_Dispatch_disable_level++; ffc08cac: 3d 20 00 00 lis r9,0 ffc08cb0: 81 69 28 54 lwz r11,10324(r9) ffc08cb4: 38 0b 00 01 addi r0,r11,1 ffc08cb8: 90 09 28 54 stw r0,10324(r9) return _Thread_Dispatch_disable_level; ffc08cbc: 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 ); ffc08cc0: 3f a0 00 00 lis r29,0 ffc08cc4: 3b bd 2f 2c addi r29,r29,12076 ffc08cc8: 7f a3 eb 78 mr r3,r29 ffc08ccc: 48 00 28 19 bl ffc0b4e4 <_Objects_Allocate> /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { ffc08cd0: 2c 03 00 00 cmpwi r3,0 ffc08cd4: 41 82 00 d8 beq- ffc08dac rtems_set_errno_and_return_minus_one( EAGAIN ); } /* The data of the created timer are stored to use them later */ ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ffc08cd8: 38 00 00 02 li r0,2 ffc08cdc: 98 03 00 3c stb r0,60(r3) ptimer->thread_id = _Thread_Executing->Object.id; ffc08ce0: 3d 20 00 00 lis r9,0 ffc08ce4: 81 29 31 70 lwz r9,12656(r9) ffc08ce8: 80 09 00 08 lwz r0,8(r9) ffc08cec: 90 03 00 38 stw r0,56(r3) if ( evp != NULL ) { ffc08cf0: 41 92 00 1c beq- cr4,ffc08d0c ptimer->inf.sigev_notify = evp->sigev_notify; ffc08cf4: 81 7f 00 00 lwz r11,0(r31) ptimer->inf.sigev_signo = evp->sigev_signo; ffc08cf8: 81 3f 00 04 lwz r9,4(r31) ptimer->inf.sigev_value = evp->sigev_value; ffc08cfc: 80 1f 00 08 lwz r0,8(r31) ptimer->state = POSIX_TIMER_STATE_CREATE_NEW; ptimer->thread_id = _Thread_Executing->Object.id; if ( evp != NULL ) { ptimer->inf.sigev_notify = evp->sigev_notify; ffc08d00: 91 63 00 40 stw r11,64(r3) ptimer->inf.sigev_signo = evp->sigev_signo; ffc08d04: 91 23 00 44 stw r9,68(r3) ptimer->inf.sigev_value = evp->sigev_value; ffc08d08: 90 03 00 48 stw r0,72(r3) uint32_t name ) { _Objects_Set_local_object( information, _Objects_Get_index( the_object->id ), ffc08d0c: 81 23 00 08 lwz r9,8(r3) } ptimer->overrun = 0; ffc08d10: 38 00 00 00 li r0,0 #if defined(RTEMS_DEBUG) if ( index > information->maximum ) return; #endif information->local_table[ index ] = the_object; ffc08d14: 81 5d 00 1c lwz r10,28(r29) ffc08d18: 55 2b 13 ba rlwinm r11,r9,2,14,29 ffc08d1c: 90 03 00 68 stw r0,104(r3) ptimer->timer_data.it_value.tv_sec = 0; ffc08d20: 90 03 00 5c stw r0,92(r3) ptimer->timer_data.it_value.tv_nsec = 0; ffc08d24: 90 03 00 60 stw r0,96(r3) ptimer->timer_data.it_interval.tv_sec = 0; ffc08d28: 90 03 00 54 stw r0,84(r3) ptimer->timer_data.it_interval.tv_nsec = 0; ffc08d2c: 90 03 00 58 stw r0,88(r3) Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc08d30: 90 03 00 18 stw r0,24(r3) the_watchdog->routine = routine; ffc08d34: 90 03 00 2c stw r0,44(r3) the_watchdog->id = id; ffc08d38: 90 03 00 30 stw r0,48(r3) the_watchdog->user_data = user_data; ffc08d3c: 90 03 00 34 stw r0,52(r3) ffc08d40: 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; ffc08d44: 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; ffc08d48: 91 3e 00 00 stw r9,0(r30) _Thread_Enable_dispatch(); ffc08d4c: 48 00 3e 55 bl ffc0cba0 <_Thread_Enable_dispatch> return 0; ffc08d50: 38 60 00 00 li r3,0 } ffc08d54: 80 01 00 1c lwz r0,28(r1) ffc08d58: 81 81 00 08 lwz r12,8(r1) ffc08d5c: 7c 08 03 a6 mtlr r0 ffc08d60: 83 a1 00 0c lwz r29,12(r1) ffc08d64: 83 c1 00 10 lwz r30,16(r1) ffc08d68: 7d 80 81 20 mtcrf 8,r12 ffc08d6c: 83 e1 00 14 lwz r31,20(r1) ffc08d70: 38 21 00 18 addi r1,r1,24 ffc08d74: 4e 80 00 20 blr if ( !evp->sigev_signo ) rtems_set_errno_and_return_minus_one( EINVAL ); if ( !is_valid_signo(evp->sigev_signo) ) rtems_set_errno_and_return_minus_one( EINVAL ); ffc08d78: 48 00 b9 c9 bl ffc14740 <__errno> ffc08d7c: 38 00 00 16 li r0,22 ffc08d80: 90 03 00 00 stw r0,0(r3) ffc08d84: 38 60 ff ff li r3,-1 _Objects_Open_u32(&_POSIX_Timer_Information, &ptimer->Object, 0); *timerid = ptimer->Object.id; _Thread_Enable_dispatch(); return 0; } ffc08d88: 80 01 00 1c lwz r0,28(r1) ffc08d8c: 81 81 00 08 lwz r12,8(r1) ffc08d90: 7c 08 03 a6 mtlr r0 ffc08d94: 83 a1 00 0c lwz r29,12(r1) ffc08d98: 83 c1 00 10 lwz r30,16(r1) ffc08d9c: 7d 80 81 20 mtcrf 8,r12 ffc08da0: 83 e1 00 14 lwz r31,20(r1) ffc08da4: 38 21 00 18 addi r1,r1,24 ffc08da8: 4e 80 00 20 blr /* * Allocate a timer */ ptimer = _POSIX_Timer_Allocate(); if ( !ptimer ) { _Thread_Enable_dispatch(); ffc08dac: 48 00 3d f5 bl ffc0cba0 <_Thread_Enable_dispatch> rtems_set_errno_and_return_minus_one( EAGAIN ); ffc08db0: 48 00 b9 91 bl ffc14740 <__errno> ffc08db4: 38 00 00 0b li r0,11 ffc08db8: 90 03 00 00 stw r0,0(r3) ffc08dbc: 38 60 ff ff li r3,-1 ffc08dc0: 4b ff ff 94 b ffc08d54 =============================================================================== ffc08dc4 : timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { ffc08dc4: 94 21 ff c8 stwu r1,-56(r1) ffc08dc8: 7c 08 02 a6 mflr r0 ffc08dcc: 93 a1 00 2c stw r29,44(r1) Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) ffc08dd0: 7c bd 2b 79 mr. r29,r5 timer_t timerid, int flags, const struct itimerspec *value, struct itimerspec *ovalue ) { ffc08dd4: 93 81 00 28 stw r28,40(r1) ffc08dd8: 7c 9c 23 78 mr r28,r4 ffc08ddc: 93 c1 00 30 stw r30,48(r1) ffc08de0: 7c de 33 78 mr r30,r6 ffc08de4: 93 e1 00 34 stw r31,52(r1) ffc08de8: 7c 7f 1b 78 mr r31,r3 ffc08dec: 90 01 00 3c stw r0,60(r1) Objects_Locations location; bool activated; uint32_t initial_period; struct itimerspec normalize; if ( !value ) ffc08df0: 41 82 01 b8 beq- ffc08fa8 <== 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) ) ) { ffc08df4: 38 7d 00 08 addi r3,r29,8 ffc08df8: 48 00 4b e9 bl ffc0d9e0 <_Timespec_Is_valid> ffc08dfc: 2f 83 00 00 cmpwi cr7,r3,0 ffc08e00: 41 9e 01 a8 beq- cr7,ffc08fa8 rtems_set_errno_and_return_minus_one( EINVAL ); } if ( !_Timespec_Is_valid( &(value->it_interval) ) ) { ffc08e04: 7f a3 eb 78 mr r3,r29 ffc08e08: 48 00 4b d9 bl ffc0d9e0 <_Timespec_Is_valid> ffc08e0c: 2f 83 00 00 cmpwi cr7,r3,0 ffc08e10: 41 9e 01 98 beq- cr7,ffc08fa8 <== NEVER TAKEN rtems_set_errno_and_return_minus_one( EINVAL ); } if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { ffc08e14: 2f 9c 00 04 cmpwi cr7,r28,4 ffc08e18: 41 9e 01 20 beq- cr7,ffc08f38 ffc08e1c: 2f 9c 00 00 cmpwi cr7,r28,0 ffc08e20: 40 9e 01 88 bne- cr7,ffc08fa8 rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08e24: 80 1d 00 0c lwz r0,12(r29) RTEMS_INLINE_ROUTINE POSIX_Timer_Control *_POSIX_Timer_Get ( timer_t id, Objects_Locations *location ) { return (POSIX_Timer_Control *) ffc08e28: 3c 60 00 00 lis r3,0 ffc08e2c: 81 5d 00 00 lwz r10,0(r29) ffc08e30: 7f e4 fb 78 mr r4,r31 ffc08e34: 81 7d 00 04 lwz r11,4(r29) ffc08e38: 38 63 2f 2c addi r3,r3,12076 ffc08e3c: 81 3d 00 08 lwz r9,8(r29) ffc08e40: 38 a1 00 08 addi r5,r1,8 ffc08e44: 90 01 00 20 stw r0,32(r1) ffc08e48: 91 41 00 14 stw r10,20(r1) ffc08e4c: 91 61 00 18 stw r11,24(r1) ffc08e50: 91 21 00 1c stw r9,28(r1) ffc08e54: 48 00 2c 81 bl ffc0bad4 <_Objects_Get> ffc08e58: 7c 7f 1b 78 mr r31,r3 * something with the structure of times of the timer: to stop, start * or start it again */ ptimer = _POSIX_Timer_Get( timerid, &location ); switch ( location ) { ffc08e5c: 80 01 00 08 lwz r0,8(r1) ffc08e60: 2f 80 00 00 cmpwi cr7,r0,0 ffc08e64: 40 9e 01 44 bne- cr7,ffc08fa8 <== NEVER TAKEN case OBJECTS_LOCAL: /* First, it verifies if the timer must be stopped */ if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) { ffc08e68: 80 01 00 1c lwz r0,28(r1) ffc08e6c: 2f 80 00 00 cmpwi cr7,r0,0 ffc08e70: 40 9e 00 10 bne- cr7,ffc08e80 ffc08e74: 80 01 00 20 lwz r0,32(r1) ffc08e78: 2f 80 00 00 cmpwi cr7,r0,0 ffc08e7c: 41 9e 01 40 beq- cr7,ffc08fbc _Thread_Enable_dispatch(); return 0; } /* Convert from seconds and nanoseconds to ticks */ ptimer->ticks = _Timespec_To_ticks( &value->it_interval ); ffc08e80: 7f a3 eb 78 mr r3,r29 ffc08e84: 48 00 4b e5 bl ffc0da68 <_Timespec_To_ticks> ffc08e88: 90 7f 00 64 stw r3,100(r31) initial_period = _Timespec_To_ticks( &normalize.it_value ); ffc08e8c: 38 61 00 1c addi r3,r1,28 ffc08e90: 48 00 4b d9 bl ffc0da68 <_Timespec_To_ticks> activated = _POSIX_Timer_Insert_helper( ffc08e94: 80 bf 00 08 lwz r5,8(r31) ffc08e98: 3c c0 ff c1 lis r6,-63 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 ); ffc08e9c: 7c 64 1b 78 mr r4,r3 activated = _POSIX_Timer_Insert_helper( ffc08ea0: 38 c6 90 3c addi r6,r6,-28612 ffc08ea4: 38 7f 00 10 addi r3,r31,16 ffc08ea8: 7f e7 fb 78 mr r7,r31 ffc08eac: 48 00 80 f1 bl ffc10f9c <_POSIX_Timer_Insert_helper> initial_period, ptimer->Object.id, _POSIX_Timer_TSR, ptimer ); if ( !activated ) { ffc08eb0: 2f 83 00 00 cmpwi cr7,r3,0 ffc08eb4: 41 9e 00 5c beq- cr7,ffc08f10 /* * The timer has been started and is running. So we return the * old ones in "ovalue" */ if ( ovalue ) ffc08eb8: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08ebc: 41 9e 00 24 beq- cr7,ffc08ee0 *ovalue = ptimer->timer_data; ffc08ec0: 81 5f 00 54 lwz r10,84(r31) ffc08ec4: 81 7f 00 58 lwz r11,88(r31) ffc08ec8: 81 3f 00 5c lwz r9,92(r31) ffc08ecc: 80 1f 00 60 lwz r0,96(r31) ffc08ed0: 91 5e 00 00 stw r10,0(r30) ffc08ed4: 91 7e 00 04 stw r11,4(r30) ffc08ed8: 91 3e 00 08 stw r9,8(r30) ffc08edc: 90 1e 00 0c stw r0,12(r30) ptimer->timer_data = normalize; ffc08ee0: 80 01 00 14 lwz r0,20(r1) /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; _TOD_Get( &ptimer->time ); ffc08ee4: 38 7f 00 6c addi r3,r31,108 * 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; ffc08ee8: 90 1f 00 54 stw r0,84(r31) ffc08eec: 80 01 00 18 lwz r0,24(r1) ffc08ef0: 90 1f 00 58 stw r0,88(r31) ffc08ef4: 80 01 00 1c lwz r0,28(r1) ffc08ef8: 90 1f 00 5c stw r0,92(r31) ffc08efc: 80 01 00 20 lwz r0,32(r1) ffc08f00: 90 1f 00 60 stw r0,96(r31) /* Indicate that the time is running */ ptimer->state = POSIX_TIMER_STATE_CREATE_RUN; ffc08f04: 38 00 00 03 li r0,3 ffc08f08: 98 1f 00 3c stb r0,60(r31) _TOD_Get( &ptimer->time ); ffc08f0c: 48 00 1f 81 bl ffc0ae8c <_TOD_Get> _Thread_Enable_dispatch(); ffc08f10: 48 00 3c 91 bl ffc0cba0 <_Thread_Enable_dispatch> return 0; ffc08f14: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc08f18: 80 01 00 3c lwz r0,60(r1) ffc08f1c: 83 81 00 28 lwz r28,40(r1) ffc08f20: 7c 08 03 a6 mtlr r0 ffc08f24: 83 a1 00 2c lwz r29,44(r1) ffc08f28: 83 c1 00 30 lwz r30,48(r1) ffc08f2c: 83 e1 00 34 lwz r31,52(r1) ffc08f30: 38 21 00 38 addi r1,r1,56 ffc08f34: 4e 80 00 20 blr if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08f38: 81 5d 00 00 lwz r10,0(r29) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08f3c: 38 61 00 0c addi r3,r1,12 if ( flags != TIMER_ABSTIME && flags != POSIX_TIMER_RELATIVE ) { rtems_set_errno_and_return_minus_one( EINVAL ); } normalize = *value; ffc08f40: 81 7d 00 04 lwz r11,4(r29) ffc08f44: 81 3d 00 08 lwz r9,8(r29) ffc08f48: 80 1d 00 0c lwz r0,12(r29) ffc08f4c: 91 41 00 14 stw r10,20(r1) ffc08f50: 91 61 00 18 stw r11,24(r1) ffc08f54: 91 21 00 1c stw r9,28(r1) ffc08f58: 90 01 00 20 stw r0,32(r1) /* Convert absolute to relative time */ if (flags == TIMER_ABSTIME) { struct timespec now; _TOD_Get( &now ); ffc08f5c: 48 00 1f 31 bl ffc0ae8c <_TOD_Get> /* Check for seconds in the past */ if ( _Timespec_Greater_than( &now, &normalize.it_value ) ) ffc08f60: 38 61 00 0c addi r3,r1,12 ffc08f64: 38 81 00 1c addi r4,r1,28 ffc08f68: 48 00 4a 3d bl ffc0d9a4 <_Timespec_Greater_than> ffc08f6c: 2f 83 00 00 cmpwi cr7,r3,0 ffc08f70: 40 9e 00 38 bne- cr7,ffc08fa8 rtems_set_errno_and_return_minus_one( EINVAL ); _Timespec_Subtract( &now, &normalize.it_value, &normalize.it_value ); ffc08f74: 38 81 00 1c addi r4,r1,28 ffc08f78: 7c 85 23 78 mr r5,r4 ffc08f7c: 38 61 00 0c addi r3,r1,12 ffc08f80: 48 00 4a 9d bl ffc0da1c <_Timespec_Subtract> ffc08f84: 3c 60 00 00 lis r3,0 ffc08f88: 7f e4 fb 78 mr r4,r31 ffc08f8c: 38 63 2f 2c addi r3,r3,12076 ffc08f90: 38 a1 00 08 addi r5,r1,8 ffc08f94: 48 00 2b 41 bl ffc0bad4 <_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 ) { ffc08f98: 80 01 00 08 lwz r0,8(r1) ffc08f9c: 7c 7f 1b 78 mr r31,r3 ffc08fa0: 2f 80 00 00 cmpwi cr7,r0,0 ffc08fa4: 41 be fe c4 beq- cr7,ffc08e68 #endif case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); ffc08fa8: 48 00 b7 99 bl ffc14740 <__errno> ffc08fac: 38 00 00 16 li r0,22 ffc08fb0: 90 03 00 00 stw r0,0(r3) ffc08fb4: 38 60 ff ff li r3,-1 ffc08fb8: 4b ff ff 60 b ffc08f18 case OBJECTS_LOCAL: /* First, it verifies if the timer must be stopped */ if ( normalize.it_value.tv_sec == 0 && normalize.it_value.tv_nsec == 0 ) { /* Stop the timer */ (void) _Watchdog_Remove( &ptimer->Timer ); ffc08fbc: 38 63 00 10 addi r3,r3,16 ffc08fc0: 48 00 51 c1 bl ffc0e180 <_Watchdog_Remove> /* The old data of the timer are returned */ if ( ovalue ) ffc08fc4: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08fc8: 41 9e 00 24 beq- cr7,ffc08fec *ovalue = ptimer->timer_data; ffc08fcc: 81 5f 00 54 lwz r10,84(r31) ffc08fd0: 81 7f 00 58 lwz r11,88(r31) ffc08fd4: 81 3f 00 5c lwz r9,92(r31) ffc08fd8: 80 1f 00 60 lwz r0,96(r31) ffc08fdc: 91 5e 00 00 stw r10,0(r30) ffc08fe0: 91 7e 00 04 stw r11,4(r30) ffc08fe4: 91 3e 00 08 stw r9,8(r30) ffc08fe8: 90 1e 00 0c stw r0,12(r30) /* The new data are set */ ptimer->timer_data = normalize; ffc08fec: 80 01 00 14 lwz r0,20(r1) ffc08ff0: 90 1f 00 54 stw r0,84(r31) ffc08ff4: 80 01 00 18 lwz r0,24(r1) ffc08ff8: 90 1f 00 58 stw r0,88(r31) ffc08ffc: 80 01 00 1c lwz r0,28(r1) ffc09000: 90 1f 00 5c stw r0,92(r31) ffc09004: 80 01 00 20 lwz r0,32(r1) ffc09008: 90 1f 00 60 stw r0,96(r31) /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; ffc0900c: 38 00 00 04 li r0,4 ffc09010: 98 1f 00 3c stb r0,60(r31) /* Returns with success */ _Thread_Enable_dispatch(); ffc09014: 48 00 3b 8d bl ffc0cba0 <_Thread_Enable_dispatch> case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc09018: 80 01 00 3c lwz r0,60(r1) ptimer->timer_data = normalize; /* Indicates that the timer is created and stopped */ ptimer->state = POSIX_TIMER_STATE_CREATE_STOP; /* Returns with success */ _Thread_Enable_dispatch(); return 0; ffc0901c: 38 60 00 00 li r3,0 case OBJECTS_ERROR: break; } rtems_set_errno_and_return_minus_one( EINVAL ); } ffc09020: 83 81 00 28 lwz r28,40(r1) ffc09024: 7c 08 03 a6 mtlr r0 ffc09028: 83 a1 00 2c lwz r29,44(r1) ffc0902c: 83 c1 00 30 lwz r30,48(r1) ffc09030: 83 e1 00 34 lwz r31,52(r1) ffc09034: 38 21 00 38 addi r1,r1,56 ffc09038: 4e 80 00 20 blr =============================================================================== ffc08b8c : useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08b8c: 94 21 ff d8 stwu r1,-40(r1) ffc08b90: 7c 08 02 a6 mflr r0 ffc08b94: 93 e1 00 24 stw r31,36(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08b98: 3f e0 00 00 lis r31,0 ffc08b9c: 3b ff 35 74 addi r31,r31,13684 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08ba0: 90 01 00 2c stw r0,44(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08ba4: 80 1f 00 1c lwz r0,28(r31) useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08ba8: 93 c1 00 20 stw r30,32(r1) ffc08bac: 7c 7e 1b 78 mr r30,r3 /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08bb0: 2f 80 00 00 cmpwi cr7,r0,0 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { ffc08bb4: 93 a1 00 1c stw r29,28(r1) /* * Initialize the timer used to implement alarm(). */ if ( !the_timer->routine ) { ffc08bb8: 41 9e 00 a4 beq- cr7,ffc08c5c _Watchdog_Initialize( the_timer, _POSIX_signals_Ualarm_TSR, 0, NULL ); } else { Watchdog_States state; state = _Watchdog_Remove( the_timer ); ffc08bbc: 7f e3 fb 78 mr r3,r31 ffc08bc0: 48 00 50 a1 bl ffc0dc60 <_Watchdog_Remove> useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc08bc4: 3b a0 00 00 li r29,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) ) { ffc08bc8: 38 63 ff fe addi r3,r3,-2 ffc08bcc: 2b 83 00 01 cmplwi cr7,r3,1 ffc08bd0: 40 9d 00 ac ble- cr7,ffc08c7c <== ALWAYS TAKEN /* * 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 ) { ffc08bd4: 2f 9e 00 00 cmpwi cr7,r30,0 ffc08bd8: 41 be 00 64 beq+ cr7,ffc08c3c Watchdog_Interval ticks; tp.tv_sec = useconds / TOD_MICROSECONDS_PER_SECOND; ffc08bdc: 3c 00 43 1b lis r0,17179 ffc08be0: 60 00 de 83 ori r0,r0,56963 ffc08be4: 7c 1e 00 16 mulhwu r0,r30,r0 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ticks = _Timespec_To_ticks( &tp ); ffc08be8: 38 61 00 08 addi r3,r1,8 * 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; ffc08bec: 54 00 74 be rlwinm r0,r0,14,18,31 tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc08bf0: 54 0b 40 2e rlwinm r11,r0,8,0,23 * 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; ffc08bf4: 90 01 00 08 stw r0,8(r1) tp.tv_nsec = (useconds % TOD_MICROSECONDS_PER_SECOND) * 1000; ffc08bf8: 54 09 18 38 rlwinm r9,r0,3,0,28 ffc08bfc: 7d 29 58 50 subf r9,r9,r11 ffc08c00: 55 2b 30 32 rlwinm r11,r9,6,0,25 ffc08c04: 7d 29 58 50 subf r9,r9,r11 ffc08c08: 7d 29 02 14 add r9,r9,r0 ffc08c0c: 55 29 30 32 rlwinm r9,r9,6,0,25 ffc08c10: 7f c9 f0 50 subf r30,r9,r30 ffc08c14: 1f de 03 e8 mulli r30,r30,1000 ffc08c18: 93 c1 00 0c stw r30,12(r1) ticks = _Timespec_To_ticks( &tp ); ffc08c1c: 48 00 48 11 bl ffc0d42c <_Timespec_To_ticks> if ( ticks == 0 ) ticks = 1; _Watchdog_Insert_ticks( the_timer, _Timespec_To_ticks( &tp ) ); ffc08c20: 38 61 00 08 addi r3,r1,8 ffc08c24: 48 00 48 09 bl ffc0d42c <_Timespec_To_ticks> ) { the_watchdog->initial = units; _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08c28: 7f e4 fb 78 mr r4,r31 Watchdog_Control *the_watchdog, Watchdog_Interval units ) { the_watchdog->initial = units; ffc08c2c: 90 7f 00 0c stw r3,12(r31) _Watchdog_Insert( &_Watchdog_Ticks_chain, the_watchdog ); ffc08c30: 3c 60 00 00 lis r3,0 ffc08c34: 38 63 2d a8 addi r3,r3,11688 ffc08c38: 48 00 4e 61 bl ffc0da98 <_Watchdog_Insert> } return remaining; } ffc08c3c: 80 01 00 2c lwz r0,44(r1) ffc08c40: 7f a3 eb 78 mr r3,r29 ffc08c44: 83 c1 00 20 lwz r30,32(r1) ffc08c48: 7c 08 03 a6 mtlr r0 ffc08c4c: 83 a1 00 1c lwz r29,28(r1) ffc08c50: 83 e1 00 24 lwz r31,36(r1) ffc08c54: 38 21 00 28 addi r1,r1,40 ffc08c58: 4e 80 00 20 blr Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; the_watchdog->routine = routine; ffc08c5c: 3d 20 ff c1 lis r9,-63 Watchdog_Service_routine_entry routine, Objects_Id id, void *user_data ) { the_watchdog->state = WATCHDOG_INACTIVE; ffc08c60: 90 1f 00 08 stw r0,8(r31) the_watchdog->routine = routine; ffc08c64: 39 29 8b 3c addi r9,r9,-29892 useconds_t ualarm( useconds_t useconds, useconds_t interval ) { useconds_t remaining = 0; ffc08c68: 3b a0 00 00 li r29,0 ffc08c6c: 91 3f 00 1c stw r9,28(r31) the_watchdog->id = id; ffc08c70: 90 1f 00 20 stw r0,32(r31) the_watchdog->user_data = user_data; ffc08c74: 90 1f 00 24 stw r0,36(r31) ffc08c78: 4b ff ff 5c b ffc08bd4 * 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); ffc08c7c: 81 3f 00 0c lwz r9,12(r31) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc08c80: 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); ffc08c84: 80 7f 00 14 lwz r3,20(r31) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; remaining += tp.tv_nsec / 1000; ffc08c88: 3f a0 10 62 lis r29,4194 * 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); ffc08c8c: 80 1f 00 18 lwz r0,24(r31) /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; remaining += tp.tv_nsec / 1000; ffc08c90: 63 bd 4d d3 ori r29,r29,19923 * 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); ffc08c94: 7c 63 4a 14 add r3,r3,r9 /* remaining is now in ticks */ _Timespec_From_ticks( ticks, &tp ); ffc08c98: 7c 60 18 50 subf r3,r0,r3 ffc08c9c: 48 00 46 f9 bl ffc0d394 <_Timespec_From_ticks> remaining = tp.tv_sec * TOD_MICROSECONDS_PER_SECOND; ffc08ca0: 80 01 00 08 lwz r0,8(r1) remaining += tp.tv_nsec / 1000; ffc08ca4: 81 21 00 0c lwz r9,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; ffc08ca8: 54 0a 40 2e rlwinm r10,r0,8,0,23 ffc08cac: 54 0b 18 38 rlwinm r11,r0,3,0,28 ffc08cb0: 7d 6b 50 50 subf r11,r11,r10 remaining += tp.tv_nsec / 1000; ffc08cb4: 7f a9 e8 96 mulhw r29,r9,r29 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; ffc08cb8: 55 6a 30 32 rlwinm r10,r11,6,0,25 ffc08cbc: 7d 6b 50 50 subf r11,r11,r10 ffc08cc0: 7c 0b 02 14 add r0,r11,r0 remaining += tp.tv_nsec / 1000; ffc08cc4: 7f bd 36 70 srawi r29,r29,6 ffc08cc8: 7d 29 fe 70 srawi r9,r9,31 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; ffc08ccc: 54 00 30 32 rlwinm r0,r0,6,0,25 remaining += tp.tv_nsec / 1000; ffc08cd0: 7f a9 e8 50 subf r29,r9,r29 ffc08cd4: 7f bd 02 14 add r29,r29,r0 ffc08cd8: 4b ff fe fc b ffc08bd4